libata-acpi: improve ACPI disabling
[safe/jmp/linux-2.6] / drivers / ata / libata-acpi.c
index b3aeca3..5932ae2 100644 (file)
@@ -41,6 +41,12 @@ static int is_pci_dev(struct device *dev)
        return (dev->bus == &pci_bus_type);
 }
 
+static void ata_acpi_clear_gtf(struct ata_device *dev)
+{
+       kfree(dev->gtf_cache);
+       dev->gtf_cache = NULL;
+}
+
 /**
  * ata_acpi_associate_sata_port - associate SATA port with ACPI objects
  * @ap: target SATA port
@@ -327,7 +333,6 @@ EXPORT_SYMBOL_GPL(ata_acpi_stm);
  * ata_dev_get_GTF - get the drive bootup default taskfile settings
  * @dev: target ATA device
  * @gtf: output parameter for buffer containing _GTF taskfile arrays
- * @ptr_to_free: pointer which should be freed
  *
  * This applies to both PATA and SATA drives.
  *
@@ -341,11 +346,10 @@ EXPORT_SYMBOL_GPL(ata_acpi_stm);
  * EH context.
  *
  * RETURNS:
- * Number of taskfiles on success, 0 if _GTF doesn't exist or doesn't
- * contain valid data.
+ * Number of taskfiles on success, 0 if _GTF doesn't exist.  -EINVAL
+ * if _GTF is invalid.
  */
-static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf,
-                          void **ptr_to_free)
+static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf)
 {
        struct ata_port *ap = dev->link->ap;
        acpi_status status;
@@ -353,6 +357,12 @@ static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf,
        union acpi_object *out_obj;
        int rc = 0;
 
+       /* if _GTF is cached, use the cached value */
+       if (dev->gtf_cache) {
+               out_obj = dev->gtf_cache;
+               goto done;
+       }
+
        /* set up output buffer */
        output.length = ACPI_ALLOCATE_BUFFER;
        output.pointer = NULL;  /* ACPI-CA sets this; save/free it later */
@@ -363,12 +373,14 @@ static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf,
 
        /* _GTF has no input parameters */
        status = acpi_evaluate_object(dev->acpi_handle, "_GTF", NULL, &output);
+       out_obj = dev->gtf_cache = output.pointer;
 
        if (ACPI_FAILURE(status)) {
                if (status != AE_NOT_FOUND) {
                        ata_dev_printk(dev, KERN_WARNING,
                                       "_GTF evaluation failed (AE 0x%x)\n",
                                       status);
+                       rc = -EINVAL;
                }
                goto out_free;
        }
@@ -380,14 +392,15 @@ static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf,
                                __FUNCTION__,
                                (unsigned long long)output.length,
                                output.pointer);
+               rc = -EINVAL;
                goto out_free;
        }
 
-       out_obj = output.pointer;
        if (out_obj->type != ACPI_TYPE_BUFFER) {
                ata_dev_printk(dev, KERN_WARNING,
                               "_GTF unexpected object type 0x%x\n",
                               out_obj->type);
+               rc = -EINVAL;
                goto out_free;
        }
 
@@ -395,21 +408,23 @@ static int ata_dev_get_GTF(struct ata_device *dev, struct ata_acpi_gtf **gtf,
                ata_dev_printk(dev, KERN_WARNING,
                               "unexpected _GTF length (%d)\n",
                               out_obj->buffer.length);
+               rc = -EINVAL;
                goto out_free;
        }
 
-       *ptr_to_free = out_obj;
-       *gtf = (void *)out_obj->buffer.pointer;
+ done:
        rc = out_obj->buffer.length / REGS_PER_GTF;
-
-       if (ata_msg_probe(ap))
-               ata_dev_printk(dev, KERN_DEBUG, "%s: returning "
-                       "gtf=%p, gtf_count=%d, ptr_to_free=%p\n",
-                       __FUNCTION__, *gtf, rc, *ptr_to_free);
+       if (gtf) {
+               *gtf = (void *)out_obj->buffer.pointer;
+               if (ata_msg_probe(ap))
+                       ata_dev_printk(dev, KERN_DEBUG,
+                                      "%s: returning gtf=%p, gtf_count=%d\n",
+                                      __FUNCTION__, *gtf, rc);
+       }
        return rc;
 
  out_free:
-       kfree(output.pointer);
+       ata_acpi_clear_gtf(dev);
        return rc;
 }
 
@@ -520,6 +535,7 @@ static int taskfile_load_raw(struct ata_device *dev,
 /**
  * ata_acpi_exec_tfs - get then write drive taskfile settings
  * @dev: target ATA device
+ * @nr_executed: out paramter for the number of executed commands
  *
  * Evaluate _GTF and excute returned taskfiles.
  *
@@ -527,17 +543,19 @@ static int taskfile_load_raw(struct ata_device *dev,
  * EH context.
  *
  * RETURNS:
- * Number of executed taskfiles on success, 0 if _GTF doesn't exist or
- * doesn't contain valid data.  -errno on other errors.
+ * Number of executed taskfiles on success, 0 if _GTF doesn't exist.
+ * -errno on other errors.
  */
-static int ata_acpi_exec_tfs(struct ata_device *dev)
+static int ata_acpi_exec_tfs(struct ata_device *dev, int *nr_executed)
 {
        struct ata_acpi_gtf *gtf = NULL;
-       void *ptr_to_free = NULL;
        int gtf_count, i, rc;
 
        /* get taskfiles */
-       gtf_count = ata_dev_get_GTF(dev, &gtf, &ptr_to_free);
+       rc = ata_dev_get_GTF(dev, &gtf);
+       if (rc < 0)
+               return rc;
+       gtf_count = rc;
 
        /* execute them */
        for (i = 0, rc = 0; i < gtf_count; i++) {
@@ -549,12 +567,12 @@ static int ata_acpi_exec_tfs(struct ata_device *dev)
                tmp = taskfile_load_raw(dev, gtf++);
                if (!rc)
                        rc = tmp;
+
+               (*nr_executed)++;
        }
 
-       kfree(ptr_to_free);
+       ata_acpi_clear_gtf(dev);
 
-       if (rc == 0)
-               return gtf_count;
        return rc;
 }
 
@@ -644,13 +662,31 @@ void ata_acpi_on_resume(struct ata_port *ap)
        const struct ata_acpi_gtm *gtm = ata_acpi_init_gtm(ap);
        struct ata_device *dev;
 
-       /* restore timing parameters */
-       if (ap->acpi_handle && gtm)
+       if (ap->acpi_handle && gtm) {
+               /* _GTM valid */
+
+               /* restore timing parameters */
                ata_acpi_stm(ap, gtm);
 
-       /* schedule _GTF */
-       ata_link_for_each_dev(dev, &ap->link)
-               dev->flags |= ATA_DFLAG_ACPI_PENDING;
+               /* _GTF should immediately follow _STM so that it can
+                * use values set by _STM.  Cache _GTF result and
+                * schedule _GTF.
+                */
+               ata_link_for_each_dev(dev, &ap->link) {
+                       ata_acpi_clear_gtf(dev);
+                       if (ata_dev_get_GTF(dev, NULL) >= 0)
+                               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.
+                */
+               ata_link_for_each_dev(dev, &ap->link) {
+                       ata_acpi_clear_gtf(dev);
+                       dev->flags |= ATA_DFLAG_ACPI_PENDING;
+               }
+       }
 }
 
 /**
@@ -672,6 +708,7 @@ int ata_acpi_on_devcfg(struct ata_device *dev)
        struct ata_port *ap = dev->link->ap;
        struct ata_eh_context *ehc = &ap->link.eh_context;
        int acpi_sata = ap->flags & ATA_FLAG_ACPI_SATA;
+       int nr_executed = 0;
        int rc;
 
        if (!dev->acpi_handle)
@@ -690,14 +727,14 @@ int ata_acpi_on_devcfg(struct ata_device *dev)
        }
 
        /* do _GTF */
-       rc = ata_acpi_exec_tfs(dev);
-       if (rc < 0)
+       rc = ata_acpi_exec_tfs(dev, &nr_executed);
+       if (rc)
                goto acpi_err;
 
        dev->flags &= ~ATA_DFLAG_ACPI_PENDING;
 
        /* refresh IDENTIFY page if any _GTF command has been executed */
-       if (rc > 0) {
+       if (nr_executed) {
                rc = ata_dev_reread_id(dev, 0);
                if (rc < 0) {
                        ata_dev_printk(dev, KERN_ERR, "failed to IDENTIFY "
@@ -709,18 +746,26 @@ int ata_acpi_on_devcfg(struct ata_device *dev)
        return 0;
 
  acpi_err:
-       /* let EH retry on the first failure, disable ACPI on the second */
-       if (dev->flags & ATA_DFLAG_ACPI_FAILED) {
-               ata_dev_printk(dev, KERN_WARNING, "ACPI on devcfg failed the "
-                              "second time, disabling (errno=%d)\n", rc);
-
-               dev->acpi_handle = NULL;
+       /* ignore evaluation failure if we can continue safely */
+       if (rc == -EINVAL && !nr_executed && !(ap->pflags & ATA_PFLAG_FROZEN))
+               return 0;
 
-               /* if port is working, request IDENTIFY reload and continue */
-               if (!(ap->pflags & ATA_PFLAG_FROZEN))
-                       rc = 1;
+       /* 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;
        }
-       dev->flags |= ATA_DFLAG_ACPI_FAILED;
+
+       ata_dev_printk(dev, KERN_WARNING,
+                      "ACPI: failed the second time, disabled\n");
+       dev->acpi_handle = NULL;
+
+       /* We can safely continue if no _GTF command has been executed
+        * and port is not frozen.
+        */
+       if (!nr_executed && !(ap->pflags & ATA_PFLAG_FROZEN))
+               return 0;
+
        return rc;
 }
 
@@ -735,4 +780,5 @@ int ata_acpi_on_devcfg(struct ata_device *dev)
  */
 void ata_acpi_on_disable(struct ata_device *dev)
 {
+       ata_acpi_clear_gtf(dev);
 }