dmfe: add support for suspend/resume

This adds support for suspend resume

[akpm@linux-foundation.org: fix CONFIG_PM=n, coding style]
Signed-off-by: Maxim Levitsky <maximlevitsky@gmail.com>
Cc: Valerie Henson <val_henson@linux.intel.com>
Cc: Jeff Garzik <jeff@garzik.org>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Jeff Garzik <jeff@garzik.org>

1 files changed, 49 insertions, 3 deletions

diff --git a/drivers/net/tulip/dmfe.c b/drivers/net/tulip/dmfe.c
index b3a64ca98634..e3a077977e4c 100644
--- a/drivers/net/tulip/dmfe.c
+++ b/drivers/net/tulip/dmfe.c
@@ -55,9 +55,6 @@
 
     TODO
 
-    Implement pci_driver::suspend() and pci_driver::resume()
-    power management methods.
-
     Check on 64 bit boxes.
     Check and fix on big endian boxes.
 
@@ -2050,11 +2047,60 @@ static struct pci_device_id dmfe_pci_tbl[] = {
 MODULE_DEVICE_TABLE(pci, dmfe_pci_tbl);
 
 
+#ifdef CONFIG_PM
+static int dmfe_suspend(struct pci_dev *pci_dev, pm_message_t state)
+{
+        struct net_device *dev = pci_get_drvdata(pci_dev);
+        struct dmfe_board_info *db = netdev_priv(dev);
+
+        /* Disable upper layer interface */
+        netif_device_detach(dev);
+
+        /* Disable Tx/Rx */
+        db->cr6_data &= ~(CR6_RXSC | CR6_TXSC);
+        update_cr6(db->cr6_data, dev->base_addr);
+
+        /* Disable Interrupt */
+        outl(0, dev->base_addr + DCR7);
+        outl(inl (dev->base_addr + DCR5), dev->base_addr + DCR5);
+
+        /* Fre RX buffers */
+        dmfe_free_rxbuffer(db);
+
+        /* Power down device*/
+        pci_set_power_state(pci_dev, pci_choose_state (pci_dev,state));
+        pci_save_state(pci_dev);
+
+        return 0;
+}
+
+static int dmfe_resume(struct pci_dev *pci_dev)
+{
+        struct net_device *dev = pci_get_drvdata(pci_dev);
+
+        pci_restore_state(pci_dev);
+        pci_set_power_state(pci_dev, PCI_D0);
+
+        /* Re-initilize DM910X board */
+        dmfe_init_dm910x(dev);
+
+        /* Restart upper layer interface */
+        netif_device_attach(dev);
+
+        return 0;
+}
+#else
+#define dmfe_suspend NULL
+#define dmfe_resume NULL
+#endif
+
 static struct pci_driver dmfe_driver = {
         .name           = "dmfe",
         .id_table       = dmfe_pci_tbl,
         .probe          = dmfe_init_one,
         .remove         = __devexit_p(dmfe_remove_one),
+        .suspend        = dmfe_suspend,
+        .resume         = dmfe_resume
 };
 
 MODULE_AUTHOR("Sten Wang, sten_wang@davicom.com.tw");