From: Ganesh Goudar <ganeshgr@chelsio.com>

Date: Thu, 2 Nov 2017 19:28:20 +0530

Subject: cxgb4vf: define get_fecparam ethtool callback

Patch-mainline: v4.15-rc1

Git-commit: 9a7b96b3462679a2fcf7205d396dbf1f8f28454c

References: bsc#1064802 bsc#1066129

Add support to new ethtool operation get_fecparam to

fetch FEC parameters.

Original Work by: Casey Leedom <leedom@chelsio.com>

Signed-off-by: Ganesh Goudar <ganeshgr@chelsio.com>

Signed-off-by: David S. Miller <davem@davemloft.net>

Acked-by: Thomas Bogendoerfer <tbogendoerfer@suse.de>

---

 drivers/net/ethernet/chelsio/cxgb4vf/cxgb4vf_main.c |   58 ++++++++++++++++++++

 1 file changed, 58 insertions(+)

--- a/drivers/net/ethernet/chelsio/cxgb4vf/cxgb4vf_main.c

+++ b/drivers/net/ethernet/chelsio/cxgb4vf/cxgb4vf_main.c

@@ -1401,6 +1401,63 @@ static int cxgb4vf_get_link_ksettings(st

 	return 0;

 }

+/* Translate the Firmware FEC value into the ethtool value. */

+static inline unsigned int fwcap_to_eth_fec(unsigned int fw_fec)

+{

+	unsigned int eth_fec = 0;

+

+	if (fw_fec & FW_PORT_CAP32_FEC_RS)

+		eth_fec |= ETHTOOL_FEC_RS;

+	if (fw_fec & FW_PORT_CAP32_FEC_BASER_RS)

+		eth_fec |= ETHTOOL_FEC_BASER;

+

+	/* if nothing is set, then FEC is off */

+	if (!eth_fec)

+		eth_fec = ETHTOOL_FEC_OFF;

+

+	return eth_fec;

+}

+

+/* Translate Common Code FEC value into ethtool value. */

+static inline unsigned int cc_to_eth_fec(unsigned int cc_fec)

+{

+	unsigned int eth_fec = 0;

+

+	if (cc_fec & FEC_AUTO)

+		eth_fec |= ETHTOOL_FEC_AUTO;

+	if (cc_fec & FEC_RS)

+		eth_fec |= ETHTOOL_FEC_RS;

+	if (cc_fec & FEC_BASER_RS)

+		eth_fec |= ETHTOOL_FEC_BASER;

+

+	/* if nothing is set, then FEC is off */

+	if (!eth_fec)

+		eth_fec = ETHTOOL_FEC_OFF;

+

+	return eth_fec;

+}

+

+static int cxgb4vf_get_fecparam(struct net_device *dev,

+				struct ethtool_fecparam *fec)

+{

+	const struct port_info *pi = netdev_priv(dev);

+	const struct link_config *lc = &pi->link_cfg;

+

+	/* Translate the Firmware FEC Support into the ethtool value.  We

+	 * always support IEEE 802.3 "automatic" selection of Link FEC type if

+	 * any FEC is supported.

+	 */

+	fec->fec = fwcap_to_eth_fec(lc->pcaps);

+	if (fec->fec != ETHTOOL_FEC_OFF)

+		fec->fec |= ETHTOOL_FEC_AUTO;

+

+	/* Translate the current internal FEC parameters into the

+	 * ethtool values.

+	 */

+	fec->active_fec = cc_to_eth_fec(lc->fec);

+	return 0;

+}

+

 /*

  * Return our driver information.

  */

@@ -1774,6 +1831,7 @@ static void cxgb4vf_get_wol(struct net_d

 static const struct ethtool_ops cxgb4vf_ethtool_ops = {

 	.get_link_ksettings	= cxgb4vf_get_link_ksettings,

+	.get_fecparam		= cxgb4vf_get_fecparam,

 	.get_drvinfo		= cxgb4vf_get_drvinfo,

 	.get_msglevel		= cxgb4vf_get_msglevel,

 	.set_msglevel		= cxgb4vf_set_msglevel,