[PATCH] AT91RM9200 Ethernet #4: Suspend/Resume

Adds power-management (suspend/resume) support to the AT91RM9200
Ethernet driver.
Patch from David Brownell.

Signed-off-by: Andrew Victor <andrew@sanpeople.com>
Signed-off-by: Jeff Garzik <jeff@garzik.org>

1 files changed, 45 insertions, 1 deletions

diff --git a/drivers/net/arm/at91_ether.c b/drivers/net/arm/at91_ether.c
index d081241f613d..613005a0285d 100644
--- a/drivers/net/arm/at91_ether.c
+++ b/drivers/net/arm/at91_ether.c
@@ -1128,10 +1128,54 @@ static int __devexit at91ether_remove(struct platform_device *pdev)
         return 0;
 }
 
+#ifdef CONFIG_PM
+
+static int at91ether_suspend(struct platform_device *pdev, pm_message_t mesg)
+{
+        struct at91_private *lp = (struct at91_private *) at91_dev->priv;
+        struct net_device *net_dev = platform_get_drvdata(pdev);
+        int phy_irq = lp->board_data.phy_irq_pin;
+
+        if (netif_running(net_dev)) {
+                if (phy_irq)
+                        disable_irq(phy_irq);
+
+                netif_stop_queue(net_dev);
+                netif_device_detach(net_dev);
+
+                clk_disable(lp->ether_clk);
+        }
+        return 0;
+}
+
+static int at91ether_resume(struct platform_device *pdev)
+{
+        struct at91_private *lp = (struct at91_private *) at91_dev->priv;
+        struct net_device *net_dev = platform_get_drvdata(pdev);
+        int phy_irq = lp->board_data.phy_irq_pin;
+
+        if (netif_running(net_dev)) {
+                clk_enable(lp->ether_clk);
+
+                netif_device_attach(net_dev);
+                netif_start_queue(net_dev);
+
+                if (phy_irq)
+                        enable_irq(phy_irq);
+        }
+        return 0;
+}
+
+#else
+#define at91ether_suspend       NULL
+#define at91ether_resume        NULL
+#endif
+
 static struct platform_driver at91ether_driver = {
         .probe          = at91ether_probe,
         .remove         = __devexit_p(at91ether_remove),
-        /* FIXME:  support suspend and resume */
+        .suspend        = at91ether_suspend,
+        .resume         = at91ether_resume,
         .driver         = {
                 .name   = DRV_NAME,
                 .owner  = THIS_MODULE,