libata-acpi.c 21.0 KB
Newer Older
1 2 3 4 5 6 7 8
/*
 * libata-acpi.c
 * Provides ACPI support for PATA/SATA.
 *
 * Copyright (C) 2006 Intel Corp.
 * Copyright (C) 2006 Randy Dunlap
 */

9
#include <linux/module.h>
10 11 12 13 14 15 16 17
#include <linux/ata.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/acpi.h>
#include <linux/libata.h>
#include <linux/pci.h>
18
#include <scsi/scsi_device.h>
19 20 21 22 23 24 25 26 27 28
#include "libata.h"

#include <acpi/acpi_bus.h>
#include <acpi/acnames.h>
#include <acpi/acnamesp.h>
#include <acpi/acparser.h>
#include <acpi/acexcep.h>
#include <acpi/acmacros.h>
#include <acpi/actypes.h>

29 30 31 32 33 34 35 36 37 38 39 40
enum {
	ATA_ACPI_FILTER_SETXFER	= 1 << 0,
	ATA_ACPI_FILTER_LOCK	= 1 << 1,

	ATA_ACPI_FILTER_DEFAULT	= ATA_ACPI_FILTER_SETXFER |
				  ATA_ACPI_FILTER_LOCK,
};

static unsigned int ata_acpi_gtf_filter = ATA_ACPI_FILTER_DEFAULT;
module_param_named(acpi_gtf_filter, ata_acpi_gtf_filter, int, 0644);
MODULE_PARM_DESC(acpi_gtf_filter, "filter mask for ACPI _GTF commands, set to filter out (0x1=set xfermode, 0x2=lock/freeze lock)");

41
#define NO_PORT_MULT		0xffff
42
#define SATA_ADR(root, pmp)	(((root) << 16) | (pmp))
43 44

#define REGS_PER_GTF		7
45 46 47
struct ata_acpi_gtf {
	u8	tf[REGS_PER_GTF];	/* regs. 0x1f1 - 0x1f7 */
} __packed;
48

49 50 51 52 53 54 55
/*
 *	Helper - belongs in the PCI layer somewhere eventually
 */
static int is_pci_dev(struct device *dev)
{
	return (dev->bus == &pci_bus_type);
}
56

57 58 59 60 61 62
static void ata_acpi_clear_gtf(struct ata_device *dev)
{
	kfree(dev->gtf_cache);
	dev->gtf_cache = NULL;
}

63 64 65 66 67 68 69 70 71 72 73 74 75 76
/**
 * ata_acpi_associate_sata_port - associate SATA port with ACPI objects
 * @ap: target SATA port
 *
 * Look up ACPI objects associated with @ap and initialize acpi_handle
 * fields of @ap, the port and devices accordingly.
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -errno on failure.
 */
void ata_acpi_associate_sata_port(struct ata_port *ap)
77
{
78 79 80 81 82 83 84 85 86 87 88 89 90 91
	WARN_ON(!(ap->flags & ATA_FLAG_ACPI_SATA));

	if (!ap->nr_pmp_links) {
		acpi_integer adr = SATA_ADR(ap->port_no, NO_PORT_MULT);

		ap->link.device->acpi_handle =
			acpi_get_child(ap->host->acpi_handle, adr);
	} else {
		struct ata_link *link;

		ap->link.device->acpi_handle = NULL;

		ata_port_for_each_link(link, ap) {
			acpi_integer adr = SATA_ADR(ap->port_no, link->pmp);
92

93 94 95 96
			link->device->acpi_handle =
				acpi_get_child(ap->host->acpi_handle, adr);
		}
	}
97 98
}

99
static void ata_acpi_associate_ide_port(struct ata_port *ap)
100
{
101
	int max_devices, i;
102

103 104 105
	ap->acpi_handle = acpi_get_child(ap->host->acpi_handle, ap->port_no);
	if (!ap->acpi_handle)
		return;
106

107 108 109
	max_devices = 1;
	if (ap->flags & ATA_FLAG_SLAVE_POSS)
		max_devices++;
110

111
	for (i = 0; i < max_devices; i++) {
T
Tejun Heo 已提交
112
		struct ata_device *dev = &ap->link.device[i];
113

114
		dev->acpi_handle = acpi_get_child(ap->acpi_handle, i);
115
	}
116 117 118

	if (ata_acpi_gtm(ap, &ap->__acpi_init_gtm) == 0)
		ap->pflags |= ATA_PFLAG_INIT_GTM_VALID;
119 120
}

121 122
static void ata_acpi_handle_hotplug(struct ata_port *ap, struct kobject *kobj,
				    u32 event)
123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138
{
	char event_string[12];
	char *envp[] = { event_string, NULL };
	struct ata_eh_info *ehi = &ap->link.eh_info;

	if (event == 0 || event == 1) {
	       unsigned long flags;
	       spin_lock_irqsave(ap->lock, flags);
	       ata_ehi_clear_desc(ehi);
	       ata_ehi_push_desc(ehi, "ACPI event");
	       ata_ehi_hotplugged(ehi);
	       ata_port_freeze(ap);
	       spin_unlock_irqrestore(ap->lock, flags);
	}

	if (kobj) {
139
		sprintf(event_string, "BAY_EVENT=%d", event);
140 141 142 143 144 145 146 147 148 149 150 151
		kobject_uevent_env(kobj, KOBJ_CHANGE, envp);
	}
}

static void ata_acpi_dev_notify(acpi_handle handle, u32 event, void *data)
{
	struct ata_device *dev = data;
	struct kobject *kobj = NULL;

	if (dev->sdev)
		kobj = &dev->sdev->sdev_gendev.kobj;

152
	ata_acpi_handle_hotplug(dev->link->ap, kobj, event);
153 154 155 156 157 158
}

static void ata_acpi_ap_notify(acpi_handle handle, u32 event, void *data)
{
	struct ata_port *ap = data;

159
	ata_acpi_handle_hotplug(ap, &ap->dev->kobj, event);
160 161
}

162 163 164 165 166 167 168 169 170 171 172 173 174 175
/**
 * ata_acpi_associate - associate ATA host with ACPI objects
 * @host: target ATA host
 *
 * Look up ACPI objects associated with @host and initialize
 * acpi_handle fields of @host, its ports and devices accordingly.
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -errno on failure.
 */
void ata_acpi_associate(struct ata_host *host)
176
{
177
	int i, j;
178

179 180
	if (!is_pci_dev(host->dev) || libata_noacpi)
		return;
181

182 183 184
	host->acpi_handle = DEVICE_ACPI_HANDLE(host->dev);
	if (!host->acpi_handle)
		return;
185

186 187 188 189 190 191 192
	for (i = 0; i < host->n_ports; i++) {
		struct ata_port *ap = host->ports[i];

		if (host->ports[0]->flags & ATA_FLAG_ACPI_SATA)
			ata_acpi_associate_sata_port(ap);
		else
			ata_acpi_associate_ide_port(ap);
193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208

		if (ap->acpi_handle)
			acpi_install_notify_handler (ap->acpi_handle,
						     ACPI_SYSTEM_NOTIFY,
						     ata_acpi_ap_notify,
						     ap);

		for (j = 0; j < ata_link_max_devices(&ap->link); j++) {
			struct ata_device *dev = &ap->link.device[j];

			if (dev->acpi_handle)
				acpi_install_notify_handler (dev->acpi_handle,
							     ACPI_SYSTEM_NOTIFY,
							     ata_acpi_dev_notify,
							     dev);
		}
209 210 211
	}
}

212 213 214 215 216 217 218 219 220 221 222 223
/**
 * ata_acpi_dissociate - dissociate ATA host from ACPI objects
 * @host: target ATA host
 *
 * This function is called during driver detach after the whole host
 * is shut down.
 *
 * LOCKING:
 * EH context.
 */
void ata_acpi_dissociate(struct ata_host *host)
{
224 225 226 227 228 229 230 231 232 233 234 235
	int i;

	/* Restore initial _GTM values so that driver which attaches
	 * afterward can use them too.
	 */
	for (i = 0; i < host->n_ports; i++) {
		struct ata_port *ap = host->ports[i];
		const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);

		if (ap->acpi_handle && gtm)
			ata_acpi_stm(ap, gtm);
	}
236 237
}

238 239 240 241 242 243 244 245 246 247 248 249 250
/**
 * ata_acpi_gtm - execute _GTM
 * @ap: target ATA port
 * @gtm: out parameter for _GTM result
 *
 * Evaluate _GTM and store the result in @gtm.
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -ENOENT if _GTM doesn't exist, -errno on failure.
 */
251
int ata_acpi_gtm(struct ata_port *ap, struct ata_acpi_gtm *gtm)
252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294
{
	struct acpi_buffer output = { .length = ACPI_ALLOCATE_BUFFER };
	union acpi_object *out_obj;
	acpi_status status;
	int rc = 0;

	status = acpi_evaluate_object(ap->acpi_handle, "_GTM", NULL, &output);

	rc = -ENOENT;
	if (status == AE_NOT_FOUND)
		goto out_free;

	rc = -EINVAL;
	if (ACPI_FAILURE(status)) {
		ata_port_printk(ap, KERN_ERR,
				"ACPI get timing mode failed (AE 0x%x)\n",
				status);
		goto out_free;
	}

	out_obj = output.pointer;
	if (out_obj->type != ACPI_TYPE_BUFFER) {
		ata_port_printk(ap, KERN_WARNING,
				"_GTM returned unexpected object type 0x%x\n",
				out_obj->type);

		goto out_free;
	}

	if (out_obj->buffer.length != sizeof(struct ata_acpi_gtm)) {
		ata_port_printk(ap, KERN_ERR,
				"_GTM returned invalid length %d\n",
				out_obj->buffer.length);
		goto out_free;
	}

	memcpy(gtm, out_obj->buffer.pointer, sizeof(struct ata_acpi_gtm));
	rc = 0;
 out_free:
	kfree(output.pointer);
	return rc;
}

295 296
EXPORT_SYMBOL_GPL(ata_acpi_gtm);

297 298 299 300 301 302 303 304 305 306 307 308 309
/**
 * ata_acpi_stm - execute _STM
 * @ap: target ATA port
 * @stm: timing parameter to _STM
 *
 * Evaluate _STM with timing parameter @stm.
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -ENOENT if _STM doesn't exist, -errno on failure.
 */
310
int ata_acpi_stm(struct ata_port *ap, const struct ata_acpi_gtm *stm)
311 312
{
	acpi_status status;
313
	struct ata_acpi_gtm		stm_buf = *stm;
314 315 316 317 318
	struct acpi_object_list         input;
	union acpi_object               in_params[3];

	in_params[0].type = ACPI_TYPE_BUFFER;
	in_params[0].buffer.length = sizeof(struct ata_acpi_gtm);
319
	in_params[0].buffer.pointer = (u8 *)&stm_buf;
320 321 322
	/* Buffers for id may need byteswapping ? */
	in_params[1].type = ACPI_TYPE_BUFFER;
	in_params[1].buffer.length = 512;
T
Tejun Heo 已提交
323
	in_params[1].buffer.pointer = (u8 *)ap->link.device[0].id;
324 325
	in_params[2].type = ACPI_TYPE_BUFFER;
	in_params[2].buffer.length = 512;
T
Tejun Heo 已提交
326
	in_params[2].buffer.pointer = (u8 *)ap->link.device[1].id;
327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342

	input.count = 3;
	input.pointer = in_params;

	status = acpi_evaluate_object(ap->acpi_handle, "_STM", &input, NULL);

	if (status == AE_NOT_FOUND)
		return -ENOENT;
	if (ACPI_FAILURE(status)) {
		ata_port_printk(ap, KERN_ERR,
			"ACPI set timing mode failed (status=0x%x)\n", status);
		return -EINVAL;
	}
	return 0;
}

343 344
EXPORT_SYMBOL_GPL(ata_acpi_stm);

345
/**
346
 * ata_dev_get_GTF - get the drive bootup default taskfile settings
347
 * @dev: target ATA device
348
 * @gtf: output parameter for buffer containing _GTF taskfile arrays
349 350 351 352 353 354 355 356 357
 *
 * This applies to both PATA and SATA drives.
 *
 * The _GTF method has no input parameters.
 * It returns a variable number of register set values (registers
 * hex 1F1..1F7, taskfiles).
 * The <variable number> is not known in advance, so have ACPI-CA
 * allocate the buffer as needed and return it, then free it later.
 *
358 359 360 361
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
362 363
 * Number of taskfiles on success, 0 if _GTF doesn't exist.  -EINVAL
 * if _GTF is invalid.
364
 */
365
static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf)
366
{
T
Tejun Heo 已提交
367
	struct ata_port *ap = dev->link->ap;
368 369 370
	acpi_status status;
	struct acpi_buffer output;
	union acpi_object *out_obj;
371
	int rc = 0;
372

373 374 375 376 377 378
	/* if _GTF is cached, use the cached value */
	if (dev->gtf_cache) {
		out_obj = dev->gtf_cache;
		goto done;
	}

379 380 381
	/* set up output buffer */
	output.length = ACPI_ALLOCATE_BUFFER;
	output.pointer = NULL;	/* ACPI-CA sets this; save/free it later */
382 383

	if (ata_msg_probe(ap))
384
		ata_dev_printk(dev, KERN_DEBUG, "%s: ENTER: port#: %d\n",
T
Tejun Heo 已提交
385
			       __FUNCTION__, ap->port_no);
386 387

	/* _GTF has no input parameters */
388
	status = acpi_evaluate_object(dev->acpi_handle, "_GTF", NULL, &output);
389
	out_obj = dev->gtf_cache = output.pointer;
390

391
	if (ACPI_FAILURE(status)) {
392 393 394 395
		if (status != AE_NOT_FOUND) {
			ata_dev_printk(dev, KERN_WARNING,
				       "_GTF evaluation failed (AE 0x%x)\n",
				       status);
T
Tejun Heo 已提交
396
			rc = -EINVAL;
397 398
		}
		goto out_free;
399 400 401 402
	}

	if (!output.length || !output.pointer) {
		if (ata_msg_probe(ap))
403
			ata_dev_printk(dev, KERN_DEBUG, "%s: Run _GTF: "
404 405 406 407
				"length or ptr is NULL (0x%llx, 0x%p)\n",
				__FUNCTION__,
				(unsigned long long)output.length,
				output.pointer);
T
Tejun Heo 已提交
408
		rc = -EINVAL;
409
		goto out_free;
410 411 412
	}

	if (out_obj->type != ACPI_TYPE_BUFFER) {
T
Tejun Heo 已提交
413 414 415
		ata_dev_printk(dev, KERN_WARNING,
			       "_GTF unexpected object type 0x%x\n",
			       out_obj->type);
T
Tejun Heo 已提交
416
		rc = -EINVAL;
417
		goto out_free;
418 419
	}

420
	if (out_obj->buffer.length % REGS_PER_GTF) {
T
Tejun Heo 已提交
421 422 423
		ata_dev_printk(dev, KERN_WARNING,
			       "unexpected _GTF length (%d)\n",
			       out_obj->buffer.length);
T
Tejun Heo 已提交
424
		rc = -EINVAL;
425
		goto out_free;
426 427
	}

428
 done:
429
	rc = out_obj->buffer.length / REGS_PER_GTF;
430 431 432 433 434 435 436
	if (gtf) {
		*gtf = (void *)out_obj->buffer.pointer;
		if (ata_msg_probe(ap))
			ata_dev_printk(dev, KERN_DEBUG,
				       "%s: returning gtf=%p, gtf_count=%d\n",
				       __FUNCTION__, *gtf, rc);
	}
437 438 439
	return rc;

 out_free:
440
	ata_acpi_clear_gtf(dev);
441
	return rc;
442 443
}

A
Alan Cox 已提交
444 445 446 447 448 449 450 451 452 453
/**
 * ata_acpi_cbl_80wire		-	Check for 80 wire cable
 * @ap: Port to check
 *
 * Return 1 if the ACPI mode data for this port indicates the BIOS selected
 * an 80wire mode.
 */

int ata_acpi_cbl_80wire(struct ata_port *ap)
{
454
	const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
A
Alan Cox 已提交
455
	int valid = 0;
456

457
	if (!gtm)
A
Alan Cox 已提交
458
		return 0;
459

A
Alan Cox 已提交
460
	/* Split timing, DMA enabled */
461
	if ((gtm->flags & 0x11) == 0x11 && gtm->drive[0].dma < 55)
A
Alan Cox 已提交
462
		valid |= 1;
463
	if ((gtm->flags & 0x14) == 0x14 && gtm->drive[1].dma < 55)
A
Alan Cox 已提交
464 465
		valid |= 2;
	/* Shared timing, DMA enabled */
466
	if ((gtm->flags & 0x11) == 0x01 && gtm->drive[0].dma < 55)
A
Alan Cox 已提交
467
		valid |= 1;
468
	if ((gtm->flags & 0x14) == 0x04 && gtm->drive[0].dma < 55)
A
Alan Cox 已提交
469 470 471 472 473 474 475 476 477 478 479 480
		valid |= 2;

	/* Drive check */
	if ((valid & 1) && ata_dev_enabled(&ap->link.device[0]))
		return 1;
	if ((valid & 2) && ata_dev_enabled(&ap->link.device[1]))
		return 1;
	return 0;
}

EXPORT_SYMBOL_GPL(ata_acpi_cbl_80wire);

481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534
static void ata_acpi_gtf_to_tf(struct ata_device *dev,
			       const struct ata_acpi_gtf *gtf,
			       struct ata_taskfile *tf)
{
	ata_tf_init(dev, tf);

	tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
	tf->protocol = ATA_PROT_NODATA;
	tf->feature = gtf->tf[0];	/* 0x1f1 */
	tf->nsect   = gtf->tf[1];	/* 0x1f2 */
	tf->lbal    = gtf->tf[2];	/* 0x1f3 */
	tf->lbam    = gtf->tf[3];	/* 0x1f4 */
	tf->lbah    = gtf->tf[4];	/* 0x1f5 */
	tf->device  = gtf->tf[5];	/* 0x1f6 */
	tf->command = gtf->tf[6];	/* 0x1f7 */
}

static int ata_acpi_filter_tf(const struct ata_taskfile *tf,
			      const struct ata_taskfile *ptf)
{
	if (ata_acpi_gtf_filter & ATA_ACPI_FILTER_SETXFER) {
		/* libata doesn't use ACPI to configure transfer mode.
		 * It will only confuse device configuration.  Skip.
		 */
		if (tf->command == ATA_CMD_SET_FEATURES &&
		    tf->feature == SETFEATURES_XFER)
			return 1;
	}

	if (ata_acpi_gtf_filter & ATA_ACPI_FILTER_LOCK) {
		/* BIOS writers, sorry but we don't wanna lock
		 * features unless the user explicitly said so.
		 */

		/* DEVICE CONFIGURATION FREEZE LOCK */
		if (tf->command == ATA_CMD_CONF_OVERLAY &&
		    tf->feature == ATA_DCO_FREEZE_LOCK)
			return 1;

		/* SECURITY FREEZE LOCK */
		if (tf->command == ATA_CMD_SEC_FREEZE_LOCK)
			return 1;

		/* SET MAX LOCK and SET MAX FREEZE LOCK */
		if ((!ptf || ptf->command != ATA_CMD_READ_NATIVE_MAX) &&
		    tf->command == ATA_CMD_SET_MAX &&
		    (tf->feature == ATA_SET_MAX_LOCK ||
		     tf->feature == ATA_SET_MAX_FREEZE_LOCK))
			return 1;
	}

	return 0;
}

535
/**
536
 * ata_acpi_run_tf - send taskfile registers to host controller
537
 * @dev: target ATA device
538 539 540 541 542 543 544 545 546 547 548 549 550
 * @gtf: raw ATA taskfile register set (0x1f1 - 0x1f7)
 *
 * Outputs ATA taskfile to standard ATA host controller using MMIO
 * or PIO as indicated by the ATA_FLAG_MMIO flag.
 * Writes the control, feature, nsect, lbal, lbam, and lbah registers.
 * Optionally (ATA_TFLAG_LBA48) writes hob_feature, hob_nsect,
 * hob_lbal, hob_lbam, and hob_lbah.
 *
 * This function waits for idle (!BUSY and !DRQ) after writing
 * registers.  If the control register has a new value, this
 * function also waits for idle after writing control and before
 * writing the remaining registers.
 *
551 552 553 554
 * LOCKING:
 * EH context.
 *
 * RETURNS:
555 556
 * 1 if command is executed successfully.  0 if ignored, rejected or
 * filtered out, -errno on other errors.
557
 */
558
static int ata_acpi_run_tf(struct ata_device *dev,
559 560
			   const struct ata_acpi_gtf *gtf,
			   const struct ata_acpi_gtf *prev_gtf)
561
{
562 563
	struct ata_taskfile *pptf = NULL;
	struct ata_taskfile tf, ptf, rtf;
564
	unsigned int err_mask;
565 566 567
	const char *level;
	char msg[60];
	int rc;
568

569 570 571 572
	if ((gtf->tf[0] == 0) && (gtf->tf[1] == 0) && (gtf->tf[2] == 0)
	    && (gtf->tf[3] == 0) && (gtf->tf[4] == 0) && (gtf->tf[5] == 0)
	    && (gtf->tf[6] == 0))
		return 0;
573

574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608
	ata_acpi_gtf_to_tf(dev, gtf, &tf);
	if (prev_gtf) {
		ata_acpi_gtf_to_tf(dev, prev_gtf, &ptf);
		pptf = &ptf;
	}

	if (!ata_acpi_filter_tf(&tf, pptf)) {
		rtf = tf;
		err_mask = ata_exec_internal(dev, &rtf, NULL,
					     DMA_NONE, NULL, 0, 0);

		switch (err_mask) {
		case 0:
			level = KERN_DEBUG;
			snprintf(msg, sizeof(msg), "succeeded");
			rc = 1;
			break;

		case AC_ERR_DEV:
			level = KERN_INFO;
			snprintf(msg, sizeof(msg),
				 "rejected by device (Stat=0x%02x Err=0x%02x)",
				 rtf.command, rtf.feature);
			rc = 0;
			break;

		default:
			level = KERN_ERR;
			snprintf(msg, sizeof(msg),
				 "failed (Emask=0x%x Stat=0x%02x Err=0x%02x)",
				 err_mask, rtf.command, rtf.feature);
			rc = -EIO;
			break;
		}
	} else {
609
		level = KERN_INFO;
610
		snprintf(msg, sizeof(msg), "filtered out");
611
		rc = 0;
612 613
	}

614 615 616 617 618 619
	ata_dev_printk(dev, level,
		       "ACPI cmd %02x/%02x:%02x:%02x:%02x:%02x:%02x %s\n",
		       tf.command, tf.feature, tf.nsect, tf.lbal,
		       tf.lbam, tf.lbah, tf.device, msg);

	return rc;
620 621 622 623
}

/**
 * ata_acpi_exec_tfs - get then write drive taskfile settings
T
Tejun Heo 已提交
624
 * @dev: target ATA device
T
Tejun Heo 已提交
625
 * @nr_executed: out paramter for the number of executed commands
626
 *
T
Tejun Heo 已提交
627
 * Evaluate _GTF and excute returned taskfiles.
T
Tejun Heo 已提交
628 629 630 631 632
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
633 634
 * Number of executed taskfiles on success, 0 if _GTF doesn't exist.
 * -errno on other errors.
635
 */
T
Tejun Heo 已提交
636
static int ata_acpi_exec_tfs(struct ata_device *dev, int *nr_executed)
637
{
638
	struct ata_acpi_gtf *gtf = NULL, *pgtf = NULL;
T
Tejun Heo 已提交
639 640 641
	int gtf_count, i, rc;

	/* get taskfiles */
T
Tejun Heo 已提交
642 643 644 645
	rc = ata_dev_get_GTF(dev, &gtf);
	if (rc < 0)
		return rc;
	gtf_count = rc;
T
Tejun Heo 已提交
646 647

	/* execute them */
648 649
	for (i = 0; i < gtf_count; i++, gtf++) {
		rc = ata_acpi_run_tf(dev, gtf, pgtf);
650 651
		if (rc < 0)
			break;
652
		if (rc) {
653
			(*nr_executed)++;
654 655
			pgtf = gtf;
		}
656 657
	}

658
	ata_acpi_clear_gtf(dev);
T
Tejun Heo 已提交
659

660 661 662
	if (rc < 0)
		return rc;
	return 0;
663 664
}

665 666
/**
 * ata_acpi_push_id - send Identify data to drive
667
 * @dev: target ATA device
668 669 670 671 672 673
 *
 * _SDD ACPI object: for SATA mode only
 * Must be after Identify (Packet) Device -- uses its data
 * ATM this function never returns a failure.  It is an optional
 * method and if it fails for whatever reason, we should still
 * just keep going.
T
Tejun Heo 已提交
674 675 676 677 678 679
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -errno on failure.
680
 */
T
Tejun Heo 已提交
681
static int ata_acpi_push_id(struct ata_device *dev)
682
{
T
Tejun Heo 已提交
683
	struct ata_port *ap = dev->link->ap;
684 685 686 687
	int err;
	acpi_status status;
	struct acpi_object_list input;
	union acpi_object in_params[1];
688 689

	if (ata_msg_probe(ap))
690 691
		ata_dev_printk(dev, KERN_DEBUG, "%s: ix = %d, port#: %d\n",
			       __FUNCTION__, dev->devno, ap->port_no);
692 693 694 695 696 697

	/* Give the drive Identify data to the drive via the _SDD method */
	/* _SDD: set up input parameters */
	input.count = 1;
	input.pointer = in_params;
	in_params[0].type = ACPI_TYPE_BUFFER;
698 699
	in_params[0].buffer.length = sizeof(dev->id[0]) * ATA_ID_WORDS;
	in_params[0].buffer.pointer = (u8 *)dev->id;
700 701 702
	/* Output buffer: _SDD has no output */

	/* It's OK for _SDD to be missing too. */
703
	swap_buf_le16(dev->id, ATA_ID_WORDS);
704
	status = acpi_evaluate_object(dev->acpi_handle, "_SDD", &input, NULL);
705
	swap_buf_le16(dev->id, ATA_ID_WORDS);
706 707

	err = ACPI_FAILURE(status) ? -EIO : 0;
T
Tejun Heo 已提交
708 709 710
	if (err < 0)
		ata_dev_printk(dev, KERN_WARNING,
			       "ACPI _SDD failed (AE 0x%x)\n", status);
711

T
Tejun Heo 已提交
712 713 714
	return err;
}

715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731
/**
 * ata_acpi_on_suspend - ATA ACPI hook called on suspend
 * @ap: target ATA port
 *
 * This function is called when @ap is about to be suspended.  All
 * devices are already put to sleep but the port_suspend() callback
 * hasn't been executed yet.  Error return from this function aborts
 * suspend.
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -errno on failure.
 */
int ata_acpi_on_suspend(struct ata_port *ap)
{
732 733
	/* nada */
	return 0;
734 735
}

T
Tejun Heo 已提交
736 737 738 739 740 741 742 743 744 745 746 747
/**
 * ata_acpi_on_resume - ATA ACPI hook called on resume
 * @ap: target ATA port
 *
 * This function is called when @ap is resumed - right after port
 * itself is resumed but before any EH action is taken.
 *
 * LOCKING:
 * EH context.
 */
void ata_acpi_on_resume(struct ata_port *ap)
{
748
	const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
749
	struct ata_device *dev;
T
Tejun Heo 已提交
750

751 752 753 754
	if (ap->acpi_handle && gtm) {
		/* _GTM valid */

		/* restore timing parameters */
755
		ata_acpi_stm(ap, gtm);
756

757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775
		/* _GTF should immediately follow _STM so that it can
		 * use values set by _STM.  Cache _GTF result and
		 * schedule _GTF.
		 */
		ata_link_for_each_dev(dev, &ap->link) {
			ata_acpi_clear_gtf(dev);
			if (ata_dev_get_GTF(dev, NULL) >= 0)
				dev->flags |= ATA_DFLAG_ACPI_PENDING;
		}
	} else {
		/* SATA _GTF needs to be evaulated after _SDD and
		 * there's no reason to evaluate IDE _GTF early
		 * without _STM.  Clear cache and schedule _GTF.
		 */
		ata_link_for_each_dev(dev, &ap->link) {
			ata_acpi_clear_gtf(dev);
			dev->flags |= ATA_DFLAG_ACPI_PENDING;
		}
	}
776 777
}

T
Tejun Heo 已提交
778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793
/**
 * ata_acpi_on_devcfg - ATA ACPI hook called on device donfiguration
 * @dev: target ATA device
 *
 * This function is called when @dev is about to be configured.
 * IDENTIFY data might have been modified after this hook is run.
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * Positive number if IDENTIFY data needs to be refreshed, 0 if not,
 * -errno on failure.
 */
int ata_acpi_on_devcfg(struct ata_device *dev)
{
T
Tejun Heo 已提交
794 795
	struct ata_port *ap = dev->link->ap;
	struct ata_eh_context *ehc = &ap->link.eh_context;
T
Tejun Heo 已提交
796
	int acpi_sata = ap->flags & ATA_FLAG_ACPI_SATA;
T
Tejun Heo 已提交
797
	int nr_executed = 0;
T
Tejun Heo 已提交
798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815
	int rc;

	if (!dev->acpi_handle)
		return 0;

	/* do we need to do _GTF? */
	if (!(dev->flags & ATA_DFLAG_ACPI_PENDING) &&
	    !(acpi_sata && (ehc->i.flags & ATA_EHI_DID_HARDRESET)))
		return 0;

	/* do _SDD if SATA */
	if (acpi_sata) {
		rc = ata_acpi_push_id(dev);
		if (rc)
			goto acpi_err;
	}

	/* do _GTF */
T
Tejun Heo 已提交
816 817
	rc = ata_acpi_exec_tfs(dev, &nr_executed);
	if (rc)
T
Tejun Heo 已提交
818 819 820 821 822
		goto acpi_err;

	dev->flags &= ~ATA_DFLAG_ACPI_PENDING;

	/* refresh IDENTIFY page if any _GTF command has been executed */
T
Tejun Heo 已提交
823
	if (nr_executed) {
T
Tejun Heo 已提交
824 825 826 827 828 829 830 831 832 833 834
		rc = ata_dev_reread_id(dev, 0);
		if (rc < 0) {
			ata_dev_printk(dev, KERN_ERR, "failed to IDENTIFY "
				       "after ACPI commands\n");
			return rc;
		}
	}

	return 0;

 acpi_err:
T
Tejun Heo 已提交
835 836 837
	/* ignore evaluation failure if we can continue safely */
	if (rc == -EINVAL && !nr_executed && !(ap->pflags & ATA_PFLAG_FROZEN))
		return 0;
T
Tejun Heo 已提交
838

T
Tejun Heo 已提交
839 840 841 842
	/* fail and let EH retry once more for unknown IO errors */
	if (!(dev->flags & ATA_DFLAG_ACPI_FAILED)) {
		dev->flags |= ATA_DFLAG_ACPI_FAILED;
		return rc;
T
Tejun Heo 已提交
843
	}
T
Tejun Heo 已提交
844 845 846 847 848 849 850 851 852 853 854

	ata_dev_printk(dev, KERN_WARNING,
		       "ACPI: failed the second time, disabled\n");
	dev->acpi_handle = NULL;

	/* We can safely continue if no _GTF command has been executed
	 * and port is not frozen.
	 */
	if (!nr_executed && !(ap->pflags & ATA_PFLAG_FROZEN))
		return 0;

T
Tejun Heo 已提交
855 856
	return rc;
}
857 858 859 860 861 862 863 864 865 866 867 868

/**
 * ata_acpi_on_disable - ATA ACPI hook called when a device is disabled
 * @dev: target ATA device
 *
 * This function is called when @dev is about to be disabled.
 *
 * LOCKING:
 * EH context.
 */
void ata_acpi_on_disable(struct ata_device *dev)
{
869
	ata_acpi_clear_gtf(dev);
870
}