net: lan743x: Add support to LAN743x register dump

Add support to LAN743x common register dump

Signed-off-by: Raju Lakkaraju <Raju.Lakkaraju@microchip.com>
Reviewed-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Jakub Kicinski <kuba@kernel.org>

diff --git a/drivers/net/ethernet/microchip/lan743x_ethtool.c b/drivers/net/ethernet/microchip/lan743x_ethtool.c
index c8fe8b31f07b3fe496a0067c81bfa8d9133bcc1c..48b19dcd43513d89d7392c9a3894da729a65f10d 100644 (file)
--- a/drivers/net/ethernet/microchip/lan743x_ethtool.c
+++ b/drivers/net/ethernet/microchip/lan743x_ethtool.c
@@ -1178,6 +1178,49 @@ static int lan743x_ethtool_set_wol(struct net_device *netdev,
 }
 #endif /* CONFIG_PM */
 
+static void lan743x_common_regs(struct net_device *dev,
+                               struct ethtool_regs *regs, void *p)
+
+{
+       struct lan743x_adapter *adapter = netdev_priv(dev);
+       u32 *rb = p;
+
+       memset(p, 0, (MAX_LAN743X_ETH_REGS * sizeof(u32)));
+
+       rb[ETH_PRIV_FLAGS] = adapter->flags;
+       rb[ETH_ID_REV]     = lan743x_csr_read(adapter, ID_REV);
+       rb[ETH_FPGA_REV]   = lan743x_csr_read(adapter, FPGA_REV);
+       rb[ETH_STRAP_READ] = lan743x_csr_read(adapter, STRAP_READ);
+       rb[ETH_INT_STS]    = lan743x_csr_read(adapter, INT_STS);
+       rb[ETH_HW_CFG]     = lan743x_csr_read(adapter, HW_CFG);
+       rb[ETH_PMT_CTL]    = lan743x_csr_read(adapter, PMT_CTL);
+       rb[ETH_E2P_CMD]    = lan743x_csr_read(adapter, E2P_CMD);
+       rb[ETH_E2P_DATA]   = lan743x_csr_read(adapter, E2P_DATA);
+       rb[ETH_MAC_CR]     = lan743x_csr_read(adapter, MAC_CR);
+       rb[ETH_MAC_RX]     = lan743x_csr_read(adapter, MAC_RX);
+       rb[ETH_MAC_TX]     = lan743x_csr_read(adapter, MAC_TX);
+       rb[ETH_FLOW]       = lan743x_csr_read(adapter, MAC_FLOW);
+       rb[ETH_MII_ACC]    = lan743x_csr_read(adapter, MAC_MII_ACC);
+       rb[ETH_MII_DATA]   = lan743x_csr_read(adapter, MAC_MII_DATA);
+       rb[ETH_EEE_TX_LPI_REQ_DLY]  = lan743x_csr_read(adapter,
+                                                      MAC_EEE_TX_LPI_REQ_DLY_CNT);
+       rb[ETH_WUCSR]      = lan743x_csr_read(adapter, MAC_WUCSR);
+       rb[ETH_WK_SRC]     = lan743x_csr_read(adapter, MAC_WK_SRC);
+}
+
+static int lan743x_get_regs_len(struct net_device *dev)
+{
+       return MAX_LAN743X_ETH_REGS * sizeof(u32);
+}
+
+static void lan743x_get_regs(struct net_device *dev,
+                            struct ethtool_regs *regs, void *p)
+{
+       regs->version = LAN743X_ETH_REG_VERSION;
+
+       lan743x_common_regs(dev, regs, p);
+}
+
 const struct ethtool_ops lan743x_ethtool_ops = {
        .get_drvinfo = lan743x_ethtool_get_drvinfo,
        .get_msglevel = lan743x_ethtool_get_msglevel,
@@ -1202,6 +1245,8 @@ const struct ethtool_ops lan743x_ethtool_ops = {
        .set_eee = lan743x_ethtool_set_eee,
        .get_link_ksettings = phy_ethtool_get_link_ksettings,
        .set_link_ksettings = phy_ethtool_set_link_ksettings,
+       .get_regs_len = lan743x_get_regs_len,
+       .get_regs = lan743x_get_regs,
 #ifdef CONFIG_PM
        .get_wol = lan743x_ethtool_get_wol,
        .set_wol = lan743x_ethtool_set_wol,

diff --git a/drivers/net/ethernet/microchip/lan743x_ethtool.h b/drivers/net/ethernet/microchip/lan743x_ethtool.h
index d0d11a777a586dd570e476c7d000bcbcb14b5453..7f5996a52488e46bf63863fe707d8af966b26dfc 100644 (file)
--- a/drivers/net/ethernet/microchip/lan743x_ethtool.h
+++ b/drivers/net/ethernet/microchip/lan743x_ethtool.h
@@ -6,6 +6,32 @@
 
 #include "linux/ethtool.h"
 
+#define LAN743X_ETH_REG_VERSION         1
+
+enum {
+       ETH_PRIV_FLAGS,
+       ETH_ID_REV,
+       ETH_FPGA_REV,
+       ETH_STRAP_READ,
+       ETH_INT_STS,
+       ETH_HW_CFG,
+       ETH_PMT_CTL,
+       ETH_E2P_CMD,
+       ETH_E2P_DATA,
+       ETH_MAC_CR,
+       ETH_MAC_RX,
+       ETH_MAC_TX,
+       ETH_FLOW,
+       ETH_MII_ACC,
+       ETH_MII_DATA,
+       ETH_EEE_TX_LPI_REQ_DLY,
+       ETH_WUCSR,
+       ETH_WK_SRC,
+
+       /* Add new registers above */
+       MAX_LAN743X_ETH_REGS
+};
+
 extern const struct ethtool_ops lan743x_ethtool_ops;
 
 #endif /* _LAN743X_ETHTOOL_H */