From mboxrd@z Thu Jan 1 00:00:00 1970 From: Randy Dunlap Subject: [PATCH 6/6 update] SATA ACPI: ata_acpi functions Date: Tue, 6 Dec 2005 13:58:15 -0800 Message-ID: <20051206135815.5026647c.randy_d_dunlap@linux.intel.com> References: <20051202100119.032b242e.randy_d_dunlap@linux.intel.com> <20051202100850.11b831ea.randy_d_dunlap@linux.intel.com> Mime-Version: 1.0 Content-Type: text/plain; charset=US-ASCII Content-Transfer-Encoding: 7bit Return-path: Received: from fmr17.intel.com ([134.134.136.16]:52181 "EHLO orsfmr002.jf.intel.com") by vger.kernel.org with ESMTP id S1030264AbVLFVzK (ORCPT ); Tue, 6 Dec 2005 16:55:10 -0500 In-Reply-To: <20051202100850.11b831ea.randy_d_dunlap@linux.intel.com> Sender: linux-ide-owner@vger.kernel.org List-Id: linux-ide@vger.kernel.org To: ide Cc: axboe@suse.de, jgarzik@pobox.com From: Randy Dunlap Add support for ACPI methods to SATA suspend/resume. do_drive_get_GTF() is changed to get the ACPI obj_handle in case do_drive_SDD() did not set that value. Signed-off-by: Randy Dunlap --- All patch files are available at http://www.xenotime.net/linux/SATA/2.6.15-rc/ drivers/scsi/ata_acpi.c | 497 ++++++++++++++++++++++++++++++++++++++++++++++++ 1 files changed, 497 insertions(+) --- /dev/null +++ linux-2615-rc4/drivers/scsi/ata_acpi.c @@ -0,0 +1,497 @@ +/* + * ata-acpi.c + * Provides ACPI support for PATA/SATA. + * + * Copyright (C) 2005 Intel Corp. + * Copyright (C) 2005 Randy Dunlap + */ + +#include +#include +#include +#include +#include +#include "scsi.h" +#include +#include +#include "libata.h" + +#include +#include +#include +#include +#include +#include +#include + +#define SATA_ROOT_PORT(x) (((x) >> 16) & 0xffff) +#define SATA_PORT_NUMBER(x) ((x) & 0xffff) /* or NO_PORT_MULT */ +#define NO_PORT_MULT 0xffff +#define SATA_ADR_RSVD 0xffffffff + +#define REGS_PER_GTF 7 +struct taskfile_array { + u8 tfa[REGS_PER_GTF]; /* regs. 0x1f1 - 0x1f7 */ +}; + +#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 */ + +static u8 *acpi_path_name(acpi_handle handle) +{ + acpi_status status; + static u8 path_name[ACPI_PATHNAME_MAX]; + struct acpi_buffer ret_buf = { ACPI_PATHNAME_MAX, path_name }; + + memset(path_name, 0, sizeof (path_name)); + status = acpi_get_name(handle, ACPI_FULL_PATHNAME, &ret_buf); + + if (ACPI_FAILURE(status)) + return NULL; + + return path_name; +} + +/** + * pci_acpi_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 0 on success, <0 on error. + */ +static int pci_acpi_get_dev_handle(struct device *dev, acpi_handle *handle, + acpi_integer *pcidevfn) +{ + struct pci_dev *pci_dev; + acpi_integer addr; + + pci_dev = to_pci_dev(dev); + /* Please refer to the ACPI spec for the syntax of _ADR. */ + addr = (PCI_SLOT(pci_dev->devfn) << 16) | PCI_FUNC(pci_dev->devfn); + *pcidevfn = addr; + *handle = acpi_get_child(DEVICE_ACPI_HANDLE(dev->parent), addr); + DEBPRINT("pcidevfn: 0x%llx\n", + (unsigned long long)*pcidevfn); + if (!*handle) + return -ENODEV; + return 0; +} + +struct walk_info { /* can be trimmed some */ + struct device *dev; + struct acpi_device *adev; + acpi_handle handle; + acpi_integer pcidevfn; + unsigned int drivenum; + acpi_handle obj_handle; + struct ata_port *ataport; + struct ata_device *atadev; + u32 sata_adr; + int status; + char basepath[ACPI_PATHNAME_MAX]; + int basepath_len; +}; + +static acpi_status get_devices(acpi_handle handle, + u32 level, void *context, void **return_value) +{ + acpi_status status; + struct walk_info *winfo = context; + u8 *path_name = acpi_path_name(handle); + struct acpi_buffer buffer; + struct acpi_device_info *dinfo; + + buffer.length = ACPI_ALLOCATE_LOCAL_BUFFER; + buffer.pointer = NULL; + status = acpi_get_object_info(handle, &buffer); + + if (ACPI_SUCCESS(status)) { + dinfo = buffer.pointer; + + /* find full device path name for pcidevfn */ + if (dinfo && (dinfo->valid & ACPI_VALID_ADR) && + dinfo->address == winfo->pcidevfn) { + DEBPRINT(":%s: matches pcidevfn (0x%llx)\n", + path_name, winfo->pcidevfn); + strlcpy(winfo->basepath, path_name, + sizeof(winfo->basepath)); + winfo->basepath_len = strlen(path_name); + goto out; + } + + /* if basepath is not yet known, ignore this object */ + if (!winfo->basepath_len) + goto out; + + /* if this object is in scope of basepath, maybe use it */ + if (strncmp(path_name, winfo->basepath, + winfo->basepath_len) == 0) { + if (!(dinfo->valid & ACPI_VALID_ADR)) + goto out; + DEBPRINT("GOT ONE: " + "(%s) root_port = 0x%llx, port_num = 0x%llx\n", + path_name, + SATA_ROOT_PORT(dinfo->address), + SATA_PORT_NUMBER(dinfo->address)); + /* heuristics: */ + if (SATA_PORT_NUMBER(dinfo->address) != NO_PORT_MULT) + DEBPRINT("warning: don't know how to handle SATA port multiplier\n"); + if (SATA_ROOT_PORT(dinfo->address) == + winfo->ataport->port_no && + SATA_PORT_NUMBER(dinfo->address) == NO_PORT_MULT) { + DEBPRINT("THIS ^^^^^ is the requested SATA drive (handle = 0x%p)\n", + handle); + winfo->sata_adr = dinfo->address; + winfo->obj_handle = handle; + } + } +out: + ACPI_MEM_FREE(dinfo); + } + + return status; +} + +/* Get the SATA drive _ADR object. */ +static int get_sata_adr(struct device *dev, acpi_handle handle, + acpi_integer pcidevfn, unsigned int drive, + struct ata_port *ap, + struct ata_device *atadev, u32 *dev_adr) +{ + acpi_status status; + struct walk_info *winfo; + int err = -ENOMEM; + + winfo = kzalloc(sizeof(struct walk_info), GFP_KERNEL); + if (!winfo) + goto out; + + winfo->dev = dev; + winfo->atadev = atadev; + winfo->ataport = ap; + if (acpi_bus_get_device(handle, &winfo->adev) < 0) + DEBPRINT("acpi_bus_get_device failed\n"); + winfo->handle = handle; + winfo->pcidevfn = pcidevfn; + winfo->drivenum = drive; + + status = acpi_get_devices(NULL, get_devices, winfo, NULL); + if (ACPI_FAILURE(status)) + err = -ENODEV; + else { + *dev_adr = winfo->sata_adr; + atadev->obj_handle = winfo->obj_handle; + err = 0; + } + kfree(winfo); +out: + return err; +} + +/** + * do_drive_SDD - send Identify data to a drive + * @ap: the ata_port for the drive + * @ix: drive index + * + * Must be after Identify (Packet) Device -- uses its data. + */ +int do_drive_SDD(struct ata_port *ap, unsigned int ix) +{ + acpi_handle handle; + acpi_integer pcidevfn; + int err = -ENODEV; + struct device *dev = ap->host_set->dev; + struct ata_device *atadev = &ap->device[ix]; + u32 dev_adr; + acpi_status status; + struct acpi_object_list input; + union acpi_object in_params[1]; + + printk(KERN_DEBUG + "%s: ap->id: %d, ix = %d, port#: %d, hard_port#: %d\n", + __FUNCTION__, ap->id, ix, ap->port_no, ap->hard_port_no); + + /* Don't continue if not a SATA device. */ + if (!ata_id_is_sata(atadev->id)) + goto out; + + /* Don't continue if device has no _ADR method. + * _SDD is intended for known motherboard devices. */ + err = pci_acpi_get_dev_handle(dev, &handle, &pcidevfn); + if (err < 0) + goto out; + /* Get this drive's _ADR info. */ + dev_adr = SATA_ADR_RSVD; + err = get_sata_adr(dev, handle, pcidevfn, ix, ap, atadev, &dev_adr); + if (err < 0 || dev_adr == SATA_ADR_RSVD || !atadev->obj_handle) + goto out; + + /* 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; + in_params[0].buffer.length = sizeof(atadev->id); + in_params[0].buffer.pointer = (u8 *)atadev->id; + /* Output buffer: _SDD has no output */ + + /* It's OK for _SDD to be missing too. */ + status = acpi_evaluate_object(atadev->obj_handle, "_SDD", &input, NULL); + err = ACPI_FAILURE(status) ? -EIO : 0; + if (err < 0) { + printk(KERN_DEBUG + "ata%u(%u): %s _SDD error: status = 0x%x\n", + ap->id, ap->device->devno, __FUNCTION__, status); + } +out: + return err; +} +EXPORT_SYMBOL_GPL(do_drive_SDD); + +/** + * do_drive_get_GTF - get the drive bootup default taskfile settings + * @ap: the ata_port for the drive + * @atadev: target ata_device + * + * 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 is not known in advance, so have ACPI-CA + * allocate the buffer as needed and return it, then free it later. + * + */ +int do_drive_get_GTF(struct ata_port *ap, struct ata_device *atadev) +{ + acpi_status status; + acpi_handle handle; + acpi_integer pcidevfn; + u32 dev_adr; + struct acpi_buffer output; + union acpi_object *out_obj; + struct device *dev = ap->host_set->dev; + int err = -ENODEV; + + if (!ata_dev_present(atadev)) /* or port disabled ? */ + goto out; + + /* Don't continue if device has no _ADR method. + * _GTF is intended for known motherboard devices. */ + err = pci_acpi_get_dev_handle(dev, &handle, &pcidevfn); + if (err < 0) + goto out; + + /* Get this drive's _ADR info. if _SDD didn't get it. */ + if (!atadev->obj_handle) { + dev_adr = SATA_ADR_RSVD; + err = get_sata_adr(dev, handle, pcidevfn, 0, ap, atadev, &dev_adr); + if (err < 0 || dev_adr == SATA_ADR_RSVD || !atadev->obj_handle) + 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(atadev->obj_handle, "_GTF", + NULL, &output); + if (ACPI_FAILURE(status)) { + ACPI_MEM_FREE(output.pointer); + printk(KERN_DEBUG + "%s: Run _GTF error: status = 0x%x\n", + __FUNCTION__, status); + goto out; + } + + if (!output.length || !output.pointer) { + printk(KERN_DEBUG + "%s: Run _GTF: length or ptr is NULL (0x%llx, 0x%p)\n", + __FUNCTION__, + (unsigned long long)output.length, output.pointer); + ACPI_MEM_FREE(output.pointer); + goto out; + } + + out_obj = output.pointer; + if (out_obj->type != ACPI_TYPE_BUFFER) { + ACPI_MEM_FREE(output.pointer); + printk(KERN_DEBUG "%s: Run _GTF: error: " + "expected object type of ACPI_TYPE_BUFFER, got 0x%x\n", + __FUNCTION__, out_obj->type); + err = -ENOENT; + goto out; + } + + atadev->gtf_length = out_obj->buffer.length; + atadev->gtf_address = out_obj->buffer.pointer; + err = 0; +out: + return err; +} +EXPORT_SYMBOL_GPL(do_drive_get_GTF); + +/** + * taskfile_load_raw - send taskfile registers to host controller + * @ap: Port to which output is sent + * @gtf: raw ATA taskfile register set (0x1f1 - 0x1f7) + * + * Outputs ATA taskfile to standard ATA host controller using MMIO + * or PIO as indicated by the ATA_FLAG_MMIO flag. + * Writes the control, feature, nsect, lbal, lbam, and lbah registers. + * Optionally (ATA_TFLAG_LBA48) writes hob_feature, hob_nsect, + * hob_lbal, hob_lbam, and hob_lbah. + * + * This function waits for idle (!BUSY and !DRQ) after writing + * registers. If the control register has a new value, this + * function also waits for idle after writing control and before + * writing the remaining registers. + * + * LOCKING: TBD: + * Inherited from caller. + */ +static void taskfile_load_raw(struct ata_port *ap, + struct ata_device *atadev, + const struct taskfile_array *gtf) +{ + 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]); + + if (ap->ops->tf_load && ap->ops->exec_command) { + struct ata_taskfile atf; + + /* convert gtf to atf */ + ata_tf_init(ap, &atf, 0); + atf.flags = ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; /* TBD */ + atf.protocol = ATA_PROT_NODATA; /* or ATA_PROT_ATAPI_NODATA */ + atf.feature = gtf->tfa[0]; /* 0x1f1 */ + atf.nsect = gtf->tfa[1]; /* 0x1f2 */ + atf.lbal = gtf->tfa[2]; /* 0x1f3 */ + atf.lbam = gtf->tfa[3]; /* 0x1f4 */ + atf.lbah = gtf->tfa[4]; /* 0x1f5 */ + atf.device = gtf->tfa[5]; /* 0x1f6 */ + atf.command = gtf->tfa[6]; /* 0x1f7 */ + + DEBPRINT("call tf_load:\n"); + ap->ops->tf_load(ap, &atf); + DEBPRINT("call exec_command:\n"); + ap->ops->exec_command(ap, &atf); + DEBPRINT("tf_load & exec_command done.\n"); + } else if (ap->ops->qc_issue && ap->ops->qc_prep) { + int ret; + struct ata_queued_cmd *qc; + unsigned long flags; + DECLARE_COMPLETION(wait); + + qc = ata_qc_new_init(ap, atadev); + if (!qc) { + printk(KERN_DEBUG "%s: ata_qc_new_init ret. NULL\n", + __FUNCTION__); + return; + } + + /* convert gtf to qc.tf */ + qc->tf.flags = ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; /* TBD */ + qc->tf.protocol = ATA_PROT_NODATA; /* or ATA_PROT_ATAPI_NODATA */ + qc->tf.feature = gtf->tfa[0]; /* 0x1f1 */ + qc->tf.nsect = gtf->tfa[1]; /* 0x1f2 */ + qc->tf.lbal = gtf->tfa[2]; /* 0x1f3 */ + qc->tf.lbam = gtf->tfa[3]; /* 0x1f4 */ + qc->tf.lbah = gtf->tfa[4]; /* 0x1f5 */ + qc->tf.device = gtf->tfa[5]; /* 0x1f6 */ + qc->tf.command = gtf->tfa[6]; /* 0x1f7 */ + + qc->waiting = &wait; + qc->complete_fn = ata_qc_complete_noop; + + // TBD: fix locking and return value/wait_for_completion here: + DEBPRINT("call ata_qc_issue:\n"); + spin_lock_irqsave(&ap->host_set->lock, flags); + ret = ata_qc_issue(qc); + spin_unlock_irqrestore(&ap->host_set->lock, flags); + DEBPRINT("ata_qc_issue done: ret = 0x%x\n", ret); + + if (!ret) + wait_for_completion(&wait); + } else + printk(KERN_WARNING "%s: SATA driver is missing tf_load/exec_command or qc_issue function entry points\n", + __FUNCTION__); +} + +/** + * do_drive_set_taskfiles - write the drive taskfile settings from _GTF + * @ap: the ata_port for the drive + * @atadev: target ata_device + * + * This applies to both PATA and SATA drives. + * + * Write {atadev->gtf_address, length atadev->gtf_length} in groups of + * REGS_PER_GTF bytes. + * + */ +int do_drive_set_taskfiles(struct ata_port *ap, struct ata_device *atadev) +{ + int err = -ENODEV; + int gtf_count = + atadev->gtf_length / REGS_PER_GTF; + int ix; + struct taskfile_array *gtf; + + if (!ata_dev_present(atadev)) /* or port disabled ? */ + goto out; + if (!gtf_count) /* shouldn't be here */ + goto out; + + DEBPRINT("total GTF bytes = %lld (0x%llx), gtf_count = %d\n", + (unsigned long long)atadev->gtf_length, + (unsigned long long)atadev->gtf_length, gtf_count); + if (atadev->gtf_length % REGS_PER_GTF) { + printk(KERN_ERR "%s: unexpected GTF length (%zd)\n", + __FUNCTION__, atadev->gtf_length); + goto out; + } + + for (ix = 0; ix < gtf_count; ix++) { + gtf = (struct taskfile_array *) + (atadev->gtf_address + ix * REGS_PER_GTF); + + /* send all TaskFile registers (0x1f1-0x1f7) *in*that*order* */ + taskfile_load_raw(ap, atadev, gtf); + } + + err = 0; +out: + return err; +} +EXPORT_SYMBOL_GPL(do_drive_set_taskfiles); + +/** + * do_drive_update_taskfiles - get then write drive taskfile settings + * @ap: the ata_port for the drive + * + * This applies to both PATA and SATA drives. + */ +int do_drive_update_taskfiles(struct ata_port *ap) +{ + int ix; + int ret; + + for (ix = 0; ix < ATA_MAX_DEVICES; ix++) { + ret = do_drive_get_GTF(ap, &ap->device[ix]); + if (ret >= 0) + ret = do_drive_set_taskfiles(ap, &ap->device[ix]); + } + + return ret; +} +EXPORT_SYMBOL_GPL(do_drive_update_taskfiles); ---