[PATCH net-next 14/19] net: usb: aqc111: Implement set_rx_mode callback

Igor Russkikh Fri, 05 Oct 2018 03:26:15 -0700

From: Dmitry Bezrukov <dmitry.bezru...@aquantia.com>

Signed-off-by: Dmitry Bezrukov <dmitry.bezru...@aquantia.com>
Signed-off-by: Igor Russkikh <igor.russk...@aquantia.com>
---
 drivers/net/usb/aqc111.c | 72 ++++++++++++++++++++++++++++++++++++++++++++----
 drivers/net/usb/aqc111.h |  4 +++
 2 files changed, 71 insertions(+), 5 deletions(-)


diff --git a/drivers/net/usb/aqc111.c b/drivers/net/usb/aqc111.c
index f61fa7446b72..cc23c39beab3 100644
--- a/drivers/net/usb/aqc111.c
+++ b/drivers/net/usb/aqc111.c
@@ -11,6 +11,7 @@
 #include <linux/netdevice.h>
 #include <linux/mii.h>
 #include <linux/usb.h>
+#include <linux/crc32.h>
 #include <linux/if_vlan.h>
 #include <linux/usb/cdc.h>
 #include <linux/usb/usbnet.h>
@@ -139,6 +140,24 @@ static int aqc111_write_cmd(struct usbnet *dev, u8 cmd, 
u16 value,
        return __aqc111_write_cmd(dev, cmd, value, index, size, data, 0);
 }
 
+static void aqc111_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value,
+                                  u16 index, u16 size, void *data)
+{
+       if (size == 2) {
+               u16 buf;
+
+               buf = *((u16 *)data);
+               cpu_to_le16s(&buf);
+               usbnet_write_cmd_async(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR |
+                                      USB_RECIP_DEVICE, value, index, &buf,
+                                      size);
+       } else {
+               usbnet_write_cmd_async(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR |
+                                      USB_RECIP_DEVICE, value, index, data,
+                                      size);
+       }
+}
+
 static int aq_mdio_read_cmd(struct usbnet *dev, u16 value, u16 index,
                            u16 size, void *data)
 {
@@ -332,6 +351,44 @@ static int aqc111_set_mac_addr(struct net_device *net, 
void *p)
                                ETH_ALEN, net->dev_addr);
 }
 
+static void aqc111_set_rx_mode(struct net_device *net)
+{
+       struct usbnet *dev = netdev_priv(net);
+       struct aqc111_data *aqc111_data = (struct aqc111_data *)dev->data[0];
+       u8 *m_filter = ((u8 *)dev->data) + 12;
+       int mc_count = 0;
+
+       mc_count = netdev_mc_count(net);
+
+       aqc111_data->rxctl &= ~(SFR_RX_CTL_PRO | SFR_RX_CTL_AMALL |
+                               SFR_RX_CTL_AM);
+
+       if (net->flags & IFF_PROMISC) {
+               aqc111_data->rxctl |= SFR_RX_CTL_PRO;
+       } else if ((net->flags & IFF_ALLMULTI) || mc_count > AQ_MAX_MCAST) {
+               aqc111_data->rxctl |= SFR_RX_CTL_AMALL;
+       } else if (!netdev_mc_empty(net)) {
+               u32 crc_bits = 0;
+               struct netdev_hw_addr *ha = NULL;
+
+               memset(m_filter, 0, AQ_MCAST_FILTER_SIZE);
+               netdev_for_each_mc_addr(ha, net) {
+                       crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
+                       m_filter[crc_bits >> 3] |= BIT(crc_bits & 7);
+               }
+
+               aqc111_write_cmd_async(dev, AQ_ACCESS_MAC,
+                                      SFR_MULTI_FILTER_ARRY,
+                                      AQ_MCAST_FILTER_SIZE,
+                                      AQ_MCAST_FILTER_SIZE, m_filter);
+
+               aqc111_data->rxctl |= SFR_RX_CTL_AM;
+       }
+
+       aqc111_write_cmd_async(dev, AQ_ACCESS_MAC, SFR_RX_CTL,
+                              2, 2, &aqc111_data->rxctl);
+}
+
 static int aqc111_set_features(struct net_device *net,
                               netdev_features_t features)
 {
@@ -381,6 +438,7 @@ static const struct net_device_ops aqc111_netdev_ops = {
        .ndo_change_mtu         = aqc111_change_mtu,
        .ndo_set_mac_address    = aqc111_set_mac_addr,
        .ndo_validate_addr      = eth_validate_addr,
+       .ndo_set_rx_mode        = aqc111_set_rx_mode,
        .ndo_set_features       = aqc111_set_features,
 };
 
@@ -681,6 +739,7 @@ static int aqc111_link_reset(struct usbnet *dev)
                aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_ARC_CTRL, 1, 1, &reg8);
 
                reg16 = SFR_RX_CTL_IPE | SFR_RX_CTL_AB;
+               aqc111_data->rxctl = reg16;
                aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_RX_CTL, 2, 2, &reg16);
 
                reg8 = SFR_RX_PATH_READY;
@@ -701,6 +760,8 @@ static int aqc111_link_reset(struct usbnet *dev)
 
                aqc111_configure_csum_offload(dev);
 
+               aqc111_set_rx_mode(dev->net);
+
                aqc111_read_cmd(dev, AQ_ACCESS_MAC, SFR_MEDIUM_STATUS_MODE,
                                2, 2, &reg16);
 
@@ -712,8 +773,9 @@ static int aqc111_link_reset(struct usbnet *dev)
                aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_MEDIUM_STATUS_MODE,
                                 2, 2, &reg16);
 
-               reg16 = SFR_RX_CTL_IPE | SFR_RX_CTL_AB | SFR_RX_CTL_START;
-               aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_RX_CTL, 2, 2, &reg16);
+               aqc111_data->rxctl |= SFR_RX_CTL_START;
+               aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_RX_CTL,
+                                2, 2, &aqc111_data->rxctl);
 
                netif_carrier_on(dev->net);
        } else {
@@ -723,9 +785,9 @@ static int aqc111_link_reset(struct usbnet *dev)
                aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_MEDIUM_STATUS_MODE,
                                 2, 2, &reg16);
 
-               aqc111_read_cmd(dev, AQ_ACCESS_MAC, SFR_RX_CTL, 2, 2, &reg16);
-               reg16 &= ~SFR_RX_CTL_START;
-               aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_RX_CTL, 2, 2, &reg16);
+               aqc111_data->rxctl &= ~SFR_RX_CTL_START;
+               aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_RX_CTL,
+                                2, 2, &aqc111_data->rxctl);
 
                reg8 = SFR_BULK_OUT_FLUSH_EN | SFR_BULK_OUT_EFF_EN;
                aqc111_write_cmd(dev, AQ_ACCESS_MAC, SFR_BULK_OUT_CTRL,
diff --git a/drivers/net/usb/aqc111.h b/drivers/net/usb/aqc111.h
index 9cf357777df9..2f324ec66a65 100644
--- a/drivers/net/usb/aqc111.h
+++ b/drivers/net/usb/aqc111.h
@@ -12,6 +12,9 @@
 
 #define URB_SIZE       (1024 * 62)
 
+#define AQ_MCAST_FILTER_SIZE           8
+#define AQ_MAX_MCAST                   64
+
 #define AQ_ACCESS_MAC                  0x01
 #define AQ_FLASH_PARAMETERS            0x20
 #define AQ_PHY_POWER                   0x31
@@ -207,6 +210,7 @@ struct aqc111_phy_options {
 };
 
 struct aqc111_data {
+       u16 rxctl;
        u8 rx_checksum;
        u8 link_speed;
        u8 link;
-- 
2.7.4

[PATCH net-next 14/19] net: usb: aqc111: Implement set_rx_mode callback

Reply via email to