root/drivers/net/ethernet/huawei/hinic3/hinic3_netdev_ops.c
// SPDX-License-Identifier: GPL-2.0
// Copyright (c) Huawei Technologies Co., Ltd. 2025. All rights reserved.

#include <linux/etherdevice.h>
#include <linux/if_vlan.h>
#include <linux/netdevice.h>
#include <net/vxlan.h>

#include "hinic3_hwif.h"
#include "hinic3_nic_cfg.h"
#include "hinic3_nic_dev.h"
#include "hinic3_nic_io.h"
#include "hinic3_rss.h"
#include "hinic3_rx.h"
#include "hinic3_tx.h"

#define HINIC3_LRO_DEFAULT_COAL_PKT_SIZE  32
#define HINIC3_LRO_DEFAULT_TIME_LIMIT     16

#define VLAN_BITMAP_BITS_SIZE(nic_dev)    (sizeof(*(nic_dev)->vlan_bitmap) * 8)
#define VID_LINE(nic_dev, vid)  \
        ((vid) / VLAN_BITMAP_BITS_SIZE(nic_dev))
#define VID_COL(nic_dev, vid)  \
        ((vid) & (VLAN_BITMAP_BITS_SIZE(nic_dev) - 1))

/* try to modify the number of irq to the target number,
 * and return the actual number of irq.
 */
static u16 hinic3_qp_irq_change(struct net_device *netdev,
                                u16 dst_num_qp_irq)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct msix_entry *qps_msix_entries;
        u16 resp_irq_num, irq_num_gap, i;
        u16 idx;
        int err;

        qps_msix_entries = nic_dev->qps_msix_entries;
        if (dst_num_qp_irq > nic_dev->num_qp_irq) {
                irq_num_gap = dst_num_qp_irq - nic_dev->num_qp_irq;
                err = hinic3_alloc_irqs(nic_dev->hwdev, irq_num_gap,
                                        &qps_msix_entries[nic_dev->num_qp_irq],
                                        &resp_irq_num);
                if (err) {
                        netdev_err(netdev, "Failed to alloc irqs\n");
                        return nic_dev->num_qp_irq;
                }

                nic_dev->num_qp_irq += resp_irq_num;
        } else if (dst_num_qp_irq < nic_dev->num_qp_irq) {
                irq_num_gap = nic_dev->num_qp_irq - dst_num_qp_irq;
                for (i = 0; i < irq_num_gap; i++) {
                        idx = (nic_dev->num_qp_irq - i) - 1;
                        hinic3_free_irq(nic_dev->hwdev,
                                        qps_msix_entries[idx].vector);
                        qps_msix_entries[idx].vector = 0;
                        qps_msix_entries[idx].entry = 0;
                }
                nic_dev->num_qp_irq = dst_num_qp_irq;
        }

        return nic_dev->num_qp_irq;
}

static void hinic3_config_num_qps(struct net_device *netdev,
                                  struct hinic3_dyna_txrxq_params *q_params)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        u16 alloc_num_irq, cur_num_irq;
        u16 dst_num_irq;

        if (!test_bit(HINIC3_RSS_ENABLE, &nic_dev->flags))
                q_params->num_qps = 1;

        if (nic_dev->num_qp_irq >= q_params->num_qps)
                goto out;

        cur_num_irq = nic_dev->num_qp_irq;

        alloc_num_irq = hinic3_qp_irq_change(netdev, q_params->num_qps);
        if (alloc_num_irq < q_params->num_qps) {
                q_params->num_qps = alloc_num_irq;
                netdev_warn(netdev, "Can not get enough irqs, adjust num_qps to %u\n",
                            q_params->num_qps);

                /* The current irq may be in use, we must keep it */
                dst_num_irq = max_t(u16, cur_num_irq, q_params->num_qps);
                hinic3_qp_irq_change(netdev, dst_num_irq);
        }

out:
        netdev_dbg(netdev, "No need to change irqs, num_qps is %u\n",
                   q_params->num_qps);
}

static int hinic3_setup_num_qps(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);

        nic_dev->num_qp_irq = 0;

        nic_dev->qps_msix_entries = kzalloc_objs(struct msix_entry,
                                                 nic_dev->max_qps);
        if (!nic_dev->qps_msix_entries)
                return -ENOMEM;

        hinic3_config_num_qps(netdev, &nic_dev->q_params);

        return 0;
}

static void hinic3_destroy_num_qps(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        u16 i;

        for (i = 0; i < nic_dev->num_qp_irq; i++)
                hinic3_free_irq(nic_dev->hwdev,
                                nic_dev->qps_msix_entries[i].vector);

        kfree(nic_dev->qps_msix_entries);
}

static int hinic3_alloc_txrxq_resources(struct net_device *netdev,
                                        struct hinic3_dyna_txrxq_params *q_params)
{
        int err;

        q_params->txqs_res = kzalloc_objs(*q_params->txqs_res,
                                          q_params->num_qps);
        if (!q_params->txqs_res)
                return -ENOMEM;

        q_params->rxqs_res = kzalloc_objs(*q_params->rxqs_res,
                                          q_params->num_qps);
        if (!q_params->rxqs_res) {
                err = -ENOMEM;
                goto err_free_txqs_res_arr;
        }

        q_params->irq_cfg = kzalloc_objs(*q_params->irq_cfg, q_params->num_qps);
        if (!q_params->irq_cfg) {
                err = -ENOMEM;
                goto err_free_rxqs_res_arr;
        }

        err = hinic3_alloc_txqs_res(netdev, q_params->num_qps,
                                    q_params->sq_depth, q_params->txqs_res);
        if (err) {
                netdev_err(netdev, "Failed to alloc txqs resource\n");
                goto err_free_irq_cfg;
        }

        err = hinic3_alloc_rxqs_res(netdev, q_params->num_qps,
                                    q_params->rq_depth, q_params->rxqs_res);
        if (err) {
                netdev_err(netdev, "Failed to alloc rxqs resource\n");
                goto err_free_txqs_res;
        }

        return 0;

err_free_txqs_res:
        hinic3_free_txqs_res(netdev, q_params->num_qps, q_params->sq_depth,
                             q_params->txqs_res);
err_free_irq_cfg:
        kfree(q_params->irq_cfg);
        q_params->irq_cfg = NULL;
err_free_rxqs_res_arr:
        kfree(q_params->rxqs_res);
        q_params->rxqs_res = NULL;
err_free_txqs_res_arr:
        kfree(q_params->txqs_res);
        q_params->txqs_res = NULL;

        return err;
}

static void hinic3_free_txrxq_resources(struct net_device *netdev,
                                        struct hinic3_dyna_txrxq_params *q_params)
{
        hinic3_free_rxqs_res(netdev, q_params->num_qps, q_params->rq_depth,
                             q_params->rxqs_res);
        hinic3_free_txqs_res(netdev, q_params->num_qps, q_params->sq_depth,
                             q_params->txqs_res);

        kfree(q_params->irq_cfg);
        q_params->irq_cfg = NULL;

        kfree(q_params->rxqs_res);
        q_params->rxqs_res = NULL;

        kfree(q_params->txqs_res);
        q_params->txqs_res = NULL;
}

static int hinic3_configure_txrxqs(struct net_device *netdev,
                                   struct hinic3_dyna_txrxq_params *q_params)
{
        int err;

        err = hinic3_configure_txqs(netdev, q_params->num_qps,
                                    q_params->sq_depth, q_params->txqs_res);
        if (err) {
                netdev_err(netdev, "Failed to configure txqs\n");
                return err;
        }

        err = hinic3_configure_rxqs(netdev, q_params->num_qps,
                                    q_params->rq_depth, q_params->rxqs_res);
        if (err) {
                netdev_err(netdev, "Failed to configure rxqs\n");
                return err;
        }

        return 0;
}

static int hinic3_configure(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        int err;

        netdev->min_mtu = HINIC3_MIN_MTU_SIZE;
        netdev->max_mtu = HINIC3_MAX_JUMBO_FRAME_SIZE;
        err = hinic3_set_port_mtu(netdev, netdev->mtu);
        if (err) {
                netdev_err(netdev, "Failed to set mtu\n");
                return err;
        }

        /* Ensure DCB is disabled */
        hinic3_sync_dcb_state(nic_dev->hwdev, 1, 0);

        if (test_bit(HINIC3_RSS_ENABLE, &nic_dev->flags)) {
                err = hinic3_rss_init(netdev);
                if (err) {
                        netdev_err(netdev, "Failed to init rss\n");
                        return err;
                }
        }

        return 0;
}

static void hinic3_remove_configure(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);

        if (test_bit(HINIC3_RSS_ENABLE, &nic_dev->flags))
                hinic3_rss_uninit(netdev);
}

static int hinic3_alloc_channel_resources(struct net_device *netdev,
                                          struct hinic3_dyna_qp_params *qp_params,
                                          struct hinic3_dyna_txrxq_params *trxq_params)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        int err;

        qp_params->num_qps = trxq_params->num_qps;
        qp_params->sq_depth = trxq_params->sq_depth;
        qp_params->rq_depth = trxq_params->rq_depth;

        err = hinic3_alloc_qps(nic_dev, qp_params);
        if (err) {
                netdev_err(netdev, "Failed to alloc qps\n");
                return err;
        }

        err = hinic3_alloc_txrxq_resources(netdev, trxq_params);
        if (err) {
                netdev_err(netdev, "Failed to alloc txrxq resources\n");
                hinic3_free_qps(nic_dev, qp_params);
                return err;
        }

        return 0;
}

static void hinic3_free_channel_resources(struct net_device *netdev,
                                          struct hinic3_dyna_qp_params *qp_params,
                                          struct hinic3_dyna_txrxq_params *trxq_params)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);

        hinic3_free_txrxq_resources(netdev, trxq_params);
        hinic3_free_qps(nic_dev, qp_params);
}

static int hinic3_open_channel(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        int err;

        err = hinic3_init_qp_ctxts(nic_dev);
        if (err) {
                netdev_err(netdev, "Failed to init qps\n");
                return err;
        }

        err = hinic3_configure_txrxqs(netdev, &nic_dev->q_params);
        if (err) {
                netdev_err(netdev, "Failed to configure txrxqs\n");
                goto err_free_qp_ctxts;
        }

        err = hinic3_qps_irq_init(netdev);
        if (err) {
                netdev_err(netdev, "Failed to init txrxq irq\n");
                goto err_free_qp_ctxts;
        }

        err = hinic3_configure(netdev);
        if (err) {
                netdev_err(netdev, "Failed to configure device resources\n");
                goto err_uninit_qps_irq;
        }

        return 0;

err_uninit_qps_irq:
        hinic3_qps_irq_uninit(netdev);
err_free_qp_ctxts:
        hinic3_free_qp_ctxts(nic_dev);

        return err;
}

static void hinic3_close_channel(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);

        hinic3_remove_configure(netdev);
        hinic3_qps_irq_uninit(netdev);
        hinic3_free_qp_ctxts(nic_dev);
}

static int hinic3_maybe_set_port_state(struct net_device *netdev, bool enable)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        int err;

        mutex_lock(&nic_dev->port_state_mutex);
        err = hinic3_set_port_enable(nic_dev->hwdev, enable);
        mutex_unlock(&nic_dev->port_state_mutex);

        return err;
}

static void hinic3_print_link_message(struct net_device *netdev,
                                      bool link_status_up)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);

        if (nic_dev->link_status_up == link_status_up)
                return;

        nic_dev->link_status_up = link_status_up;

        netdev_dbg(netdev, "Link is %s\n", str_up_down(link_status_up));
}

static int hinic3_vport_up(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        bool link_status_up;
        u16 glb_func_id;
        int err;

        glb_func_id = hinic3_global_func_id(nic_dev->hwdev);
        err = hinic3_set_vport_enable(nic_dev->hwdev, glb_func_id, true);
        if (err) {
                netdev_err(netdev, "Failed to enable vport\n");
                goto err_flush_qps_res;
        }

        err = hinic3_maybe_set_port_state(netdev, true);
        if (err) {
                netdev_err(netdev, "Failed to enable port\n");
                goto err_disable_vport;
        }

        err = netif_set_real_num_queues(netdev, nic_dev->q_params.num_qps,
                                        nic_dev->q_params.num_qps);
        if (err) {
                netdev_err(netdev, "Failed to set real number of queues\n");
                goto err_disable_vport;
        }
        netif_tx_start_all_queues(netdev);

        err = hinic3_get_link_status(nic_dev->hwdev, &link_status_up);
        if (!err && link_status_up)
                netif_carrier_on(netdev);

        hinic3_print_link_message(netdev, link_status_up);

        return 0;

err_disable_vport:
        hinic3_set_vport_enable(nic_dev->hwdev, glb_func_id, false);
err_flush_qps_res:
        hinic3_flush_qps_res(nic_dev->hwdev);
        /* wait to guarantee that no packets will be sent to host */
        msleep(100);

        return err;
}

static void hinic3_vport_down(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        u16 glb_func_id;

        netif_carrier_off(netdev);
        netif_tx_disable(netdev);

        glb_func_id = hinic3_global_func_id(nic_dev->hwdev);
        hinic3_set_vport_enable(nic_dev->hwdev, glb_func_id, false);

        hinic3_flush_txqs(netdev);
        /* wait to guarantee that no packets will be sent to host */
        msleep(100);
        hinic3_flush_qps_res(nic_dev->hwdev);
}

static int hinic3_open(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct hinic3_dyna_qp_params qp_params;
        int err;

        if (test_bit(HINIC3_INTF_UP, &nic_dev->flags)) {
                netdev_dbg(netdev, "Netdev already open, do nothing\n");
                return 0;
        }

        err = hinic3_init_nicio_res(nic_dev);
        if (err) {
                netdev_err(netdev, "Failed to init nicio resources\n");
                return err;
        }

        err = hinic3_setup_num_qps(netdev);
        if (err) {
                netdev_err(netdev, "Failed to setup num_qps\n");
                goto err_free_nicio_res;
        }

        err = hinic3_alloc_channel_resources(netdev, &qp_params,
                                             &nic_dev->q_params);
        if (err)
                goto err_destroy_num_qps;

        hinic3_init_qps(nic_dev, &qp_params);

        err = hinic3_open_channel(netdev);
        if (err)
                goto err_uninit_qps;

        err = hinic3_vport_up(netdev);
        if (err)
                goto err_close_channel;

        set_bit(HINIC3_INTF_UP, &nic_dev->flags);

        return 0;

err_close_channel:
        hinic3_close_channel(netdev);
err_uninit_qps:
        hinic3_uninit_qps(nic_dev, &qp_params);
        hinic3_free_channel_resources(netdev, &qp_params, &nic_dev->q_params);
err_destroy_num_qps:
        hinic3_destroy_num_qps(netdev);
err_free_nicio_res:
        hinic3_free_nicio_res(nic_dev);

        return err;
}

static int hinic3_close(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct hinic3_dyna_qp_params qp_params;

        if (!test_and_clear_bit(HINIC3_INTF_UP, &nic_dev->flags)) {
                netdev_dbg(netdev, "Netdev already close, do nothing\n");
                return 0;
        }

        hinic3_vport_down(netdev);
        hinic3_close_channel(netdev);
        hinic3_uninit_qps(nic_dev, &qp_params);
        hinic3_free_channel_resources(netdev, &qp_params, &nic_dev->q_params);

        return 0;
}

#define SET_FEATURES_OP_STR(op)  ((op) ? "Enable" : "Disable")

static int hinic3_set_feature_rx_csum(struct net_device *netdev,
                                      netdev_features_t wanted_features,
                                      netdev_features_t features,
                                      netdev_features_t *failed_features)
{
        netdev_features_t changed = wanted_features ^ features;
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct hinic3_hwdev *hwdev = nic_dev->hwdev;

        if (changed & NETIF_F_RXCSUM)
                dev_dbg(hwdev->dev, "%s rx csum success\n",
                        SET_FEATURES_OP_STR(wanted_features & NETIF_F_RXCSUM));

        return 0;
}

static int hinic3_set_feature_tso(struct net_device *netdev,
                                  netdev_features_t wanted_features,
                                  netdev_features_t features,
                                  netdev_features_t *failed_features)
{
        netdev_features_t changed = wanted_features ^ features;
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct hinic3_hwdev *hwdev = nic_dev->hwdev;

        if (changed & NETIF_F_TSO)
                dev_dbg(hwdev->dev, "%s tso success\n",
                        SET_FEATURES_OP_STR(wanted_features & NETIF_F_TSO));

        return 0;
}

static int hinic3_set_feature_lro(struct net_device *netdev,
                                  netdev_features_t wanted_features,
                                  netdev_features_t features,
                                  netdev_features_t *failed_features)
{
        netdev_features_t changed = wanted_features ^ features;
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct hinic3_hwdev *hwdev = nic_dev->hwdev;
        bool en = !!(wanted_features & NETIF_F_LRO);
        int err;

        if (!(changed & NETIF_F_LRO))
                return 0;

        err = hinic3_set_rx_lro_state(hwdev, en,
                                      HINIC3_LRO_DEFAULT_TIME_LIMIT,
                                      HINIC3_LRO_DEFAULT_COAL_PKT_SIZE);
        if (err) {
                dev_err(hwdev->dev, "%s lro failed\n", SET_FEATURES_OP_STR(en));
                *failed_features |= NETIF_F_LRO;
        }

        return err;
}

static int hinic3_set_feature_rx_cvlan(struct net_device *netdev,
                                       netdev_features_t wanted_features,
                                       netdev_features_t features,
                                       netdev_features_t *failed_features)
{
        bool en = !!(wanted_features & NETIF_F_HW_VLAN_CTAG_RX);
        netdev_features_t changed = wanted_features ^ features;
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct hinic3_hwdev *hwdev = nic_dev->hwdev;
        int err;

        if (!(changed & NETIF_F_HW_VLAN_CTAG_RX))
                return 0;

        err = hinic3_set_rx_vlan_offload(hwdev, en);
        if (err) {
                dev_err(hwdev->dev, "%s rx vlan offload failed\n",
                        SET_FEATURES_OP_STR(en));
                *failed_features |= NETIF_F_HW_VLAN_CTAG_RX;
        }

        return err;
}

static int hinic3_set_feature_vlan_filter(struct net_device *netdev,
                                          netdev_features_t wanted_features,
                                          netdev_features_t features,
                                          netdev_features_t *failed_features)
{
        bool en = !!(wanted_features & NETIF_F_HW_VLAN_CTAG_FILTER);
        netdev_features_t changed = wanted_features ^ features;
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct hinic3_hwdev *hwdev = nic_dev->hwdev;
        int err;

        if (!(changed & NETIF_F_HW_VLAN_CTAG_FILTER))
                return 0;

        err = hinic3_set_vlan_filter(hwdev, en);
        if (err) {
                dev_err(hwdev->dev, "%s rx vlan filter failed\n",
                        SET_FEATURES_OP_STR(en));
                *failed_features |= NETIF_F_HW_VLAN_CTAG_FILTER;
        }

        return err;
}

static int hinic3_set_features(struct net_device *netdev,
                               netdev_features_t curr,
                               netdev_features_t wanted)
{
        netdev_features_t failed = 0;
        int err;

        err = hinic3_set_feature_rx_csum(netdev, wanted, curr, &failed) |
              hinic3_set_feature_tso(netdev, wanted, curr, &failed) |
              hinic3_set_feature_lro(netdev, wanted, curr, &failed) |
              hinic3_set_feature_rx_cvlan(netdev, wanted, curr, &failed) |
              hinic3_set_feature_vlan_filter(netdev, wanted, curr, &failed);
        if (err) {
                netdev->features = wanted ^ failed;
                return err;
        }

        return 0;
}

static int hinic3_ndo_set_features(struct net_device *netdev,
                                   netdev_features_t features)
{
        return hinic3_set_features(netdev, netdev->features, features);
}

static netdev_features_t hinic3_fix_features(struct net_device *netdev,
                                             netdev_features_t features)
{
        netdev_features_t features_tmp = features;

        /* If Rx checksum is disabled, then LRO should also be disabled */
        if (!(features_tmp & NETIF_F_RXCSUM))
                features_tmp &= ~NETIF_F_LRO;

        return features_tmp;
}

static netdev_features_t hinic3_features_check(struct sk_buff *skb,
                                               struct net_device *dev,
                                               netdev_features_t features)
{
        features = vlan_features_check(skb, features);
        features = vxlan_features_check(skb, features);

        return features;
}

int hinic3_set_hw_features(struct net_device *netdev)
{
        netdev_features_t wanted, curr;

        wanted = netdev->features;
        /* fake current features so all wanted are enabled */
        curr = ~wanted;

        return hinic3_set_features(netdev, curr, wanted);
}

static int hinic3_change_mtu(struct net_device *netdev, int new_mtu)
{
        int err;

        err = hinic3_set_port_mtu(netdev, new_mtu);
        if (err) {
                netdev_err(netdev, "Failed to change port mtu to %d\n",
                           new_mtu);
                return err;
        }

        netdev_dbg(netdev, "Change mtu from %u to %d\n", netdev->mtu, new_mtu);
        WRITE_ONCE(netdev->mtu, new_mtu);

        return 0;
}

static int hinic3_set_mac_addr(struct net_device *netdev, void *addr)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct sockaddr *saddr = addr;
        int err;

        if (!is_valid_ether_addr(saddr->sa_data))
                return -EADDRNOTAVAIL;

        if (ether_addr_equal(netdev->dev_addr, saddr->sa_data))
                return 0;

        err = hinic3_update_mac(nic_dev->hwdev, netdev->dev_addr,
                                saddr->sa_data, 0,
                                hinic3_global_func_id(nic_dev->hwdev));

        if (err)
                return err;

        eth_hw_addr_set(netdev, saddr->sa_data);

        return 0;
}

static int hinic3_vlan_rx_add_vid(struct net_device *netdev,
                                  __be16 proto, u16 vid)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        unsigned long *vlan_bitmap = nic_dev->vlan_bitmap;
        u32 column, row;
        u16 func_id;
        int err;

        column = VID_COL(nic_dev, vid);
        row = VID_LINE(nic_dev, vid);

        func_id = hinic3_global_func_id(nic_dev->hwdev);

        err = hinic3_add_vlan(nic_dev->hwdev, vid, func_id);
        if (err) {
                netdev_err(netdev, "Failed to add vlan %u\n", vid);
                goto out;
        }

        set_bit(column, &vlan_bitmap[row]);
        netdev_dbg(netdev, "Add vlan %u\n", vid);

out:
        return err;
}

static int hinic3_vlan_rx_kill_vid(struct net_device *netdev,
                                   __be16 proto, u16 vid)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        unsigned long *vlan_bitmap = nic_dev->vlan_bitmap;
        u32 column, row;
        u16 func_id;
        int err;

        column  = VID_COL(nic_dev, vid);
        row = VID_LINE(nic_dev, vid);

        func_id = hinic3_global_func_id(nic_dev->hwdev);
        err = hinic3_del_vlan(nic_dev->hwdev, vid, func_id);
        if (err) {
                netdev_err(netdev, "Failed to delete vlan %u\n", vid);
                goto out;
        }

        clear_bit(column, &vlan_bitmap[row]);
        netdev_dbg(netdev, "Remove vlan %u\n", vid);

out:
        return err;
}

static void hinic3_tx_timeout(struct net_device *netdev, unsigned int txqueue)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        struct hinic3_io_queue *sq;
        u16 sw_pi, hw_ci;

        sq = nic_dev->txqs[txqueue].sq;
        sw_pi = hinic3_get_sq_local_pi(sq);
        hw_ci = hinic3_get_sq_hw_ci(sq);
        netdev_dbg(netdev,
                   "txq%u: sw_pi: %u, hw_ci: %u, sw_ci: %u, napi->state: 0x%lx.\n",
                   txqueue, sw_pi, hw_ci, hinic3_get_sq_local_ci(sq),
                   nic_dev->q_params.irq_cfg[txqueue].napi.state);

        if (sw_pi != hw_ci)
                set_bit(HINIC3_EVENT_WORK_TX_TIMEOUT, &nic_dev->event_flag);
}

static void hinic3_get_stats64(struct net_device *netdev,
                               struct rtnl_link_stats64 *stats)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);
        u64 bytes, packets, dropped, errors;
        struct hinic3_txq_stats *txq_stats;
        struct hinic3_rxq_stats *rxq_stats;
        struct hinic3_txq *txq;
        struct hinic3_rxq *rxq;
        unsigned int start;
        int i;

        bytes = 0;
        packets = 0;
        dropped = 0;
        for (i = 0; i < nic_dev->max_qps; i++) {
                if (!nic_dev->txqs)
                        break;

                txq = &nic_dev->txqs[i];
                txq_stats = &txq->txq_stats;
                do {
                        start = u64_stats_fetch_begin(&txq_stats->syncp);
                        bytes += txq_stats->bytes;
                        packets += txq_stats->packets;
                        dropped += txq_stats->dropped;
                } while (u64_stats_fetch_retry(&txq_stats->syncp, start));
        }
        stats->tx_packets = packets;
        stats->tx_bytes   = bytes;
        stats->tx_dropped = dropped;

        bytes = 0;
        packets = 0;
        errors = 0;
        dropped = 0;
        for (i = 0; i < nic_dev->max_qps; i++) {
                if (!nic_dev->rxqs)
                        break;

                rxq = &nic_dev->rxqs[i];
                rxq_stats = &rxq->rxq_stats;
                do {
                        start = u64_stats_fetch_begin(&rxq_stats->syncp);
                        bytes += rxq_stats->bytes;
                        packets += rxq_stats->packets;
                        errors += rxq_stats->csum_errors +
                                rxq_stats->other_errors;
                        dropped += rxq_stats->dropped;
                } while (u64_stats_fetch_retry(&rxq_stats->syncp, start));
        }
        stats->rx_packets = packets;
        stats->rx_bytes   = bytes;
        stats->rx_errors  = errors;
        stats->rx_dropped = dropped;
}

static void hinic3_nic_set_rx_mode(struct net_device *netdev)
{
        struct hinic3_nic_dev *nic_dev = netdev_priv(netdev);

        if (netdev_uc_count(netdev) != nic_dev->netdev_uc_cnt ||
            netdev_mc_count(netdev) != nic_dev->netdev_mc_cnt) {
                set_bit(HINIC3_UPDATE_MAC_FILTER, &nic_dev->flags);
                nic_dev->netdev_uc_cnt = netdev_uc_count(netdev);
                nic_dev->netdev_mc_cnt = netdev_mc_count(netdev);
        }

        queue_work(nic_dev->workq, &nic_dev->rx_mode_work);
}

static const struct net_device_ops hinic3_netdev_ops = {
        .ndo_open             = hinic3_open,
        .ndo_stop             = hinic3_close,
        .ndo_set_features     = hinic3_ndo_set_features,
        .ndo_fix_features     = hinic3_fix_features,
        .ndo_features_check   = hinic3_features_check,
        .ndo_change_mtu       = hinic3_change_mtu,
        .ndo_set_mac_address  = hinic3_set_mac_addr,
        .ndo_validate_addr    = eth_validate_addr,
        .ndo_vlan_rx_add_vid  = hinic3_vlan_rx_add_vid,
        .ndo_vlan_rx_kill_vid = hinic3_vlan_rx_kill_vid,
        .ndo_tx_timeout       = hinic3_tx_timeout,
        .ndo_get_stats64      = hinic3_get_stats64,
        .ndo_set_rx_mode      = hinic3_nic_set_rx_mode,
        .ndo_start_xmit       = hinic3_xmit_frame,
};

void hinic3_set_netdev_ops(struct net_device *netdev)
{
        netdev->netdev_ops = &hinic3_netdev_ops;
}