1 files changed, 145 insertions, 35 deletions

diff --git a/drivers/net/r8169.c b/drivers/net/r8169.c
index dbb1f5a1824c..340da3915b96 100644
--- a/drivers/net/r8169.c
+++ b/drivers/net/r8169.c
@@ -23,6 +23,7 @@
 #include <linux/tcp.h>
 #include <linux/init.h>
 #include <linux/dma-mapping.h>
+#include <linux/pm_runtime.h>
 
 #include <asm/system.h>
 #include <asm/io.h>
@@ -509,6 +510,7 @@ struct rtl8169_private {
 
         struct mii_if_info mii;
         struct rtl8169_counters counters;
+        u32 saved_wolopts;
 };
 
 MODULE_AUTHOR("Realtek and the Linux r8169 crew <netdev@vger.kernel.org>");
@@ -748,53 +750,61 @@ static void rtl8169_check_link_status(struct net_device *dev,
 
         spin_lock_irqsave(&tp->lock, flags);
         if (tp->link_ok(ioaddr)) {
+                /* This is to cancel a scheduled suspend if there's one. */
+                pm_request_resume(&tp->pci_dev->dev);
                 netif_carrier_on(dev);
                 netif_info(tp, ifup, dev, "link up\n");
         } else {
                 netif_carrier_off(dev);
                 netif_info(tp, ifdown, dev, "link down\n");
+                pm_schedule_suspend(&tp->pci_dev->dev, 100);
         }
         spin_unlock_irqrestore(&tp->lock, flags);
 }
 
-static void rtl8169_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
+#define WAKE_ANY (WAKE_PHY | WAKE_MAGIC | WAKE_UCAST | WAKE_BCAST | WAKE_MCAST)
+
+static u32 __rtl8169_get_wol(struct rtl8169_private *tp)
 {
-        struct rtl8169_private *tp = netdev_priv(dev);
         void __iomem *ioaddr = tp->mmio_addr;
         u8 options;
-
-        wol->wolopts = 0;
-
-#define WAKE_ANY (WAKE_PHY | WAKE_MAGIC | WAKE_UCAST | WAKE_BCAST | WAKE_MCAST)
-        wol->supported = WAKE_ANY;
-
-        spin_lock_irq(&tp->lock);
+        u32 wolopts = 0;
 
         options = RTL_R8(Config1);
         if (!(options & PMEnable))
-                goto out_unlock;
+                return 0;
 
         options = RTL_R8(Config3);
         if (options & LinkUp)
-                wol->wolopts |= WAKE_PHY;
+                wolopts |= WAKE_PHY;
         if (options & MagicPacket)
-                wol->wolopts |= WAKE_MAGIC;
+                wolopts |= WAKE_MAGIC;
 
         options = RTL_R8(Config5);
         if (options & UWF)
-                wol->wolopts |= WAKE_UCAST;
+                wolopts |= WAKE_UCAST;
         if (options & BWF)
-                wol->wolopts |= WAKE_BCAST;
+                wolopts |= WAKE_BCAST;
         if (options & MWF)
-                wol->wolopts |= WAKE_MCAST;
+                wolopts |= WAKE_MCAST;
 
-out_unlock:
-        spin_unlock_irq(&tp->lock);
+        return wolopts;
 }
 
-static int rtl8169_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
+static void rtl8169_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
 {
         struct rtl8169_private *tp = netdev_priv(dev);
+
+        spin_lock_irq(&tp->lock);
+
+        wol->supported = WAKE_ANY;
+        wol->wolopts = __rtl8169_get_wol(tp);
+
+        spin_unlock_irq(&tp->lock);
+}
+
+static void __rtl8169_set_wol(struct rtl8169_private *tp, u32 wolopts)
+{
         void __iomem *ioaddr = tp->mmio_addr;
         unsigned int i;
         static const struct {
@@ -811,23 +821,29 @@ static int rtl8169_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
                 { WAKE_ANY,   Config5, LanWake }
         };
 
-        spin_lock_irq(&tp->lock);
-
         RTL_W8(Cfg9346, Cfg9346_Unlock);
 
         for (i = 0; i < ARRAY_SIZE(cfg); i++) {
                 u8 options = RTL_R8(cfg[i].reg) & ~cfg[i].mask;
-                if (wol->wolopts & cfg[i].opt)
+                if (wolopts & cfg[i].opt)
                         options |= cfg[i].mask;
                 RTL_W8(cfg[i].reg, options);
         }
 
         RTL_W8(Cfg9346, Cfg9346_Lock);
+}
+
+static int rtl8169_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
+{
+        struct rtl8169_private *tp = netdev_priv(dev);
+
+        spin_lock_irq(&tp->lock);
 
         if (wol->wolopts)
                 tp->features |= RTL_FEATURE_WOL;
         else
                 tp->features &= ~RTL_FEATURE_WOL;
+        __rtl8169_set_wol(tp, wol->wolopts);
         device_set_wakeup_enable(&tp->pci_dev->dev, wol->wolopts);
 
         spin_unlock_irq(&tp->lock);
@@ -1042,14 +1058,14 @@ static void rtl8169_vlan_rx_register(struct net_device *dev,
 }
 
 static int rtl8169_rx_vlan_skb(struct rtl8169_private *tp, struct RxDesc *desc,
-                               struct sk_buff *skb)
+                               struct sk_buff *skb, int polling)
 {
         u32 opts2 = le32_to_cpu(desc->opts2);
         struct vlan_group *vlgrp = tp->vlgrp;
         int ret;
 
         if (vlgrp && (opts2 & RxVlanTag)) {
-                vlan_hwaccel_receive_skb(skb, vlgrp, swab16(opts2 & 0xffff));
+                __vlan_hwaccel_rx(skb, vlgrp, swab16(opts2 & 0xffff), polling);
                 ret = 0;
         } else
                 ret = -1;
@@ -1066,7 +1082,7 @@ static inline u32 rtl8169_tx_vlan_tag(struct rtl8169_private *tp,
 }
 
 static int rtl8169_rx_vlan_skb(struct rtl8169_private *tp, struct RxDesc *desc,
-                               struct sk_buff *skb)
+                               struct sk_buff *skb, int polling)
 {
         return -1;
 }
@@ -3187,6 +3203,12 @@ rtl8169_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
 
         device_set_wakeup_enable(&pdev->dev, tp->features & RTL_FEATURE_WOL);
 
+        if (pci_dev_run_wake(pdev)) {
+                pm_runtime_set_active(&pdev->dev);
+                pm_runtime_enable(&pdev->dev);
+        }
+        pm_runtime_idle(&pdev->dev);
+
 out:
         return rc;
 
@@ -3209,10 +3231,18 @@ static void __devexit rtl8169_remove_one(struct pci_dev *pdev)
         struct net_device *dev = pci_get_drvdata(pdev);
         struct rtl8169_private *tp = netdev_priv(dev);
 
+        pm_runtime_get_sync(&pdev->dev);
+
         flush_scheduled_work();
 
         unregister_netdev(dev);
 
+        if (pci_dev_run_wake(pdev)) {
+                pm_runtime_disable(&pdev->dev);
+                pm_runtime_set_suspended(&pdev->dev);
+        }
+        pm_runtime_put_noidle(&pdev->dev);
+
         /* restore original MAC address */
         rtl_rar_set(tp, dev->perm_addr);
 
@@ -3239,6 +3269,7 @@ static int rtl8169_open(struct net_device *dev)
         struct pci_dev *pdev = tp->pci_dev;
         int retval = -ENOMEM;
 
+        pm_runtime_get_sync(&pdev->dev);
 
         /*
          * Note that we use a magic value here, its wierd I know
@@ -3259,7 +3290,7 @@ static int rtl8169_open(struct net_device *dev)
         tp->TxDescArray = pci_alloc_consistent(pdev, R8169_TX_RING_BYTES,
                                                &tp->TxPhyAddr);
         if (!tp->TxDescArray)
-                goto out;
+                goto err_pm_runtime_put;
 
         tp->RxDescArray = pci_alloc_consistent(pdev, R8169_RX_RING_BYTES,
                                                &tp->RxPhyAddr);
@@ -3286,6 +3317,9 @@ static int rtl8169_open(struct net_device *dev)
 
         rtl8169_request_timer(dev);
 
+        tp->saved_wolopts = 0;
+        pm_runtime_put_noidle(&pdev->dev);
+
         rtl8169_check_link_status(dev, tp, tp->mmio_addr);
 out:
         return retval;
@@ -3295,9 +3329,13 @@ err_release_ring_2:
 err_free_rx_1:
         pci_free_consistent(pdev, R8169_RX_RING_BYTES, tp->RxDescArray,
                             tp->RxPhyAddr);
+        tp->RxDescArray = NULL;
 err_free_tx_0:
         pci_free_consistent(pdev, R8169_TX_RING_BYTES, tp->TxDescArray,
                             tp->TxPhyAddr);
+        tp->TxDescArray = NULL;
+err_pm_runtime_put:
+        pm_runtime_put_noidle(&pdev->dev);
         goto out;
 }
 
@@ -4441,12 +4479,20 @@ out:
         return done;
 }
 
+/*
+ * Warning : rtl8169_rx_interrupt() might be called :
+ * 1) from NAPI (softirq) context
+ *      (polling = 1 : we should call netif_receive_skb())
+ * 2) from process context (rtl8169_reset_task())
+ *      (polling = 0 : we must call netif_rx() instead)
+ */
 static int rtl8169_rx_interrupt(struct net_device *dev,
                                 struct rtl8169_private *tp,
                                 void __iomem *ioaddr, u32 budget)
 {
         unsigned int cur_rx, rx_left;
         unsigned int delta, count;
+        int polling = (budget != ~(u32)0) ? 1 : 0;
 
         cur_rx = tp->cur_rx;
         rx_left = NUM_RX_DESC + tp->dirty_rx - cur_rx;
@@ -4508,8 +4554,12 @@ static int rtl8169_rx_interrupt(struct net_device *dev,
                         skb_put(skb, pkt_size);
                         skb->protocol = eth_type_trans(skb, dev);
 
-                        if (rtl8169_rx_vlan_skb(tp, desc, skb) < 0)
-                                netif_receive_skb(skb);
+                        if (rtl8169_rx_vlan_skb(tp, desc, skb, polling) < 0) {
+                                if (likely(polling))
+                                        netif_receive_skb(skb);
+                                else
+                                        netif_rx(skb);
+                        }
 
                         dev->stats.rx_bytes += pkt_size;
                         dev->stats.rx_packets++;
@@ -4704,6 +4754,8 @@ static int rtl8169_close(struct net_device *dev)
         struct rtl8169_private *tp = netdev_priv(dev);
         struct pci_dev *pdev = tp->pci_dev;
 
+        pm_runtime_get_sync(&pdev->dev);
+
         /* update counters before going down */
         rtl8169_update_counters(dev);
 
@@ -4718,6 +4770,8 @@ static int rtl8169_close(struct net_device *dev)
         tp->TxDescArray = NULL;
         tp->RxDescArray = NULL;
 
+        pm_runtime_put_sync(&pdev->dev);
+
         return 0;
 }
 
@@ -4743,12 +4797,12 @@ static void rtl_set_rx_mode(struct net_device *dev)
                 rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
                 mc_filter[1] = mc_filter[0] = 0xffffffff;
         } else {
-                struct dev_mc_list *mclist;
+                struct netdev_hw_addr *ha;
 
                 rx_mode = AcceptBroadcast | AcceptMyPhys;
                 mc_filter[1] = mc_filter[0] = 0;
-                netdev_for_each_mc_addr(mclist, dev) {
-                        int bit_nr = ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26;
+                netdev_for_each_mc_addr(ha, dev) {
+                        int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26;
                         mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
                         rx_mode |= AcceptMulticast;
                 }
@@ -4816,21 +4870,74 @@ static int rtl8169_suspend(struct device *device)
         return 0;
 }
 
+static void __rtl8169_resume(struct net_device *dev)
+{
+        netif_device_attach(dev);
+        rtl8169_schedule_work(dev, rtl8169_reset_task);
+}
+
 static int rtl8169_resume(struct device *device)
 {
         struct pci_dev *pdev = to_pci_dev(device);
         struct net_device *dev = pci_get_drvdata(pdev);
 
-        if (!netif_running(dev))
-                goto out;
+        if (netif_running(dev))
+                __rtl8169_resume(dev);
 
-        netif_device_attach(dev);
+        return 0;
+}
+
+static int rtl8169_runtime_suspend(struct device *device)
+{
+        struct pci_dev *pdev = to_pci_dev(device);
+        struct net_device *dev = pci_get_drvdata(pdev);
+        struct rtl8169_private *tp = netdev_priv(dev);
+
+        if (!tp->TxDescArray)
+                return 0;
+
+        spin_lock_irq(&tp->lock);
+        tp->saved_wolopts = __rtl8169_get_wol(tp);
+        __rtl8169_set_wol(tp, WAKE_ANY);
+        spin_unlock_irq(&tp->lock);
+
+        rtl8169_net_suspend(dev);
 
-        rtl8169_schedule_work(dev, rtl8169_reset_task);
-out:
         return 0;
 }
 
+static int rtl8169_runtime_resume(struct device *device)
+{
+        struct pci_dev *pdev = to_pci_dev(device);
+        struct net_device *dev = pci_get_drvdata(pdev);
+        struct rtl8169_private *tp = netdev_priv(dev);
+
+        if (!tp->TxDescArray)
+                return 0;
+
+        spin_lock_irq(&tp->lock);
+        __rtl8169_set_wol(tp, tp->saved_wolopts);
+        tp->saved_wolopts = 0;
+        spin_unlock_irq(&tp->lock);
+
+        __rtl8169_resume(dev);
+
+        return 0;
+}
+
+static int rtl8169_runtime_idle(struct device *device)
+{
+        struct pci_dev *pdev = to_pci_dev(device);
+        struct net_device *dev = pci_get_drvdata(pdev);
+        struct rtl8169_private *tp = netdev_priv(dev);
+
+        if (!tp->TxDescArray)
+                return 0;
+
+        rtl8169_check_link_status(dev, tp, tp->mmio_addr);
+        return -EBUSY;
+}
+
 static const struct dev_pm_ops rtl8169_pm_ops = {
         .suspend = rtl8169_suspend,
         .resume = rtl8169_resume,
@@ -4838,6 +4945,9 @@ static const struct dev_pm_ops rtl8169_pm_ops = {
         .thaw = rtl8169_resume,
         .poweroff = rtl8169_suspend,
         .restore = rtl8169_resume,
+        .runtime_suspend = rtl8169_runtime_suspend,
+        .runtime_resume = rtl8169_runtime_resume,
+        .runtime_idle = rtl8169_runtime_idle,
 };
 
 #define RTL8169_PM_OPS  (&rtl8169_pm_ops)