[PATCH 7/7] net/nfp: support setting FEC mode

[Chaoyong He]

From: Zerun Fu <zerun...@corigine.com>

Add support for configuring FEC mode. This feature allows to set any
currently supported FEC mode.

Signed-off-by: Zerun Fu <zerun...@corigine.com>
Reviewed-by: Long Wu <long...@corigine.com>
Reviewed-by: Peng Zhang <peng.zh...@corigine.com>
Reviewed-by: Chaoyong He <chaoyong...@corigine.com>
---
 drivers/net/nfp/nfp_ethdev.c      |  1 +
 drivers/net/nfp/nfp_net_common.c  | 54 +++++++++++++++++++++++++++++++
 drivers/net/nfp/nfp_net_common.h  |  2 ++
 drivers/net/nfp/nfpcore/nfp_nsp.h |  1 +
 4 files changed, 58 insertions(+)

diff --git a/drivers/net/nfp/nfp_ethdev.c b/drivers/net/nfp/nfp_ethdev.c
index e3f5fe7917..185b570892 100644
--- a/drivers/net/nfp/nfp_ethdev.c
+++ b/drivers/net/nfp/nfp_ethdev.c
@@ -761,6 +761,7 @@ static const struct eth_dev_ops nfp_net_eth_dev_ops = {
        .flow_ops_get           = nfp_net_flow_ops_get,
        .fec_get_capability     = nfp_net_fec_get_capability,
        .fec_get                = nfp_net_fec_get,
+       .fec_set                = nfp_net_fec_set,
 };
 
 static inline void
diff --git a/drivers/net/nfp/nfp_net_common.c b/drivers/net/nfp/nfp_net_common.c
index 063c048675..eeb0aaae26 100644
--- a/drivers/net/nfp/nfp_net_common.c
+++ b/drivers/net/nfp/nfp_net_common.c
@@ -2386,3 +2386,57 @@ nfp_net_fec_get(struct rte_eth_dev *dev,
 
        return 0;
 }
+
+static enum nfp_eth_fec
+nfp_net_fec_rte_to_nfp(uint32_t fec)
+{
+       switch (fec) {
+       case RTE_BIT32(RTE_ETH_FEC_AUTO):
+               return NFP_FEC_AUTO_BIT;
+       case RTE_BIT32(RTE_ETH_FEC_NOFEC):
+               return NFP_FEC_DISABLED_BIT;
+       case RTE_BIT32(RTE_ETH_FEC_RS):
+               return NFP_FEC_REED_SOLOMON_BIT;
+       case RTE_BIT32(RTE_ETH_FEC_BASER):
+               return NFP_FEC_BASER_BIT;
+       default:
+               return NFP_FEC_INVALID_BIT;
+       }
+}
+
+int
+nfp_net_fec_set(struct rte_eth_dev *dev,
+               uint32_t fec_capa)
+{
+       enum nfp_eth_fec fec;
+       struct nfp_net_hw *hw;
+       uint32_t supported_fec;
+       struct nfp_eth_table *nfp_eth_table;
+       struct nfp_eth_table_port *eth_port;
+
+       hw = nfp_net_get_hw(dev);
+       if (hw->pf_dev == NULL)
+               return -EINVAL;
+
+       nfp_eth_table = hw->pf_dev->nfp_eth_table;
+       eth_port = &nfp_eth_table->ports[hw->idx];
+
+       supported_fec = nfp_eth_supported_fec_modes(eth_port);
+       if (supported_fec == 0) {
+               PMD_DRV_LOG(ERR, "NFP can not support FEC.");
+               return -ENOTSUP;
+       }
+
+       fec = nfp_net_fec_rte_to_nfp(fec_capa);
+       if (fec == NFP_FEC_INVALID_BIT) {
+               PMD_DRV_LOG(ERR, "FEC modes is invalid.");
+               return -EINVAL;
+       }
+
+       if ((RTE_BIT32(fec) & supported_fec) == 0) {
+               PMD_DRV_LOG(ERR, "Unsupported FEC mode is set.");
+               return -EIO;
+       }
+
+       return nfp_eth_set_fec(hw->cpp, eth_port->index, fec);
+}
diff --git a/drivers/net/nfp/nfp_net_common.h b/drivers/net/nfp/nfp_net_common.h
index fa88323b7c..66c900e3b8 100644
--- a/drivers/net/nfp/nfp_net_common.h
+++ b/drivers/net/nfp/nfp_net_common.h
@@ -293,6 +293,8 @@ int nfp_net_fec_get_capability(struct rte_eth_dev *dev,
                unsigned int num);
 int nfp_net_fec_get(struct rte_eth_dev *dev,
                uint32_t *fec_capa);
+int nfp_net_fec_set(struct rte_eth_dev *dev,
+               uint32_t fec_capa);
 
 #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 41e8402154..2ce05c2ec9 100644
--- a/drivers/net/nfp/nfpcore/nfp_nsp.h
+++ b/drivers/net/nfp/nfpcore/nfp_nsp.h
@@ -100,6 +100,7 @@ enum nfp_eth_fec {
        NFP_FEC_BASER_BIT,
        NFP_FEC_REED_SOLOMON_BIT,
        NFP_FEC_DISABLED_BIT,
+       NFP_FEC_INVALID_BIT,
 };
 
 #define NFP_FEC_AUTO            RTE_BIT32(NFP_FEC_AUTO_BIT)
-- 
2.39.1