bnx2x: Allow ethtool to enable/disable loopback.

This patch updates the bnx2x_set_features() to handle loopback mode.
When enabled; it sets internal-MAC loopback.

Signed-off-by: Mahesh Bandewar <maheshb@google.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

1 files changed, 16 insertions, 0 deletions

diff --git a/drivers/net/bnx2x/bnx2x_cmn.c b/drivers/net/bnx2x/bnx2x_cmn.c
index 6ee6601b517..ca2bbc0e5d4 100644
--- a/drivers/net/bnx2x/bnx2x_cmn.c
+++ b/drivers/net/bnx2x/bnx2x_cmn.c
@@ -2840,15 +2840,31 @@ int bnx2x_set_features(struct net_device *dev, u32 features)
 {
         struct bnx2x *bp = netdev_priv(dev);
         u32 flags = bp->flags;
+        bool bnx2x_reload = false;
 
         if (features & NETIF_F_LRO)
                 flags |= TPA_ENABLE_FLAG;
         else
                 flags &= ~TPA_ENABLE_FLAG;
 
+        if (features & NETIF_F_LOOPBACK) {
+                if (bp->link_params.loopback_mode != LOOPBACK_BMAC) {
+                        bp->link_params.loopback_mode = LOOPBACK_BMAC;
+                        bnx2x_reload = true;
+                }
+        } else {
+                if (bp->link_params.loopback_mode != LOOPBACK_NONE) {
+                        bp->link_params.loopback_mode = LOOPBACK_NONE;
+                        bnx2x_reload = true;
+                }
+        }
+
         if (flags ^ bp->flags) {
                 bp->flags = flags;
+                bnx2x_reload = true;
+        }
 
+        if (bnx2x_reload) {
                 if (bp->recovery_state == BNX2X_RECOVERY_DONE)
                         return bnx2x_reload_if_running(dev);
                 /* else: bnx2x_nic_load() will be called at end of recovery */