libata-acpi.c 25.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 <linux/slab.h>
19
#include <scsi/scsi_device.h>
20 21 22 23
#include "libata.h"

#include <acpi/acpi_bus.h>

T
Tejun Heo 已提交
24
unsigned int ata_acpi_gtf_filter = ATA_ACPI_FILTER_DEFAULT;
25
module_param_named(acpi_gtf_filter, ata_acpi_gtf_filter, int, 0644);
26
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, 0x8=FPDMA non-zero offset, 0x10=FPDMA DMA Setup FIS auto-activate)");
27

28
#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
/**
 * ata_ap_acpi_handle - provide the acpi_handle for an ata_port
 * @ap: the acpi_handle returned will correspond to this port
 *
 * Returns the acpi_handle for the ACPI namespace object corresponding to
 * the ata_port passed into the function, or NULL if no such object exists
 */
acpi_handle ata_ap_acpi_handle(struct ata_port *ap)
58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73
{
	if (ap->flags & ATA_FLAG_ACPI_SATA)
		return NULL;

	/*
	 * If acpi bind operation has already happened, we can get the handle
	 * for the port by checking the corresponding scsi_host device's
	 * firmware node, otherwise we will need to find out the handle from
	 * its parent's acpi node.
	 */
	if (ap->scsi_host)
		return DEVICE_ACPI_HANDLE(&ap->scsi_host->shost_gendev);
	else
		return acpi_get_child(DEVICE_ACPI_HANDLE(ap->host->dev),
				ap->port_no);
}
74
EXPORT_SYMBOL(ata_ap_acpi_handle);
75

76 77 78 79 80 81 82 83
/**
 * ata_dev_acpi_handle - provide the acpi_handle for an ata_device
 * @dev: the acpi_device returned will correspond to this port
 *
 * Returns the acpi_handle for the ACPI namespace object corresponding to
 * the ata_device passed into the function, or NULL if no such object exists
 */
acpi_handle ata_dev_acpi_handle(struct ata_device *dev)
84 85 86 87 88 89 90 91 92 93 94
{
	acpi_integer adr;
	struct ata_port *ap = dev->link->ap;

	if (ap->flags & ATA_FLAG_ACPI_SATA) {
		if (!sata_pmp_attached(ap))
			adr = SATA_ADR(ap->port_no, NO_PORT_MULT);
		else
			adr = SATA_ADR(ap->port_no, dev->link->pmp);
		return acpi_get_child(DEVICE_ACPI_HANDLE(ap->host->dev), adr);
	} else
95
		return acpi_get_child(ata_ap_acpi_handle(ap), dev->devno);
96
}
97
EXPORT_SYMBOL(ata_dev_acpi_handle);
98

99 100 101 102 103 104 105 106 107
/* @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 已提交
108 109
		ata_for_each_link(tlink, ap, EDGE)
			ata_for_each_dev(tdev, tlink, ALL)
110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133
				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,
134
				    u32 event)
135
{
136
	struct ata_eh_info *ehi = &ap->link.eh_info;
137 138
	int wait = 0;
	unsigned long flags;
139

140
	spin_lock_irqsave(ap->lock, flags);
141 142 143 144 145
	/*
	 * 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
	 */
146 147 148 149
	switch (event) {
	case ACPI_NOTIFY_BUS_CHECK:
	case ACPI_NOTIFY_DEVICE_CHECK:
		ata_ehi_push_desc(ehi, "ACPI event");
150

151 152
		ata_ehi_hotplugged(ehi);
		ata_port_freeze(ap);
153 154 155 156 157 158 159
		break;
	case ACPI_NOTIFY_EJECT_REQUEST:
		ata_ehi_push_desc(ehi, "ACPI event");

		ata_acpi_detach_device(ap, dev);
		wait = 1;
		break;
160 161
	}

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

164
	if (wait)
M
Matthew Garrett 已提交
165
		ata_port_wait_eh(ap);
166 167 168 169 170 171
}

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

172
	ata_acpi_handle_hotplug(dev->link->ap, dev, event);
173 174 175 176 177 178
}

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

179
	ata_acpi_handle_hotplug(ap, NULL, event);
180 181
}

182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211
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);
}

V
Vasiliy Kulikov 已提交
212
static const struct acpi_dock_ops ata_acpi_dev_dock_ops = {
213 214 215 216
	.handler = ata_acpi_dev_notify_dock,
	.uevent = ata_acpi_dev_uevent,
};

V
Vasiliy Kulikov 已提交
217
static const struct acpi_dock_ops ata_acpi_ap_dock_ops = {
218 219 220 221
	.handler = ata_acpi_ap_notify_dock,
	.uevent = ata_acpi_ap_uevent,
};

222 223 224 225 226 227 228 229 230 231 232 233
/**
 * 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)
{
234 235 236 237 238 239 240 241 242
	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);

243
		if (ata_ap_acpi_handle(ap) && gtm)
244 245
			ata_acpi_stm(ap, gtm);
	}
246 247
}

248 249 250 251 252 253 254 255 256 257 258 259 260
/**
 * 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.
 */
261
int ata_acpi_gtm(struct ata_port *ap, struct ata_acpi_gtm *gtm)
262 263 264 265 266 267
{
	struct acpi_buffer output = { .length = ACPI_ALLOCATE_BUFFER };
	union acpi_object *out_obj;
	acpi_status status;
	int rc = 0;

268 269
	status = acpi_evaluate_object(ata_ap_acpi_handle(ap), "_GTM", NULL,
				      &output);
270 271 272 273 274 275 276

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

	rc = -EINVAL;
	if (ACPI_FAILURE(status)) {
277 278
		ata_port_err(ap, "ACPI get timing mode failed (AE 0x%x)\n",
			     status);
279 280 281 282 283
		goto out_free;
	}

	out_obj = output.pointer;
	if (out_obj->type != ACPI_TYPE_BUFFER) {
284 285
		ata_port_warn(ap, "_GTM returned unexpected object type 0x%x\n",
			      out_obj->type);
286 287 288 289 290

		goto out_free;
	}

	if (out_obj->buffer.length != sizeof(struct ata_acpi_gtm)) {
291 292
		ata_port_err(ap, "_GTM returned invalid length %d\n",
			     out_obj->buffer.length);
293 294 295 296 297 298 299 300 301 302
		goto out_free;
	}

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

303 304
EXPORT_SYMBOL_GPL(ata_acpi_gtm);

305 306 307 308 309 310 311 312 313 314 315 316 317
/**
 * 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.
 */
318
int ata_acpi_stm(struct ata_port *ap, const struct ata_acpi_gtm *stm)
319 320
{
	acpi_status status;
321
	struct ata_acpi_gtm		stm_buf = *stm;
322 323 324 325 326
	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);
327
	in_params[0].buffer.pointer = (u8 *)&stm_buf;
328 329 330
	/* Buffers for id may need byteswapping ? */
	in_params[1].type = ACPI_TYPE_BUFFER;
	in_params[1].buffer.length = 512;
T
Tejun Heo 已提交
331
	in_params[1].buffer.pointer = (u8 *)ap->link.device[0].id;
332 333
	in_params[2].type = ACPI_TYPE_BUFFER;
	in_params[2].buffer.length = 512;
T
Tejun Heo 已提交
334
	in_params[2].buffer.pointer = (u8 *)ap->link.device[1].id;
335 336 337 338

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

339 340
	status = acpi_evaluate_object(ata_ap_acpi_handle(ap), "_STM", &input,
				      NULL);
341 342 343 344

	if (status == AE_NOT_FOUND)
		return -ENOENT;
	if (ACPI_FAILURE(status)) {
345 346
		ata_port_err(ap, "ACPI set timing mode failed (status=0x%x)\n",
			     status);
347 348 349 350 351
		return -EINVAL;
	}
	return 0;
}

352 353
EXPORT_SYMBOL_GPL(ata_acpi_stm);

354
/**
355
 * ata_dev_get_GTF - get the drive bootup default taskfile settings
356
 * @dev: target ATA device
357
 * @gtf: output parameter for buffer containing _GTF taskfile arrays
358 359 360 361 362 363 364 365 366
 *
 * 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.
 *
367 368 369 370
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
371 372
 * Number of taskfiles on success, 0 if _GTF doesn't exist.  -EINVAL
 * if _GTF is invalid.
373
 */
374
static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf)
375
{
T
Tejun Heo 已提交
376
	struct ata_port *ap = dev->link->ap;
377 378 379
	acpi_status status;
	struct acpi_buffer output;
	union acpi_object *out_obj;
380
	int rc = 0;
381

382 383 384 385 386 387
	/* if _GTF is cached, use the cached value */
	if (dev->gtf_cache) {
		out_obj = dev->gtf_cache;
		goto done;
	}

388 389 390
	/* set up output buffer */
	output.length = ACPI_ALLOCATE_BUFFER;
	output.pointer = NULL;	/* ACPI-CA sets this; save/free it later */
391 392

	if (ata_msg_probe(ap))
393 394
		ata_dev_dbg(dev, "%s: ENTER: port#: %d\n",
			    __func__, ap->port_no);
395 396

	/* _GTF has no input parameters */
397 398
	status = acpi_evaluate_object(ata_dev_acpi_handle(dev), "_GTF", NULL,
				      &output);
399
	out_obj = dev->gtf_cache = output.pointer;
400

401
	if (ACPI_FAILURE(status)) {
402
		if (status != AE_NOT_FOUND) {
403 404
			ata_dev_warn(dev, "_GTF evaluation failed (AE 0x%x)\n",
				     status);
T
Tejun Heo 已提交
405
			rc = -EINVAL;
406 407
		}
		goto out_free;
408 409 410 411
	}

	if (!output.length || !output.pointer) {
		if (ata_msg_probe(ap))
412 413 414 415
			ata_dev_dbg(dev, "%s: Run _GTF: length or ptr is NULL (0x%llx, 0x%p)\n",
				    __func__,
				    (unsigned long long)output.length,
				    output.pointer);
T
Tejun Heo 已提交
416
		rc = -EINVAL;
417
		goto out_free;
418 419 420
	}

	if (out_obj->type != ACPI_TYPE_BUFFER) {
421 422
		ata_dev_warn(dev, "_GTF unexpected object type 0x%x\n",
			     out_obj->type);
T
Tejun Heo 已提交
423
		rc = -EINVAL;
424
		goto out_free;
425 426
	}

427
	if (out_obj->buffer.length % REGS_PER_GTF) {
428 429
		ata_dev_warn(dev, "unexpected _GTF length (%d)\n",
			     out_obj->buffer.length);
T
Tejun Heo 已提交
430
		rc = -EINVAL;
431
		goto out_free;
432 433
	}

434
 done:
435
	rc = out_obj->buffer.length / REGS_PER_GTF;
436 437 438
	if (gtf) {
		*gtf = (void *)out_obj->buffer.pointer;
		if (ata_msg_probe(ap))
439 440
			ata_dev_dbg(dev, "%s: returning gtf=%p, gtf_count=%d\n",
				    __func__, *gtf, rc);
441
	}
442 443 444
	return rc;

 out_free:
445
	ata_acpi_clear_gtf(dev);
446
	return rc;
447 448
}

449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464
/**
 * 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)
{
465 466 467 468
	unsigned long xfer_mask = 0;
	unsigned int type;
	int unit;
	u8 mode;
469 470 471 472 473 474

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

475 476 477
	/* PIO */
	mode = ata_timing_cycle2mode(ATA_SHIFT_PIO, gtm->drive[unit].pio);
	xfer_mask |= ata_xfer_mode2mask(mode);
478 479 480 481 482

	/* 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.
	 */
483 484 485 486 487 488 489
	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);
490

491
	return xfer_mask;
492 493 494
}
EXPORT_SYMBOL_GPL(ata_acpi_gtm_xfermask);

A
Alan Cox 已提交
495 496 497
/**
 * ata_acpi_cbl_80wire		-	Check for 80 wire cable
 * @ap: Port to check
498
 * @gtm: GTM data to use
A
Alan Cox 已提交
499
 *
500
 * Return 1 if the @gtm indicates the BIOS selected an 80wire mode.
A
Alan Cox 已提交
501
 */
502
int ata_acpi_cbl_80wire(struct ata_port *ap, const struct ata_acpi_gtm *gtm)
A
Alan Cox 已提交
503
{
504 505
	struct ata_device *dev;

T
Tejun Heo 已提交
506
	ata_for_each_dev(dev, &ap->link, ENABLED) {
507 508 509 510 511 512 513 514 515
		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 已提交
516 517 518 519
	return 0;
}
EXPORT_SYMBOL_GPL(ata_acpi_cbl_80wire);

520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536
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 */
}

T
Tejun Heo 已提交
537 538
static int ata_acpi_filter_tf(struct ata_device *dev,
			      const struct ata_taskfile *tf,
539 540
			      const struct ata_taskfile *ptf)
{
T
Tejun Heo 已提交
541
	if (dev->gtf_filter & ATA_ACPI_FILTER_SETXFER) {
542 543 544 545 546 547 548 549
		/* 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;
	}

T
Tejun Heo 已提交
550
	if (dev->gtf_filter & ATA_ACPI_FILTER_LOCK) {
551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571
		/* 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;
	}

572 573
	if (tf->command == ATA_CMD_SET_FEATURES &&
	    tf->feature == SETFEATURES_SATA_ENABLE) {
T
Tejun Heo 已提交
574
		/* inhibit enabling DIPM */
T
Tejun Heo 已提交
575
		if (dev->gtf_filter & ATA_ACPI_FILTER_DIPM &&
T
Tejun Heo 已提交
576 577
		    tf->nsect == SATA_DIPM)
			return 1;
578 579

		/* inhibit FPDMA non-zero offset */
T
Tejun Heo 已提交
580
		if (dev->gtf_filter & ATA_ACPI_FILTER_FPDMA_OFFSET &&
581 582 583 584 585
		    (tf->nsect == SATA_FPDMA_OFFSET ||
		     tf->nsect == SATA_FPDMA_IN_ORDER))
			return 1;

		/* inhibit FPDMA auto activation */
T
Tejun Heo 已提交
586
		if (dev->gtf_filter & ATA_ACPI_FILTER_FPDMA_AA &&
587 588
		    tf->nsect == SATA_FPDMA_AA)
			return 1;
T
Tejun Heo 已提交
589 590
	}

591 592 593
	return 0;
}

594
/**
595
 * ata_acpi_run_tf - send taskfile registers to host controller
596
 * @dev: target ATA device
597 598
 * @gtf: raw ATA taskfile register set (0x1f1 - 0x1f7)
 *
S
Sergei Shtylyov 已提交
599
 * Outputs ATA taskfile to standard ATA host controller.
600 601 602 603 604 605 606 607 608
 * 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.
 *
609 610 611 612
 * LOCKING:
 * EH context.
 *
 * RETURNS:
613 614
 * 1 if command is executed successfully.  0 if ignored, rejected or
 * filtered out, -errno on other errors.
615
 */
616
static int ata_acpi_run_tf(struct ata_device *dev,
617 618
			   const struct ata_acpi_gtf *gtf,
			   const struct ata_acpi_gtf *prev_gtf)
619
{
620 621
	struct ata_taskfile *pptf = NULL;
	struct ata_taskfile tf, ptf, rtf;
622
	unsigned int err_mask;
623
	const char *level;
624
	const char *descr;
625 626
	char msg[60];
	int rc;
627

628 629 630 631
	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;
632

633 634 635 636 637 638
	ata_acpi_gtf_to_tf(dev, gtf, &tf);
	if (prev_gtf) {
		ata_acpi_gtf_to_tf(dev, prev_gtf, &ptf);
		pptf = &ptf;
	}

T
Tejun Heo 已提交
639
	if (!ata_acpi_filter_tf(dev, &tf, pptf)) {
640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667
		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 {
668
		level = KERN_INFO;
669
		snprintf(msg, sizeof(msg), "filtered out");
670
		rc = 0;
671
	}
672
	descr = ata_get_cmd_descript(tf.command);
673

674
	ata_dev_printk(dev, level,
675
		       "ACPI cmd %02x/%02x:%02x:%02x:%02x:%02x:%02x (%s) %s\n",
676
		       tf.command, tf.feature, tf.nsect, tf.lbal,
677 678
		       tf.lbam, tf.lbah, tf.device,
		       (descr ? descr : "unknown"), msg);
679 680

	return rc;
681 682 683 684
}

/**
 * ata_acpi_exec_tfs - get then write drive taskfile settings
T
Tejun Heo 已提交
685
 * @dev: target ATA device
686
 * @nr_executed: out parameter for the number of executed commands
687
 *
688
 * Evaluate _GTF and execute returned taskfiles.
T
Tejun Heo 已提交
689 690 691 692 693
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
T
Tejun Heo 已提交
694 695
 * Number of executed taskfiles on success, 0 if _GTF doesn't exist.
 * -errno on other errors.
696
 */
T
Tejun Heo 已提交
697
static int ata_acpi_exec_tfs(struct ata_device *dev, int *nr_executed)
698
{
699
	struct ata_acpi_gtf *gtf = NULL, *pgtf = NULL;
T
Tejun Heo 已提交
700 701 702
	int gtf_count, i, rc;

	/* get taskfiles */
T
Tejun Heo 已提交
703 704 705 706
	rc = ata_dev_get_GTF(dev, &gtf);
	if (rc < 0)
		return rc;
	gtf_count = rc;
T
Tejun Heo 已提交
707 708

	/* execute them */
709 710
	for (i = 0; i < gtf_count; i++, gtf++) {
		rc = ata_acpi_run_tf(dev, gtf, pgtf);
711 712
		if (rc < 0)
			break;
713
		if (rc) {
714
			(*nr_executed)++;
715 716
			pgtf = gtf;
		}
717 718
	}

719
	ata_acpi_clear_gtf(dev);
T
Tejun Heo 已提交
720

721 722 723
	if (rc < 0)
		return rc;
	return 0;
724 725
}

726 727
/**
 * ata_acpi_push_id - send Identify data to drive
728
 * @dev: target ATA device
729 730 731 732 733 734
 *
 * _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 已提交
735 736 737 738 739
 *
 * LOCKING:
 * EH context.
 *
 * RETURNS:
740
 * 0 on success, -ENOENT if _SDD doesn't exist, -errno on failure.
741
 */
T
Tejun Heo 已提交
742
static int ata_acpi_push_id(struct ata_device *dev)
743
{
T
Tejun Heo 已提交
744
	struct ata_port *ap = dev->link->ap;
745 746 747
	acpi_status status;
	struct acpi_object_list input;
	union acpi_object in_params[1];
748 749

	if (ata_msg_probe(ap))
750 751
		ata_dev_dbg(dev, "%s: ix = %d, port#: %d\n",
			    __func__, dev->devno, ap->port_no);
752 753 754 755 756 757

	/* 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;
758 759
	in_params[0].buffer.length = sizeof(dev->id[0]) * ATA_ID_WORDS;
	in_params[0].buffer.pointer = (u8 *)dev->id;
760 761 762
	/* Output buffer: _SDD has no output */

	/* It's OK for _SDD to be missing too. */
763
	swap_buf_le16(dev->id, ATA_ID_WORDS);
764 765
	status = acpi_evaluate_object(ata_dev_acpi_handle(dev), "_SDD", &input,
				      NULL);
766
	swap_buf_le16(dev->id, ATA_ID_WORDS);
767

768 769 770 771
	if (status == AE_NOT_FOUND)
		return -ENOENT;

	if (ACPI_FAILURE(status)) {
772
		ata_dev_warn(dev, "ACPI _SDD failed (AE 0x%x)\n", status);
773 774
		return -EIO;
	}
775

776
	return 0;
T
Tejun Heo 已提交
777 778
}

779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795
/**
 * 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)
{
796 797
	/* nada */
	return 0;
798 799
}

T
Tejun Heo 已提交
800 801 802 803 804 805 806 807 808 809 810 811
/**
 * 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)
{
812
	const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
813
	struct ata_device *dev;
T
Tejun Heo 已提交
814

815
	if (ata_ap_acpi_handle(ap) && gtm) {
816 817 818
		/* _GTM valid */

		/* restore timing parameters */
819
		ata_acpi_stm(ap, gtm);
820

821 822 823 824
		/* _GTF should immediately follow _STM so that it can
		 * use values set by _STM.  Cache _GTF result and
		 * schedule _GTF.
		 */
T
Tejun Heo 已提交
825
		ata_for_each_dev(dev, &ap->link, ALL) {
826
			ata_acpi_clear_gtf(dev);
827 828
			if (ata_dev_enabled(dev) &&
			    ata_dev_get_GTF(dev, NULL) >= 0)
829 830 831 832 833 834 835
				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 已提交
836
		ata_for_each_dev(dev, &ap->link, ALL) {
837
			ata_acpi_clear_gtf(dev);
838 839
			if (ata_dev_enabled(dev))
				dev->flags |= ATA_DFLAG_ACPI_PENDING;
840 841
		}
	}
842 843
}

S
Shaohua Li 已提交
844 845 846 847 848 849 850 851 852 853 854
/**
 * 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;
855
	acpi_handle handle;
S
Shaohua Li 已提交
856 857 858

	/* channel first and then drives for power on and vica versa
	   for power off */
859 860 861
	handle = ata_ap_acpi_handle(ap);
	if (handle && state.event == PM_EVENT_ON)
		acpi_bus_set_power(handle, ACPI_STATE_D0);
S
Shaohua Li 已提交
862

T
Tejun Heo 已提交
863
	ata_for_each_dev(dev, &ap->link, ENABLED) {
864 865 866
		handle = ata_dev_acpi_handle(dev);
		if (handle)
			acpi_bus_set_power(handle,
S
Shaohua Li 已提交
867 868 869
				state.event == PM_EVENT_ON ?
					ACPI_STATE_D0 : ACPI_STATE_D3);
	}
870 871 872 873

	handle = ata_ap_acpi_handle(ap);
	if (handle && state.event != PM_EVENT_ON)
		acpi_bus_set_power(handle, ACPI_STATE_D3);
S
Shaohua Li 已提交
874 875
}

T
Tejun Heo 已提交
876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891
/**
 * 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 已提交
892 893
	struct ata_port *ap = dev->link->ap;
	struct ata_eh_context *ehc = &ap->link.eh_context;
T
Tejun Heo 已提交
894
	int acpi_sata = ap->flags & ATA_FLAG_ACPI_SATA;
T
Tejun Heo 已提交
895
	int nr_executed = 0;
T
Tejun Heo 已提交
896 897
	int rc;

898
	if (!ata_dev_acpi_handle(dev))
T
Tejun Heo 已提交
899 900 901 902 903 904 905 906 907 908
		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);
909
		if (rc && rc != -ENOENT)
T
Tejun Heo 已提交
910 911 912 913
			goto acpi_err;
	}

	/* do _GTF */
T
Tejun Heo 已提交
914 915
	rc = ata_acpi_exec_tfs(dev, &nr_executed);
	if (rc)
T
Tejun Heo 已提交
916 917 918 919 920
		goto acpi_err;

	dev->flags &= ~ATA_DFLAG_ACPI_PENDING;

	/* refresh IDENTIFY page if any _GTF command has been executed */
T
Tejun Heo 已提交
921
	if (nr_executed) {
T
Tejun Heo 已提交
922 923
		rc = ata_dev_reread_id(dev, 0);
		if (rc < 0) {
924 925
			ata_dev_err(dev,
				    "failed to IDENTIFY after ACPI commands\n");
T
Tejun Heo 已提交
926 927 928 929 930 931 932
			return rc;
		}
	}

	return 0;

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

T
Tejun Heo 已提交
937 938 939 940
	/* 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 已提交
941
	}
T
Tejun Heo 已提交
942

943
	ata_dev_warn(dev, "ACPI: failed the second time, disabled\n");
T
Tejun Heo 已提交
944 945 946 947 948 949 950

	/* 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 已提交
951 952
	return rc;
}
953 954 955 956 957 958 959 960 961 962 963 964

/**
 * 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)
{
965
	ata_acpi_clear_gtf(dev);
966
}
967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008

static int compat_pci_ata(struct ata_port *ap)
{
	struct device *dev = ap->tdev.parent;
	struct pci_dev *pdev;

	if (!is_pci_dev(dev))
		return 0;

	pdev = to_pci_dev(dev);

	if ((pdev->class >> 8) != PCI_CLASS_STORAGE_SATA &&
	    (pdev->class >> 8) != PCI_CLASS_STORAGE_IDE)
		return 0;

	return 1;
}

static int ata_acpi_bind_host(struct ata_port *ap, acpi_handle *handle)
{
	if (ap->flags & ATA_FLAG_ACPI_SATA)
		return -ENODEV;

	*handle = acpi_get_child(DEVICE_ACPI_HANDLE(ap->tdev.parent),
			ap->port_no);

	if (!*handle)
		return -ENODEV;

	return 0;
}

static int ata_acpi_bind_device(struct ata_port *ap, struct scsi_device *sdev,
				acpi_handle *handle)
{
	struct ata_device *ata_dev;

	if (ap->flags & ATA_FLAG_ACPI_SATA)
		ata_dev = &ap->link.device[sdev->channel];
	else
		ata_dev = &ap->link.device[sdev->id];

1009
	*handle = ata_dev_acpi_handle(ata_dev);
1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070

	if (!*handle)
		return -ENODEV;

	return 0;
}

static int is_ata_port(const struct device *dev)
{
	return dev->type == &ata_port_type;
}

static struct ata_port *dev_to_ata_port(struct device *dev)
{
	while (!is_ata_port(dev)) {
		if (!dev->parent)
			return NULL;
		dev = dev->parent;
	}
	return to_ata_port(dev);
}

static int ata_acpi_find_device(struct device *dev, acpi_handle *handle)
{
	struct ata_port *ap = dev_to_ata_port(dev);

	if (!ap)
		return -ENODEV;

	if (!compat_pci_ata(ap))
		return -ENODEV;

	if (scsi_is_host_device(dev))
		return ata_acpi_bind_host(ap, handle);
	else if (scsi_is_sdev_device(dev)) {
		struct scsi_device *sdev = to_scsi_device(dev);

		return ata_acpi_bind_device(ap, sdev, handle);
	} else
		return -ENODEV;
}

static int ata_acpi_find_dummy(struct device *dev, acpi_handle *handle)
{
	return -ENODEV;
}

static struct acpi_bus_type ata_acpi_bus = {
	.find_bridge = ata_acpi_find_dummy,
	.find_device = ata_acpi_find_device,
};

int ata_acpi_register(void)
{
	return scsi_register_acpi_bus_type(&ata_acpi_bus);
}

void ata_acpi_unregister(void)
{
	scsi_unregister_acpi_bus_type(&ata_acpi_bus);
}