libata-acpi.c 23.4 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
static void ata_acpi_handle_hotplug(struct ata_port *ap, struct ata_device *dev,
122
				    u32 event)
123 124 125
{
	char event_string[12];
	char *envp[] = { event_string, NULL };
126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160
	struct ata_eh_info *ehi;
	struct kobject *kobj = NULL;
	int wait = 0;
	unsigned long flags;

	if (!ap)
		ap = dev->link->ap;
	ehi = &ap->link.eh_info;

	spin_lock_irqsave(ap->lock, flags);

	switch (event) {
	case ACPI_NOTIFY_BUS_CHECK:
	case ACPI_NOTIFY_DEVICE_CHECK:
		ata_ehi_push_desc(ehi, "ACPI event");
		ata_ehi_hotplugged(ehi);
		ata_port_freeze(ap);
		break;

	case ACPI_NOTIFY_EJECT_REQUEST:
		ata_ehi_push_desc(ehi, "ACPI event");
		if (dev)
			dev->flags |= ATA_DFLAG_DETACH;
		else {
			struct ata_link *tlink;
			struct ata_device *tdev;

			ata_port_for_each_link(tlink, ap)
				ata_link_for_each_dev(tdev, tlink)
					tdev->flags |= ATA_DFLAG_DETACH;
		}

		ata_port_schedule_eh(ap);
		wait = 1;
		break;
161 162
	}

163 164 165 166 167 168
	if (dev) {
		if (dev->sdev)
			kobj = &dev->sdev->sdev_gendev.kobj;
	} else
		kobj = &ap->dev->kobj;

169
	if (kobj) {
170
		sprintf(event_string, "BAY_EVENT=%d", event);
171 172
		kobject_uevent_env(kobj, KOBJ_CHANGE, envp);
	}
173 174 175 176 177

	spin_unlock_irqrestore(ap->lock, flags);

	if (wait)
		ata_port_wait_eh(ap);
178 179 180 181 182 183
}

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

184
	ata_acpi_handle_hotplug(NULL, dev, event);
185 186 187 188 189 190
}

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

191
	ata_acpi_handle_hotplug(ap, NULL, event);
192 193
}

194 195 196 197 198 199 200 201 202 203 204 205 206 207
/**
 * 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)
208
{
209
	int i, j;
210

211 212
	if (!is_pci_dev(host->dev) || libata_noacpi)
		return;
213

214 215 216
	host->acpi_handle = DEVICE_ACPI_HANDLE(host->dev);
	if (!host->acpi_handle)
		return;
217

218 219 220 221 222 223 224
	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);
225

226 227 228 229 230 231 232 233 234 235
		if (ap->acpi_handle) {
			acpi_install_notify_handler(ap->acpi_handle,
						    ACPI_SYSTEM_NOTIFY,
						    ata_acpi_ap_notify, ap);
#if defined(CONFIG_ACPI_DOCK) || defined(CONFIG_ACPI_DOCK_MODULE)
			/* we might be on a docking station */
			register_hotplug_dock_device(ap->acpi_handle,
						     ata_acpi_ap_notify, ap);
#endif
		}
236 237 238 239

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

240 241 242 243 244 245 246 247 248 249
			if (dev->acpi_handle) {
				acpi_install_notify_handler(dev->acpi_handle,
						ACPI_SYSTEM_NOTIFY,
						ata_acpi_dev_notify, dev);
#if defined(CONFIG_ACPI_DOCK) || defined(CONFIG_ACPI_DOCK_MODULE)
				/* we might be on a docking station */
				register_hotplug_dock_device(dev->acpi_handle,
						ata_acpi_dev_notify, dev);
#endif
			}
250
		}
251 252 253
	}
}

254 255 256 257 258 259 260 261 262 263 264 265
/**
 * 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)
{
266 267 268 269 270 271 272 273 274 275 276 277
	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);
	}
278 279
}

280 281 282 283 284 285 286 287 288 289 290 291 292
/**
 * 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.
 */
293
int ata_acpi_gtm(struct ata_port *ap, struct ata_acpi_gtm *gtm)
294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336
{
	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;
}

337 338
EXPORT_SYMBOL_GPL(ata_acpi_gtm);

339 340 341 342 343 344 345 346 347 348 349 350 351
/**
 * 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.
 */
352
int ata_acpi_stm(struct ata_port *ap, const struct ata_acpi_gtm *stm)
353 354
{
	acpi_status status;
355
	struct ata_acpi_gtm		stm_buf = *stm;
356 357 358 359 360
	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);
361
	in_params[0].buffer.pointer = (u8 *)&stm_buf;
362 363 364
	/* Buffers for id may need byteswapping ? */
	in_params[1].type = ACPI_TYPE_BUFFER;
	in_params[1].buffer.length = 512;
T
Tejun Heo 已提交
365
	in_params[1].buffer.pointer = (u8 *)ap->link.device[0].id;
366 367
	in_params[2].type = ACPI_TYPE_BUFFER;
	in_params[2].buffer.length = 512;
T
Tejun Heo 已提交
368
	in_params[2].buffer.pointer = (u8 *)ap->link.device[1].id;
369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384

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

385 386
EXPORT_SYMBOL_GPL(ata_acpi_stm);

387
/**
388
 * ata_dev_get_GTF - get the drive bootup default taskfile settings
389
 * @dev: target ATA device
390
 * @gtf: output parameter for buffer containing _GTF taskfile arrays
391 392 393 394 395 396 397 398 399
 *
 * 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.
 *
400 401 402 403
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
404 405
 * Number of taskfiles on success, 0 if _GTF doesn't exist.  -EINVAL
 * if _GTF is invalid.
406
 */
407
static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf)
408
{
T
Tejun Heo 已提交
409
	struct ata_port *ap = dev->link->ap;
410 411 412
	acpi_status status;
	struct acpi_buffer output;
	union acpi_object *out_obj;
413
	int rc = 0;
414

415 416 417 418 419 420
	/* if _GTF is cached, use the cached value */
	if (dev->gtf_cache) {
		out_obj = dev->gtf_cache;
		goto done;
	}

421 422 423
	/* set up output buffer */
	output.length = ACPI_ALLOCATE_BUFFER;
	output.pointer = NULL;	/* ACPI-CA sets this; save/free it later */
424 425

	if (ata_msg_probe(ap))
426
		ata_dev_printk(dev, KERN_DEBUG, "%s: ENTER: port#: %d\n",
427
			       __func__, ap->port_no);
428 429

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

433
	if (ACPI_FAILURE(status)) {
434 435 436 437
		if (status != AE_NOT_FOUND) {
			ata_dev_printk(dev, KERN_WARNING,
				       "_GTF evaluation failed (AE 0x%x)\n",
				       status);
T
Tejun Heo 已提交
438
			rc = -EINVAL;
439 440
		}
		goto out_free;
441 442 443 444
	}

	if (!output.length || !output.pointer) {
		if (ata_msg_probe(ap))
445
			ata_dev_printk(dev, KERN_DEBUG, "%s: Run _GTF: "
446
				"length or ptr is NULL (0x%llx, 0x%p)\n",
447
				__func__,
448 449
				(unsigned long long)output.length,
				output.pointer);
T
Tejun Heo 已提交
450
		rc = -EINVAL;
451
		goto out_free;
452 453 454
	}

	if (out_obj->type != ACPI_TYPE_BUFFER) {
T
Tejun Heo 已提交
455 456 457
		ata_dev_printk(dev, KERN_WARNING,
			       "_GTF unexpected object type 0x%x\n",
			       out_obj->type);
T
Tejun Heo 已提交
458
		rc = -EINVAL;
459
		goto out_free;
460 461
	}

462
	if (out_obj->buffer.length % REGS_PER_GTF) {
T
Tejun Heo 已提交
463 464 465
		ata_dev_printk(dev, KERN_WARNING,
			       "unexpected _GTF length (%d)\n",
			       out_obj->buffer.length);
T
Tejun Heo 已提交
466
		rc = -EINVAL;
467
		goto out_free;
468 469
	}

470
 done:
471
	rc = out_obj->buffer.length / REGS_PER_GTF;
472 473 474 475 476
	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",
477
				       __func__, *gtf, rc);
478
	}
479 480 481
	return rc;

 out_free:
482
	ata_acpi_clear_gtf(dev);
483
	return rc;
484 485
}

486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
/**
 * ata_acpi_gtm_xfermode - determine xfermode from GTM parameter
 * @dev: target device
 * @gtm: GTM parameter to use
 *
 * Determine xfermask for @dev from @gtm.
 *
 * LOCKING:
 * None.
 *
 * RETURNS:
 * Determined xfermask.
 */
unsigned long ata_acpi_gtm_xfermask(struct ata_device *dev,
				    const struct ata_acpi_gtm *gtm)
{
502 503 504 505
	unsigned long xfer_mask = 0;
	unsigned int type;
	int unit;
	u8 mode;
506 507 508 509 510 511

	/* we always use the 0 slot for crap hardware */
	unit = dev->devno;
	if (!(gtm->flags & 0x10))
		unit = 0;

512 513 514
	/* PIO */
	mode = ata_timing_cycle2mode(ATA_SHIFT_PIO, gtm->drive[unit].pio);
	xfer_mask |= ata_xfer_mode2mask(mode);
515 516 517 518 519

	/* See if we have MWDMA or UDMA data. We don't bother with
	 * MWDMA if UDMA is available as this means the BIOS set UDMA
	 * and our error changedown if it works is UDMA to PIO anyway.
	 */
520 521 522 523 524 525 526
	if (!(gtm->flags & (1 << (2 * unit))))
		type = ATA_SHIFT_MWDMA;
	else
		type = ATA_SHIFT_UDMA;

	mode = ata_timing_cycle2mode(type, gtm->drive[unit].dma);
	xfer_mask |= ata_xfer_mode2mask(mode);
527

528
	return xfer_mask;
529 530 531
}
EXPORT_SYMBOL_GPL(ata_acpi_gtm_xfermask);

A
Alan Cox 已提交
532 533 534
/**
 * ata_acpi_cbl_80wire		-	Check for 80 wire cable
 * @ap: Port to check
535
 * @gtm: GTM data to use
A
Alan Cox 已提交
536
 *
537
 * Return 1 if the @gtm indicates the BIOS selected an 80wire mode.
A
Alan Cox 已提交
538
 */
539
int ata_acpi_cbl_80wire(struct ata_port *ap, const struct ata_acpi_gtm *gtm)
A
Alan Cox 已提交
540
{
541 542 543 544 545 546 547 548 549 550 551 552 553 554 555
	struct ata_device *dev;

	ata_link_for_each_dev(dev, &ap->link) {
		unsigned long xfer_mask, udma_mask;

		if (!ata_dev_enabled(dev))
			continue;

		xfer_mask = ata_acpi_gtm_xfermask(dev, gtm);
		ata_unpack_xfermask(xfer_mask, NULL, NULL, &udma_mask);

		if (udma_mask & ~ATA_UDMA_MASK_40C)
			return 1;
	}

A
Alan Cox 已提交
556 557 558 559
	return 0;
}
EXPORT_SYMBOL_GPL(ata_acpi_cbl_80wire);

560 561 562 563 564 565 566 567 568 569 570 571 572 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 609 610 611 612 613
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;
}

614
/**
615
 * ata_acpi_run_tf - send taskfile registers to host controller
616
 * @dev: target ATA device
617 618 619 620 621 622 623 624 625 626 627 628 629
 * @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.
 *
630 631 632 633
 * LOCKING:
 * EH context.
 *
 * RETURNS:
634 635
 * 1 if command is executed successfully.  0 if ignored, rejected or
 * filtered out, -errno on other errors.
636
 */
637
static int ata_acpi_run_tf(struct ata_device *dev,
638 639
			   const struct ata_acpi_gtf *gtf,
			   const struct ata_acpi_gtf *prev_gtf)
640
{
641 642
	struct ata_taskfile *pptf = NULL;
	struct ata_taskfile tf, ptf, rtf;
643
	unsigned int err_mask;
644 645 646
	const char *level;
	char msg[60];
	int rc;
647

648 649 650 651
	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;
652

653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687
	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 {
688
		level = KERN_INFO;
689
		snprintf(msg, sizeof(msg), "filtered out");
690
		rc = 0;
691 692
	}

693 694 695 696 697 698
	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;
699 700 701 702
}

/**
 * ata_acpi_exec_tfs - get then write drive taskfile settings
T
Tejun Heo 已提交
703
 * @dev: target ATA device
T
Tejun Heo 已提交
704
 * @nr_executed: out paramter for the number of executed commands
705
 *
T
Tejun Heo 已提交
706
 * Evaluate _GTF and excute returned taskfiles.
T
Tejun Heo 已提交
707 708 709 710 711
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
712 713
 * Number of executed taskfiles on success, 0 if _GTF doesn't exist.
 * -errno on other errors.
714
 */
T
Tejun Heo 已提交
715
static int ata_acpi_exec_tfs(struct ata_device *dev, int *nr_executed)
716
{
717
	struct ata_acpi_gtf *gtf = NULL, *pgtf = NULL;
T
Tejun Heo 已提交
718 719 720
	int gtf_count, i, rc;

	/* get taskfiles */
T
Tejun Heo 已提交
721 722 723 724
	rc = ata_dev_get_GTF(dev, &gtf);
	if (rc < 0)
		return rc;
	gtf_count = rc;
T
Tejun Heo 已提交
725 726

	/* execute them */
727 728
	for (i = 0; i < gtf_count; i++, gtf++) {
		rc = ata_acpi_run_tf(dev, gtf, pgtf);
729 730
		if (rc < 0)
			break;
731
		if (rc) {
732
			(*nr_executed)++;
733 734
			pgtf = gtf;
		}
735 736
	}

737
	ata_acpi_clear_gtf(dev);
T
Tejun Heo 已提交
738

739 740 741
	if (rc < 0)
		return rc;
	return 0;
742 743
}

744 745
/**
 * ata_acpi_push_id - send Identify data to drive
746
 * @dev: target ATA device
747 748 749 750 751 752
 *
 * _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 已提交
753 754 755 756 757 758
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -errno on failure.
759
 */
T
Tejun Heo 已提交
760
static int ata_acpi_push_id(struct ata_device *dev)
761
{
T
Tejun Heo 已提交
762
	struct ata_port *ap = dev->link->ap;
763 764 765 766
	int err;
	acpi_status status;
	struct acpi_object_list input;
	union acpi_object in_params[1];
767 768

	if (ata_msg_probe(ap))
769
		ata_dev_printk(dev, KERN_DEBUG, "%s: ix = %d, port#: %d\n",
770
			       __func__, dev->devno, ap->port_no);
771 772 773 774 775 776

	/* 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;
777 778
	in_params[0].buffer.length = sizeof(dev->id[0]) * ATA_ID_WORDS;
	in_params[0].buffer.pointer = (u8 *)dev->id;
779 780 781
	/* Output buffer: _SDD has no output */

	/* It's OK for _SDD to be missing too. */
782
	swap_buf_le16(dev->id, ATA_ID_WORDS);
783
	status = acpi_evaluate_object(dev->acpi_handle, "_SDD", &input, NULL);
784
	swap_buf_le16(dev->id, ATA_ID_WORDS);
785 786

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

T
Tejun Heo 已提交
791 792 793
	return err;
}

794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810
/**
 * 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)
{
811 812
	/* nada */
	return 0;
813 814
}

T
Tejun Heo 已提交
815 816 817 818 819 820 821 822 823 824 825 826
/**
 * 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)
{
827
	const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
828
	struct ata_device *dev;
T
Tejun Heo 已提交
829

830 831 832 833
	if (ap->acpi_handle && gtm) {
		/* _GTM valid */

		/* restore timing parameters */
834
		ata_acpi_stm(ap, gtm);
835

836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854
		/* _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;
		}
	}
855 856
}

S
Shaohua Li 已提交
857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886
/**
 * ata_acpi_set_state - set the port power state
 * @ap: target ATA port
 * @state: state, on/off
 *
 * This function executes the _PS0/_PS3 ACPI method to set the power state.
 * ACPI spec requires _PS0 when IDE power on and _PS3 when power off
 */
void ata_acpi_set_state(struct ata_port *ap, pm_message_t state)
{
	struct ata_device *dev;

	if (!ap->acpi_handle || (ap->flags & ATA_FLAG_ACPI_SATA))
		return;

	/* channel first and then drives for power on and vica versa
	   for power off */
	if (state.event == PM_EVENT_ON)
		acpi_bus_set_power(ap->acpi_handle, ACPI_STATE_D0);

	ata_link_for_each_dev(dev, &ap->link) {
		if (dev->acpi_handle && ata_dev_enabled(dev))
			acpi_bus_set_power(dev->acpi_handle,
				state.event == PM_EVENT_ON ?
					ACPI_STATE_D0 : ACPI_STATE_D3);
	}
	if (state.event != PM_EVENT_ON)
		acpi_bus_set_power(ap->acpi_handle, ACPI_STATE_D3);
}

T
Tejun Heo 已提交
887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902
/**
 * 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 已提交
903 904
	struct ata_port *ap = dev->link->ap;
	struct ata_eh_context *ehc = &ap->link.eh_context;
T
Tejun Heo 已提交
905
	int acpi_sata = ap->flags & ATA_FLAG_ACPI_SATA;
T
Tejun Heo 已提交
906
	int nr_executed = 0;
T
Tejun Heo 已提交
907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924
	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 已提交
925 926
	rc = ata_acpi_exec_tfs(dev, &nr_executed);
	if (rc)
T
Tejun Heo 已提交
927 928 929 930 931
		goto acpi_err;

	dev->flags &= ~ATA_DFLAG_ACPI_PENDING;

	/* refresh IDENTIFY page if any _GTF command has been executed */
T
Tejun Heo 已提交
932
	if (nr_executed) {
T
Tejun Heo 已提交
933 934 935 936 937 938 939 940 941 942 943
		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 已提交
944 945 946
	/* ignore evaluation failure if we can continue safely */
	if (rc == -EINVAL && !nr_executed && !(ap->pflags & ATA_PFLAG_FROZEN))
		return 0;
T
Tejun Heo 已提交
947

T
Tejun Heo 已提交
948 949 950 951
	/* 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 已提交
952
	}
T
Tejun Heo 已提交
953 954 955 956 957 958 959 960 961 962 963

	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 已提交
964 965
	return rc;
}
966 967 968 969 970 971 972 973 974 975 976 977

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