From: Renyong Wan <wa...@3snic.com>
Signed-off-by: Steven Song <steven.s...@3snic.com>
Signed-off-by: Renyong Wan <wa...@3snic.com>
---
doc/guides/nics/features/sssnic.ini | 1 +
drivers/net/sssnic/base/sssnic_api.c | 68 ++++++++++++++++++++++++++++
drivers/net/sssnic/base/sssnic_api.h | 4 ++
drivers/net/sssnic/base/sssnic_cmd.h | 11 +++++
drivers/net/sssnic/sssnic_ethdev.c | 65 ++++++++++++++++++++++++++
5 files changed, 149 insertions(+)
diff --git a/doc/guides/nics/features/sssnic.ini
b/doc/guides/nics/features/sssnic.ini
index a40b509558..9bf05cb968 100644
--- a/doc/guides/nics/features/sssnic.ini
+++ b/doc/guides/nics/features/sssnic.ini
@@ -26,6 +26,7 @@ Inner L4 checksum = Y
Basic stats = Y
Extended stats = Y
Stats per queue = Y
+Flow control = P
FW version = Y
Linux = Y
ARMv8 = Y
diff --git a/drivers/net/sssnic/base/sssnic_api.c
b/drivers/net/sssnic/base/sssnic_api.c
index 12aca16995..d91896cdd2 100644
--- a/drivers/net/sssnic/base/sssnic_api.c
+++ b/drivers/net/sssnic/base/sssnic_api.c
@@ -1533,3 +1533,71 @@ sssnic_fw_version_get(struct sssnic_hw *hw, struct
sssnic_fw_version *version)
return 0;
}
+
+int
+sssnic_flow_ctrl_set(struct sssnic_hw *hw, bool autoneg, bool rx_en, bool
tx_en)
+{
+ int ret;
+ struct sssnic_msg msg;
+ struct sssnic_flow_ctrl_cmd cmd;
+ uint32_t cmdlen = sizeof(cmd);
+
+ memset(&cmd, 0, sizeof(cmd));
+ cmd.auto_neg = autoneg ? 1 : 0;
+ cmd.rx_en = rx_en ? 1 : 0;
+ cmd.tx_en = tx_en ? 1 : 0;
+ cmd.opcode = SSSNIC_CMD_OPCODE_SET;
+
+ sssnic_msg_init(&msg, (uint8_t *)&cmd, cmdlen,
+ SSSNIC_PORT_FLOW_CTRL_CMD, SSSNIC_MPU_FUNC_IDX,
+ SSSNIC_LAN_MODULE, SSSNIC_MSG_TYPE_REQ);
+ ret = sssnic_mbox_send(hw, &msg, (uint8_t *)&cmd, &cmdlen, 0);
+ if (ret != 0) {
+ PMD_DRV_LOG(ERR, "Failed to send mbox message, ret=%d", ret);
+ return ret;
+ }
+
+ if (cmdlen == 0 || cmd.common.status != 0) {
+ PMD_DRV_LOG(ERR,
+ "Bad response to SSSNIC_PORT_FLOW_CTRL_CMD, len=%u,
status=%u",
+ cmdlen, cmd.common.status);
+ return -EIO;
+ }
+
+ return 0;
+}
+
+int
+sssnic_flow_ctrl_get(struct sssnic_hw *hw, bool *autoneg, bool *rx_en,
+ bool *tx_en)
+{
+ int ret;
+ struct sssnic_msg msg;
+ struct sssnic_flow_ctrl_cmd cmd;
+ uint32_t cmdlen = sizeof(cmd);
+
+ memset(&cmd, 0, sizeof(cmd));
+ cmd.opcode = SSSNIC_CMD_OPCODE_GET;
+
+ sssnic_msg_init(&msg, (uint8_t *)&cmd, cmdlen,
+ SSSNIC_PORT_FLOW_CTRL_CMD, SSSNIC_MPU_FUNC_IDX,
+ SSSNIC_LAN_MODULE, SSSNIC_MSG_TYPE_REQ);
+ ret = sssnic_mbox_send(hw, &msg, (uint8_t *)&cmd, &cmdlen, 0);
+ if (ret != 0) {
+ PMD_DRV_LOG(ERR, "Failed to send mbox message, ret=%d", ret);
+ return ret;
+ }
+
+ if (cmdlen == 0 || cmd.common.status != 0) {
+ PMD_DRV_LOG(ERR,
+ "Bad response to SSSNIC_PORT_FLOW_CTRL_CMD, len=%u,
status=%u",
+ cmdlen, cmd.common.status);
+ return -EIO;
+ }
+
+ *autoneg = cmd.auto_neg;
+ *rx_en = cmd.rx_en;
+ *tx_en = cmd.tx_en;
+
+ return 0;
+}
diff --git a/drivers/net/sssnic/base/sssnic_api.h
b/drivers/net/sssnic/base/sssnic_api.h
index bd4f01d388..36544a5dc3 100644
--- a/drivers/net/sssnic/base/sssnic_api.h
+++ b/drivers/net/sssnic/base/sssnic_api.h
@@ -465,5 +465,9 @@ int sssnic_rss_indir_table_get(struct sssnic_hw *hw,
uint16_t *entry,
uint32_t num_entries);
int sssnic_fw_version_get(struct sssnic_hw *hw,
struct sssnic_fw_version *version);
+int sssnic_flow_ctrl_set(struct sssnic_hw *hw, bool autoneg, bool rx_en,
+ bool tx_en);
+int sssnic_flow_ctrl_get(struct sssnic_hw *hw, bool *autoneg, bool *rx_en,
+ bool *tx_en);
#endif /* _SSSNIC_API_H_ */
diff --git a/drivers/net/sssnic/base/sssnic_cmd.h
b/drivers/net/sssnic/base/sssnic_cmd.h
index 9da07770b1..d2054fad5a 100644
--- a/drivers/net/sssnic/base/sssnic_cmd.h
+++ b/drivers/net/sssnic/base/sssnic_cmd.h
@@ -414,4 +414,15 @@ struct sssnic_fw_version_get_cmd {
uint8_t time[20];
};
+struct sssnic_flow_ctrl_cmd {
+ struct sssnic_cmd_common common;
+ uint8_t port;
+ uint8_t opcode;
+ uint16_t resvd0;
+ uint8_t auto_neg;
+ uint8_t rx_en;
+ uint8_t tx_en;
+ uint8_t resvd1[5];
+};
+
#endif /* _SSSNIC_CMD_H_ */
diff --git a/drivers/net/sssnic/sssnic_ethdev.c
b/drivers/net/sssnic/sssnic_ethdev.c
index cceaa5c8be..8999693027 100644
--- a/drivers/net/sssnic/sssnic_ethdev.c
+++ b/drivers/net/sssnic/sssnic_ethdev.c
@@ -758,6 +758,69 @@ sssnic_ethdev_fw_version_get(struct rte_eth_dev *ethdev,
char *fw_version,
return 0;
}
+static int
+sssnic_ethdev_flow_ctrl_set(struct rte_eth_dev *ethdev,
+ struct rte_eth_fc_conf *fc_conf)
+{
+ struct sssnic_hw *hw = SSSNIC_ETHDEV_TO_HW(ethdev);
+ bool autoneg, rx_en, tx_en;
+ int ret;
+
+ if (fc_conf->autoneg != 0)
+ autoneg = true;
+ else
+ autoneg = false;
+
+ if (fc_conf->mode == RTE_ETH_FC_FULL ||
+ fc_conf->mode == RTE_ETH_FC_RX_PAUSE)
+ rx_en = true;
+ else
+ rx_en = false;
+
+ if (fc_conf->mode == RTE_ETH_FC_FULL ||
+ fc_conf->mode == RTE_ETH_FC_TX_PAUSE)
+ tx_en = true;
+ else
+ tx_en = false;
+
+ ret = sssnic_flow_ctrl_set(hw, autoneg, rx_en, tx_en);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "Failed to set flow conctrol");
+ return ret;
+ }
+
+ return 0;
+}
+
+static int
+sssnic_ethdev_flow_ctrl_get(struct rte_eth_dev *ethdev,
+ struct rte_eth_fc_conf *fc_conf)
+{
+ struct sssnic_hw *hw = SSSNIC_ETHDEV_TO_HW(ethdev);
+ bool autoneg, rx_en, tx_en;
+ int ret;
+
+ ret = sssnic_flow_ctrl_get(hw, &autoneg, &rx_en, &tx_en);
+ if (ret) {
+ PMD_DRV_LOG(ERR, "Failed to get flow conctrol");
+ return ret;
+ }
+
+ if (autoneg)
+ fc_conf->autoneg = true;
+
+ if (rx_en && tx_en)
+ fc_conf->mode = RTE_ETH_FC_FULL;
+ else if (rx_en)
+ fc_conf->mode = RTE_ETH_FC_RX_PAUSE;
+ else if (tx_en)
+ fc_conf->mode = RTE_ETH_FC_TX_PAUSE;
+ else
+ fc_conf->mode = RTE_ETH_FC_NONE;
+
+ return 0;
+}
+
static const struct eth_dev_ops sssnic_ethdev_ops = {
.dev_start = sssnic_ethdev_start,
.dev_stop = sssnic_ethdev_stop,
@@ -799,6 +862,8 @@ static const struct eth_dev_ops sssnic_ethdev_ops = {
.rxq_info_get = sssnic_ethdev_rx_queue_info_get,
.txq_info_get = sssnic_ethdev_tx_queue_info_get,
.fw_version_get = sssnic_ethdev_fw_version_get,
+ .flow_ctrl_set = sssnic_ethdev_flow_ctrl_set,
+ .flow_ctrl_get = sssnic_ethdev_flow_ctrl_get,
};
static int
--
2.27.0
