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

#include <acpi/acpi_bus.h>

T
Tejun Heo 已提交
25
unsigned int ata_acpi_gtf_filter = ATA_ACPI_FILTER_DEFAULT;
26
module_param_named(acpi_gtf_filter, ata_acpi_gtf_filter, int, 0644);
27
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)");
28

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

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

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

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

51 52 53 54 55 56 57 58
/**
 * 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)
59 60 61 62
{
	if (ap->flags & ATA_FLAG_ACPI_SATA)
		return NULL;

63
	return acpi_get_child(DEVICE_ACPI_HANDLE(ap->host->dev), ap->port_no);
64
}
65
EXPORT_SYMBOL(ata_ap_acpi_handle);
66

67 68 69 70 71 72 73 74
/**
 * 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)
75 76 77 78 79 80 81 82 83 84 85
{
	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
86
		return acpi_get_child(ata_ap_acpi_handle(ap), dev->devno);
87
}
88
EXPORT_SYMBOL(ata_dev_acpi_handle);
89

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

131
	spin_lock_irqsave(ap->lock, flags);
132 133 134 135 136
	/*
	 * 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
	 */
137 138 139 140
	switch (event) {
	case ACPI_NOTIFY_BUS_CHECK:
	case ACPI_NOTIFY_DEVICE_CHECK:
		ata_ehi_push_desc(ehi, "ACPI event");
141

142 143
		ata_ehi_hotplugged(ehi);
		ata_port_freeze(ap);
144 145 146 147 148 149 150
		break;
	case ACPI_NOTIFY_EJECT_REQUEST:
		ata_ehi_push_desc(ehi, "ACPI event");

		ata_acpi_detach_device(ap, dev);
		wait = 1;
		break;
151 152
	}

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

155
	if (wait)
M
Matthew Garrett 已提交
156
		ata_port_wait_eh(ap);
157 158 159 160 161 162
}

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

163
	ata_acpi_handle_hotplug(dev->link->ap, dev, event);
164 165 166 167 168 169
}

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

170
	ata_acpi_handle_hotplug(ap, NULL, event);
171 172
}

173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202
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 已提交
203
static const struct acpi_dock_ops ata_acpi_dev_dock_ops = {
204 205 206 207
	.handler = ata_acpi_dev_notify_dock,
	.uevent = ata_acpi_dev_uevent,
};

V
Vasiliy Kulikov 已提交
208
static const struct acpi_dock_ops ata_acpi_ap_dock_ops = {
209 210 211 212
	.handler = ata_acpi_ap_notify_dock,
	.uevent = ata_acpi_ap_uevent,
};

213 214 215 216 217 218 219 220 221 222 223 224
/**
 * 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)
{
225 226 227 228 229 230 231 232 233
	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);

234
		if (ata_ap_acpi_handle(ap) && gtm)
235 236
			ata_acpi_stm(ap, gtm);
	}
237 238
}

239 240 241 242 243 244 245 246 247 248 249 250 251
/**
 * 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.
 */
252
int ata_acpi_gtm(struct ata_port *ap, struct ata_acpi_gtm *gtm)
253 254 255 256 257 258
{
	struct acpi_buffer output = { .length = ACPI_ALLOCATE_BUFFER };
	union acpi_object *out_obj;
	acpi_status status;
	int rc = 0;

259 260
	status = acpi_evaluate_object(ata_ap_acpi_handle(ap), "_GTM", NULL,
				      &output);
261 262 263 264 265 266 267

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

	rc = -EINVAL;
	if (ACPI_FAILURE(status)) {
268 269
		ata_port_err(ap, "ACPI get timing mode failed (AE 0x%x)\n",
			     status);
270 271 272 273 274
		goto out_free;
	}

	out_obj = output.pointer;
	if (out_obj->type != ACPI_TYPE_BUFFER) {
275 276
		ata_port_warn(ap, "_GTM returned unexpected object type 0x%x\n",
			      out_obj->type);
277 278 279 280 281

		goto out_free;
	}

	if (out_obj->buffer.length != sizeof(struct ata_acpi_gtm)) {
282 283
		ata_port_err(ap, "_GTM returned invalid length %d\n",
			     out_obj->buffer.length);
284 285 286 287 288 289 290 291 292 293
		goto out_free;
	}

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

294 295
EXPORT_SYMBOL_GPL(ata_acpi_gtm);

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

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

330 331
	status = acpi_evaluate_object(ata_ap_acpi_handle(ap), "_STM", &input,
				      NULL);
332 333 334 335

	if (status == AE_NOT_FOUND)
		return -ENOENT;
	if (ACPI_FAILURE(status)) {
336 337
		ata_port_err(ap, "ACPI set timing mode failed (status=0x%x)\n",
			     status);
338 339 340 341 342
		return -EINVAL;
	}
	return 0;
}

343 344
EXPORT_SYMBOL_GPL(ata_acpi_stm);

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

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

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

	if (ata_msg_probe(ap))
384 385
		ata_dev_dbg(dev, "%s: ENTER: port#: %d\n",
			    __func__, ap->port_no);
386 387

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

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

	if (!output.length || !output.pointer) {
		if (ata_msg_probe(ap))
403 404 405 406
			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 已提交
407
		rc = -EINVAL;
408
		goto out_free;
409 410 411
	}

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

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

425
 done:
426
	rc = out_obj->buffer.length / REGS_PER_GTF;
427 428 429
	if (gtf) {
		*gtf = (void *)out_obj->buffer.pointer;
		if (ata_msg_probe(ap))
430 431
			ata_dev_dbg(dev, "%s: returning gtf=%p, gtf_count=%d\n",
				    __func__, *gtf, rc);
432
	}
433 434 435
	return rc;

 out_free:
436
	ata_acpi_clear_gtf(dev);
437
	return rc;
438 439
}

440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455
/**
 * 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)
{
456 457 458 459
	unsigned long xfer_mask = 0;
	unsigned int type;
	int unit;
	u8 mode;
460 461 462 463 464 465

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

466 467 468
	/* PIO */
	mode = ata_timing_cycle2mode(ATA_SHIFT_PIO, gtm->drive[unit].pio);
	xfer_mask |= ata_xfer_mode2mask(mode);
469 470 471 472 473

	/* 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.
	 */
474 475 476 477 478 479 480
	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);
481

482
	return xfer_mask;
483 484 485
}
EXPORT_SYMBOL_GPL(ata_acpi_gtm_xfermask);

A
Alan Cox 已提交
486 487 488
/**
 * ata_acpi_cbl_80wire		-	Check for 80 wire cable
 * @ap: Port to check
489
 * @gtm: GTM data to use
A
Alan Cox 已提交
490
 *
491
 * Return 1 if the @gtm indicates the BIOS selected an 80wire mode.
A
Alan Cox 已提交
492
 */
493
int ata_acpi_cbl_80wire(struct ata_port *ap, const struct ata_acpi_gtm *gtm)
A
Alan Cox 已提交
494
{
495 496
	struct ata_device *dev;

T
Tejun Heo 已提交
497
	ata_for_each_dev(dev, &ap->link, ENABLED) {
498 499 500 501 502 503 504 505 506
		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 已提交
507 508 509 510
	return 0;
}
EXPORT_SYMBOL_GPL(ata_acpi_cbl_80wire);

511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527
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 已提交
528 529
static int ata_acpi_filter_tf(struct ata_device *dev,
			      const struct ata_taskfile *tf,
530 531
			      const struct ata_taskfile *ptf)
{
T
Tejun Heo 已提交
532
	if (dev->gtf_filter & ATA_ACPI_FILTER_SETXFER) {
533 534 535 536 537 538 539 540
		/* 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 已提交
541
	if (dev->gtf_filter & ATA_ACPI_FILTER_LOCK) {
542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562
		/* 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;
	}

563 564
	if (tf->command == ATA_CMD_SET_FEATURES &&
	    tf->feature == SETFEATURES_SATA_ENABLE) {
T
Tejun Heo 已提交
565
		/* inhibit enabling DIPM */
T
Tejun Heo 已提交
566
		if (dev->gtf_filter & ATA_ACPI_FILTER_DIPM &&
T
Tejun Heo 已提交
567 568
		    tf->nsect == SATA_DIPM)
			return 1;
569 570

		/* inhibit FPDMA non-zero offset */
T
Tejun Heo 已提交
571
		if (dev->gtf_filter & ATA_ACPI_FILTER_FPDMA_OFFSET &&
572 573 574 575 576
		    (tf->nsect == SATA_FPDMA_OFFSET ||
		     tf->nsect == SATA_FPDMA_IN_ORDER))
			return 1;

		/* inhibit FPDMA auto activation */
T
Tejun Heo 已提交
577
		if (dev->gtf_filter & ATA_ACPI_FILTER_FPDMA_AA &&
578 579
		    tf->nsect == SATA_FPDMA_AA)
			return 1;
T
Tejun Heo 已提交
580 581
	}

582 583 584
	return 0;
}

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

619 620 621 622
	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;
623

624 625 626 627 628 629
	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 已提交
630
	if (!ata_acpi_filter_tf(dev, &tf, pptf)) {
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 656 657 658
		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 {
659
		level = KERN_INFO;
660
		snprintf(msg, sizeof(msg), "filtered out");
661
		rc = 0;
662
	}
663
	descr = ata_get_cmd_descript(tf.command);
664

665
	ata_dev_printk(dev, level,
666
		       "ACPI cmd %02x/%02x:%02x:%02x:%02x:%02x:%02x (%s) %s\n",
667
		       tf.command, tf.feature, tf.nsect, tf.lbal,
668 669
		       tf.lbam, tf.lbah, tf.device,
		       (descr ? descr : "unknown"), msg);
670 671

	return rc;
672 673 674 675
}

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

	/* get taskfiles */
T
Tejun Heo 已提交
694 695 696 697
	rc = ata_dev_get_GTF(dev, &gtf);
	if (rc < 0)
		return rc;
	gtf_count = rc;
T
Tejun Heo 已提交
698 699

	/* execute them */
700 701
	for (i = 0; i < gtf_count; i++, gtf++) {
		rc = ata_acpi_run_tf(dev, gtf, pgtf);
702 703
		if (rc < 0)
			break;
704
		if (rc) {
705
			(*nr_executed)++;
706 707
			pgtf = gtf;
		}
708 709
	}

710
	ata_acpi_clear_gtf(dev);
T
Tejun Heo 已提交
711

712 713 714
	if (rc < 0)
		return rc;
	return 0;
715 716
}

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

	if (ata_msg_probe(ap))
741 742
		ata_dev_dbg(dev, "%s: ix = %d, port#: %d\n",
			    __func__, dev->devno, ap->port_no);
743 744 745 746 747 748

	/* 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;
749 750
	in_params[0].buffer.length = sizeof(dev->id[0]) * ATA_ID_WORDS;
	in_params[0].buffer.pointer = (u8 *)dev->id;
751 752 753
	/* Output buffer: _SDD has no output */

	/* It's OK for _SDD to be missing too. */
754
	swap_buf_le16(dev->id, ATA_ID_WORDS);
755 756
	status = acpi_evaluate_object(ata_dev_acpi_handle(dev), "_SDD", &input,
				      NULL);
757
	swap_buf_le16(dev->id, ATA_ID_WORDS);
758

759 760 761 762
	if (status == AE_NOT_FOUND)
		return -ENOENT;

	if (ACPI_FAILURE(status)) {
763
		ata_dev_warn(dev, "ACPI _SDD failed (AE 0x%x)\n", status);
764 765
		return -EIO;
	}
766

767
	return 0;
T
Tejun Heo 已提交
768 769
}

770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786
/**
 * 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)
{
787 788
	/* nada */
	return 0;
789 790
}

T
Tejun Heo 已提交
791 792 793 794 795 796 797 798 799 800 801 802
/**
 * 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)
{
803
	const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
804
	struct ata_device *dev;
T
Tejun Heo 已提交
805

806
	if (ata_ap_acpi_handle(ap) && gtm) {
807 808 809
		/* _GTM valid */

		/* restore timing parameters */
810
		ata_acpi_stm(ap, gtm);
811

812 813 814 815
		/* _GTF should immediately follow _STM so that it can
		 * use values set by _STM.  Cache _GTF result and
		 * schedule _GTF.
		 */
T
Tejun Heo 已提交
816
		ata_for_each_dev(dev, &ap->link, ALL) {
817
			ata_acpi_clear_gtf(dev);
818 819
			if (ata_dev_enabled(dev) &&
			    ata_dev_get_GTF(dev, NULL) >= 0)
820 821 822 823 824 825 826
				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 已提交
827
		ata_for_each_dev(dev, &ap->link, ALL) {
828
			ata_acpi_clear_gtf(dev);
829 830
			if (ata_dev_enabled(dev))
				dev->flags |= ATA_DFLAG_ACPI_PENDING;
831 832
		}
	}
833 834
}

S
Shaohua Li 已提交
835 836 837 838 839 840 841 842 843 844 845
/**
 * 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;
846
	acpi_handle handle;
847
	int acpi_state;
S
Shaohua Li 已提交
848 849 850

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

T
Tejun Heo 已提交
855
	ata_for_each_dev(dev, &ap->link, ENABLED) {
856
		handle = ata_dev_acpi_handle(dev);
857 858 859 860 861
		if (!handle)
			continue;

		if (state.event != PM_EVENT_ON) {
			acpi_state = acpi_pm_device_sleep_state(
862
				&dev->sdev->sdev_gendev, NULL, ACPI_STATE_D3);
863 864 865 866 867 868 869 870 871 872 873
			if (acpi_state > 0)
				acpi_bus_set_power(handle, acpi_state);
			/* TBD: need to check if it's runtime pm request */
			acpi_pm_device_run_wake(
				&dev->sdev->sdev_gendev, true);
		} else {
			/* Ditto */
			acpi_pm_device_run_wake(
				&dev->sdev->sdev_gendev, false);
			acpi_bus_set_power(handle, ACPI_STATE_D0);
		}
S
Shaohua Li 已提交
874
	}
875 876 877 878

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

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

903
	if (!ata_dev_acpi_handle(dev))
T
Tejun Heo 已提交
904 905 906 907 908 909 910 911 912 913
		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);
914
		if (rc && rc != -ENOENT)
T
Tejun Heo 已提交
915 916 917 918
			goto acpi_err;
	}

	/* do _GTF */
T
Tejun Heo 已提交
919 920
	rc = ata_acpi_exec_tfs(dev, &nr_executed);
	if (rc)
T
Tejun Heo 已提交
921 922 923 924 925
		goto acpi_err;

	dev->flags &= ~ATA_DFLAG_ACPI_PENDING;

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

	return 0;

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

T
Tejun Heo 已提交
942 943 944 945
	/* 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 已提交
946
	}
T
Tejun Heo 已提交
947

948
	ata_dev_warn(dev, "ACPI: failed the second time, disabled\n");
T
Tejun Heo 已提交
949 950 951 952 953 954 955

	/* 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 已提交
956 957
	return rc;
}
958 959 960 961 962 963 964 965 966 967 968 969

/**
 * 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)
{
970
	ata_acpi_clear_gtf(dev);
971
}
972

973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992
static void ata_acpi_wake_dev(acpi_handle handle, u32 event, void *context)
{
	struct ata_device *ata_dev = context;

	if (event == ACPI_NOTIFY_DEVICE_WAKE && ata_dev &&
			pm_runtime_suspended(&ata_dev->sdev->sdev_gendev))
		scsi_autopm_get_device(ata_dev->sdev);
}

static void ata_acpi_add_pm_notifier(struct ata_device *dev)
{
	struct acpi_device *acpi_dev;
	acpi_handle handle;
	acpi_status status;

	handle = ata_dev_acpi_handle(dev);
	if (!handle)
		return;

	status = acpi_bus_get_device(handle, &acpi_dev);
993 994 995 996
	if (ACPI_FAILURE(status))
		return;

	if (dev->sdev->can_power_off) {
997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013
		acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
			ata_acpi_wake_dev, dev);
		device_set_run_wake(&dev->sdev->sdev_gendev, true);
	}
}

static void ata_acpi_remove_pm_notifier(struct ata_device *dev)
{
	struct acpi_device *acpi_dev;
	acpi_handle handle;
	acpi_status status;

	handle = ata_dev_acpi_handle(dev);
	if (!handle)
		return;

	status = acpi_bus_get_device(handle, &acpi_dev);
1014 1015 1016 1017
	if (ACPI_FAILURE(status))
		return;

	if (dev->sdev->can_power_off) {
1018 1019 1020 1021 1022 1023
		device_set_run_wake(&dev->sdev->sdev_gendev, false);
		acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
			ata_acpi_wake_dev);
	}
}

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
static void ata_acpi_register_power_resource(struct ata_device *dev)
{
	struct scsi_device *sdev = dev->sdev;
	acpi_handle handle;
	struct device *device;

	handle = ata_dev_acpi_handle(dev);
	if (!handle)
		return;

	device = &sdev->sdev_gendev;

	acpi_power_resource_register_device(device, handle);
}

static void ata_acpi_unregister_power_resource(struct ata_device *dev)
{
	struct scsi_device *sdev = dev->sdev;
	acpi_handle handle;
	struct device *device;

	handle = ata_dev_acpi_handle(dev);
	if (!handle)
		return;

	device = &sdev->sdev_gendev;

	acpi_power_resource_unregister_device(device, handle);
}

1054 1055 1056
void ata_acpi_bind(struct ata_device *dev)
{
	ata_acpi_add_pm_notifier(dev);
1057
	ata_acpi_register_power_resource(dev);
1058 1059 1060 1061 1062
}

void ata_acpi_unbind(struct ata_device *dev)
{
	ata_acpi_remove_pm_notifier(dev);
1063
	ata_acpi_unregister_power_resource(dev);
1064 1065
}

1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093
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;

1094 1095 1096
	if (ata_acpi_gtm(ap, &ap->__acpi_init_gtm) == 0)
		ap->pflags |= ATA_PFLAG_INIT_GTM_VALID;

1097 1098 1099 1100 1101 1102 1103
	return 0;
}

static int ata_acpi_bind_device(struct ata_port *ap, struct scsi_device *sdev,
				acpi_handle *handle)
{
	struct ata_device *ata_dev;
1104 1105 1106
	acpi_status status;
	struct acpi_device *acpi_dev;
	struct acpi_device_power_state *states;
1107

1108 1109 1110 1111 1112 1113 1114
	if (ap->flags & ATA_FLAG_ACPI_SATA) {
		if (!sata_pmp_attached(ap))
			ata_dev = &ap->link.device[sdev->id];
		else
			ata_dev = &ap->pmp_link[sdev->channel].device[sdev->id];
	}
	else {
1115
		ata_dev = &ap->link.device[sdev->id];
1116
	}
1117

1118
	*handle = ata_dev_acpi_handle(ata_dev);
1119 1120 1121 1122

	if (!*handle)
		return -ENODEV;

1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137
	status = acpi_bus_get_device(*handle, &acpi_dev);
	if (ACPI_FAILURE(status))
		return 0;

	/*
	 * If firmware has _PS3 or _PR3 for this device,
	 * and this ata ODD device support device attention,
	 * it means this device can be powered off
	 */
	states = acpi_dev->power.states;
	if ((states[ACPI_STATE_D3_HOT].flags.valid ||
			states[ACPI_STATE_D3_COLD].flags.explicit_set) &&
			ata_dev->flags & ATA_DFLAG_DA)
		sdev->can_power_off = 1;

1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
	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);
}