[PATCH net-next 1/4] cxgb4: Add ethtool self-test support

[Vishal Kulkarni]

This test checks whether adapter has crashed or not

Signed-off-by: Vishal Kulkarni <vis...@chelsio.com>
---
 .../ethernet/chelsio/cxgb4/cxgb4_ethtool.c    | 40 +++++++++++++++++++
 1 file changed, 40 insertions(+)

diff --git a/drivers/net/ethernet/chelsio/cxgb4/cxgb4_ethtool.c 
b/drivers/net/ethernet/chelsio/cxgb4/cxgb4_ethtool.c
index b66a2e6cbbeb..1ec6157f8ba7 100644
--- a/drivers/net/ethernet/chelsio/cxgb4/cxgb4_ethtool.c
+++ b/drivers/net/ethernet/chelsio/cxgb4/cxgb4_ethtool.c
@@ -25,6 +25,15 @@ static void set_msglevel(struct net_device *dev, u32 val)
        netdev2adap(dev)->msg_enable = val;
 }
 
+enum cxgb4_ethtool_tests {
+       CXGB4_ETHTOOL_ADAPTER_TEST,
+       CXGB4_ETHTOOL_MAX_TEST,
+};
+
+static const char 
cxgb4_selftest_strings[CXGB4_ETHTOOL_MAX_TEST][ETH_GSTRING_LEN] = {
+       "Adapter health status",
+};
+
 static const char * const flash_region_strings[] = {
        "All",
        "Firmware",
@@ -166,6 +175,8 @@ static int get_sset_count(struct net_device *dev, int sset)
                       ARRAY_SIZE(loopback_stats_strings);
        case ETH_SS_PRIV_FLAGS:
                return ARRAY_SIZE(cxgb4_priv_flags_strings);
+       case ETH_SS_TEST:
+               return ARRAY_SIZE(cxgb4_selftest_strings);
        default:
                return -EOPNOTSUPP;
        }
@@ -228,6 +239,9 @@ static void get_strings(struct net_device *dev, u32 
stringset, u8 *data)
        } else if (stringset == ETH_SS_PRIV_FLAGS) {
                memcpy(data, cxgb4_priv_flags_strings,
                       sizeof(cxgb4_priv_flags_strings));
+       } else if (stringset == ETH_SS_TEST) {
+               memcpy(data, cxgb4_selftest_strings,
+                      sizeof(cxgb4_selftest_strings));
        }
 }
 
@@ -2056,6 +2070,31 @@ static int cxgb4_set_priv_flags(struct net_device 
*netdev, u32 flags)
        return 0;
 }
 
+static void cxgb4_adapter_status_test(struct net_device *netdev, u64 *data)
+{
+       struct port_info *pi = netdev_priv(netdev);
+       struct adapter *adap = pi->adapter;
+       u32 pcie_fw;
+
+       pcie_fw = t4_read_reg(adap, PCIE_FW_A);
+       if (pcie_fw & PCIE_FW_ERR_F) {
+               *data = 1;
+               return;
+       }
+
+       *data = 0;
+}
+
+static void cxgb4_self_test(struct net_device *netdev,
+                           struct ethtool_test *eth_test, u64 *data)
+{
+       memset(data, 0, sizeof(u64) * CXGB4_ETHTOOL_MAX_TEST);
+
+       cxgb4_adapter_status_test(netdev, &data[CXGB4_ETHTOOL_ADAPTER_TEST]);
+       if (data[CXGB4_ETHTOOL_ADAPTER_TEST])
+               eth_test->flags |= ETH_TEST_FL_FAILED;
+}
+
 static const struct ethtool_ops cxgb_ethtool_ops = {
        .supported_coalesce_params = ETHTOOL_COALESCE_USECS |
                                     ETHTOOL_COALESCE_RX_MAX_FRAMES |
@@ -2090,6 +2129,7 @@ static const struct ethtool_ops cxgb_ethtool_ops = {
        .get_rxfh_indir_size = get_rss_table_size,
        .get_rxfh          = get_rss_table,
        .set_rxfh          = set_rss_table,
+       .self_test         = cxgb4_self_test,
        .flash_device      = set_flash,
        .get_ts_info       = get_ts_info,
        .set_dump          = set_dump,
-- 
2.21.1