[v2,12/32] net/sssnic: support dev link status

Message ID 20230831095650.219964-13-wanry@3snic.com (mailing list archive)
State Superseded, archived
Delegated to: Thomas Monjalon
Headers
Series Introduce sssnic PMD for 3SNIC's 9x0 serials Ethernet adapters |

Checks

Context Check Description
ci/checkpatch warning coding style issues

Commit Message

Renyong Wan Aug. 31, 2023, 9:56 a.m. UTC
  From: Renyong Wan <wanry@3snic.com>

Signed-off-by: Steven Song <steven.song@3snic.com>
Signed-off-by: Renyong Wan <wanry@3snic.com>
---
v2:
* Removed error.h from including files.
---
 doc/guides/nics/features/sssnic.ini     |   1 +
 drivers/net/sssnic/base/sssnic_api.c    | 127 ++++++++++++++++++++++++
 drivers/net/sssnic/base/sssnic_api.h    |  14 +++
 drivers/net/sssnic/base/sssnic_cmd.h    |  37 +++++++
 drivers/net/sssnic/meson.build          |   1 +
 drivers/net/sssnic/sssnic_ethdev.c      |   4 +
 drivers/net/sssnic/sssnic_ethdev_link.c | 111 +++++++++++++++++++++
 drivers/net/sssnic/sssnic_ethdev_link.h |  12 +++
 8 files changed, 307 insertions(+)
 create mode 100644 drivers/net/sssnic/sssnic_ethdev_link.c
 create mode 100644 drivers/net/sssnic/sssnic_ethdev_link.h
  

Patch

diff --git a/doc/guides/nics/features/sssnic.ini b/doc/guides/nics/features/sssnic.ini
index 602839d301..a0688e70ef 100644
--- a/doc/guides/nics/features/sssnic.ini
+++ b/doc/guides/nics/features/sssnic.ini
@@ -4,6 +4,7 @@ 
 ; Refer to default.ini for the full list of available PMD features.
 ;
 [Features]
+Link status          = Y
 Unicast MAC filter   = Y
 Multicast MAC filter = Y
 Linux                = Y
diff --git a/drivers/net/sssnic/base/sssnic_api.c b/drivers/net/sssnic/base/sssnic_api.c
index 76266dfbae..3bb31009c5 100644
--- a/drivers/net/sssnic/base/sssnic_api.c
+++ b/drivers/net/sssnic/base/sssnic_api.c
@@ -307,3 +307,130 @@  sssnic_mac_addr_del(struct sssnic_hw *hw, uint8_t *addr)
 
 	return 0;
 }
+
+int
+sssnic_netif_link_status_get(struct sssnic_hw *hw, uint8_t *status)
+{
+	int ret;
+	struct sssnic_netif_link_status_get_cmd cmd;
+	struct sssnic_msg msg;
+	uint32_t cmd_len;
+	uint16_t func;
+
+	if (hw == NULL || status == NULL)
+		return -EINVAL;
+
+	if (SSSNIC_FUNC_TYPE(hw) == SSSNIC_FUNC_TYPE_VF)
+		func = SSSNIC_PF_FUNC_IDX(hw);
+	else
+		func = SSSNIC_MPU_FUNC_IDX;
+
+	memset(&cmd, 0, sizeof(cmd));
+	cmd.port = SSSNIC_PHY_PORT(hw);
+	cmd_len = sizeof(cmd);
+	sssnic_msg_init(&msg, (uint8_t *)&cmd, cmd_len,
+		SSSNIC_GET_NETIF_LINK_STATUS_CMD, func, SSSNIC_NETIF_MODULE,
+		SSSNIC_MSG_TYPE_REQ);
+	ret = sssnic_mbox_send(hw, &msg, (uint8_t *)&cmd, &cmd_len, 0);
+	if (ret != 0) {
+		PMD_DRV_LOG(ERR, "Failed to send mbox message, ret=%d", ret);
+		return ret;
+	}
+
+	if (cmd_len == 0 || cmd.common.status != 0) {
+		PMD_DRV_LOG(ERR,
+			"Bad response to SSSNIC_GET_NETIF_LINK_STATUS_CMD, len=%u, status=%u",
+			cmd_len, cmd.common.status);
+		return -EIO;
+	}
+
+	*status = cmd.status;
+
+	return 0;
+}
+
+int
+sssnic_netif_link_info_get(struct sssnic_hw *hw,
+	struct sssnic_netif_link_info *info)
+{
+	int ret;
+	struct sssnic_netif_link_info_get_cmd cmd;
+	struct sssnic_msg msg;
+	uint32_t cmd_len;
+
+	if (hw == NULL || info == NULL)
+		return -EINVAL;
+
+	ret = sssnic_netif_link_status_get(hw, &info->status);
+	if (ret != 0) {
+		PMD_DRV_LOG(ERR, "Failed to get netif link state!");
+		return ret;
+	}
+
+	memset(&cmd, 0, sizeof(cmd));
+	cmd.port = SSSNIC_PHY_PORT(hw);
+	cmd_len = sizeof(cmd);
+	sssnic_msg_init(&msg, (uint8_t *)&cmd, cmd_len,
+		SSSNIC_GET_NETIF_LINK_INFO_CMD, SSSNIC_MPU_FUNC_IDX,
+		SSSNIC_NETIF_MODULE, SSSNIC_MSG_TYPE_REQ);
+	ret = sssnic_mbox_send(hw, &msg, (uint8_t *)&cmd, &cmd_len, 0);
+	if (ret != 0) {
+		PMD_DRV_LOG(ERR, "Failed to send mbox message, ret=%d", ret);
+		return ret;
+	}
+
+	if (cmd_len == 0 || cmd.common.status != 0) {
+		PMD_DRV_LOG(ERR,
+			"Bad response to SSSNIC_GET_NETIF_LINK_INFO_CMD, len=%u, status=%u",
+			cmd_len, cmd.common.status);
+		return -EIO;
+	}
+
+	info->speed = cmd.speed;
+	info->duplex = cmd.duplex;
+	info->fec = cmd.fec;
+	info->type = cmd.type;
+	info->autoneg_capa = cmd.autoneg_capa;
+	info->autoneg = cmd.autoneg;
+
+	return 0;
+}
+
+int
+sssnic_netif_enable_set(struct sssnic_hw *hw, uint8_t state)
+{
+	int ret;
+	struct sssnic_netif_enable_set_cmd cmd;
+	struct sssnic_msg msg;
+	uint32_t cmd_len;
+
+	if (hw == NULL)
+		return -EINVAL;
+
+	if (SSSNIC_FUNC_TYPE(hw) == SSSNIC_FUNC_TYPE_VF)
+		return 0;
+
+	memset(&cmd, 0, sizeof(cmd));
+	cmd.function = SSSNIC_FUNC_IDX(hw);
+	if (state != 0)
+		cmd.flag = SSSNIC_SET_NETIF_ENABLE_CMD_FLAG_RX_EN |
+			   SSSNIC_SET_NETIF_ENABLE_CMD_FLAG_TX_EN;
+	cmd_len = sizeof(cmd);
+	sssnic_msg_init(&msg, (uint8_t *)&cmd, cmd_len,
+		SSSNIC_SET_NETIF_ENABLE_CMD, SSSNIC_MPU_FUNC_IDX,
+		SSSNIC_NETIF_MODULE, SSSNIC_MSG_TYPE_REQ);
+	ret = sssnic_mbox_send(hw, &msg, (uint8_t *)&cmd, &cmd_len, 0);
+	if (ret != 0) {
+		PMD_DRV_LOG(ERR, "Failed to send mbox message, ret=%d", ret);
+		return ret;
+	}
+
+	if (cmd_len == 0 || cmd.common.status != 0) {
+		PMD_DRV_LOG(ERR,
+			"Bad response to SSSNIC_SET_NETIF_ENABLE_CMD, len=%u, status=%u",
+			cmd_len, cmd.common.status);
+		return -EIO;
+	}
+
+	return 0;
+}
diff --git a/drivers/net/sssnic/base/sssnic_api.h b/drivers/net/sssnic/base/sssnic_api.h
index b985230595..168aa152b9 100644
--- a/drivers/net/sssnic/base/sssnic_api.h
+++ b/drivers/net/sssnic/base/sssnic_api.h
@@ -22,6 +22,16 @@  struct sssnic_capability {
 	uint8_t cos;
 };
 
+struct sssnic_netif_link_info {
+	uint8_t status;
+	uint8_t type;
+	uint8_t autoneg_capa;
+	uint8_t autoneg;
+	uint8_t duplex;
+	uint8_t speed;
+	uint8_t fec;
+};
+
 int sssnic_msix_attr_get(struct sssnic_hw *hw, uint16_t msix_idx,
 	struct sssnic_msix_attr *attr);
 int sssnic_msix_attr_set(struct sssnic_hw *hw, uint16_t msix_idx,
@@ -31,5 +41,9 @@  int sssnic_mac_addr_get(struct sssnic_hw *hw, uint8_t *addr);
 int sssnic_mac_addr_update(struct sssnic_hw *hw, uint8_t *new, uint8_t *old);
 int sssnic_mac_addr_add(struct sssnic_hw *hw, uint8_t *addr);
 int sssnic_mac_addr_del(struct sssnic_hw *hw, uint8_t *addr);
+int sssnic_netif_link_status_get(struct sssnic_hw *hw, uint8_t *status);
+int sssnic_netif_link_info_get(struct sssnic_hw *hw,
+	struct sssnic_netif_link_info *info);
+int sssnic_netif_enable_set(struct sssnic_hw *hw, uint8_t state);
 
 #endif /* _SSSNIC_API_H_ */
diff --git a/drivers/net/sssnic/base/sssnic_cmd.h b/drivers/net/sssnic/base/sssnic_cmd.h
index e70184866e..6957b742fc 100644
--- a/drivers/net/sssnic/base/sssnic_cmd.h
+++ b/drivers/net/sssnic/base/sssnic_cmd.h
@@ -27,6 +27,13 @@  enum sssnic_mac_addr_cmd_id {
 	SSSNIC_DEL_MAC_ADDR_CMD,
 	SSSNIC_UPDATE_MAC_ADDR_CMD,
 };
+enum sssnic_netif_cmd_id {
+	SSSNIC_SET_NETIF_ENABLE_CMD = 6,
+	SSSNIC_GET_NETIF_LINK_STATUS_CMD = 7,
+	SSSNIC_GET_NETIF_MAC_STATS_CMD = 151,
+	SSSNIC_CLEAR_NETIF_MAC_STATS_CMD = 152,
+	SSSNIC_GET_NETIF_LINK_INFO_CMD = 153,
+};
 
 struct sssnic_cmd_common {
 	uint8_t status;
@@ -150,4 +157,34 @@  struct sssnic_mac_addr_update_cmd {
 	uint16_t resvd1;
 	uint8_t new_addr[6];
 };
+struct sssnic_netif_link_status_get_cmd {
+	struct sssnic_cmd_common common;
+	uint8_t port;
+	uint8_t status;
+	uint16_t rsvd;
+};
+
+struct sssnic_netif_link_info_get_cmd {
+	struct sssnic_cmd_common common;
+	uint8_t port;
+	uint8_t resvd0[3];
+	uint8_t type;
+	uint8_t autoneg_capa;
+	uint8_t autoneg;
+	uint8_t duplex;
+	uint8_t speed;
+	uint8_t fec;
+	uint8_t resvd1[18];
+};
+
+#define SSSNIC_SET_NETIF_ENABLE_CMD_FLAG_TX_EN 0x1
+#define SSSNIC_SET_NETIF_ENABLE_CMD_FLAG_RX_EN 0x2
+struct sssnic_netif_enable_set_cmd {
+	struct sssnic_cmd_common common;
+	uint16_t function;
+	uint16_t resvd0;
+	uint8_t flag;
+	uint8_t resvd1[3];
+};
+
 #endif /* _SSSNIC_CMD_H_ */
diff --git a/drivers/net/sssnic/meson.build b/drivers/net/sssnic/meson.build
index 328bb41436..12e967722a 100644
--- a/drivers/net/sssnic/meson.build
+++ b/drivers/net/sssnic/meson.build
@@ -18,4 +18,5 @@  objs = [base_objs]
 
 sources = files(
         'sssnic_ethdev.c',
+        'sssnic_ethdev_link.c',
 )
diff --git a/drivers/net/sssnic/sssnic_ethdev.c b/drivers/net/sssnic/sssnic_ethdev.c
index 92a20649fc..4e546cca66 100644
--- a/drivers/net/sssnic/sssnic_ethdev.c
+++ b/drivers/net/sssnic/sssnic_ethdev.c
@@ -9,6 +9,7 @@ 
 #include "base/sssnic_hw.h"
 #include "base/sssnic_api.h"
 #include "sssnic_ethdev.h"
+#include "sssnic_ethdev_link.h"
 
 static int
 sssnic_ethdev_infos_get(struct rte_eth_dev *ethdev,
@@ -339,6 +340,9 @@  sssnic_ethdev_release(struct rte_eth_dev *ethdev)
 }
 
 static const struct eth_dev_ops sssnic_ethdev_ops = {
+	.dev_set_link_up = sssnic_ethdev_set_link_up,
+	.dev_set_link_down = sssnic_ethdev_set_link_down,
+	.link_update = sssnic_ethdev_link_update,
 	.dev_configure = sssnic_ethdev_configure,
 	.dev_infos_get = sssnic_ethdev_infos_get,
 	.mac_addr_set = sssnic_ethdev_mac_addr_set,
diff --git a/drivers/net/sssnic/sssnic_ethdev_link.c b/drivers/net/sssnic/sssnic_ethdev_link.c
new file mode 100644
index 0000000000..04e2d2e5d2
--- /dev/null
+++ b/drivers/net/sssnic/sssnic_ethdev_link.c
@@ -0,0 +1,111 @@ 
+/* SPDX-License-Identifier: BSD-3-Clause
+ * Copyright(c) 2018-2022 Shenzhen 3SNIC Information Technology Co., Ltd.
+ */
+
+#include <rte_common.h>
+#include <ethdev_pci.h>
+
+#include "sssnic_log.h"
+#include "sssnic_ethdev.h"
+#include "sssnic_ethdev_link.h"
+#include "base/sssnic_hw.h"
+#include "base/sssnic_api.h"
+
+static const uint32_t sssnic_ethdev_speed_map[] = { RTE_ETH_SPEED_NUM_NONE,
+	RTE_ETH_SPEED_NUM_10M, RTE_ETH_SPEED_NUM_100M, RTE_ETH_SPEED_NUM_1G,
+	RTE_ETH_SPEED_NUM_10G, RTE_ETH_SPEED_NUM_25G, RTE_ETH_SPEED_NUM_40G,
+	RTE_ETH_SPEED_NUM_50G, RTE_ETH_SPEED_NUM_100G, RTE_ETH_SPEED_NUM_200G };
+
+#define SSSNIC_ETHDEV_NUM_SPEED_TYPE RTE_DIM(sssnic_ethdev_speed_map)
+
+static int
+sssnic_ethdev_link_get(struct rte_eth_dev *ethdev, struct rte_eth_link *link)
+{
+	int ret;
+	struct sssnic_netif_link_info info;
+	struct sssnic_hw *hw = SSSNIC_ETHDEV_TO_HW(ethdev);
+
+	memset(&info, 0, sizeof(info));
+	ret = sssnic_netif_link_info_get(hw, &info);
+	if (ret != 0) {
+		link->link_status = RTE_ETH_LINK_DOWN;
+		link->link_speed = RTE_ETH_SPEED_NUM_NONE;
+		link->link_duplex = RTE_ETH_LINK_HALF_DUPLEX;
+		link->link_autoneg = RTE_ETH_LINK_FIXED;
+		PMD_DRV_LOG(ERR, "Failed to get netif link info");
+		return ret;
+	}
+
+	if (!info.status) {
+		link->link_status = RTE_ETH_LINK_DOWN;
+		link->link_speed = RTE_ETH_SPEED_NUM_NONE;
+		link->link_duplex = RTE_ETH_LINK_HALF_DUPLEX;
+		link->link_autoneg = RTE_ETH_LINK_FIXED;
+	} else {
+		link->link_status = RTE_ETH_LINK_UP;
+		link->link_duplex = info.duplex;
+		link->link_autoneg = info.autoneg;
+		if (info.speed >= SSSNIC_ETHDEV_NUM_SPEED_TYPE)
+			link->link_speed = RTE_ETH_SPEED_NUM_UNKNOWN;
+		else
+			link->link_speed = sssnic_ethdev_speed_map[info.speed];
+	}
+
+	return 0;
+}
+
+int
+sssnic_ethdev_set_link_up(struct rte_eth_dev *ethdev)
+{
+	struct sssnic_hw *hw = SSSNIC_ETHDEV_TO_HW(ethdev);
+	int ret;
+
+	ret = sssnic_netif_enable_set(hw, 1);
+	if (ret != 0) {
+		PMD_DRV_LOG(ERR, "Failed to enable netif");
+		return ret;
+	}
+
+	return 0;
+}
+
+int
+sssnic_ethdev_set_link_down(struct rte_eth_dev *ethdev)
+{
+	struct sssnic_hw *hw = SSSNIC_ETHDEV_TO_HW(ethdev);
+	int ret;
+
+	ret = sssnic_netif_enable_set(hw, 0);
+	if (ret != 0) {
+		PMD_DRV_LOG(ERR, "Failed to disable netif");
+		return ret;
+	}
+
+	return 0;
+}
+
+int
+sssnic_ethdev_link_update(struct rte_eth_dev *ethdev, int wait_to_complete)
+{
+#define CHECK_INTERVAL 100 /* 100ms */
+#define MAX_REPEAT_TIME 10 /* 1s (10 * 100ms) in total */
+	int ret;
+	struct rte_eth_link link;
+	unsigned int rep_cnt = MAX_REPEAT_TIME;
+
+	memset(&link, 0, sizeof(link));
+	do {
+		ret = sssnic_ethdev_link_get(ethdev, &link);
+		if (ret != 0)
+			goto out;
+
+		if (!wait_to_complete || link.link_status)
+			goto out;
+
+		rte_delay_ms(CHECK_INTERVAL);
+
+	} while (--rep_cnt);
+
+out:
+	return rte_eth_linkstatus_set(ethdev, &link);
+}
diff --git a/drivers/net/sssnic/sssnic_ethdev_link.h b/drivers/net/sssnic/sssnic_ethdev_link.h
new file mode 100644
index 0000000000..00ad13fe9b
--- /dev/null
+++ b/drivers/net/sssnic/sssnic_ethdev_link.h
@@ -0,0 +1,12 @@ 
+/* SPDX-License-Identifier: BSD-3-Clause
+ * Copyright(c) 2018-2022 Shenzhen 3SNIC Information Technology Co., Ltd.
+ */
+
+#ifndef _SSSNIC_ETHDEV_LINK_H_
+#define _SSSNIC_ETHDEV_LINK_H_
+
+int sssnic_ethdev_set_link_up(struct rte_eth_dev *ethdev);
+int sssnic_ethdev_set_link_down(struct rte_eth_dev *ethdev);
+int sssnic_ethdev_link_update(struct rte_eth_dev *ethdev, int wait_to_complete);
+
+#endif /* _SSSNIC_ETHDEV_LINK_H_ */