[2/2] net/nfp: support setting pause frame switch mode

Message ID 20231102061641.2463244-3-chaoyong.he@corigine.com (mailing list archive)
State Accepted, archived
Delegated to: Ferruh Yigit
Headers
Series add support of RX/TX pause frame switch |

Checks

Context Check Description
ci/checkpatch success coding style OK
ci/loongarch-compilation success Compilation OK
ci/loongarch-unit-testing success Unit Testing PASS
ci/Intel-compilation success Compilation OK
ci/intel-Testing success Testing PASS
ci/intel-Functional success Functional PASS
ci/iol-mellanox-Performance success Performance Testing PASS
ci/iol-intel-Performance success Performance Testing PASS
ci/iol-intel-Functional success Functional Testing PASS
ci/iol-broadcom-Performance success Performance Testing PASS
ci/iol-compile-amd64-testing fail Testing issues
ci/iol-broadcom-Functional success Functional Testing PASS
ci/iol-unit-arm64-testing success Testing PASS
ci/iol-unit-amd64-testing fail Testing issues
ci/iol-compile-arm64-testing success Testing PASS
ci/iol-sample-apps-testing success Testing PASS

Commit Message

Chaoyong He Nov. 2, 2023, 6:16 a.m. UTC
  From: Zerun Fu <zerun.fu@corigine.com>

Add support for configuring RX/TX pause frame switch mode.

Signed-off-by: Zerun Fu <zerun.fu@corigine.com>
Reviewed-by: Long Wu <long.wu@corigine.com>
Reviewed-by: Peng Zhang <peng.zhang@corigine.com>
Reviewed-by: Chaoyong He <chaoyong.he@corigine.com>
---
 drivers/net/nfp/nfp_ethdev.c          |  1 +
 drivers/net/nfp/nfp_net_common.c      | 75 +++++++++++++++++++++++++++
 drivers/net/nfp/nfp_net_common.h      |  2 +
 drivers/net/nfp/nfpcore/nfp_nsp.h     |  2 +
 drivers/net/nfp/nfpcore/nfp_nsp_eth.c | 52 ++++++++++++++++++-
 5 files changed, 131 insertions(+), 1 deletion(-)
  

Patch

diff --git a/drivers/net/nfp/nfp_ethdev.c b/drivers/net/nfp/nfp_ethdev.c
index 452e16e126..fd54d58cb5 100644
--- a/drivers/net/nfp/nfp_ethdev.c
+++ b/drivers/net/nfp/nfp_ethdev.c
@@ -429,6 +429,7 @@  static const struct eth_dev_ops nfp_net_eth_dev_ops = {
 	.udp_tunnel_port_del    = nfp_udp_tunnel_port_del,
 	.fw_version_get         = nfp_net_firmware_version_get,
 	.flow_ctrl_get          = nfp_net_flow_ctrl_get,
+	.flow_ctrl_set          = nfp_net_flow_ctrl_set,
 };
 
 static inline void
diff --git a/drivers/net/nfp/nfp_net_common.c b/drivers/net/nfp/nfp_net_common.c
index 44b2d6dd4f..8dd014c575 100644
--- a/drivers/net/nfp/nfp_net_common.c
+++ b/drivers/net/nfp/nfp_net_common.c
@@ -2114,3 +2114,78 @@  nfp_net_flow_ctrl_get(struct rte_eth_dev *dev,
 
 	return 0;
 }
+
+static int
+nfp_net_pause_frame_set(struct nfp_net_hw *net_hw,
+		struct nfp_eth_table_port *eth_port,
+		enum rte_eth_fc_mode mode)
+{
+	int err;
+	bool flag;
+	struct nfp_nsp *nsp;
+
+	nsp = nfp_eth_config_start(net_hw->cpp, eth_port->index);
+	if (nsp == NULL) {
+		PMD_DRV_LOG(ERR, "NFP error when obtaining NSP handle.");
+		return -EIO;
+	}
+
+	flag = (mode & RTE_ETH_FC_TX_PAUSE) == 0 ? false : true;
+	err = nfp_eth_set_tx_pause(nsp, flag);
+	if (err != 0) {
+		PMD_DRV_LOG(ERR, "Failed to configure TX pause frame.");
+		nfp_eth_config_cleanup_end(nsp);
+		return err;
+	}
+
+	flag = (mode & RTE_ETH_FC_RX_PAUSE) == 0 ? false : true;
+	err = nfp_eth_set_rx_pause(nsp, flag);
+	if (err != 0) {
+		PMD_DRV_LOG(ERR, "Failed to configure RX pause frame.");
+		nfp_eth_config_cleanup_end(nsp);
+		return err;
+	}
+
+	err = nfp_eth_config_commit_end(nsp);
+	if (err != 0) {
+		PMD_DRV_LOG(ERR, "Failed to configure pause frame.");
+		return err;
+	}
+
+	return 0;
+}
+
+int
+nfp_net_flow_ctrl_set(struct rte_eth_dev *dev,
+		struct rte_eth_fc_conf *fc_conf)
+{
+	int ret;
+	struct nfp_net_hw *net_hw;
+	enum rte_eth_fc_mode set_mode;
+	enum rte_eth_fc_mode original_mode;
+	struct nfp_eth_table *nfp_eth_table;
+	struct nfp_eth_table_port *eth_port;
+
+	net_hw = nfp_net_get_hw(dev);
+	if (net_hw->pf_dev == NULL)
+		return -EINVAL;
+
+	nfp_eth_table = net_hw->pf_dev->nfp_eth_table;
+	eth_port = &nfp_eth_table->ports[net_hw->idx];
+
+	original_mode = nfp_net_get_pause_mode(eth_port);
+	set_mode = fc_conf->mode;
+
+	if (set_mode == original_mode)
+		return 0;
+
+	ret = nfp_net_pause_frame_set(net_hw, eth_port, set_mode);
+	if (ret != 0)
+		return ret;
+
+	/* Update eth_table after modifying RX/TX pause frame mode. */
+	eth_port->tx_pause_enabled = (set_mode & RTE_ETH_FC_TX_PAUSE) == 0 ? false : true;
+	eth_port->rx_pause_enabled = (set_mode & RTE_ETH_FC_RX_PAUSE) == 0 ? false : true;
+
+	return 0;
+}
diff --git a/drivers/net/nfp/nfp_net_common.h b/drivers/net/nfp/nfp_net_common.h
index 5a65d166e0..68a84dea06 100644
--- a/drivers/net/nfp/nfp_net_common.h
+++ b/drivers/net/nfp/nfp_net_common.h
@@ -240,6 +240,8 @@  struct nfp_net_hw *nfp_net_get_hw(const struct rte_eth_dev *dev);
 int nfp_net_stop(struct rte_eth_dev *dev);
 int nfp_net_flow_ctrl_get(struct rte_eth_dev *dev,
 		struct rte_eth_fc_conf *fc_conf);
+int nfp_net_flow_ctrl_set(struct rte_eth_dev *dev,
+		struct rte_eth_fc_conf *fc_conf);
 
 #define NFP_PRIV_TO_APP_FW_NIC(app_fw_priv)\
 	((struct nfp_app_fw_nic *)app_fw_priv)
diff --git a/drivers/net/nfp/nfpcore/nfp_nsp.h b/drivers/net/nfp/nfpcore/nfp_nsp.h
index dc1eb55a1f..4888501e46 100644
--- a/drivers/net/nfp/nfpcore/nfp_nsp.h
+++ b/drivers/net/nfp/nfpcore/nfp_nsp.h
@@ -189,6 +189,8 @@  void nfp_eth_config_cleanup_end(struct nfp_nsp *nsp);
 int nfp_eth_set_aneg(struct nfp_nsp *nsp, enum nfp_eth_aneg mode);
 int nfp_eth_set_speed(struct nfp_nsp *nsp, uint32_t speed);
 int nfp_eth_set_split(struct nfp_nsp *nsp, uint32_t lanes);
+int nfp_eth_set_tx_pause(struct nfp_nsp *nsp, bool tx_pause);
+int nfp_eth_set_rx_pause(struct nfp_nsp *nsp, bool rx_pause);
 
 /* NSP static information */
 struct nfp_nsp_identify {
diff --git a/drivers/net/nfp/nfpcore/nfp_nsp_eth.c b/drivers/net/nfp/nfpcore/nfp_nsp_eth.c
index ca8bc8f550..87db928c08 100644
--- a/drivers/net/nfp/nfpcore/nfp_nsp_eth.c
+++ b/drivers/net/nfp/nfpcore/nfp_nsp_eth.c
@@ -44,6 +44,8 @@ 
 #define NSP_ETH_CTRL_SET_LANES          RTE_BIT64(5)
 #define NSP_ETH_CTRL_SET_ANEG           RTE_BIT64(6)
 #define NSP_ETH_CTRL_SET_FEC            RTE_BIT64(7)
+#define NSP_ETH_CTRL_SET_TX_PAUSE       RTE_BIT64(10)
+#define NSP_ETH_CTRL_SET_RX_PAUSE       RTE_BIT64(11)
 
 /* Which connector port. */
 #define PORT_TP                 0x00
@@ -519,7 +521,7 @@  nfp_eth_set_bit_config(struct nfp_nsp *nsp,
 		uint32_t raw_idx,
 		const uint64_t mask,
 		const uint32_t shift,
-		uint32_t val,
+		uint64_t val,
 		const uint64_t ctrl_bit)
 {
 	uint64_t reg;
@@ -683,3 +685,51 @@  nfp_eth_set_split(struct nfp_nsp *nsp,
 	return NFP_ETH_SET_BIT_CONFIG(nsp, NSP_ETH_RAW_PORT,
 			NSP_ETH_PORT_LANES, lanes, NSP_ETH_CTRL_SET_LANES);
 }
+
+/**
+ * Set TX pause switch.
+ *
+ * @param nsp
+ *    NFP NSP handle returned from nfp_eth_config_start()
+ * @param tx_pause
+ *   TX pause switch
+ *
+ * @return
+ *   0 or -ERRNO
+ */
+int
+nfp_eth_set_tx_pause(struct nfp_nsp *nsp,
+		bool tx_pause)
+{
+	if (nfp_nsp_get_abi_ver_minor(nsp) < 37) {
+		PMD_DRV_LOG(ERR, "Set frame pause operation not supported, please update flash.");
+		return -EOPNOTSUPP;
+	}
+
+	return NFP_ETH_SET_BIT_CONFIG(nsp, NSP_ETH_RAW_STATE,
+			NSP_ETH_STATE_TX_PAUSE, tx_pause, NSP_ETH_CTRL_SET_TX_PAUSE);
+}
+
+/**
+ * Set RX pause switch.
+ *
+ * @param nsp
+ *    NFP NSP handle returned from nfp_eth_config_start()
+ * @param rx_pause
+ *   RX pause switch
+ *
+ * @return
+ *   0 or -ERRNO
+ */
+int
+nfp_eth_set_rx_pause(struct nfp_nsp *nsp,
+		bool rx_pause)
+{
+	if (nfp_nsp_get_abi_ver_minor(nsp) < 37) {
+		PMD_DRV_LOG(ERR, "Set frame pause operation not supported, please update flash.");
+		return -EOPNOTSUPP;
+	}
+
+	return NFP_ETH_SET_BIT_CONFIG(nsp, NSP_ETH_RAW_STATE,
+			NSP_ETH_STATE_RX_PAUSE, rx_pause, NSP_ETH_CTRL_SET_RX_PAUSE);
+}