[SCSI] aic7xxx: Add suspend/resume support

The aic7xxx driver already contains fragments for suspend/resume
support. So we only need to update them to the current interface
and have full PCI suspend/resume.

Signed-off-by: Hannes Reinecke <hare@suse.de>
Tested-by: Jens Axboe <jens.axboe@oracle.com>
Signed-off-by: James Bottomley <James.Bottomley@SteelEye.com>

1 files changed, 46 insertions, 0 deletions

diff --git a/drivers/scsi/aic7xxx/aic7xxx_osm_pci.c b/drivers/scsi/aic7xxx/aic7xxx_osm_pci.c
index ea5687df732d..4488946cff2e 100644
--- a/drivers/scsi/aic7xxx/aic7xxx_osm_pci.c
+++ b/drivers/scsi/aic7xxx/aic7xxx_osm_pci.c
@@ -49,6 +49,8 @@ static int	ahc_linux_pci_reserve_io_region(struct ahc_softc *ahc,
 static int      ahc_linux_pci_reserve_mem_region(struct ahc_softc *ahc,
                                                  u_long *bus_addr,
                                                  uint8_t __iomem **maddr);
+static int      ahc_linux_pci_dev_suspend(struct pci_dev *pdev, pm_message_t mesg);
+static int      ahc_linux_pci_dev_resume(struct pci_dev *pdev);
 static void     ahc_linux_pci_dev_remove(struct pci_dev *pdev);
 
 /* Define the macro locally since it's different for different class of chips.
@@ -133,10 +135,54 @@ MODULE_DEVICE_TABLE(pci, ahc_linux_pci_id_table);
 static struct pci_driver aic7xxx_pci_driver = {
         .name           = "aic7xxx",
         .probe          = ahc_linux_pci_dev_probe,
+#ifdef CONFIG_PM
+        .suspend        = ahc_linux_pci_dev_suspend,
+        .resume         = ahc_linux_pci_dev_resume,
+#endif
         .remove         = ahc_linux_pci_dev_remove,
         .id_table       = ahc_linux_pci_id_table
 };
 
+static int
+ahc_linux_pci_dev_suspend(struct pci_dev *pdev, pm_message_t mesg)
+{
+        struct ahc_softc *ahc = pci_get_drvdata(pdev);
+        int rc;
+
+        if ((rc = ahc_suspend(ahc)))
+                return rc;
+
+        pci_save_state(pdev);
+        pci_disable_device(pdev);
+
+        if (mesg.event == PM_EVENT_SUSPEND)
+                pci_set_power_state(pdev, PCI_D3hot);
+
+        return rc;
+}
+
+static int
+ahc_linux_pci_dev_resume(struct pci_dev *pdev)
+{
+        struct ahc_softc *ahc = pci_get_drvdata(pdev);
+        int rc;
+
+        pci_set_power_state(pdev, PCI_D0);
+        pci_restore_state(pdev);
+
+        if ((rc = pci_enable_device(pdev))) {
+                dev_printk(KERN_ERR, &pdev->dev,
+                           "failed to enable device after resume (%d)\n", rc);
+                return rc;
+        }
+
+        pci_set_master(pdev);
+
+        ahc_pci_resume(ahc);
+
+        return (ahc_resume(ahc));
+}
+
 static void
 ahc_linux_pci_dev_remove(struct pci_dev *pdev)
 {