[PATCH net-next 7/7] net: aquantia: implement vlan offload configuration

[Igor Russkikh]

set_features should update flags and reinit hardware if
vlan offload settings were changed.

Signed-off-by: Igor Russkikh <igor.russk...@aquantia.com>
Tested-by: Nikita Danilov <ndani...@aquantia.com>
---
 .../net/ethernet/aquantia/atlantic/aq_main.c  | 34 +++++++++++++++----
 1 file changed, 27 insertions(+), 7 deletions(-)

diff --git a/drivers/net/ethernet/aquantia/atlantic/aq_main.c 
b/drivers/net/ethernet/aquantia/atlantic/aq_main.c
index 1ea8b77fc1a7..87112e50ee60 100644
--- a/drivers/net/ethernet/aquantia/atlantic/aq_main.c
+++ b/drivers/net/ethernet/aquantia/atlantic/aq_main.c
@@ -111,11 +111,16 @@ static int aq_ndev_change_mtu(struct net_device *ndev, 
int new_mtu)
 static int aq_ndev_set_features(struct net_device *ndev,
                                netdev_features_t features)
 {
+       bool is_vlan_rx_strip = !!(features & NETIF_F_HW_VLAN_CTAG_RX);
+       bool is_vlan_tx_insert = !!(features & NETIF_F_HW_VLAN_CTAG_TX);
        struct aq_nic_s *aq_nic = netdev_priv(ndev);
-       struct aq_nic_cfg_s *aq_cfg = aq_nic_get_cfg(aq_nic);
+       bool need_ndev_restart = false;
+       struct aq_nic_cfg_s *aq_cfg;
        bool is_lro = false;
        int err = 0;
 
+       aq_cfg = aq_nic_get_cfg(aq_nic);
+
        if (!(features & NETIF_F_NTUPLE)) {
                if (aq_nic->ndev->features & NETIF_F_NTUPLE) {
                        err = aq_clear_rxnfc_all_rules(aq_nic);
@@ -138,17 +143,32 @@ static int aq_ndev_set_features(struct net_device *ndev,
 
                if (aq_cfg->is_lro != is_lro) {
                        aq_cfg->is_lro = is_lro;
-
-                       if (netif_running(ndev)) {
-                               aq_ndev_close(ndev);
-                               aq_ndev_open(ndev);
-                       }
+                       need_ndev_restart = true;
                }
        }
-       if ((aq_nic->ndev->features ^ features) & NETIF_F_RXCSUM)
+
+       if ((aq_nic->ndev->features ^ features) & NETIF_F_RXCSUM) {
                err = aq_nic->aq_hw_ops->hw_set_offload(aq_nic->aq_hw,
                                                        aq_cfg);
 
+               if (unlikely(err))
+                       goto err_exit;
+       }
+
+       if (aq_cfg->is_vlan_rx_strip != is_vlan_rx_strip) {
+               aq_cfg->is_vlan_rx_strip = is_vlan_rx_strip;
+               need_ndev_restart = true;
+       }
+       if (aq_cfg->is_vlan_tx_insert != is_vlan_tx_insert) {
+               aq_cfg->is_vlan_tx_insert = is_vlan_tx_insert;
+               need_ndev_restart = true;
+       }
+
+       if (need_ndev_restart && netif_running(ndev)) {
+               aq_ndev_close(ndev);
+               aq_ndev_open(ndev);
+       }
+
 err_exit:
        return err;
 }
-- 
2.17.1