libata-acpi.c 19.0 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 * libata-acpi.c
 * Provides ACPI support for PATA/SATA.
 *
 * Copyright (C) 2006 Intel Corp.
 * Copyright (C) 2006 Randy Dunlap
 */

#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>
17
#include <scsi/scsi_device.h>
18 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>

#define NO_PORT_MULT		0xffff
29
#define SATA_ADR(root, pmp)	(((root) << 16) | (pmp))
30 31

#define REGS_PER_GTF		7
32 33 34
struct ata_acpi_gtf {
	u8	tf[REGS_PER_GTF];	/* regs. 0x1f1 - 0x1f7 */
} __packed;
35

36 37 38 39 40 41 42
/*
 *	Helper - belongs in the PCI layer somewhere eventually
 */
static int is_pci_dev(struct device *dev)
{
	return (dev->bus == &pci_bus_type);
}
43

44 45 46 47 48 49
static void ata_acpi_clear_gtf(struct ata_device *dev)
{
	kfree(dev->gtf_cache);
	dev->gtf_cache = NULL;
}

50 51 52 53 54 55 56 57 58 59 60 61 62 63
/**
 * 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)
64
{
65 66 67 68 69 70 71 72 73 74 75 76 77 78
	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);
79

80 81 82 83
			link->device->acpi_handle =
				acpi_get_child(ap->host->acpi_handle, adr);
		}
	}
84 85
}

86
static void ata_acpi_associate_ide_port(struct ata_port *ap)
87
{
88
	int max_devices, i;
89

90 91 92
	ap->acpi_handle = acpi_get_child(ap->host->acpi_handle, ap->port_no);
	if (!ap->acpi_handle)
		return;
93

94 95 96
	max_devices = 1;
	if (ap->flags & ATA_FLAG_SLAVE_POSS)
		max_devices++;
97

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

101
		dev->acpi_handle = acpi_get_child(ap->acpi_handle, i);
102
	}
103 104 105

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

108 109
static void ata_acpi_handle_hotplug(struct ata_port *ap, struct kobject *kobj,
				    u32 event)
110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125
{
	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) {
126
		sprintf(event_string, "BAY_EVENT=%d", event);
127 128 129 130 131 132 133 134 135 136 137 138
		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;

139
	ata_acpi_handle_hotplug(dev->link->ap, kobj, event);
140 141 142 143 144 145
}

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

146
	ata_acpi_handle_hotplug(ap, &ap->dev->kobj, event);
147 148
}

149 150 151 152 153 154 155 156 157 158 159 160 161 162
/**
 * 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)
163
{
164
	int i, j;
165

166 167
	if (!is_pci_dev(host->dev) || libata_noacpi)
		return;
168

169 170 171
	host->acpi_handle = DEVICE_ACPI_HANDLE(host->dev);
	if (!host->acpi_handle)
		return;
172

173 174 175 176 177 178 179
	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);
180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195

		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);
		}
196 197 198
	}
}

199 200 201 202 203 204 205 206 207 208 209 210
/**
 * 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)
{
211 212 213 214 215 216 217 218 219 220 221 222
	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);
	}
223 224
}

225 226 227 228 229 230 231 232 233 234 235 236 237
/**
 * 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.
 */
238
int ata_acpi_gtm(struct ata_port *ap, struct ata_acpi_gtm *gtm)
239 240 241 242 243 244 245 246 247 248 249 250 251 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
{
	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;
}

282 283
EXPORT_SYMBOL_GPL(ata_acpi_gtm);

284 285 286 287 288 289 290 291 292 293 294 295 296
/**
 * 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.
 */
297
int ata_acpi_stm(struct ata_port *ap, const struct ata_acpi_gtm *stm)
298 299
{
	acpi_status status;
300
	struct ata_acpi_gtm		stm_buf = *stm;
301 302 303 304 305
	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);
306
	in_params[0].buffer.pointer = (u8 *)&stm_buf;
307 308 309
	/* Buffers for id may need byteswapping ? */
	in_params[1].type = ACPI_TYPE_BUFFER;
	in_params[1].buffer.length = 512;
T
Tejun Heo 已提交
310
	in_params[1].buffer.pointer = (u8 *)ap->link.device[0].id;
311 312
	in_params[2].type = ACPI_TYPE_BUFFER;
	in_params[2].buffer.length = 512;
T
Tejun Heo 已提交
313
	in_params[2].buffer.pointer = (u8 *)ap->link.device[1].id;
314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329

	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;
}

330 331
EXPORT_SYMBOL_GPL(ata_acpi_stm);

332
/**
333
 * ata_dev_get_GTF - get the drive bootup default taskfile settings
334
 * @dev: target ATA device
335
 * @gtf: output parameter for buffer containing _GTF taskfile arrays
336 337 338 339 340 341 342 343 344
 *
 * 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.
 *
345 346 347 348
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
349 350
 * Number of taskfiles on success, 0 if _GTF doesn't exist.  -EINVAL
 * if _GTF is invalid.
351
 */
352
static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf)
353
{
T
Tejun Heo 已提交
354
	struct ata_port *ap = dev->link->ap;
355 356 357
	acpi_status status;
	struct acpi_buffer output;
	union acpi_object *out_obj;
358
	int rc = 0;
359

360 361 362 363 364 365
	/* if _GTF is cached, use the cached value */
	if (dev->gtf_cache) {
		out_obj = dev->gtf_cache;
		goto done;
	}

366 367 368
	/* set up output buffer */
	output.length = ACPI_ALLOCATE_BUFFER;
	output.pointer = NULL;	/* ACPI-CA sets this; save/free it later */
369 370

	if (ata_msg_probe(ap))
371
		ata_dev_printk(dev, KERN_DEBUG, "%s: ENTER: port#: %d\n",
T
Tejun Heo 已提交
372
			       __FUNCTION__, ap->port_no);
373 374

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

378
	if (ACPI_FAILURE(status)) {
379 380 381 382
		if (status != AE_NOT_FOUND) {
			ata_dev_printk(dev, KERN_WARNING,
				       "_GTF evaluation failed (AE 0x%x)\n",
				       status);
T
Tejun Heo 已提交
383
			rc = -EINVAL;
384 385
		}
		goto out_free;
386 387 388 389
	}

	if (!output.length || !output.pointer) {
		if (ata_msg_probe(ap))
390
			ata_dev_printk(dev, KERN_DEBUG, "%s: Run _GTF: "
391 392 393 394
				"length or ptr is NULL (0x%llx, 0x%p)\n",
				__FUNCTION__,
				(unsigned long long)output.length,
				output.pointer);
T
Tejun Heo 已提交
395
		rc = -EINVAL;
396
		goto out_free;
397 398 399
	}

	if (out_obj->type != ACPI_TYPE_BUFFER) {
T
Tejun Heo 已提交
400 401 402
		ata_dev_printk(dev, KERN_WARNING,
			       "_GTF unexpected object type 0x%x\n",
			       out_obj->type);
T
Tejun Heo 已提交
403
		rc = -EINVAL;
404
		goto out_free;
405 406
	}

407
	if (out_obj->buffer.length % REGS_PER_GTF) {
T
Tejun Heo 已提交
408 409 410
		ata_dev_printk(dev, KERN_WARNING,
			       "unexpected _GTF length (%d)\n",
			       out_obj->buffer.length);
T
Tejun Heo 已提交
411
		rc = -EINVAL;
412
		goto out_free;
413 414
	}

415
 done:
416
	rc = out_obj->buffer.length / REGS_PER_GTF;
417 418 419 420 421 422 423
	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);
	}
424 425 426
	return rc;

 out_free:
427
	ata_acpi_clear_gtf(dev);
428
	return rc;
429 430
}

A
Alan Cox 已提交
431 432 433 434 435 436 437 438 439 440
/**
 * 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)
{
441
	const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
A
Alan Cox 已提交
442
	int valid = 0;
443

444
	if (!gtm)
A
Alan Cox 已提交
445
		return 0;
446

A
Alan Cox 已提交
447
	/* Split timing, DMA enabled */
448
	if ((gtm->flags & 0x11) == 0x11 && gtm->drive[0].dma < 55)
A
Alan Cox 已提交
449
		valid |= 1;
450
	if ((gtm->flags & 0x14) == 0x14 && gtm->drive[1].dma < 55)
A
Alan Cox 已提交
451 452
		valid |= 2;
	/* Shared timing, DMA enabled */
453
	if ((gtm->flags & 0x11) == 0x01 && gtm->drive[0].dma < 55)
A
Alan Cox 已提交
454
		valid |= 1;
455
	if ((gtm->flags & 0x14) == 0x04 && gtm->drive[0].dma < 55)
A
Alan Cox 已提交
456 457 458 459 460 461 462 463 464 465 466 467
		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);

468
/**
469
 * ata_acpi_run_tf - send taskfile registers to host controller
470
 * @dev: target ATA device
471 472 473 474 475 476 477 478 479 480 481 482 483
 * @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.
 *
484 485 486 487
 * LOCKING:
 * EH context.
 *
 * RETURNS:
488 489
 * 1 if command is executed successfully.  0 if ignored or rejected,
 * -errno on other errors.
490
 */
491 492
static int ata_acpi_run_tf(struct ata_device *dev,
			   const struct ata_acpi_gtf *gtf)
493
{
494 495
	struct ata_taskfile tf, rtf;
	unsigned int err_mask;
496 497 498
	const char *level;
	char msg[60];
	int rc;
499

500 501 502 503
	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;
504

505
	ata_tf_init(dev, &tf);
506 507 508

	/* convert gtf to tf */
	tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; /* TBD */
509
	tf.protocol = ATA_PROT_NODATA;
510 511 512 513 514 515 516 517 518
	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 */

	rtf = tf;
519
	err_mask = ata_exec_internal(dev, &rtf, NULL, DMA_NONE, NULL, 0, 0);
520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542

	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;
543 544
	}

545 546 547 548 549 550
	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;
551 552 553 554
}

/**
 * ata_acpi_exec_tfs - get then write drive taskfile settings
T
Tejun Heo 已提交
555
 * @dev: target ATA device
T
Tejun Heo 已提交
556
 * @nr_executed: out paramter for the number of executed commands
557
 *
T
Tejun Heo 已提交
558
 * Evaluate _GTF and excute returned taskfiles.
T
Tejun Heo 已提交
559 560 561 562 563
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
564 565
 * Number of executed taskfiles on success, 0 if _GTF doesn't exist.
 * -errno on other errors.
566
 */
T
Tejun Heo 已提交
567
static int ata_acpi_exec_tfs(struct ata_device *dev, int *nr_executed)
568
{
T
Tejun Heo 已提交
569 570 571 572
	struct ata_acpi_gtf *gtf = NULL;
	int gtf_count, i, rc;

	/* get taskfiles */
T
Tejun Heo 已提交
573 574 575 576
	rc = ata_dev_get_GTF(dev, &gtf);
	if (rc < 0)
		return rc;
	gtf_count = rc;
T
Tejun Heo 已提交
577 578

	/* execute them */
579 580 581 582 583 584
	for (i = 0; i < gtf_count; i++) {
		rc = ata_acpi_run_tf(dev, gtf++);
		if (rc < 0)
			break;
		if (rc)
			(*nr_executed)++;
585 586
	}

587
	ata_acpi_clear_gtf(dev);
T
Tejun Heo 已提交
588

589 590 591
	if (rc < 0)
		return rc;
	return 0;
592 593
}

594 595
/**
 * ata_acpi_push_id - send Identify data to drive
596
 * @dev: target ATA device
597 598 599 600 601 602
 *
 * _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 已提交
603 604 605 606 607 608
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -errno on failure.
609
 */
T
Tejun Heo 已提交
610
static int ata_acpi_push_id(struct ata_device *dev)
611
{
T
Tejun Heo 已提交
612
	struct ata_port *ap = dev->link->ap;
613 614 615 616
	int err;
	acpi_status status;
	struct acpi_object_list input;
	union acpi_object in_params[1];
617 618

	if (ata_msg_probe(ap))
619 620
		ata_dev_printk(dev, KERN_DEBUG, "%s: ix = %d, port#: %d\n",
			       __FUNCTION__, dev->devno, ap->port_no);
621 622 623 624 625 626

	/* 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;
627 628
	in_params[0].buffer.length = sizeof(dev->id[0]) * ATA_ID_WORDS;
	in_params[0].buffer.pointer = (u8 *)dev->id;
629 630 631
	/* Output buffer: _SDD has no output */

	/* It's OK for _SDD to be missing too. */
632
	swap_buf_le16(dev->id, ATA_ID_WORDS);
633
	status = acpi_evaluate_object(dev->acpi_handle, "_SDD", &input, NULL);
634
	swap_buf_le16(dev->id, ATA_ID_WORDS);
635 636

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

T
Tejun Heo 已提交
641 642 643
	return err;
}

644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660
/**
 * 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)
{
661 662
	/* nada */
	return 0;
663 664
}

T
Tejun Heo 已提交
665 666 667 668 669 670 671 672 673 674 675 676
/**
 * 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)
{
677
	const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
678
	struct ata_device *dev;
T
Tejun Heo 已提交
679

680 681 682 683
	if (ap->acpi_handle && gtm) {
		/* _GTM valid */

		/* restore timing parameters */
684
		ata_acpi_stm(ap, gtm);
685

686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704
		/* _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;
		}
	}
705 706
}

T
Tejun Heo 已提交
707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722
/**
 * 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 已提交
723 724
	struct ata_port *ap = dev->link->ap;
	struct ata_eh_context *ehc = &ap->link.eh_context;
T
Tejun Heo 已提交
725
	int acpi_sata = ap->flags & ATA_FLAG_ACPI_SATA;
T
Tejun Heo 已提交
726
	int nr_executed = 0;
T
Tejun Heo 已提交
727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744
	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 已提交
745 746
	rc = ata_acpi_exec_tfs(dev, &nr_executed);
	if (rc)
T
Tejun Heo 已提交
747 748 749 750 751
		goto acpi_err;

	dev->flags &= ~ATA_DFLAG_ACPI_PENDING;

	/* refresh IDENTIFY page if any _GTF command has been executed */
T
Tejun Heo 已提交
752
	if (nr_executed) {
T
Tejun Heo 已提交
753 754 755 756 757 758 759 760 761 762 763
		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 已提交
764 765 766
	/* ignore evaluation failure if we can continue safely */
	if (rc == -EINVAL && !nr_executed && !(ap->pflags & ATA_PFLAG_FROZEN))
		return 0;
T
Tejun Heo 已提交
767

T
Tejun Heo 已提交
768 769 770 771
	/* 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 已提交
772
	}
T
Tejun Heo 已提交
773 774 775 776 777 778 779 780 781 782 783

	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 已提交
784 785
	return rc;
}
786 787 788 789 790 791 792 793 794 795 796 797

/**
 * 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)
{
798
	ata_acpi_clear_gtf(dev);
799
}