cxgb4: ethtool forward error correction management support

Signed-off-by: Casey Leedom <leedom@chelsio.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/chelsio/cxgb4/cxgb4_ethtool.c b/drivers/net/ethernet/chelsio/cxgb4/cxgb4_ethtool.c
index 26eb00a45db1e9ae04facda2ad90df632d8eafe9..03f593e84c2465232e63952e247bb4942a7c53e1 100644 (file)
--- a/drivers/net/ethernet/chelsio/cxgb4/cxgb4_ethtool.c
+++ b/drivers/net/ethernet/chelsio/cxgb4/cxgb4_ethtool.c
@@ -801,6 +801,104 @@ static int set_link_ksettings(struct net_device *dev,
        return ret;
 }
 
+/* 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_CAP_FEC_RS)
+               eth_fec |= ETHTOOL_FEC_RS;
+       if (fw_fec & FW_PORT_CAP_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;
+}
+
+/* Translate ethtool FEC value into Common Code value. */
+static inline unsigned int eth_to_cc_fec(unsigned int eth_fec)
+{
+       unsigned int cc_fec = 0;
+
+       if (eth_fec & ETHTOOL_FEC_OFF)
+               return cc_fec;
+
+       if (eth_fec & ETHTOOL_FEC_AUTO)
+               cc_fec |= FEC_AUTO;
+       if (eth_fec & ETHTOOL_FEC_RS)
+               cc_fec |= FEC_RS;
+       if (eth_fec & ETHTOOL_FEC_BASER)
+               cc_fec |= FEC_BASER_RS;
+
+       return cc_fec;
+}
+
+static int 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->supported);
+       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;
+}
+
+static int set_fecparam(struct net_device *dev, struct ethtool_fecparam *fec)
+{
+       struct port_info *pi = netdev_priv(dev);
+       struct link_config *lc = &pi->link_cfg;
+       struct link_config old_lc;
+       int ret;
+
+       /* Save old Link Configuration in case the L1 Configure below
+        * fails.
+        */
+       old_lc = *lc;
+
+       /* Try to perform the L1 Configure and return the result of that
+        * effort.  If it fails, revert the attempted change.
+        */
+       lc->requested_fec = eth_to_cc_fec(fec->fec);
+       ret = t4_link_l1cfg(pi->adapter, pi->adapter->mbox,
+                           pi->tx_chan, lc);
+       if (ret)
+               *lc = old_lc;
+       return ret;
+}
+
 static void get_pauseparam(struct net_device *dev,
                           struct ethtool_pauseparam *epause)
 {
@@ -1255,6 +1353,8 @@ static int get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *info,
 static const struct ethtool_ops cxgb_ethtool_ops = {
        .get_link_ksettings = get_link_ksettings,
        .set_link_ksettings = set_link_ksettings,
+       .get_fecparam      = get_fecparam,
+       .set_fecparam      = set_fecparam,
        .get_drvinfo       = get_drvinfo,
        .get_msglevel      = get_msglevel,
        .set_msglevel      = set_msglevel,