|
@@ -15,12 +15,33 @@
|
|
|
#include "mtk_eth_soc.h"
|
|
|
#include "ethtool.h"
|
|
|
|
|
|
-static const char mtk_gdma_str[][ETH_GSTRING_LEN] = {
|
|
|
-#define _FE(x...) # x,
|
|
|
-MTK_STAT_REG_DECLARE
|
|
|
-#undef _FE
|
|
|
+struct mtk_stat {
|
|
|
+ char name[ETH_GSTRING_LEN];
|
|
|
+ unsigned int idx;
|
|
|
};
|
|
|
|
|
|
+#define MTK_HW_STAT(stat) { \
|
|
|
+ .name = #stat, \
|
|
|
+ .idx = offsetof(struct mtk_hw_stats, stat) / sizeof(u64) \
|
|
|
+}
|
|
|
+
|
|
|
+static const struct mtk_stat mtk_ethtool_hw_stats[] = {
|
|
|
+ MTK_HW_STAT(tx_bytes),
|
|
|
+ MTK_HW_STAT(tx_packets),
|
|
|
+ MTK_HW_STAT(tx_skip),
|
|
|
+ MTK_HW_STAT(tx_collisions),
|
|
|
+ MTK_HW_STAT(rx_bytes),
|
|
|
+ MTK_HW_STAT(rx_packets),
|
|
|
+ MTK_HW_STAT(rx_overflow),
|
|
|
+ MTK_HW_STAT(rx_fcs_errors),
|
|
|
+ MTK_HW_STAT(rx_short_errors),
|
|
|
+ MTK_HW_STAT(rx_long_errors),
|
|
|
+ MTK_HW_STAT(rx_checksum_errors),
|
|
|
+ MTK_HW_STAT(rx_flow_control_packets),
|
|
|
+};
|
|
|
+
|
|
|
+#define MTK_HW_STATS_LEN ARRAY_SIZE(mtk_ethtool_hw_stats)
|
|
|
+
|
|
|
static int mtk_get_link_ksettings(struct net_device *dev,
|
|
|
struct ethtool_link_ksettings *cmd)
|
|
|
{
|
|
@@ -76,7 +97,7 @@ static void mtk_get_drvinfo(struct net_device *dev,
|
|
|
strlcpy(info->bus_info, dev_name(mac->hw->dev), sizeof(info->bus_info));
|
|
|
|
|
|
if (soc->reg_table[MTK_REG_MTK_COUNTER_BASE])
|
|
|
- info->n_stats = ARRAY_SIZE(mtk_gdma_str);
|
|
|
+ info->n_stats = MTK_HW_STATS_LEN;
|
|
|
}
|
|
|
|
|
|
static u32 mtk_get_msglevel(struct net_device *dev)
|
|
@@ -155,9 +176,15 @@ static void mtk_get_ringparam(struct net_device *dev,
|
|
|
|
|
|
static void mtk_get_strings(struct net_device *dev, u32 stringset, u8 *data)
|
|
|
{
|
|
|
+ int i;
|
|
|
+
|
|
|
switch (stringset) {
|
|
|
case ETH_SS_STATS:
|
|
|
- memcpy(data, *mtk_gdma_str, sizeof(mtk_gdma_str));
|
|
|
+ for (i = 0; i < MTK_HW_STATS_LEN; i++) {
|
|
|
+ memcpy(data, mtk_ethtool_hw_stats[i].name,
|
|
|
+ ETH_GSTRING_LEN);
|
|
|
+ data += ETH_GSTRING_LEN;
|
|
|
+ }
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
@@ -166,7 +193,7 @@ static int mtk_get_sset_count(struct net_device *dev, int sset)
|
|
|
{
|
|
|
switch (sset) {
|
|
|
case ETH_SS_STATS:
|
|
|
- return ARRAY_SIZE(mtk_gdma_str);
|
|
|
+ return MTK_HW_STATS_LEN;
|
|
|
default:
|
|
|
return -EOPNOTSUPP;
|
|
|
}
|
|
@@ -177,7 +204,6 @@ static void mtk_get_ethtool_stats(struct net_device *dev,
|
|
|
{
|
|
|
struct mtk_mac *mac = netdev_priv(dev);
|
|
|
struct mtk_hw_stats *hwstats = mac->hw_stats;
|
|
|
- u64 *data_src, *data_dst;
|
|
|
unsigned int start;
|
|
|
int i;
|
|
|
|
|
@@ -189,12 +215,9 @@ static void mtk_get_ethtool_stats(struct net_device *dev,
|
|
|
}
|
|
|
|
|
|
do {
|
|
|
- data_src = &hwstats->tx_bytes;
|
|
|
- data_dst = data;
|
|
|
start = u64_stats_fetch_begin_irq(&hwstats->syncp);
|
|
|
-
|
|
|
- for (i = 0; i < ARRAY_SIZE(mtk_gdma_str); i++)
|
|
|
- *data_dst++ = *data_src++;
|
|
|
+ for (i = 0; i < MTK_HW_STATS_LEN; i++)
|
|
|
+ data[i] = ((u64 *)hwstats)[mtk_ethtool_hw_stats[i].idx];
|
|
|
|
|
|
} while (u64_stats_fetch_retry_irq(&hwstats->syncp, start));
|
|
|
}
|