[PATCH v2 14/18] net/r8169: implement promisc and allmulti modes

[Howard Wang]

Add support for promiscuous/allmulticast modes configuration.

Signed-off-by: Howard Wang <howard_w...@realsil.com.cn>
---
 drivers/net/r8169/r8169_ethdev.c | 68 ++++++++++++++++++++++++++++++++
 1 file changed, 68 insertions(+)

diff --git a/drivers/net/r8169/r8169_ethdev.c b/drivers/net/r8169/r8169_ethdev.c
index cf9ea4dca4..3e6bc570d6 100644
--- a/drivers/net/r8169/r8169_ethdev.c
+++ b/drivers/net/r8169/r8169_ethdev.c
@@ -43,6 +43,11 @@ static int rtl_dev_infos_get(struct rte_eth_dev *dev,
 static int rtl_dev_stats_get(struct rte_eth_dev *dev,
                              struct rte_eth_stats *rte_stats);
 static int rtl_dev_stats_reset(struct rte_eth_dev *dev);
+static int rtl_promiscuous_enable(struct rte_eth_dev *dev);
+static int rtl_promiscuous_disable(struct rte_eth_dev *dev);
+static int rtl_allmulticast_enable(struct rte_eth_dev *dev);
+static int rtl_allmulticast_disable(struct rte_eth_dev *dev);
+
 /*
  * The set of PCI devices this driver supports
  */
@@ -78,6 +83,11 @@ static const struct eth_dev_ops rtl_eth_dev_ops = {
        .dev_set_link_down    = rtl_dev_set_link_down,
        .dev_infos_get        = rtl_dev_infos_get,
 
+       .promiscuous_enable   = rtl_promiscuous_enable,
+       .promiscuous_disable  = rtl_promiscuous_disable,
+       .allmulticast_enable  = rtl_allmulticast_enable,
+       .allmulticast_disable = rtl_allmulticast_disable,
+
        .link_update          = rtl_dev_link_update,
 
        .stats_get            = rtl_dev_stats_get,
@@ -385,6 +395,64 @@ rtl_dev_infos_get(struct rte_eth_dev *dev, struct 
rte_eth_dev_info *dev_info)
        return 0;
 }
 
+static int
+rtl_promiscuous_enable(struct rte_eth_dev *dev)
+{
+       struct rtl_adapter *adapter = RTL_DEV_PRIVATE(dev);
+       struct rtl_hw *hw = &adapter->hw;
+
+       int rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys | 
AcceptAllPhys;
+
+       RTL_W32(hw, RxConfig, rx_mode | (RTL_R32(hw, RxConfig)));
+       rtl_allmulticast_enable(dev);
+
+       return 0;
+}
+
+static int
+rtl_promiscuous_disable(struct rte_eth_dev *dev)
+{
+       struct rtl_adapter *adapter = RTL_DEV_PRIVATE(dev);
+       struct rtl_hw *hw = &adapter->hw;
+       int rx_mode = ~AcceptAllPhys;
+
+       RTL_W32(hw, RxConfig, rx_mode & (RTL_R32(hw, RxConfig)));
+
+       if (dev->data->all_multicast == 1)
+               rtl_allmulticast_enable(dev);
+       else
+               rtl_allmulticast_disable(dev);
+
+       return 0;
+}
+
+static int
+rtl_allmulticast_enable(struct rte_eth_dev *dev)
+{
+       struct rtl_adapter *adapter = RTL_DEV_PRIVATE(dev);
+       struct rtl_hw *hw = &adapter->hw;
+
+       RTL_W32(hw, MAR0 + 0, 0xffffffff);
+       RTL_W32(hw, MAR0 + 4, 0xffffffff);
+
+       return 0;
+}
+
+static int
+rtl_allmulticast_disable(struct rte_eth_dev *dev)
+{
+       struct rtl_adapter *adapter = RTL_DEV_PRIVATE(dev);
+       struct rtl_hw *hw = &adapter->hw;
+
+       if (dev->data->promiscuous == 1)
+               return 0; /* Must remain in all_multicast mode */
+
+       RTL_W32(hw, MAR0 + 0, 0);
+       RTL_W32(hw, MAR0 + 4, 0);
+
+       return 0;
+}
+
 static int
 rtl_dev_stats_reset(struct rte_eth_dev *dev)
 {
-- 
2.34.1