Attachment #72776 for bug #145591

View | Details | Raw Unified | Return to bug 145591
Collapse All | Expand All

Lines 22-27 ide-core-$(CONFIG_BLK_DEV_IDEPCI) += set Link Here

(-)a/drivers/ide/Makefile (+1 lines)
22	ide-core-$(CONFIG_BLK_DEV_IDEDMA) += ide-dma.o	22	ide-core-$(CONFIG_BLK_DEV_IDEDMA) += ide-dma.o
23	ide-core-$(CONFIG_PROC_FS) += ide-proc.o	23	ide-core-$(CONFIG_PROC_FS) += ide-proc.o
24	ide-core-$(CONFIG_BLK_DEV_IDEPNP) += ide-pnp.o	24	ide-core-$(CONFIG_BLK_DEV_IDEPNP) += ide-pnp.o
		25	ide-core-$(CONFIG_BLK_DEV_IDEACPI) += ide-acpi.o
25		26
26	# built-in only drivers from arm/	27	# built-in only drivers from arm/
27	ide-core-$(CONFIG_IDE_ARM) += arm/ide_arm.o	28	ide-core-$(CONFIG_IDE_ARM) += arm/ide_arm.o




/*
 * ide-acpi.c
 * Provides ACPI support for IDE drives.
 *
 * Copyright (C) 2005 Intel Corp.
 * Copyright (C) 2005 Randy Dunlap
 * Copyright (C) 2006 SUSE Linux Products GmbH
 * Copyright (C) 2006 Hannes Reinecke
 */

#include <linux/ata.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <acpi/acpi.h>
#include <linux/ide.h>
#include <linux/pci.h>

#include <acpi/acpi_bus.h>
#include <acpi/acnames.h>
#include <acpi/acnamesp.h>
#include <acpi/acparser.h>
#include <acpi/acexcep.h>
#include <acpi/acmacros.h>
#include <acpi/actypes.h>

#define REGS_PER_GTF		7
struct taskfile_array {
	u8	tfa[REGS_PER_GTF];	/* regs. 0x1f1 - 0x1f7 */
};

struct GTM_buffer {
	u32	PIO_speed0;
	u32	DMA_speed0;
	u32	PIO_speed1;
	u32	DMA_speed1;
	u32	GTM_flags;
};

struct ide_acpi_drive_link {
	ide_drive_t	*drive;
	acpi_handle	 obj_handle;
	u8		 idbuff[512];
};

struct ide_acpi_hwif_link {
	ide_hwif_t			*hwif;
	acpi_handle			 obj_handle;
	struct GTM_buffer		 gtm;
	struct ide_acpi_drive_link	 master;
	struct ide_acpi_drive_link	 slave;
};
	
#define DEBUGGING	1
/* note: adds function name and KERN_DEBUG */
#ifdef DEBUGGING
#define DEBPRINT(fmt, args...)	\
		printk(KERN_DEBUG "%s: " fmt, __FUNCTION__, ## args)
#else
#define DEBPRINT(fmt, args...)	do {} while (0)
#endif	/* DEBUGGING */

extern int ide_noacpi;
extern int ide_noacpitfs;
extern int ide_noacpionboot;

/**
 * ide_get_dev_handle - finds acpi_handle and PCI device.function
 * @dev: device to locate
 * @handle: returned acpi_handle for @dev
 * @pcidevfn: return PCI device.func for @dev
 *
 * Returns the ACPI object handle to the corresponding PCI device.
 *
 * Returns 0 on success, <0 on error.
 */
static int ide_get_dev_handle(struct device *dev, acpi_handle *handle,
			       acpi_integer *pcidevfn)
{
	struct pci_dev *pdev = to_pci_dev(dev);
	unsigned int bus, devnum, func;
	acpi_integer addr;
	acpi_handle dev_handle, parent_handle;
	struct acpi_buffer buffer = {.length = ACPI_ALLOCATE_BUFFER,
					.pointer = NULL};
	acpi_status status;
	struct acpi_device_info	*dinfo = NULL;
	int ret = -ENODEV;

	bus = pdev->bus->number;
	devnum = PCI_SLOT(pdev->devfn);
	func = PCI_FUNC(pdev->devfn);

	DEBPRINT("ENTER: pci %02x:%02x.%01x\n", bus, devnum, func);

	dev_handle = DEVICE_ACPI_HANDLE(dev);
	parent_handle = DEVICE_ACPI_HANDLE(dev->parent);

	status = acpi_get_object_info(parent_handle, &buffer);
	if (ACPI_FAILURE(status)) {
		DEBPRINT("get_object_info for parent failed\n");
		goto err;
	}
	dinfo = buffer.pointer;
	if (dinfo && (dinfo->valid & ACPI_VALID_ADR) &&
	    dinfo->address == bus) {
		/* ACPI spec for _ADR for PCI bus: */
		addr = (acpi_integer)(devnum << 16 | func);
		*pcidevfn = addr;
		*handle = dev_handle;
	} else {
		DEBPRINT("get_object_info for parent has wrong "
			" bus: %llu, should be %d\n",
			dinfo ? (unsigned long long)dinfo->address : -1ULL,
			bus);
		goto err;
	}

	DEBPRINT("for dev=0x%x.%x, addr=0x%llx, parent=0x%p, *handle=0x%p\n",
		 devnum, func, (unsigned long long)addr,
		 dev->parent, *handle);
	if (!*handle)
		goto err;
	ret = 0;
err:
	acpi_os_free(dinfo);
	return ret;
}

/**
 * ide_acpi_hwif_get_handle - Get ACPI object handle for a given hwif
 * @hwif: device to locate
 *
 * Retrieves the object handle for a given hwif.
 *
 * Returns handle on success, 0 on error.
 */
acpi_handle ide_acpi_hwif_get_handle(ide_hwif_t *hwif)
{
	struct device		*dev = hwif->gendev.parent;
	acpi_handle		dev_handle;
	acpi_integer		pcidevfn;
	acpi_handle		chan_handle;
	int			err;

	DEBPRINT("ENTER: device %s\n", hwif->name);

	if (!dev) {
		DEBPRINT("no PCI device for %s\n", hwif->name);
		return NULL;
	}

	err = ide_get_dev_handle(dev, &dev_handle, &pcidevfn);
	if (err < 0) {
		DEBPRINT("ide_get_dev_handle failed (%d)\n", err);
		return NULL;
	}

	/* get child objects of dev_handle == channel objects,
	 * + _their_ children == drive objects */
	/* channel is hwif->channel */
	chan_handle = acpi_get_child(dev_handle, hwif->channel);
	DEBPRINT("chan adr=%d: handle=0x%p\n",
		 hwif->channel, chan_handle);

	return chan_handle;
}

/**
 * ide_acpi_drive_get_handle - Get ACPI object handle for a given drive
 * @drive: device to locate
 *
 * Retrieves the object handle of a given drive. According to the ACPI
 * spec the drive is a child of the hwif.
 *
 * Returns handle on success, 0 on error.
 */
acpi_handle ide_acpi_drive_get_handle(ide_drive_t *drive)
{
	ide_hwif_t	*hwif = HWIF(drive);
	int		 port;
	acpi_handle	 drive_handle;

	if (!hwif->acpidata)
		return NULL;

	if (!hwif->acpidata->obj_handle)
		return NULL;

	port = hwif->channel ? drive->dn - 2: drive->dn;

	DEBPRINT("ENTER: %s at channel#: %d port#: %d\n",
		 drive->name, hwif->channel, port);


	/* TBD: could also check ACPI object VALID bits */
	drive_handle = acpi_get_child(hwif->acpidata->obj_handle, port);
	DEBPRINT("drive %s handle 0x%p\n", drive->name, drive_handle);

	return drive_handle;
}

/**
 * do_drive_get_GTF - get the drive bootup default taskfile settings
 * @drive: the drive for which the taskfile settings should be retrieved
 * @gtf_length: number of bytes of _GTF data returned at @gtf_address
 * @gtf_address: buffer containing _GTF taskfile arrays
 *
 * 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.
 *
 * The returned @gtf_length and @gtf_address are only valid if the
 * function return value is 0.
 */
int do_drive_get_GTF(ide_drive_t *drive,
		     unsigned int *gtf_length, unsigned long *gtf_address,
		     unsigned long *obj_loc)
{
	acpi_status			status;
	struct acpi_buffer		output;
	union acpi_object 		*out_obj;
	ide_hwif_t			*hwif = HWIF(drive);
	struct device			*dev = hwif->gendev.parent;
	int				err = -ENODEV;
	int				port;

	*gtf_length = 0;
	*gtf_address = 0UL;
	*obj_loc = 0UL;

	if (ide_noacpi)
		return 0;

	if (!dev) {
		DEBPRINT("no PCI device for %s\n", hwif->name);
		goto out;
	}

	if (!hwif->acpidata) {
		DEBPRINT("no ACPI data for %s\n", hwif->name);
		goto out;
	}

	port = hwif->channel ? drive->dn - 2: drive->dn;

	if (!drive->acpidata) {
		if (port == 0) {
			drive->acpidata = &hwif->acpidata->master;
			hwif->acpidata->master.drive = drive;
		} else {
			drive->acpidata = &hwif->acpidata->slave;
			hwif->acpidata->slave.drive = drive;
		}
	}

	DEBPRINT("ENTER: %s at %s, port#: %d, hard_port#: %d\n",
		 hwif->name, dev->bus_id, port, hwif->channel);

	if (!drive->present) {
		DEBPRINT("%s drive %d:%d not present\n",
			 hwif->name, hwif->channel, port);
		goto out;
	}

	/* Get this drive's _ADR info. if not already known. */
	if (!drive->acpidata->obj_handle) {
		drive->acpidata->obj_handle = ide_acpi_drive_get_handle(drive);
		if (!drive->acpidata->obj_handle) {
			DEBPRINT("No ACPI object found for %s\n",
				 drive->name);
			goto out;
		}
	}

	/* Setting up output buffer */
	output.length = ACPI_ALLOCATE_BUFFER;
	output.pointer = NULL;	/* ACPI-CA sets this; save/free it later */

	/* _GTF has no input parameters */
	err = -EIO;
	status = acpi_evaluate_object(drive->acpidata->obj_handle, "_GTF",
				      NULL, &output);
	if (ACPI_FAILURE(status)) {
		printk(KERN_DEBUG
		       "%s: Run _GTF error: status = 0x%x\n",
		       __FUNCTION__, status);
		goto out;
	}

	if (!output.length || !output.pointer) {
		DEBPRINT("Run _GTF: "
		       "length or ptr is NULL (0x%llx, 0x%p)\n",
		       (unsigned long long)output.length,
		       output.pointer);
		goto out;
	}

	out_obj = output.pointer;
	if (out_obj->type != ACPI_TYPE_BUFFER) {
		DEBPRINT("Run _GTF: error: "
		       "expected object type of ACPI_TYPE_BUFFER, "
		       "got 0x%x\n", out_obj->type);
		err = -ENOENT;
		acpi_os_free(output.pointer);
		goto out;
	}

	if (!out_obj->buffer.length || !out_obj->buffer.pointer ||
	    out_obj->buffer.length % REGS_PER_GTF) {
		printk(KERN_ERR
		       "%s: unexpected GTF length (%d) or addr (0x%p)\n",
		       __FUNCTION__, out_obj->buffer.length,
		       out_obj->buffer.pointer);
		err = -ENOENT;
		acpi_os_free(output.pointer);
		goto out;
	}

	*gtf_length = out_obj->buffer.length;
	*gtf_address = (unsigned long)out_obj->buffer.pointer;
	*obj_loc = (unsigned long)out_obj;
	DEBPRINT("returning gtf_length=%d, gtf_address=0x%lx, obj_loc=0x%lx\n",
		 *gtf_length, *gtf_address, *obj_loc);
	err = 0;
out:
	return err;
}

/**
 * taskfile_load_raw - send taskfile registers to drive
 * @drive: drive to which output is sent
 * @gtf: raw ATA taskfile register set (0x1f1 - 0x1f7)
 *
 * Outputs IDE taskfile to the drive.
 */
static int taskfile_load_raw(ide_drive_t *drive,
			      const struct taskfile_array *gtf)
{
	ide_task_t args;
	int err = 0;

	DEBPRINT("(0x1f1-1f7): hex: "
	       "%02x %02x %02x %02x %02x %02x %02x\n",
	       gtf->tfa[0], gtf->tfa[1], gtf->tfa[2],
	       gtf->tfa[3], gtf->tfa[4], gtf->tfa[5], gtf->tfa[6]);

	memset(&args, 0, sizeof(ide_task_t));
	args.command_type = IDE_DRIVE_TASK_NO_DATA;
	args.data_phase   = TASKFILE_IN;
	args.handler      = &task_no_data_intr;

	/* convert gtf to IDE Taskfile */
	args.tfRegister[1] = gtf->tfa[0];	/* 0x1f1 */
	args.tfRegister[2] = gtf->tfa[1];	/* 0x1f2 */
	args.tfRegister[3] = gtf->tfa[2];	/* 0x1f3 */
	args.tfRegister[4] = gtf->tfa[3];	/* 0x1f4 */
	args.tfRegister[5] = gtf->tfa[4];	/* 0x1f5 */
	args.tfRegister[6] = gtf->tfa[5];	/* 0x1f6 */
	args.tfRegister[7] = gtf->tfa[6];	/* 0x1f7 */

	if (ide_noacpitfs) {
		DEBPRINT("_GTF execution disabled\n");
		return err;
	}

	err = ide_raw_taskfile(drive, &args, NULL);
	if (err)
		printk(KERN_ERR "%s: ide_raw_taskfile failed: %u\n",
		       __FUNCTION__, err);

	return err;
}

/**
 * do_drive_set_taskfiles - write the drive taskfile settings from _GTF
 * @drive: the drive to which the taskfile command should be sent
 * @gtf_length: total number of bytes of _GTF taskfiles
 * @gtf_address: location of _GTF taskfile arrays
 *
 * Write {gtf_address, length gtf_length} in groups of
 * REGS_PER_GTF bytes.
 */
static int do_drive_set_taskfiles(ide_drive_t *drive,
				  unsigned int gtf_length,
				  unsigned long gtf_address)
{
	int			rc = -ENODEV, err;
	int			gtf_count = gtf_length / REGS_PER_GTF;
	int			ix;
	struct taskfile_array	*gtf;

	if (ide_noacpi)
		return 0;

	DEBPRINT("ENTER: %s, hard_port#: %d\n", drive->name, drive->dn);

	if (!drive->present)
		goto out;
	if (!gtf_count)		/* shouldn't be here */
		goto out;

	DEBPRINT("total GTF bytes=%u (0x%x), gtf_count=%d, addr=0x%lx\n",
		 gtf_length, gtf_length, gtf_count, gtf_address);

	if (gtf_length % REGS_PER_GTF) {
		printk(KERN_ERR "%s: unexpected GTF length (%d)\n",
		       __FUNCTION__, gtf_length);
		goto out;
	}

	rc = 0;
	for (ix = 0; ix < gtf_count; ix++) {
		gtf = (struct taskfile_array *)
			(gtf_address + ix * REGS_PER_GTF);

		/* send all TaskFile registers (0x1f1-0x1f7) *in*that*order* */
		err = taskfile_load_raw(drive, gtf);
		if (err)
			rc = err;
	}

out:
	return rc;
}

/**
 * ide_acpi_exec_tfs - get then write drive taskfile settings
 * @drive: the drive for which the taskfile settings should be
 *         written.
 *
 * According to the ACPI spec this should be called after _STM
 * has been evaluated for the interface. Some ACPI vendors interpret
 * that as a hard requirement and modify the taskfile according
 * to the Identify Drive information passed down with _STM.
 * So one should really make sure to call this only after _STM has
 * been executed.
 */
int ide_acpi_exec_tfs(ide_drive_t *drive)
{
	int		ret;
	unsigned int	gtf_length;
	unsigned long	gtf_address;
	unsigned long	obj_loc;

	if (ide_noacpi)
		return 0;

	DEBPRINT("call get_GTF, drive=%s port=%d\n", drive->name, drive->dn);

	ret = do_drive_get_GTF(drive, &gtf_length, &gtf_address, &obj_loc);
	if (ret < 0) {
		DEBPRINT("get_GTF error (%d)\n", ret);
		return ret;
	}

	DEBPRINT("call set_taskfiles, drive=%s\n", drive->name);

	ret = do_drive_set_taskfiles(drive, gtf_length, gtf_address);
	acpi_os_free((void *)obj_loc);
	if (ret < 0) {
		DEBPRINT("set_taskfiles error (%d)\n", ret);
	}

	DEBPRINT("ret=%d\n", ret);

	return ret;
}
EXPORT_SYMBOL_GPL(ide_acpi_exec_tfs);

/**
 * ide_acpi_get_timing - get the channel (controller) timings
 * @hwif: target IDE interface (channel)
 *
 * This function executes the _GTM ACPI method for the target channel.
 *
 */
void ide_acpi_get_timing(ide_hwif_t *hwif)
{
	acpi_status		status;
	struct acpi_buffer	output;
	union acpi_object 	*out_obj;

	if (ide_noacpi)
		return;

	DEBPRINT("ENTER:\n");

	if (!hwif->acpidata) {
		DEBPRINT("no ACPI data for %s\n", hwif->name);
		return;
	}

	/* Setting up output buffer for _GTM */
	output.length = ACPI_ALLOCATE_BUFFER;
	output.pointer = NULL;	/* ACPI-CA sets this; save/free it later */

	/* _GTM has no input parameters */
	status = acpi_evaluate_object(hwif->acpidata->obj_handle, "_GTM",
				      NULL, &output);

	DEBPRINT("_GTM status: %d, outptr: 0x%p, outlen: 0x%llx\n",
		 status, output.pointer,
		 (unsigned long long)output.length);

	if (ACPI_FAILURE(status)) {
		DEBPRINT("Run _GTM error: status = 0x%x\n", status);
		return;
	}

	if (!output.length || !output.pointer) {
		DEBPRINT("Run _GTM: length or ptr is NULL (0x%llx, 0x%p)\n",
		       (unsigned long long)output.length,
		       output.pointer);
		acpi_os_free(output.pointer);
		return;
	}

	out_obj = output.pointer;
	if (out_obj->type != ACPI_TYPE_BUFFER) {
		acpi_os_free(output.pointer);
		DEBPRINT("Run _GTM: error: "
		       "expected object type of ACPI_TYPE_BUFFER, "
		       "got 0x%x\n", out_obj->type);
		return;
	}

	if (!out_obj->buffer.length || !out_obj->buffer.pointer ||
	    out_obj->buffer.length != sizeof(struct GTM_buffer)) {
		acpi_os_free(output.pointer);
		printk(KERN_ERR
		       "%s: unexpected _GTM length (0x%x)[should be 0x%x] or addr (0x%p)\n",
		       __FUNCTION__, out_obj->buffer.length,
		       sizeof(struct GTM_buffer), out_obj->buffer.pointer);
		return;
	}

	memcpy(&hwif->acpidata->gtm, out_obj->buffer.pointer,
	       sizeof(struct GTM_buffer));

	DEBPRINT("_GTM info: ptr: 0x%p, len: 0x%x, exp.len: 0x%Zx\n",
		 out_obj->buffer.pointer, out_obj->buffer.length, 
		 sizeof(struct GTM_buffer));

	DEBPRINT("_GTM fields: 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n",
		 hwif->acpidata->gtm.PIO_speed0,
		 hwif->acpidata->gtm.DMA_speed0,
		 hwif->acpidata->gtm.PIO_speed1,
		 hwif->acpidata->gtm.DMA_speed1,
		 hwif->acpidata->gtm.GTM_flags);

	acpi_os_free(output.pointer);
}
EXPORT_SYMBOL_GPL(ide_acpi_get_timing);

/**
 * ide_acpi_push_timing - set the channel (controller) timings
 * @hwif: target IDE interface (channel)
 *
 * This function executes the _STM ACPI method for the target channel.
 *
 * _STM requires Identify Drive data, which has to passed as an argument.
 * Unfortunately hd_driveid is a mangled version which we can't readily
 * use; hence we'll get the information afresh.
 */
void ide_acpi_push_timing(ide_hwif_t *hwif)
{
	acpi_status		status;
	struct acpi_object_list	input;
	union acpi_object 	in_params[3];
	struct ide_acpi_drive_link	*master = &hwif->acpidata->master;
	struct ide_acpi_drive_link	*slave = &hwif->acpidata->slave;

	if (ide_noacpi)
		return;

	DEBPRINT("ENTER:\n");

	if (!hwif->acpidata) {
		DEBPRINT("no ACPI data for %s\n", hwif->name);
		return;
	}

	/* Give the GTM buffer + drive Identify data to the channel via the
	 * _STM method: */
	/* setup input parameters buffer for _STM */
	input.count = 3;
	input.pointer = in_params;
	in_params[0].type = ACPI_TYPE_BUFFER;
	in_params[0].buffer.length = sizeof(struct GTM_buffer);
	in_params[0].buffer.pointer = (u8 *)&hwif->acpidata->gtm;
	in_params[1].type = ACPI_TYPE_BUFFER;
	in_params[1].buffer.length = sizeof(struct hd_driveid);
	in_params[1].buffer.pointer = (u8 *)&master->idbuff;
	in_params[2].type = ACPI_TYPE_BUFFER;
	in_params[2].buffer.length = sizeof(struct hd_driveid);
	in_params[2].buffer.pointer = (u8 *)&slave->idbuff;
	/* Output buffer: _STM has no output */

	status = acpi_evaluate_object(hwif->acpidata->obj_handle, "_STM",
				      &input, NULL);

	if (ACPI_FAILURE(status)) {
		DEBPRINT("Run _STM error: status = 0x%x\n", status);
	}
	DEBPRINT("_STM status: %d\n", status);
}
EXPORT_SYMBOL_GPL(ide_acpi_push_timing);

/**
 * ide_acpi_init - initialize the ACPI link for an IDE interface
 * @hwif: target IDE interface (channel)
 *
 * The ACPI spec is not quite clear when the drive identify buffer
 * should be obtained. Calling IDENTIFY DEVICE during shutdown
 * is not the best of ideas as the drive might already being put to
 * sleep. And obviously we can't call it during resume.
 * So we get the information during startup; but this means that
 * any changes during run-time will be lost after resume.
 */
void ide_acpi_init(ide_hwif_t *hwif)
{
	int unit;
	int			err;
	struct ide_acpi_drive_link	*master;
	struct ide_acpi_drive_link	*slave;

	hwif->acpidata = kzalloc(sizeof(struct ide_acpi_hwif_link), GFP_KERNEL);
	if (!hwif->acpidata)
		return;

	hwif->acpidata->obj_handle = ide_acpi_hwif_get_handle(hwif);
	if (!hwif->acpidata->obj_handle) {
		DEBPRINT("no ACPI object for %s found\n", hwif->name);
		kfree(hwif->acpidata);
		hwif->acpidata = NULL;
		return;
	}

	/*
	 * The ACPI spec mandates that we send information
	 * for both drives, regardless whether they are connected
	 * or not.
	 */
	hwif->acpidata->master.drive = &hwif->drives[0];
	hwif->drives[0].acpidata = &hwif->acpidata->master;
	master = &hwif->acpidata->master;

	hwif->acpidata->slave.drive = &hwif->drives[1];
	hwif->drives[1].acpidata = &hwif->acpidata->slave;
	slave = &hwif->acpidata->slave;


	/*
	 * Send IDENTIFY for each drive
	 */
	if (master->drive->present) {
		err = taskfile_lib_get_identify(master->drive, master->idbuff);
		if (err) {
			DEBPRINT("identify device %s failed (%d)\n",
				 master->drive->name, err);
		}
	}
		
	if (slave->drive->present) {
		err = taskfile_lib_get_identify(slave->drive, slave->idbuff);
		if (err) {
			DEBPRINT("identify device %s failed (%d)\n",
				 slave->drive->name, err);
		}
	}

	if (ide_noacpionboot) {
		DEBPRINT("ACPI methods disabled on boot\n");
		return;
	}

	/*
	 * ACPI requires us to call _STM on startup
	 */
	ide_acpi_get_timing(hwif);
	ide_acpi_push_timing(hwif);

	for (unit = 0; unit < MAX_DRIVES; ++unit) {
		ide_drive_t *drive = &hwif->drives[unit];

		if (drive->present) {
			/* Execute ACPI startup code */
			ide_acpi_exec_tfs(drive);
		}
	}
}
EXPORT_SYMBOL_GPL(ide_acpi_init);

Lines 1385-1390 static int hwif_init(ide_hwif_t *hwif) Link Here

(-)a/drivers/ide/ide-probe.c (+3 lines)
1385		1385
1386	done:	1386	done:
1387	init_gendisk(hwif);	1387	init_gendisk(hwif);
		1388
		1389	ide_acpi_init(hwif);
		1390
1388	hwif->present = 1; /* success */	1391	hwif->present = 1; /* success */
1389	return 1;	1392	return 1;
1390		1393

Lines 189-194 int noautodma = 1; Link Here

(-)a/drivers/ide/ide.c (+36 lines)
189		189
190	EXPORT_SYMBOL(noautodma);	190	EXPORT_SYMBOL(noautodma);
191		191
		192	#ifdef CONFIG_BLK_DEV_IDEACPI
		193	int ide_noacpi = 0;
		194	int ide_noacpitfs = 1;
		195	int ide_noacpionboot = 1;
		196	#endif
		197
192	/*	198	/*
193	* This is declared extern in ide.h, for access by other IDE modules:	199	* This is declared extern in ide.h, for access by other IDE modules:
194	*/	200	*/
Lines 1216-1225 EXPORT_SYMBOL(system_bus_clock); Link Here
1216	static int generic_ide_suspend(struct device *dev, pm_message_t state)	1222	static int generic_ide_suspend(struct device *dev, pm_message_t state)
1217	{	1223	{
1218	ide_drive_t *drive = dev->driver_data;	1224	ide_drive_t *drive = dev->driver_data;
		1225	ide_hwif_t *hwif = HWIF(drive);
1219	struct request rq;	1226	struct request rq;
1220	struct request_pm_state rqpm;	1227	struct request_pm_state rqpm;
1221	ide_task_t args;	1228	ide_task_t args;
1222		1229
		1230	/* Call ACPI _GTM only once */
		1231	if (!(drive->dn % 2))
		1232	ide_acpi_get_timing(hwif);
		1233
1223	memset(&rq, 0, sizeof(rq));	1234	memset(&rq, 0, sizeof(rq));
1224	memset(&rqpm, 0, sizeof(rqpm));	1235	memset(&rqpm, 0, sizeof(rqpm));
1225	memset(&args, 0, sizeof(args));	1236	memset(&args, 0, sizeof(args));
Lines 1235-1244 static int generic_ide_suspend(struct de Link Here
1235	static int generic_ide_resume(struct device *dev)	1246	static int generic_ide_resume(struct device *dev)
1236	{	1247	{
1237	ide_drive_t *drive = dev->driver_data;	1248	ide_drive_t *drive = dev->driver_data;
		1249	ide_hwif_t *hwif = HWIF(drive);
1238	struct request rq;	1250	struct request rq;
1239	struct request_pm_state rqpm;	1251	struct request_pm_state rqpm;
1240	ide_task_t args;	1252	ide_task_t args;
1241		1253
		1254	/* Call ACPI _STM only once */
		1255	if (!(drive->dn % 2))
		1256	ide_acpi_push_timing(hwif);
		1257
		1258	ide_acpi_exec_tfs(drive);
		1259
1242	memset(&rq, 0, sizeof(rq));	1260	memset(&rq, 0, sizeof(rq));
1243	memset(&rqpm, 0, sizeof(rqpm));	1261	memset(&rqpm, 0, sizeof(rqpm));
1244	memset(&args, 0, sizeof(args));	1262	memset(&args, 0, sizeof(args));
Lines 1539-1544 static int __init ide_setup(char *s) Link Here
1539	}	1557	}
1540	#endif /* CONFIG_BLK_DEV_IDEPCI */	1558	#endif /* CONFIG_BLK_DEV_IDEPCI */
1541		1559
		1560	#ifdef CONFIG_BLK_DEV_IDEACPI
		1561	if (!strcmp(s, "ide=noacpi")) {
		1562	printk(" : Disable IDE ACPI support.\n");
		1563	ide_noacpi = 1;
		1564	return 1;
		1565	}
		1566	if (!strcmp(s, "ide=acpigtf")) {
		1567	printk(" : Enable IDE ACPI _GTF support.\n");
		1568	ide_noacpitfs = 0;
		1569	return 1;
		1570	}
		1571	if (!strcmp(s, "ide=acpionboot")) {
		1572	printk(" : Call IDE ACPI methods on boot.\n");
		1573	ide_noacpionboot = 0;
		1574	return 1;
		1575	}
		1576	#endif /* CONFIG_BLK_DEV_IDEACPI */
		1577
1542	/*	1578	/*
1543	* Look for drive options: "hdx="	1579	* Look for drive options: "hdx="
1544	*/	1580	*/

Lines 19-24 Link Here

(-)a/include/linux/ide.h (+25 lines)
19	#include <linux/device.h>	19	#include <linux/device.h>
20	#include <linux/pci.h>	20	#include <linux/pci.h>
21	#include <linux/completion.h>	21	#include <linux/completion.h>
		22	#include <acpi/acpi.h>
22	#include <asm/byteorder.h>	23	#include <asm/byteorder.h>
23	#include <asm/system.h>	24	#include <asm/system.h>
24	#include <asm/io.h>	25	#include <asm/io.h>
Lines 541-546 typedef enum { Link Here
541	struct ide_driver_s;	542	struct ide_driver_s;
542	struct ide_settings_s;	543	struct ide_settings_s;
543		544
		545	#ifdef CONFIG_BLK_DEV_IDEACPI
		546	struct ide_acpi_drive_link;
		547	struct ide_acpi_hwif_link;
		548	#endif
		549
544	typedef struct ide_drive_s {	550	typedef struct ide_drive_s {
545	char name[4]; /* drive name, such as "hda" */	551	char name[4]; /* drive name, such as "hda" */
546	char driver_req[10]; /* requests specific driver */	552	char driver_req[10]; /* requests specific driver */
Lines 636-641 typedef struct ide_drive_s { Link Here
636		642
637	int lun; /* logical unit */	643	int lun; /* logical unit */
638	int crc_count; /* crc counter to reduce drive speed */	644	int crc_count; /* crc counter to reduce drive speed */
		645	#ifdef CONFIG_BLK_DEV_IDEACPI
		646	struct ide_acpi_drive_link *acpidata;
		647	#endif
639	struct list_head list;	648	struct list_head list;
640	struct device gendev;	649	struct device gendev;
641	struct completion gendev_rel_comp; /* to deal with device release() */	650	struct completion gendev_rel_comp; /* to deal with device release() */
Lines 801-806 typedef struct hwif_s { Link Here
801	unsigned dma;	810	unsigned dma;
802		811
803	void (led_act)(void data, int rw);	812	void (led_act)(void data, int rw);
		813
		814	#ifdef CONFIG_BLK_DEV_IDEACPI
		815	struct ide_acpi_hwif_link *acpidata;
		816	#endif
804	} ____cacheline_internodealigned_in_smp ide_hwif_t;	817	} ____cacheline_internodealigned_in_smp ide_hwif_t;
805		818
806	/*	819	/*
Lines 1292-1297 static inline void ide_dma_verbose(ide_d Link Here
1292	static inline void ide_release_dma(ide_hwif_t *drive) {;}	1305	static inline void ide_release_dma(ide_hwif_t *drive) {;}
1293	#endif	1306	#endif
1294		1307
		1308	#ifdef CONFIG_BLK_DEV_IDEACPI
		1309	extern int ide_acpi_exec_tfs(ide_drive_t *drive);
		1310	extern void ide_acpi_get_timing(ide_hwif_t *hwif);
		1311	extern void ide_acpi_push_timing(ide_hwif_t *hwif);
		1312	extern void ide_acpi_init(ide_hwif_t *hwif);
		1313	#else
		1314	static inline int ide_acpi_exec_tfs(ide_drive_t *drive) { return 0; }
		1315	static inline void ide_acpi_get_timing(ide_hwif_t *hwif) { ; }
		1316	static inline void ide_acpi_push_timing(ide_hwif_t *hwif) { ; }
		1317	static inline void ide_acpi_init(ide_hwif_t *hwif) { ; }
		1318	#endif
		1319
1295	extern int ide_hwif_request_regions(ide_hwif_t *hwif);	1320	extern int ide_hwif_request_regions(ide_hwif_t *hwif);
1296	extern void ide_hwif_release_regions(ide_hwif_t* hwif);	1321	extern void ide_hwif_release_regions(ide_hwif_t* hwif);
1297	extern void ide_unregister (unsigned int index);	1322	extern void ide_unregister (unsigned int index);

Return to bug 145591

Line 0 Link Here

(-)a/drivers/ide/ide-acpi.c (+696 lines)
		1	/*
		2	* ide-acpi.c
		3	* Provides ACPI support for IDE drives.
		4	*
		5	* Copyright (C) 2005 Intel Corp.
		6	* Copyright (C) 2005 Randy Dunlap
		7	* Copyright (C) 2006 SUSE Linux Products GmbH
		8	* Copyright (C) 2006 Hannes Reinecke
		9	*/
		10
		11	#include <linux/ata.h>
		12	#include <linux/delay.h>
		13	#include <linux/device.h>
		14	#include <linux/errno.h>
		15	#include <linux/kernel.h>
		16	#include <acpi/acpi.h>
		17	#include <linux/ide.h>
		18	#include <linux/pci.h>
		19
		20	#include <acpi/acpi_bus.h>
		21	#include <acpi/acnames.h>
		22	#include <acpi/acnamesp.h>
		23	#include <acpi/acparser.h>
		24	#include <acpi/acexcep.h>
		25	#include <acpi/acmacros.h>
		26	#include <acpi/actypes.h>
		27
		28	#define REGS_PER_GTF 7
		29	struct taskfile_array {
		30	u8 tfa[REGS_PER_GTF]; /* regs. 0x1f1 - 0x1f7 */
		31	};
		32
		33	struct GTM_buffer {
		34	u32 PIO_speed0;
		35	u32 DMA_speed0;
		36	u32 PIO_speed1;
		37	u32 DMA_speed1;
		38	u32 GTM_flags;
		39	};
		40
		41	struct ide_acpi_drive_link {
		42	ide_drive_t *drive;
		43	acpi_handle obj_handle;
		44	u8 idbuff[512];
		45	};
		46
		47	struct ide_acpi_hwif_link {
		48	ide_hwif_t *hwif;
		49	acpi_handle obj_handle;
		50	struct GTM_buffer gtm;
		51	struct ide_acpi_drive_link master;
		52	struct ide_acpi_drive_link slave;
		53	};
		54
		55	#define DEBUGGING 1
		56	/* note: adds function name and KERN_DEBUG */
		57	#ifdef DEBUGGING
		58	#define DEBPRINT(fmt, args...) \
		59	printk(KERN_DEBUG "%s: " fmt, __FUNCTION__, ## args)
		60	#else
		61	#define DEBPRINT(fmt, args...) do {} while (0)
		62	#endif /* DEBUGGING */
		63
		64	extern int ide_noacpi;
65	extern int ide_noacpitfs;
66	extern int ide_noacpionboot;
67
68	/**
69	* ide_get_dev_handle - finds acpi_handle and PCI device.function
70	* @dev: device to locate
71	* @handle: returned acpi_handle for @dev
72	* @pcidevfn: return PCI device.func for @dev
73	*
74	* Returns the ACPI object handle to the corresponding PCI device.
75	*
76	* Returns 0 on success, <0 on error.
77	*/
78	static int ide_get_dev_handle(struct device dev, acpi_handle handle,
79	acpi_integer *pcidevfn)
80	{
81	struct pci_dev *pdev = to_pci_dev(dev);
82	unsigned int bus, devnum, func;
83	acpi_integer addr;
84	acpi_handle dev_handle, parent_handle;
85	struct acpi_buffer buffer = {.length = ACPI_ALLOCATE_BUFFER,
86	.pointer = NULL};
87	acpi_status status;
88	struct acpi_device_info *dinfo = NULL;
89	int ret = -ENODEV;
90
91	bus = pdev->bus->number;
92	devnum = PCI_SLOT(pdev->devfn);
93	func = PCI_FUNC(pdev->devfn);
94
95	DEBPRINT("ENTER: pci %02x:%02x.%01x\n", bus, devnum, func);
96
97	dev_handle = DEVICE_ACPI_HANDLE(dev);
98	parent_handle = DEVICE_ACPI_HANDLE(dev->parent);
99
100	status = acpi_get_object_info(parent_handle, &buffer);
101	if (ACPI_FAILURE(status)) {
102	DEBPRINT("get_object_info for parent failed\n");
103	goto err;
104	}
105	dinfo = buffer.pointer;
106	if (dinfo && (dinfo->valid & ACPI_VALID_ADR) &&
107	dinfo->address == bus) {
108	/* ACPI spec for _ADR for PCI bus: */
109	addr = (acpi_integer)(devnum << 16 \| func);
110	*pcidevfn = addr;
111	*handle = dev_handle;
112	} else {
113	DEBPRINT("get_object_info for parent has wrong "
114	" bus: %llu, should be %d\n",
115	dinfo ? (unsigned long long)dinfo->address : -1ULL,
116	bus);
117	goto err;
118	}
119
120	DEBPRINT("for dev=0x%x.%x, addr=0x%llx, parent=0x%p, *handle=0x%p\n",
121	devnum, func, (unsigned long long)addr,
122	dev->parent, *handle);
123	if (!*handle)
124	goto err;
125	ret = 0;
126	err:
127	acpi_os_free(dinfo);
128	return ret;
129	}
130
131	/**
132	* ide_acpi_hwif_get_handle - Get ACPI object handle for a given hwif
133	* @hwif: device to locate
134	*
135	* Retrieves the object handle for a given hwif.
136	*
137	* Returns handle on success, 0 on error.
138	*/
139	acpi_handle ide_acpi_hwif_get_handle(ide_hwif_t *hwif)
140	{
141	struct device *dev = hwif->gendev.parent;
142	acpi_handle dev_handle;
143	acpi_integer pcidevfn;
144	acpi_handle chan_handle;
145	int err;
146
147	DEBPRINT("ENTER: device %s\n", hwif->name);
148
149	if (!dev) {
150	DEBPRINT("no PCI device for %s\n", hwif->name);
151	return NULL;
152	}
153
154	err = ide_get_dev_handle(dev, &dev_handle, &pcidevfn);
155	if (err < 0) {
156	DEBPRINT("ide_get_dev_handle failed (%d)\n", err);
157	return NULL;
158	}
159
160	/* get child objects of dev_handle == channel objects,
161	* + _their_ children == drive objects */
162	/* channel is hwif->channel */
163	chan_handle = acpi_get_child(dev_handle, hwif->channel);
164	DEBPRINT("chan adr=%d: handle=0x%p\n",
165	hwif->channel, chan_handle);
166
167	return chan_handle;
168	}
169
170	/**
171	* ide_acpi_drive_get_handle - Get ACPI object handle for a given drive
172	* @drive: device to locate
173	*
174	* Retrieves the object handle of a given drive. According to the ACPI
175	* spec the drive is a child of the hwif.
176	*
177	* Returns handle on success, 0 on error.
178	*/
179	acpi_handle ide_acpi_drive_get_handle(ide_drive_t *drive)
180	{
181	ide_hwif_t *hwif = HWIF(drive);
182	int port;
183	acpi_handle drive_handle;
184
185	if (!hwif->acpidata)
186	return NULL;
187
188	if (!hwif->acpidata->obj_handle)
189	return NULL;
190
191	port = hwif->channel ? drive->dn - 2: drive->dn;
192
193	DEBPRINT("ENTER: %s at channel#: %d port#: %d\n",
194	drive->name, hwif->channel, port);
195
196
197	/* TBD: could also check ACPI object VALID bits */
198	drive_handle = acpi_get_child(hwif->acpidata->obj_handle, port);
199	DEBPRINT("drive %s handle 0x%p\n", drive->name, drive_handle);
200
201	return drive_handle;
202	}
203
204	/**
205	* do_drive_get_GTF - get the drive bootup default taskfile settings
206	* @drive: the drive for which the taskfile settings should be retrieved
207	* @gtf_length: number of bytes of _GTF data returned at @gtf_address
208	* @gtf_address: buffer containing _GTF taskfile arrays
209	*
210	* The _GTF method has no input parameters.
211	* It returns a variable number of register set values (registers
212	* hex 1F1..1F7, taskfiles).
213	* The <variable number> is not known in advance, so have ACPI-CA
214	* allocate the buffer as needed and return it, then free it later.
215	*
216	* The returned @gtf_length and @gtf_address are only valid if the
217	* function return value is 0.
218	*/
219	int do_drive_get_GTF(ide_drive_t *drive,
220	unsigned int gtf_length, unsigned long gtf_address,
221	unsigned long *obj_loc)
222	{
223	acpi_status status;
224	struct acpi_buffer output;
225	union acpi_object *out_obj;
226	ide_hwif_t *hwif = HWIF(drive);
227	struct device *dev = hwif->gendev.parent;
228	int err = -ENODEV;
229	int port;
230
231	*gtf_length = 0;
232	*gtf_address = 0UL;
233	*obj_loc = 0UL;
234
235	if (ide_noacpi)
236	return 0;
237
238	if (!dev) {
239	DEBPRINT("no PCI device for %s\n", hwif->name);
240	goto out;
241	}
242
243	if (!hwif->acpidata) {
244	DEBPRINT("no ACPI data for %s\n", hwif->name);
245	goto out;
246	}
247
248	port = hwif->channel ? drive->dn - 2: drive->dn;
249
250	if (!drive->acpidata) {
251	if (port == 0) {
252	drive->acpidata = &hwif->acpidata->master;
253	hwif->acpidata->master.drive = drive;
254	} else {
255	drive->acpidata = &hwif->acpidata->slave;
256	hwif->acpidata->slave.drive = drive;
257	}
258	}
259
260	DEBPRINT("ENTER: %s at %s, port#: %d, hard_port#: %d\n",
261	hwif->name, dev->bus_id, port, hwif->channel);
262
263	if (!drive->present) {
264	DEBPRINT("%s drive %d:%d not present\n",
265	hwif->name, hwif->channel, port);
266	goto out;
267	}
268
269	/* Get this drive's _ADR info. if not already known. */
270	if (!drive->acpidata->obj_handle) {
271	drive->acpidata->obj_handle = ide_acpi_drive_get_handle(drive);
272	if (!drive->acpidata->obj_handle) {
273	DEBPRINT("No ACPI object found for %s\n",
274	drive->name);
275	goto out;
276	}
277	}
278
279	/* Setting up output buffer */
280	output.length = ACPI_ALLOCATE_BUFFER;
281	output.pointer = NULL; /* ACPI-CA sets this; save/free it later */
282
283	/* _GTF has no input parameters */
284	err = -EIO;
285	status = acpi_evaluate_object(drive->acpidata->obj_handle, "_GTF",
286	NULL, &output);
287	if (ACPI_FAILURE(status)) {
288	printk(KERN_DEBUG
289	"%s: Run _GTF error: status = 0x%x\n",
290	__FUNCTION__, status);
291	goto out;
292	}
293
294	if (!output.length \|\| !output.pointer) {
295	DEBPRINT("Run _GTF: "
296	"length or ptr is NULL (0x%llx, 0x%p)\n",
297	(unsigned long long)output.length,
298	output.pointer);
299	goto out;
300	}
301
302	out_obj = output.pointer;
303	if (out_obj->type != ACPI_TYPE_BUFFER) {
304	DEBPRINT("Run _GTF: error: "
305	"expected object type of ACPI_TYPE_BUFFER, "
306	"got 0x%x\n", out_obj->type);
307	err = -ENOENT;
308	acpi_os_free(output.pointer);
309	goto out;
310	}
311
312	if (!out_obj->buffer.length \|\| !out_obj->buffer.pointer \|\|
313	out_obj->buffer.length % REGS_PER_GTF) {
314	printk(KERN_ERR
315	"%s: unexpected GTF length (%d) or addr (0x%p)\n",
316	__FUNCTION__, out_obj->buffer.length,
317	out_obj->buffer.pointer);
318	err = -ENOENT;
319	acpi_os_free(output.pointer);
320	goto out;
321	}
322
323	*gtf_length = out_obj->buffer.length;
324	*gtf_address = (unsigned long)out_obj->buffer.pointer;
325	*obj_loc = (unsigned long)out_obj;
326	DEBPRINT("returning gtf_length=%d, gtf_address=0x%lx, obj_loc=0x%lx\n",
327	gtf_length, gtf_address, *obj_loc);
328	err = 0;
329	out:
330	return err;
331	}
332
333	/**
334	* taskfile_load_raw - send taskfile registers to drive
335	* @drive: drive to which output is sent
336	* @gtf: raw ATA taskfile register set (0x1f1 - 0x1f7)
337	*
338	* Outputs IDE taskfile to the drive.
339	*/
340	static int taskfile_load_raw(ide_drive_t *drive,
341	const struct taskfile_array *gtf)
342	{
343	ide_task_t args;
344	int err = 0;
345
346	DEBPRINT("(0x1f1-1f7): hex: "
347	"%02x %02x %02x %02x %02x %02x %02x\n",
348	gtf->tfa[0], gtf->tfa[1], gtf->tfa[2],
349	gtf->tfa[3], gtf->tfa[4], gtf->tfa[5], gtf->tfa[6]);
350
351	memset(&args, 0, sizeof(ide_task_t));
352	args.command_type = IDE_DRIVE_TASK_NO_DATA;
353	args.data_phase = TASKFILE_IN;
354	args.handler = &task_no_data_intr;
355
356	/* convert gtf to IDE Taskfile */
357	args.tfRegister[1] = gtf->tfa[0]; /* 0x1f1 */
358	args.tfRegister[2] = gtf->tfa[1]; /* 0x1f2 */
359	args.tfRegister[3] = gtf->tfa[2]; /* 0x1f3 */
360	args.tfRegister[4] = gtf->tfa[3]; /* 0x1f4 */
361	args.tfRegister[5] = gtf->tfa[4]; /* 0x1f5 */
362	args.tfRegister[6] = gtf->tfa[5]; /* 0x1f6 */
363	args.tfRegister[7] = gtf->tfa[6]; /* 0x1f7 */
364
365	if (ide_noacpitfs) {
366	DEBPRINT("_GTF execution disabled\n");
367	return err;
368	}
369
370	err = ide_raw_taskfile(drive, &args, NULL);
371	if (err)
372	printk(KERN_ERR "%s: ide_raw_taskfile failed: %u\n",
373	__FUNCTION__, err);
374
375	return err;
376	}
377
378	/**
379	* do_drive_set_taskfiles - write the drive taskfile settings from _GTF
380	* @drive: the drive to which the taskfile command should be sent
381	* @gtf_length: total number of bytes of _GTF taskfiles
382	* @gtf_address: location of _GTF taskfile arrays
383	*
384	* Write {gtf_address, length gtf_length} in groups of
385	* REGS_PER_GTF bytes.
386	*/
387	static int do_drive_set_taskfiles(ide_drive_t *drive,
388	unsigned int gtf_length,
389	unsigned long gtf_address)
390	{
391	int rc = -ENODEV, err;
392	int gtf_count = gtf_length / REGS_PER_GTF;
393	int ix;
394	struct taskfile_array *gtf;
395
396	if (ide_noacpi)
397	return 0;
398
399	DEBPRINT("ENTER: %s, hard_port#: %d\n", drive->name, drive->dn);
400
401	if (!drive->present)
402	goto out;
403	if (!gtf_count) /* shouldn't be here */
404	goto out;
405
406	DEBPRINT("total GTF bytes=%u (0x%x), gtf_count=%d, addr=0x%lx\n",
407	gtf_length, gtf_length, gtf_count, gtf_address);
408
409	if (gtf_length % REGS_PER_GTF) {
410	printk(KERN_ERR "%s: unexpected GTF length (%d)\n",
411	__FUNCTION__, gtf_length);
412	goto out;
413	}
414
415	rc = 0;
416	for (ix = 0; ix < gtf_count; ix++) {
417	gtf = (struct taskfile_array *)
418	(gtf_address + ix * REGS_PER_GTF);
419
420	/* send all TaskFile registers (0x1f1-0x1f7) inthatorder */
421	err = taskfile_load_raw(drive, gtf);
422	if (err)
423	rc = err;
424	}
425
426	out:
427	return rc;
428	}
429
430	/**
431	* ide_acpi_exec_tfs - get then write drive taskfile settings
432	* @drive: the drive for which the taskfile settings should be
433	* written.
434	*
435	* According to the ACPI spec this should be called after _STM
436	* has been evaluated for the interface. Some ACPI vendors interpret
437	* that as a hard requirement and modify the taskfile according
438	* to the Identify Drive information passed down with _STM.
439	* So one should really make sure to call this only after _STM has
440	* been executed.
441	*/
442	int ide_acpi_exec_tfs(ide_drive_t *drive)
443	{
444	int ret;
445	unsigned int gtf_length;
446	unsigned long gtf_address;
447	unsigned long obj_loc;
448
449	if (ide_noacpi)
450	return 0;
451
452	DEBPRINT("call get_GTF, drive=%s port=%d\n", drive->name, drive->dn);
453
454	ret = do_drive_get_GTF(drive, &gtf_length, &gtf_address, &obj_loc);
455	if (ret < 0) {
456	DEBPRINT("get_GTF error (%d)\n", ret);
457	return ret;
458	}
459
460	DEBPRINT("call set_taskfiles, drive=%s\n", drive->name);
461
462	ret = do_drive_set_taskfiles(drive, gtf_length, gtf_address);
463	acpi_os_free((void *)obj_loc);
464	if (ret < 0) {
465	DEBPRINT("set_taskfiles error (%d)\n", ret);
466	}
467
468	DEBPRINT("ret=%d\n", ret);
469
470	return ret;
471	}
472	EXPORT_SYMBOL_GPL(ide_acpi_exec_tfs);
473
474	/**
475	* ide_acpi_get_timing - get the channel (controller) timings
476	* @hwif: target IDE interface (channel)
477	*
478	* This function executes the _GTM ACPI method for the target channel.
479	*
480	*/
481	void ide_acpi_get_timing(ide_hwif_t *hwif)
482	{
483	acpi_status status;
484	struct acpi_buffer output;
485	union acpi_object *out_obj;
486
487	if (ide_noacpi)
488	return;
489
490	DEBPRINT("ENTER:\n");
491
492	if (!hwif->acpidata) {
493	DEBPRINT("no ACPI data for %s\n", hwif->name);
494	return;
495	}
496
497	/* Setting up output buffer for _GTM */
498	output.length = ACPI_ALLOCATE_BUFFER;
499	output.pointer = NULL; /* ACPI-CA sets this; save/free it later */
500
501	/* _GTM has no input parameters */
502	status = acpi_evaluate_object(hwif->acpidata->obj_handle, "_GTM",
503	NULL, &output);
504
505	DEBPRINT("_GTM status: %d, outptr: 0x%p, outlen: 0x%llx\n",
506	status, output.pointer,
507	(unsigned long long)output.length);
508
509	if (ACPI_FAILURE(status)) {
510	DEBPRINT("Run _GTM error: status = 0x%x\n", status);
511	return;
512	}
513
514	if (!output.length \|\| !output.pointer) {
515	DEBPRINT("Run _GTM: length or ptr is NULL (0x%llx, 0x%p)\n",
516	(unsigned long long)output.length,
517	output.pointer);
518	acpi_os_free(output.pointer);
519	return;
520	}
521
522	out_obj = output.pointer;
523	if (out_obj->type != ACPI_TYPE_BUFFER) {
524	acpi_os_free(output.pointer);
525	DEBPRINT("Run _GTM: error: "
526	"expected object type of ACPI_TYPE_BUFFER, "
527	"got 0x%x\n", out_obj->type);
528	return;
529	}
530
531	if (!out_obj->buffer.length \|\| !out_obj->buffer.pointer \|\|
532	out_obj->buffer.length != sizeof(struct GTM_buffer)) {
533	acpi_os_free(output.pointer);
534	printk(KERN_ERR
535	"%s: unexpected _GTM length (0x%x)[should be 0x%x] or addr (0x%p)\n",
536	__FUNCTION__, out_obj->buffer.length,
537	sizeof(struct GTM_buffer), out_obj->buffer.pointer);
538	return;
539	}
540
541	memcpy(&hwif->acpidata->gtm, out_obj->buffer.pointer,
542	sizeof(struct GTM_buffer));
543
544	DEBPRINT("_GTM info: ptr: 0x%p, len: 0x%x, exp.len: 0x%Zx\n",
545	out_obj->buffer.pointer, out_obj->buffer.length,
546	sizeof(struct GTM_buffer));
547
548	DEBPRINT("_GTM fields: 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n",
549	hwif->acpidata->gtm.PIO_speed0,
550	hwif->acpidata->gtm.DMA_speed0,
551	hwif->acpidata->gtm.PIO_speed1,
552	hwif->acpidata->gtm.DMA_speed1,
553	hwif->acpidata->gtm.GTM_flags);
554
555	acpi_os_free(output.pointer);
556	}
557	EXPORT_SYMBOL_GPL(ide_acpi_get_timing);
558
559	/**
560	* ide_acpi_push_timing - set the channel (controller) timings
561	* @hwif: target IDE interface (channel)
562	*
563	* This function executes the _STM ACPI method for the target channel.
564	*
565	* _STM requires Identify Drive data, which has to passed as an argument.
566	* Unfortunately hd_driveid is a mangled version which we can't readily
567	* use; hence we'll get the information afresh.
568	*/
569	void ide_acpi_push_timing(ide_hwif_t *hwif)
570	{
571	acpi_status status;
572	struct acpi_object_list input;
573	union acpi_object in_params[3];
574	struct ide_acpi_drive_link *master = &hwif->acpidata->master;
575	struct ide_acpi_drive_link *slave = &hwif->acpidata->slave;
576
577	if (ide_noacpi)
578	return;
579
580	DEBPRINT("ENTER:\n");
581
582	if (!hwif->acpidata) {
583	DEBPRINT("no ACPI data for %s\n", hwif->name);
584	return;
585	}
586
587	/* Give the GTM buffer + drive Identify data to the channel via the
588	* _STM method: */
589	/* setup input parameters buffer for _STM */
590	input.count = 3;
591	input.pointer = in_params;
592	in_params[0].type = ACPI_TYPE_BUFFER;
593	in_params[0].buffer.length = sizeof(struct GTM_buffer);
594	in_params[0].buffer.pointer = (u8 *)&hwif->acpidata->gtm;
595	in_params[1].type = ACPI_TYPE_BUFFER;
596	in_params[1].buffer.length = sizeof(struct hd_driveid);
597	in_params[1].buffer.pointer = (u8 *)&master->idbuff;
598	in_params[2].type = ACPI_TYPE_BUFFER;
599	in_params[2].buffer.length = sizeof(struct hd_driveid);
600	in_params[2].buffer.pointer = (u8 *)&slave->idbuff;
601	/* Output buffer: _STM has no output */
602
603	status = acpi_evaluate_object(hwif->acpidata->obj_handle, "_STM",
604	&input, NULL);
605
606	if (ACPI_FAILURE(status)) {
607	DEBPRINT("Run _STM error: status = 0x%x\n", status);
608	}
609	DEBPRINT("_STM status: %d\n", status);
610	}
611	EXPORT_SYMBOL_GPL(ide_acpi_push_timing);
612
613	/**
614	* ide_acpi_init - initialize the ACPI link for an IDE interface
615	* @hwif: target IDE interface (channel)
616	*
617	* The ACPI spec is not quite clear when the drive identify buffer
618	* should be obtained. Calling IDENTIFY DEVICE during shutdown
619	* is not the best of ideas as the drive might already being put to
620	* sleep. And obviously we can't call it during resume.
621	* So we get the information during startup; but this means that
622	* any changes during run-time will be lost after resume.
623	*/
624	void ide_acpi_init(ide_hwif_t *hwif)
625	{
626	int unit;
627	int err;
628	struct ide_acpi_drive_link *master;
629	struct ide_acpi_drive_link *slave;
630
631	hwif->acpidata = kzalloc(sizeof(struct ide_acpi_hwif_link), GFP_KERNEL);
632	if (!hwif->acpidata)
633	return;
634
635	hwif->acpidata->obj_handle = ide_acpi_hwif_get_handle(hwif);
636	if (!hwif->acpidata->obj_handle) {
637	DEBPRINT("no ACPI object for %s found\n", hwif->name);
638	kfree(hwif->acpidata);
639	hwif->acpidata = NULL;
640	return;
641	}
642
643	/*
644	* The ACPI spec mandates that we send information
645	* for both drives, regardless whether they are connected
646	* or not.
647	*/
648	hwif->acpidata->master.drive = &hwif->drives[0];
649	hwif->drives[0].acpidata = &hwif->acpidata->master;
650	master = &hwif->acpidata->master;
651
652	hwif->acpidata->slave.drive = &hwif->drives[1];
653	hwif->drives[1].acpidata = &hwif->acpidata->slave;
654	slave = &hwif->acpidata->slave;
655
656
657	/*
658	* Send IDENTIFY for each drive
659	*/
660	if (master->drive->present) {
661	err = taskfile_lib_get_identify(master->drive, master->idbuff);
662	if (err) {
663	DEBPRINT("identify device %s failed (%d)\n",
664	master->drive->name, err);
665	}
666	}
667
668	if (slave->drive->present) {
669	err = taskfile_lib_get_identify(slave->drive, slave->idbuff);
670	if (err) {
671	DEBPRINT("identify device %s failed (%d)\n",
672	slave->drive->name, err);
673	}
674	}
675
676	if (ide_noacpionboot) {
677	DEBPRINT("ACPI methods disabled on boot\n");
678	return;
679	}
680
681	/*
682	* ACPI requires us to call _STM on startup
683	*/
684	ide_acpi_get_timing(hwif);
685	ide_acpi_push_timing(hwif);
686
687	for (unit = 0; unit < MAX_DRIVES; ++unit) {
688	ide_drive_t *drive = &hwif->drives[unit];
689
690	if (drive->present) {
691	/* Execute ACPI startup code */
692	ide_acpi_exec_tfs(drive);
693	}
694	}
695	}
696	EXPORT_SYMBOL_GPL(ide_acpi_init);