provided vlan filter, vlan offload ops.
Signed-off-by: Junlong Wang <wang.junlong1@zte.com.cn>
---
doc/guides/nics/features/zxdh.ini | 3 +
doc/guides/nics/zxdh.rst | 3 +
drivers/net/zxdh/zxdh_ethdev.c | 40 +++++-
drivers/net/zxdh/zxdh_ethdev_ops.c | 223 +++++++++++++++++++++++++++++
drivers/net/zxdh/zxdh_ethdev_ops.h | 2 +
drivers/net/zxdh/zxdh_msg.h | 22 +++
drivers/net/zxdh/zxdh_rxtx.c | 18 +++
drivers/net/zxdh/zxdh_tables.c | 99 +++++++++++++
drivers/net/zxdh/zxdh_tables.h | 10 +-
9 files changed, 417 insertions(+), 3 deletions(-)
diff --git a/doc/guides/nics/features/zxdh.ini b/doc/guides/nics/features/zxdh.ini
index e9b237e102..6fb006c2da 100644
--- a/doc/guides/nics/features/zxdh.ini
+++ b/doc/guides/nics/features/zxdh.ini
@@ -16,3 +16,6 @@ Unicast MAC filter = Y
Multicast MAC filter = Y
Promiscuous mode = Y
Allmulticast mode = Y
+VLAN filter = Y
+VLAN offload = Y
+QinQ offload = Y
diff --git a/doc/guides/nics/zxdh.rst b/doc/guides/nics/zxdh.rst
index 0399df1302..3a7585d123 100644
--- a/doc/guides/nics/zxdh.rst
+++ b/doc/guides/nics/zxdh.rst
@@ -28,6 +28,9 @@ Features of the ZXDH PMD are:
- Multicast MAC filter
- Promiscuous mode
- Multicast mode
+- VLAN filter and VLAN offload
+- VLAN stripping and inserting
+- QINQ stripping and inserting
Driver compilation and testing
diff --git a/drivers/net/zxdh/zxdh_ethdev.c b/drivers/net/zxdh/zxdh_ethdev.c
index 1d64b877c1..cc32b467a9 100644
--- a/drivers/net/zxdh/zxdh_ethdev.c
+++ b/drivers/net/zxdh/zxdh_ethdev.c
@@ -758,6 +758,34 @@ zxdh_alloc_queues(struct rte_eth_dev *dev, uint16_t nr_vq)
return 0;
}
+static int
+zxdh_vlan_offload_configure(struct rte_eth_dev *dev)
+{
+ int ret;
+ int mask = RTE_ETH_VLAN_STRIP_MASK | RTE_ETH_VLAN_FILTER_MASK | RTE_ETH_QINQ_STRIP_MASK;
+
+ ret = zxdh_dev_vlan_offload_set(dev, mask);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "vlan offload set error");
+ return -1;
+ }
+
+ return 0;
+}
+
+static int
+zxdh_dev_conf_offload(struct rte_eth_dev *dev)
+{
+ int ret = 0;
+
+ ret = zxdh_vlan_offload_configure(dev);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "zxdh_vlan_offload_configure failed");
+ return ret;
+ }
+
+ return 0;
+}
static int32_t
zxdh_dev_configure(struct rte_eth_dev *dev)
@@ -815,7 +843,7 @@ zxdh_dev_configure(struct rte_eth_dev *dev)
nr_vq = dev->data->nb_rx_queues + dev->data->nb_tx_queues;
if (nr_vq == hw->queue_num)
- return 0;
+ goto end;
PMD_DRV_LOG(DEBUG, "queue changed need reset ");
/* Reset the device although not necessary at startup */
@@ -847,6 +875,8 @@ zxdh_dev_configure(struct rte_eth_dev *dev)
zxdh_pci_reinit_complete(hw);
+end:
+ zxdh_dev_conf_offload(dev);
return ret;
}
@@ -1067,6 +1097,8 @@ static const struct eth_dev_ops zxdh_eth_dev_ops = {
.promiscuous_disable = zxdh_dev_promiscuous_disable,
.allmulticast_enable = zxdh_dev_allmulticast_enable,
.allmulticast_disable = zxdh_dev_allmulticast_disable,
+ .vlan_filter_set = zxdh_dev_vlan_filter_set,
+ .vlan_offload_set = zxdh_dev_vlan_offload_set,
};
static int32_t
@@ -1325,6 +1357,12 @@ zxdh_tables_init(struct rte_eth_dev *dev)
return ret;
}
+ ret = zxdh_vlan_filter_table_init(dev);
+ if (ret) {
+ PMD_DRV_LOG(ERR, " vlan filter table init failed");
+ return ret;
+ }
+
return ret;
}
diff --git a/drivers/net/zxdh/zxdh_ethdev_ops.c b/drivers/net/zxdh/zxdh_ethdev_ops.c
index aed4e6410c..94c5e6dbc8 100644
--- a/drivers/net/zxdh/zxdh_ethdev_ops.c
+++ b/drivers/net/zxdh/zxdh_ethdev_ops.c
@@ -2,6 +2,8 @@
* Copyright(c) 2024 ZTE Corporation
*/
+#include <rte_malloc.h>
+
#include "zxdh_ethdev.h"
#include "zxdh_pci.h"
#include "zxdh_msg.h"
@@ -9,6 +11,8 @@
#include "zxdh_tables.h"
#include "zxdh_logs.h"
+#define ZXDH_VLAN_FILTER_GROUPS 64
+
static int32_t zxdh_config_port_status(struct rte_eth_dev *dev, uint16_t link_status)
{
struct zxdh_hw *hw = dev->data->dev_private;
@@ -529,3 +533,222 @@ int zxdh_dev_allmulticast_disable(struct rte_eth_dev *dev)
hw->allmulti_status = 0;
return ret;
}
+
+int
+zxdh_dev_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
+{
+ struct zxdh_hw *hw = (struct zxdh_hw *)dev->data->dev_private;
+ uint16_t idx = 0;
+ uint16_t bit_idx = 0;
+ uint8_t msg_type = 0;
+ int ret = 0;
+
+ vlan_id &= RTE_VLAN_ID_MASK;
+ if (vlan_id == 0 || vlan_id == RTE_ETHER_MAX_VLAN_ID) {
+ PMD_DRV_LOG(ERR, "vlan id (%d) is reserved", vlan_id);
+ return -EINVAL;
+ }
+
+ if (dev->data->dev_started == 0) {
+ PMD_DRV_LOG(ERR, "vlan_filter dev not start");
+ return -1;
+ }
+
+ idx = vlan_id / ZXDH_VLAN_FILTER_GROUPS;
+ bit_idx = vlan_id % ZXDH_VLAN_FILTER_GROUPS;
+
+ if (on) {
+ if (dev->data->vlan_filter_conf.ids[idx] & (1ULL << bit_idx)) {
+ PMD_DRV_LOG(ERR, "vlan:%d has already added.", vlan_id);
+ return 0;
+ }
+ msg_type = ZXDH_VLAN_FILTER_ADD;
+ } else {
+ if (!(dev->data->vlan_filter_conf.ids[idx] & (1ULL << bit_idx))) {
+ PMD_DRV_LOG(ERR, "vlan:%d has already deleted.", vlan_id);
+ return 0;
+ }
+ msg_type = ZXDH_VLAN_FILTER_DEL;
+ }
+
+ if (hw->is_pf) {
+ ret = zxdh_vlan_filter_table_set(hw->vport.vport, vlan_id, on);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "vlan_id:%d table set failed.", vlan_id);
+ return -1;
+ }
+ } else {
+ struct zxdh_msg_info msg = {0};
+ zxdh_msg_head_build(hw, msg_type, &msg);
+ msg.data.vlan_filter_msg.vlan_id = vlan_id;
+ ret = zxdh_vf_send_msg_to_pf(dev, &msg, sizeof(struct zxdh_msg_info), NULL, 0);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "Failed to send msg: port 0x%x msg type %d ",
+ hw->vport.vport, msg_type);
+ return ret;
+ }
+ }
+
+ if (on)
+ dev->data->vlan_filter_conf.ids[idx] |= (1ULL << bit_idx);
+ else
+ dev->data->vlan_filter_conf.ids[idx] &= ~(1ULL << bit_idx);
+
+ return 0;
+}
+
+int
+zxdh_dev_vlan_offload_set(struct rte_eth_dev *dev, int mask)
+{
+ struct zxdh_hw *hw = dev->data->dev_private;
+ struct rte_eth_rxmode *rxmode;
+ struct zxdh_msg_info msg = {0};
+ struct zxdh_port_attr_table port_attr = {0};
+ int ret = 0;
+
+ rxmode = &dev->data->dev_conf.rxmode;
+ if (mask & RTE_ETH_VLAN_FILTER_MASK) {
+ if (rxmode->offloads & RTE_ETH_RX_OFFLOAD_VLAN_FILTER) {
+ if (hw->is_pf) {
+ ret = zxdh_get_port_attr(hw->vport.vfid, &port_attr);
+ port_attr.vlan_filter_enable = true;
+ ret = zxdh_set_port_attr(hw->vport.vfid, &port_attr);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d vlan filter set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ } else {
+ msg.data.vlan_filter_set_msg.enable = true;
+ zxdh_msg_head_build(hw, ZXDH_VLAN_FILTER_SET, &msg);
+ ret = zxdh_vf_send_msg_to_pf(hw->eth_dev, &msg,
+ sizeof(struct zxdh_msg_info), NULL, 0);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d vlan filter set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ }
+ } else {
+ if (hw->is_pf) {
+ ret = zxdh_get_port_attr(hw->vport.vfid, &port_attr);
+ port_attr.vlan_filter_enable = false;
+ ret = zxdh_set_port_attr(hw->vport.vfid, &port_attr);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d vlan filter set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ } else {
+ msg.data.vlan_filter_set_msg.enable = true;
+ zxdh_msg_head_build(hw, ZXDH_VLAN_FILTER_SET, &msg);
+ ret = zxdh_vf_send_msg_to_pf(hw->eth_dev, &msg,
+ sizeof(struct zxdh_msg_info), NULL, 0);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d vlan filter set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ }
+ }
+ }
+
+ if (mask & RTE_ETH_VLAN_STRIP_MASK) {
+ if (rxmode->offloads & RTE_ETH_RX_OFFLOAD_VLAN_STRIP) {
+ if (hw->is_pf) {
+ ret = zxdh_get_port_attr(hw->vport.vfid, &port_attr);
+ port_attr.vlan_strip_offload = true;
+ ret = zxdh_set_port_attr(hw->vport.vfid, &port_attr);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d vlan strip set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ } else {
+ msg.data.vlan_offload_msg.enable = true;
+ msg.data.vlan_offload_msg.type = ZXDH_VLAN_STRIP_MSG_TYPE;
+ zxdh_msg_head_build(hw, ZXDH_VLAN_OFFLOAD, &msg);
+ ret = zxdh_vf_send_msg_to_pf(hw->eth_dev, &msg,
+ sizeof(struct zxdh_msg_info), NULL, 0);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d vlan strip set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ }
+ } else {
+ if (hw->is_pf) {
+ ret = zxdh_get_port_attr(hw->vport.vfid, &port_attr);
+ port_attr.vlan_strip_offload = false;
+ ret = zxdh_set_port_attr(hw->vport.vfid, &port_attr);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d vlan strip set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ } else {
+ msg.data.vlan_offload_msg.enable = false;
+ msg.data.vlan_offload_msg.type = ZXDH_VLAN_STRIP_MSG_TYPE;
+ zxdh_msg_head_build(hw, ZXDH_VLAN_OFFLOAD, &msg);
+ ret = zxdh_vf_send_msg_to_pf(hw->eth_dev, &msg,
+ sizeof(struct zxdh_msg_info), NULL, 0);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d vlan strip set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ }
+ }
+ }
+
+ if (mask & RTE_ETH_QINQ_STRIP_MASK) {
+ memset(&msg, 0, sizeof(struct zxdh_msg_info));
+ if (rxmode->offloads & RTE_ETH_RX_OFFLOAD_QINQ_STRIP) {
+ if (hw->is_pf) {
+ ret = zxdh_get_port_attr(hw->vport.vfid, &port_attr);
+ port_attr.qinq_strip_offload = true;
+ ret = zxdh_set_port_attr(hw->vport.vfid, &port_attr);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d qinq offload set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ } else {
+ msg.data.vlan_offload_msg.enable = true;
+ msg.data.vlan_offload_msg.type = ZXDH_QINQ_STRIP_MSG_TYPE;
+ zxdh_msg_head_build(hw, ZXDH_VLAN_OFFLOAD, &msg);
+ ret = zxdh_vf_send_msg_to_pf(hw->eth_dev, &msg,
+ sizeof(struct zxdh_msg_info), NULL, 0);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d qinq offload set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ }
+ } else {
+ if (hw->is_pf) {
+ ret = zxdh_get_port_attr(hw->vport.vfid, &port_attr);
+ port_attr.qinq_strip_offload = true;
+ ret = zxdh_set_port_attr(hw->vport.vfid, &port_attr);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d qinq offload set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ } else {
+ msg.data.vlan_offload_msg.enable = false;
+ msg.data.vlan_offload_msg.type = ZXDH_QINQ_STRIP_MSG_TYPE;
+ zxdh_msg_head_build(hw, ZXDH_VLAN_OFFLOAD, &msg);
+ ret = zxdh_vf_send_msg_to_pf(hw->eth_dev, &msg,
+ sizeof(struct zxdh_msg_info), NULL, 0);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "port %d qinq offload set failed",
+ hw->vport.vfid);
+ return -EAGAIN;
+ }
+ }
+ }
+ }
+
+ return ret;
+}
diff --git a/drivers/net/zxdh/zxdh_ethdev_ops.h b/drivers/net/zxdh/zxdh_ethdev_ops.h
index 394ddedc0e..058d271ab3 100644
--- a/drivers/net/zxdh/zxdh_ethdev_ops.h
+++ b/drivers/net/zxdh/zxdh_ethdev_ops.h
@@ -18,5 +18,7 @@ int zxdh_dev_promiscuous_enable(struct rte_eth_dev *dev);
int zxdh_dev_promiscuous_disable(struct rte_eth_dev *dev);
int zxdh_dev_allmulticast_enable(struct rte_eth_dev *dev);
int zxdh_dev_allmulticast_disable(struct rte_eth_dev *dev);
+int zxdh_dev_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on);
+int zxdh_dev_vlan_offload_set(struct rte_eth_dev *dev, int mask);
#endif /* ZXDH_ETHDEV_OPS_H */
diff --git a/drivers/net/zxdh/zxdh_msg.h b/drivers/net/zxdh/zxdh_msg.h
index 2abf579a80..ec15388f7a 100644
--- a/drivers/net/zxdh/zxdh_msg.h
+++ b/drivers/net/zxdh/zxdh_msg.h
@@ -50,6 +50,8 @@
#define ZXDH_MAC_UNFILTER 0xff
#define ZXDH_PROMISC_MODE 1
#define ZXDH_ALLMULTI_MODE 2
+#define ZXDH_VLAN_STRIP_MSG_TYPE 0
+#define ZXDH_QINQ_STRIP_MSG_TYPE 1
enum ZXDH_DRIVER_TYPE {
ZXDH_MSG_CHAN_END_MPF = 0,
@@ -180,6 +182,10 @@ enum zxdh_msg_type {
ZXDH_VF_PORT_UNINIT = 2,
ZXDH_MAC_ADD = 3,
ZXDH_MAC_DEL = 4,
+ ZXDH_VLAN_FILTER_SET = 17,
+ ZXDH_VLAN_FILTER_ADD = 18,
+ ZXDH_VLAN_FILTER_DEL = 19,
+ ZXDH_VLAN_OFFLOAD = 21,
ZXDH_PORT_ATTRS_SET = 25,
ZXDH_PORT_PROMISC_SET = 26,
@@ -341,6 +347,19 @@ struct zxdh_msg_head {
uint16_t pcieid;
} __rte_packed;
+struct zxdh_vlan_filter {
+ uint16_t vlan_id;
+};
+
+struct zxdh_vlan_filter_set {
+ uint8_t enable;
+};
+
+struct zxdh_vlan_offload {
+ uint8_t enable;
+ uint8_t type;
+} __rte_packed;
+
struct zxdh_agent_msg_head {
enum zxdh_agent_msg_type msg_type;
uint8_t panel_id;
@@ -363,6 +382,9 @@ struct zxdh_msg_info {
struct zxdh_link_info_msg link_msg;
struct zxdh_mac_filter mac_filter_msg;
struct zxdh_port_promisc_msg port_promisc_msg;
+ struct zxdh_vlan_filter vlan_filter_msg;
+ struct zxdh_vlan_filter_set vlan_filter_set_msg;
+ struct zxdh_vlan_offload vlan_offload_msg;
} __rte_packed data;
} __rte_packed;
diff --git a/drivers/net/zxdh/zxdh_rxtx.c b/drivers/net/zxdh/zxdh_rxtx.c
index 06290d48bb..0ffce50042 100644
--- a/drivers/net/zxdh/zxdh_rxtx.c
+++ b/drivers/net/zxdh/zxdh_rxtx.c
@@ -11,6 +11,9 @@
#include "zxdh_pci.h"
#include "zxdh_queue.h"
+#define ZXDH_SVLAN_TPID 0x88a8
+#define ZXDH_CVLAN_TPID 0x8100
+
#define ZXDH_PKT_FORM_CPU 0x20 /* 1-cpu 0-np */
#define ZXDH_NO_IP_FRAGMENT 0x2000 /* ip fragment flag */
#define ZXDH_NO_IPID_UPDATE 0x4000 /* ipid update flag */
@@ -21,6 +24,9 @@
#define ZXDH_PI_L3TYPE_RSV 0xC0
#define ZXDH_PI_L3TYPE_MASK 0xC0
+#define ZXDH_PD_OFFLOAD_SVLAN_INSERT (1 << 14)
+#define ZXDH_PD_OFFLOAD_CVLAN_INSERT (1 << 13)
+
#define ZXDH_PCODE_MASK 0x1F
#define ZXDH_PCODE_IP_PKT_TYPE 0x01
#define ZXDH_PCODE_TCP_PKT_TYPE 0x02
@@ -259,6 +265,18 @@ static void zxdh_xmit_fill_net_hdr(struct rte_mbuf *cookie,
hdr->pi_hdr.l3_offset = rte_be_to_cpu_16(l3_offset);
hdr->pi_hdr.l4_offset = rte_be_to_cpu_16(l3_offset + cookie->l3_len);
+ if (cookie->ol_flags & RTE_MBUF_F_TX_VLAN) {
+ ol_flag |= ZXDH_PD_OFFLOAD_CVLAN_INSERT;
+ hdr->pi_hdr.vlan_id = rte_be_to_cpu_16(cookie->vlan_tci);
+ hdr->pd_hdr.cvlan_insert =
+ rte_be_to_cpu_32((ZXDH_CVLAN_TPID << 16) | cookie->vlan_tci);
+ }
+ if (cookie->ol_flags & RTE_MBUF_F_TX_QINQ) {
+ ol_flag |= ZXDH_PD_OFFLOAD_SVLAN_INSERT;
+ hdr->pd_hdr.svlan_insert =
+ rte_be_to_cpu_32((ZXDH_SVLAN_TPID << 16) | cookie->vlan_tci_outer);
+ }
+
hdr->pd_hdr.ol_flag = rte_be_to_cpu_32(ol_flag);
}
diff --git a/drivers/net/zxdh/zxdh_tables.c b/drivers/net/zxdh/zxdh_tables.c
index 45aeb3e3e4..ca98b36da2 100644
--- a/drivers/net/zxdh/zxdh_tables.c
+++ b/drivers/net/zxdh/zxdh_tables.c
@@ -10,6 +10,7 @@
#define ZXDH_SDT_VPORT_ATT_TABLE 1
#define ZXDH_SDT_PANEL_ATT_TABLE 2
+#define ZXDH_SDT_VLAN_ATT_TABLE 4
#define ZXDH_SDT_BROCAST_ATT_TABLE 6
#define ZXDH_SDT_UNICAST_ATT_TABLE 10
#define ZXDH_SDT_MULTICAST_ATT_TABLE 11
@@ -19,6 +20,10 @@
#define ZXDH_MC_GROUP_NUM 4
#define ZXDH_BASE_VFID 1152
#define ZXDH_TABLE_HIT_FLAG 128
+#define ZXDH_FIRST_VLAN_GROUP_BITS 23
+#define ZXDH_VLAN_GROUP_BITS 31
+#define ZXDH_VLAN_GROUP_NUM 35
+#define ZXDH_VLAN_FILTER_VLANID_STEP 120
int
zxdh_set_port_attr(uint16_t vfid, struct zxdh_port_attr_table *port_attr)
@@ -569,3 +574,97 @@ zxdh_dev_multicast_table_set(struct zxdh_hw *hw, uint16_t vport, bool enable)
}
return 0;
}
+
+int
+zxdh_vlan_filter_table_init(struct rte_eth_dev *dev)
+{
+ struct zxdh_hw *hw = dev->data->dev_private;
+ struct zxdh_vlan_filter_table vlan_table = {0};
+ int16_t ret = 0;
+
+ if (!hw->is_pf)
+ return 0;
+
+ for (uint8_t vlan_group = 0; vlan_group < ZXDH_VLAN_GROUP_NUM; vlan_group++) {
+ if (vlan_group == 0) {
+ vlan_table.vlans[0] |= (1 << ZXDH_FIRST_VLAN_GROUP_BITS);
+ vlan_table.vlans[0] |= (1 << ZXDH_VLAN_GROUP_BITS);
+
+ } else {
+ vlan_table.vlans[0] = 0;
+ }
+ uint32_t index = (vlan_group << 11) | hw->vport.vfid;
+ ZXDH_DTB_ERAM_ENTRY_INFO_T entry_data = {
+ .index = index,
+ .p_data = (uint32_t *)&vlan_table
+ };
+ ZXDH_DTB_USER_ENTRY_T user_entry = {ZXDH_SDT_VLAN_ATT_TABLE, &entry_data};
+
+ ret = zxdh_np_dtb_table_entry_write(ZXDH_DEVICE_NO,
+ g_dtb_data.queueid, 1, &user_entry);
+ if (ret != 0) {
+ PMD_DRV_LOG(ERR,
+ "[vfid:%d], vlan_group:%d, init vlan filter table failed",
+ hw->vport.vfid, vlan_group);
+ ret = -1;
+ }
+ }
+
+ return ret;
+}
+
+int
+zxdh_vlan_filter_table_set(uint16_t vport, uint16_t vlan_id, uint8_t enable)
+{
+ struct zxdh_vlan_filter_table vlan_table = {0};
+ union zxdh_virport_num vport_num = (union zxdh_virport_num)vport;
+ int ret = 0;
+
+ memset(&vlan_table, 0, sizeof(struct zxdh_vlan_filter_table));
+ int table_num = vlan_id / ZXDH_VLAN_FILTER_VLANID_STEP;
+ uint32_t index = (table_num << 11) | vport_num.vfid;
+ uint16_t group = (vlan_id - table_num * ZXDH_VLAN_FILTER_VLANID_STEP) / 8 + 1;
+
+ uint8_t val = sizeof(struct zxdh_vlan_filter_table) / sizeof(uint32_t);
+ uint8_t vlan_tbl_index = group / val;
+ uint16_t used_group = vlan_tbl_index * val;
+
+ used_group = (used_group == 0 ? 0 : (used_group - 1));
+
+ ZXDH_DTB_ERAM_ENTRY_INFO_T entry_data = {index, (uint32_t *)&vlan_table};
+ ZXDH_DTB_USER_ENTRY_T user_entry_get = {ZXDH_SDT_VLAN_ATT_TABLE, &entry_data};
+
+ ret = zxdh_np_dtb_table_entry_get(ZXDH_DEVICE_NO, g_dtb_data.queueid, &user_entry_get, 1);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "get vlan table failed");
+ return -1;
+ }
+ uint16_t relative_vlan_id = vlan_id - table_num * ZXDH_VLAN_FILTER_VLANID_STEP;
+ uint32_t *base_group = &vlan_table.vlans[0];
+
+ *base_group |= 1 << 31;
+ base_group = &vlan_table.vlans[vlan_tbl_index];
+ uint8_t valid_bits = (vlan_tbl_index == 0 ?
+ ZXDH_FIRST_VLAN_GROUP_BITS : ZXDH_VLAN_GROUP_BITS) + 1;
+
+ uint8_t shift_left = (valid_bits - (relative_vlan_id - used_group * 8) % valid_bits) - 1;
+
+ if (enable)
+ *base_group |= 1 << shift_left;
+ else
+ *base_group &= ~(1 << shift_left);
+
+
+ ZXDH_DTB_USER_ENTRY_T user_entry_write = {
+ .sdt_no = ZXDH_SDT_VLAN_ATT_TABLE,
+ .p_entry_data = &entry_data
+ };
+
+ ret = zxdh_np_dtb_table_entry_write(ZXDH_DEVICE_NO,
+ g_dtb_data.queueid, 1, &user_entry_write);
+ if (ret != 0) {
+ PMD_DRV_LOG(ERR, "write vlan table failed");
+ return -1;
+ }
+ return 0;
+}
diff --git a/drivers/net/zxdh/zxdh_tables.h b/drivers/net/zxdh/zxdh_tables.h
index fb30c8f32e..8dac8f30dd 100644
--- a/drivers/net/zxdh/zxdh_tables.h
+++ b/drivers/net/zxdh/zxdh_tables.h
@@ -43,7 +43,7 @@ struct zxdh_port_attr_table {
uint8_t rdma_offload_enable: 1;
uint8_t vlan_filter_enable: 1;
uint8_t vlan_strip_offload: 1;
- uint8_t qinq_valn_strip_offload: 1;
+ uint8_t qinq_strip_offload: 1;
uint8_t rss_enable: 1;
uint8_t mtu_enable: 1;
uint8_t hit_flag: 1;
@@ -73,7 +73,7 @@ struct zxdh_port_attr_table {
uint8_t rdma_offload_enable: 1;
uint8_t vlan_filter_enable: 1;
uint8_t vlan_strip_offload: 1;
- uint8_t qinq_valn_strip_offload: 1;
+ uint8_t qinq_strip_offload: 1;
uint8_t rss_enable: 1;
uint8_t mtu_enable: 1;
uint8_t hit_flag: 1;
@@ -194,6 +194,10 @@ struct zxdh_multicast_table {
uint32_t bitmap[2];
};
+struct zxdh_vlan_filter_table {
+ uint32_t vlans[4];
+};
+
int zxdh_port_attr_init(struct rte_eth_dev *dev);
int zxdh_panel_table_init(struct rte_eth_dev *dev);
int zxdh_set_port_attr(uint16_t vfid, struct zxdh_port_attr_table *port_attr);
@@ -205,5 +209,7 @@ int zxdh_promisc_table_init(struct rte_eth_dev *dev);
int zxdh_promisc_table_uninit(struct rte_eth_dev *dev);
int zxdh_dev_unicast_table_set(struct zxdh_hw *hw, uint16_t vport, bool enable);
int zxdh_dev_multicast_table_set(struct zxdh_hw *hw, uint16_t vport, bool enable);
+int zxdh_vlan_filter_table_init(struct rte_eth_dev *dev);
+int zxdh_vlan_filter_table_set(uint16_t vport, uint16_t vlan_id, uint8_t enable);
#endif /* ZXDH_TABLES_H */
--
2.27.0