libata-acpi.c 24.9 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
enum {
	ATA_ACPI_FILTER_SETXFER	= 1 << 0,
	ATA_ACPI_FILTER_LOCK	= 1 << 1,
T
Tejun Heo 已提交
32
	ATA_ACPI_FILTER_DIPM	= 1 << 2,
33 34

	ATA_ACPI_FILTER_DEFAULT	= ATA_ACPI_FILTER_SETXFER |
T
Tejun Heo 已提交
35 36
				  ATA_ACPI_FILTER_LOCK |
				  ATA_ACPI_FILTER_DIPM,
37 38 39 40
};

static unsigned int ata_acpi_gtf_filter = ATA_ACPI_FILTER_DEFAULT;
module_param_named(acpi_gtf_filter, ata_acpi_gtf_filter, int, 0644);
T
Tejun Heo 已提交
41
MODULE_PARM_DESC(acpi_gtf_filter, "filter mask for ACPI _GTF commands, set to filter out (0x1=set xfermode, 0x2=lock/freeze lock, 0x4=DIPM)");
42

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

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

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

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

65 66 67 68 69 70 71 72 73 74 75 76 77 78
/**
 * 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)
79
{
80 81
	WARN_ON(!(ap->flags & ATA_FLAG_ACPI_SATA));

T
Tejun Heo 已提交
82
	if (!sata_pmp_attached(ap)) {
83 84 85 86 87 88 89 90 91
		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;

T
Tejun Heo 已提交
92
		ata_for_each_link(link, ap, EDGE) {
93
			acpi_integer adr = SATA_ADR(ap->port_no, link->pmp);
94

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

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

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

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

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

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

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

123 124 125 126 127 128 129 130 131
/* @ap and @dev are the same as ata_acpi_handle_hotplug() */
static void ata_acpi_detach_device(struct ata_port *ap, struct ata_device *dev)
{
	if (dev)
		dev->flags |= ATA_DFLAG_DETACH;
	else {
		struct ata_link *tlink;
		struct ata_device *tdev;

T
Tejun Heo 已提交
132 133
		ata_for_each_link(tlink, ap, EDGE)
			ata_for_each_dev(tdev, tlink, ALL)
134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157
				tdev->flags |= ATA_DFLAG_DETACH;
	}

	ata_port_schedule_eh(ap);
}

/**
 * ata_acpi_handle_hotplug - ACPI event handler backend
 * @ap: ATA port ACPI event occurred
 * @dev: ATA device ACPI event occurred (can be NULL)
 * @event: ACPI event which occurred
 *
 * All ACPI bay / device realted events end up in this function.  If
 * the event is port-wide @dev is NULL.  If the event is specific to a
 * device, @dev points to it.
 *
 * Hotplug (as opposed to unplug) notification is always handled as
 * port-wide while unplug only kills the target device on device-wide
 * event.
 *
 * LOCKING:
 * ACPI notify handler context.  May sleep.
 */
static void ata_acpi_handle_hotplug(struct ata_port *ap, struct ata_device *dev,
158
				    u32 event)
159
{
160
	struct ata_eh_info *ehi = &ap->link.eh_info;
161 162
	int wait = 0;
	unsigned long flags;
163
	acpi_handle handle;
164

165
	if (dev)
M
Matthew Garrett 已提交
166
		handle = dev->acpi_handle;
167
	else
M
Matthew Garrett 已提交
168
		handle = ap->acpi_handle;
169

170
	spin_lock_irqsave(ap->lock, flags);
171 172 173 174 175
	/*
	 * When dock driver calls into the routine, it will always use
	 * ACPI_NOTIFY_BUS_CHECK/ACPI_NOTIFY_DEVICE_CHECK for add and
	 * ACPI_NOTIFY_EJECT_REQUEST for remove
	 */
176 177 178 179
	switch (event) {
	case ACPI_NOTIFY_BUS_CHECK:
	case ACPI_NOTIFY_DEVICE_CHECK:
		ata_ehi_push_desc(ehi, "ACPI event");
180

181 182
		ata_ehi_hotplugged(ehi);
		ata_port_freeze(ap);
183 184 185 186 187 188 189
		break;
	case ACPI_NOTIFY_EJECT_REQUEST:
		ata_ehi_push_desc(ehi, "ACPI event");

		ata_acpi_detach_device(ap, dev);
		wait = 1;
		break;
190 191
	}

M
Matthew Garrett 已提交
192 193
	spin_unlock_irqrestore(ap->lock, flags);

194
	if (wait)
M
Matthew Garrett 已提交
195
		ata_port_wait_eh(ap);
196 197 198 199 200 201
}

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

202
	ata_acpi_handle_hotplug(dev->link->ap, dev, event);
203 204 205 206 207 208
}

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

209
	ata_acpi_handle_hotplug(ap, NULL, event);
210 211
}

212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251
static void ata_acpi_uevent(struct ata_port *ap, struct ata_device *dev,
	u32 event)
{
	struct kobject *kobj = NULL;
	char event_string[20];
	char *envp[] = { event_string, NULL };

	if (dev) {
		if (dev->sdev)
			kobj = &dev->sdev->sdev_gendev.kobj;
	} else
		kobj = &ap->dev->kobj;

	if (kobj) {
		snprintf(event_string, 20, "BAY_EVENT=%d", event);
		kobject_uevent_env(kobj, KOBJ_CHANGE, envp);
	}
}

static void ata_acpi_ap_uevent(acpi_handle handle, u32 event, void *data)
{
	ata_acpi_uevent(data, NULL, event);
}

static void ata_acpi_dev_uevent(acpi_handle handle, u32 event, void *data)
{
	struct ata_device *dev = data;
	ata_acpi_uevent(dev->link->ap, dev, event);
}

static struct acpi_dock_ops ata_acpi_dev_dock_ops = {
	.handler = ata_acpi_dev_notify_dock,
	.uevent = ata_acpi_dev_uevent,
};

static struct acpi_dock_ops ata_acpi_ap_dock_ops = {
	.handler = ata_acpi_ap_notify_dock,
	.uevent = ata_acpi_ap_uevent,
};

252 253 254 255 256 257 258 259 260 261 262 263 264 265
/**
 * 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)
266
{
267
	int i, j;
268

269 270
	if (!is_pci_dev(host->dev) || libata_noacpi)
		return;
271

272 273 274
	host->acpi_handle = DEVICE_ACPI_HANDLE(host->dev);
	if (!host->acpi_handle)
		return;
275

276 277 278 279 280 281 282
	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);
283

284 285 286
		if (ap->acpi_handle) {
			/* we might be on a docking station */
			register_hotplug_dock_device(ap->acpi_handle,
287
					     &ata_acpi_ap_dock_ops, ap);
288
		}
289 290 291 292

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

293 294 295
			if (dev->acpi_handle) {
				/* we might be on a docking station */
				register_hotplug_dock_device(dev->acpi_handle,
296
					     &ata_acpi_dev_dock_ops, dev);
297
			}
298
		}
299 300 301
	}
}

302 303 304 305 306 307 308 309 310 311 312 313
/**
 * 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)
{
314 315 316 317 318 319 320 321 322 323 324 325
	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);
	}
326 327
}

328 329 330 331 332 333 334 335 336 337 338 339 340
/**
 * 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.
 */
341
int ata_acpi_gtm(struct ata_port *ap, struct ata_acpi_gtm *gtm)
342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384
{
	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;
}

385 386
EXPORT_SYMBOL_GPL(ata_acpi_gtm);

387 388 389 390 391 392 393 394 395 396 397 398 399
/**
 * 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.
 */
400
int ata_acpi_stm(struct ata_port *ap, const struct ata_acpi_gtm *stm)
401 402
{
	acpi_status status;
403
	struct ata_acpi_gtm		stm_buf = *stm;
404 405 406 407 408
	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);
409
	in_params[0].buffer.pointer = (u8 *)&stm_buf;
410 411 412
	/* Buffers for id may need byteswapping ? */
	in_params[1].type = ACPI_TYPE_BUFFER;
	in_params[1].buffer.length = 512;
T
Tejun Heo 已提交
413
	in_params[1].buffer.pointer = (u8 *)ap->link.device[0].id;
414 415
	in_params[2].type = ACPI_TYPE_BUFFER;
	in_params[2].buffer.length = 512;
T
Tejun Heo 已提交
416
	in_params[2].buffer.pointer = (u8 *)ap->link.device[1].id;
417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432

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

433 434
EXPORT_SYMBOL_GPL(ata_acpi_stm);

435
/**
436
 * ata_dev_get_GTF - get the drive bootup default taskfile settings
437
 * @dev: target ATA device
438
 * @gtf: output parameter for buffer containing _GTF taskfile arrays
439 440 441 442 443 444 445 446 447
 *
 * 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.
 *
448 449 450 451
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
452 453
 * Number of taskfiles on success, 0 if _GTF doesn't exist.  -EINVAL
 * if _GTF is invalid.
454
 */
455
static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf)
456
{
T
Tejun Heo 已提交
457
	struct ata_port *ap = dev->link->ap;
458 459 460
	acpi_status status;
	struct acpi_buffer output;
	union acpi_object *out_obj;
461
	int rc = 0;
462

463 464 465 466 467 468
	/* if _GTF is cached, use the cached value */
	if (dev->gtf_cache) {
		out_obj = dev->gtf_cache;
		goto done;
	}

469 470 471
	/* set up output buffer */
	output.length = ACPI_ALLOCATE_BUFFER;
	output.pointer = NULL;	/* ACPI-CA sets this; save/free it later */
472 473

	if (ata_msg_probe(ap))
474
		ata_dev_printk(dev, KERN_DEBUG, "%s: ENTER: port#: %d\n",
475
			       __func__, ap->port_no);
476 477

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

481
	if (ACPI_FAILURE(status)) {
482 483 484 485
		if (status != AE_NOT_FOUND) {
			ata_dev_printk(dev, KERN_WARNING,
				       "_GTF evaluation failed (AE 0x%x)\n",
				       status);
T
Tejun Heo 已提交
486
			rc = -EINVAL;
487 488
		}
		goto out_free;
489 490 491 492
	}

	if (!output.length || !output.pointer) {
		if (ata_msg_probe(ap))
493
			ata_dev_printk(dev, KERN_DEBUG, "%s: Run _GTF: "
494
				"length or ptr is NULL (0x%llx, 0x%p)\n",
495
				__func__,
496 497
				(unsigned long long)output.length,
				output.pointer);
T
Tejun Heo 已提交
498
		rc = -EINVAL;
499
		goto out_free;
500 501 502
	}

	if (out_obj->type != ACPI_TYPE_BUFFER) {
T
Tejun Heo 已提交
503 504 505
		ata_dev_printk(dev, KERN_WARNING,
			       "_GTF unexpected object type 0x%x\n",
			       out_obj->type);
T
Tejun Heo 已提交
506
		rc = -EINVAL;
507
		goto out_free;
508 509
	}

510
	if (out_obj->buffer.length % REGS_PER_GTF) {
T
Tejun Heo 已提交
511 512 513
		ata_dev_printk(dev, KERN_WARNING,
			       "unexpected _GTF length (%d)\n",
			       out_obj->buffer.length);
T
Tejun Heo 已提交
514
		rc = -EINVAL;
515
		goto out_free;
516 517
	}

518
 done:
519
	rc = out_obj->buffer.length / REGS_PER_GTF;
520 521 522 523 524
	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",
525
				       __func__, *gtf, rc);
526
	}
527 528 529
	return rc;

 out_free:
530
	ata_acpi_clear_gtf(dev);
531
	return rc;
532 533
}

534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549
/**
 * 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)
{
550 551 552 553
	unsigned long xfer_mask = 0;
	unsigned int type;
	int unit;
	u8 mode;
554 555 556 557 558 559

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

560 561 562
	/* PIO */
	mode = ata_timing_cycle2mode(ATA_SHIFT_PIO, gtm->drive[unit].pio);
	xfer_mask |= ata_xfer_mode2mask(mode);
563 564 565 566 567

	/* 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.
	 */
568 569 570 571 572 573 574
	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);
575

576
	return xfer_mask;
577 578 579
}
EXPORT_SYMBOL_GPL(ata_acpi_gtm_xfermask);

A
Alan Cox 已提交
580 581 582
/**
 * ata_acpi_cbl_80wire		-	Check for 80 wire cable
 * @ap: Port to check
583
 * @gtm: GTM data to use
A
Alan Cox 已提交
584
 *
585
 * Return 1 if the @gtm indicates the BIOS selected an 80wire mode.
A
Alan Cox 已提交
586
 */
587
int ata_acpi_cbl_80wire(struct ata_port *ap, const struct ata_acpi_gtm *gtm)
A
Alan Cox 已提交
588
{
589 590
	struct ata_device *dev;

T
Tejun Heo 已提交
591
	ata_for_each_dev(dev, &ap->link, ENABLED) {
592 593 594 595 596 597 598 599 600
		unsigned long xfer_mask, udma_mask;

		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 已提交
601 602 603 604
	return 0;
}
EXPORT_SYMBOL_GPL(ata_acpi_cbl_80wire);

605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655
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;
	}

T
Tejun Heo 已提交
656 657 658 659 660 661 662 663
	if (ata_acpi_gtf_filter & ATA_ACPI_FILTER_DIPM) {
		/* inhibit enabling DIPM */
		if (tf->command == ATA_CMD_SET_FEATURES &&
		    tf->feature == SETFEATURES_SATA_ENABLE &&
		    tf->nsect == SATA_DIPM)
			return 1;
	}

664 665 666
	return 0;
}

667
/**
668
 * ata_acpi_run_tf - send taskfile registers to host controller
669
 * @dev: target ATA device
670 671 672 673 674 675 676 677 678 679 680 681 682
 * @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.
 *
683 684 685 686
 * LOCKING:
 * EH context.
 *
 * RETURNS:
687 688
 * 1 if command is executed successfully.  0 if ignored, rejected or
 * filtered out, -errno on other errors.
689
 */
690
static int ata_acpi_run_tf(struct ata_device *dev,
691 692
			   const struct ata_acpi_gtf *gtf,
			   const struct ata_acpi_gtf *prev_gtf)
693
{
694 695
	struct ata_taskfile *pptf = NULL;
	struct ata_taskfile tf, ptf, rtf;
696
	unsigned int err_mask;
697 698 699
	const char *level;
	char msg[60];
	int rc;
700

701 702 703 704
	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;
705

706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740
	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 {
741
		level = KERN_INFO;
742
		snprintf(msg, sizeof(msg), "filtered out");
743
		rc = 0;
744 745
	}

746 747 748 749 750 751
	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;
752 753 754 755
}

/**
 * ata_acpi_exec_tfs - get then write drive taskfile settings
T
Tejun Heo 已提交
756
 * @dev: target ATA device
T
Tejun Heo 已提交
757
 * @nr_executed: out paramter for the number of executed commands
758
 *
T
Tejun Heo 已提交
759
 * Evaluate _GTF and excute returned taskfiles.
T
Tejun Heo 已提交
760 761 762 763 764
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
765 766
 * Number of executed taskfiles on success, 0 if _GTF doesn't exist.
 * -errno on other errors.
767
 */
T
Tejun Heo 已提交
768
static int ata_acpi_exec_tfs(struct ata_device *dev, int *nr_executed)
769
{
770
	struct ata_acpi_gtf *gtf = NULL, *pgtf = NULL;
T
Tejun Heo 已提交
771 772 773
	int gtf_count, i, rc;

	/* get taskfiles */
T
Tejun Heo 已提交
774 775 776 777
	rc = ata_dev_get_GTF(dev, &gtf);
	if (rc < 0)
		return rc;
	gtf_count = rc;
T
Tejun Heo 已提交
778 779

	/* execute them */
780 781
	for (i = 0; i < gtf_count; i++, gtf++) {
		rc = ata_acpi_run_tf(dev, gtf, pgtf);
782 783
		if (rc < 0)
			break;
784
		if (rc) {
785
			(*nr_executed)++;
786 787
			pgtf = gtf;
		}
788 789
	}

790
	ata_acpi_clear_gtf(dev);
T
Tejun Heo 已提交
791

792 793 794
	if (rc < 0)
		return rc;
	return 0;
795 796
}

797 798
/**
 * ata_acpi_push_id - send Identify data to drive
799
 * @dev: target ATA device
800 801 802 803 804 805
 *
 * _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 已提交
806 807 808 809 810 811
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
 * 0 on success, -errno on failure.
812
 */
T
Tejun Heo 已提交
813
static int ata_acpi_push_id(struct ata_device *dev)
814
{
T
Tejun Heo 已提交
815
	struct ata_port *ap = dev->link->ap;
816 817 818 819
	int err;
	acpi_status status;
	struct acpi_object_list input;
	union acpi_object in_params[1];
820 821

	if (ata_msg_probe(ap))
822
		ata_dev_printk(dev, KERN_DEBUG, "%s: ix = %d, port#: %d\n",
823
			       __func__, dev->devno, ap->port_no);
824 825 826 827 828 829

	/* 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;
830 831
	in_params[0].buffer.length = sizeof(dev->id[0]) * ATA_ID_WORDS;
	in_params[0].buffer.pointer = (u8 *)dev->id;
832 833 834
	/* Output buffer: _SDD has no output */

	/* It's OK for _SDD to be missing too. */
835
	swap_buf_le16(dev->id, ATA_ID_WORDS);
836
	status = acpi_evaluate_object(dev->acpi_handle, "_SDD", &input, NULL);
837
	swap_buf_le16(dev->id, ATA_ID_WORDS);
838 839

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

T
Tejun Heo 已提交
844 845 846
	return err;
}

847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863
/**
 * 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)
{
864 865
	/* nada */
	return 0;
866 867
}

T
Tejun Heo 已提交
868 869 870 871 872 873 874 875 876 877 878 879
/**
 * 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)
{
880
	const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
881
	struct ata_device *dev;
T
Tejun Heo 已提交
882

883 884 885 886
	if (ap->acpi_handle && gtm) {
		/* _GTM valid */

		/* restore timing parameters */
887
		ata_acpi_stm(ap, gtm);
888

889 890 891 892
		/* _GTF should immediately follow _STM so that it can
		 * use values set by _STM.  Cache _GTF result and
		 * schedule _GTF.
		 */
T
Tejun Heo 已提交
893
		ata_for_each_dev(dev, &ap->link, ALL) {
894
			ata_acpi_clear_gtf(dev);
895 896
			if (ata_dev_enabled(dev) &&
			    ata_dev_get_GTF(dev, NULL) >= 0)
897 898 899 900 901 902 903
				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.
		 */
T
Tejun Heo 已提交
904
		ata_for_each_dev(dev, &ap->link, ALL) {
905
			ata_acpi_clear_gtf(dev);
906 907
			if (ata_dev_enabled(dev))
				dev->flags |= ATA_DFLAG_ACPI_PENDING;
908 909
		}
	}
910 911
}

S
Shaohua Li 已提交
912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931
/**
 * 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);

T
Tejun Heo 已提交
932 933
	ata_for_each_dev(dev, &ap->link, ENABLED) {
		if (dev->acpi_handle)
S
Shaohua Li 已提交
934 935 936 937 938 939 940 941
			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 已提交
942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957
/**
 * 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 已提交
958 959
	struct ata_port *ap = dev->link->ap;
	struct ata_eh_context *ehc = &ap->link.eh_context;
T
Tejun Heo 已提交
960
	int acpi_sata = ap->flags & ATA_FLAG_ACPI_SATA;
T
Tejun Heo 已提交
961
	int nr_executed = 0;
T
Tejun Heo 已提交
962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979
	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 已提交
980 981
	rc = ata_acpi_exec_tfs(dev, &nr_executed);
	if (rc)
T
Tejun Heo 已提交
982 983 984 985 986
		goto acpi_err;

	dev->flags &= ~ATA_DFLAG_ACPI_PENDING;

	/* refresh IDENTIFY page if any _GTF command has been executed */
T
Tejun Heo 已提交
987
	if (nr_executed) {
T
Tejun Heo 已提交
988 989 990 991 992 993 994 995 996 997 998
		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 已提交
999 1000 1001
	/* ignore evaluation failure if we can continue safely */
	if (rc == -EINVAL && !nr_executed && !(ap->pflags & ATA_PFLAG_FROZEN))
		return 0;
T
Tejun Heo 已提交
1002

T
Tejun Heo 已提交
1003 1004 1005 1006
	/* 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 已提交
1007
	}
T
Tejun Heo 已提交
1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018

	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 已提交
1019 1020
	return rc;
}
1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032

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