74 lines · c
1// SPDX-License-Identifier: GPL-2.02//3// Copyright (c) 2023, 2024 Pengutronix,4// Marc Kleine-Budde <kernel@pengutronix.de>5//6 7#include <linux/ethtool.h>8 9#include "rockchip_canfd.h"10 11enum rkcanfd_stats_type {12 RKCANFD_STATS_TYPE_RX_FIFO_EMPTY_ERRORS,13 RKCANFD_STATS_TYPE_TX_EXTENDED_AS_STANDARD_ERRORS,14};15 16static const char rkcanfd_stats_strings[][ETH_GSTRING_LEN] = {17 [RKCANFD_STATS_TYPE_RX_FIFO_EMPTY_ERRORS] = "rx_fifo_empty_errors",18 [RKCANFD_STATS_TYPE_TX_EXTENDED_AS_STANDARD_ERRORS] = "tx_extended_as_standard_errors",19};20 21static void22rkcanfd_ethtool_get_strings(struct net_device *ndev, u32 stringset, u8 *buf)23{24 switch (stringset) {25 case ETH_SS_STATS:26 memcpy(buf, rkcanfd_stats_strings,27 sizeof(rkcanfd_stats_strings));28 }29}30 31static int rkcanfd_ethtool_get_sset_count(struct net_device *netdev, int sset)32{33 switch (sset) {34 case ETH_SS_STATS:35 return ARRAY_SIZE(rkcanfd_stats_strings);36 default:37 return -EOPNOTSUPP;38 }39}40 41static void42rkcanfd_ethtool_get_ethtool_stats(struct net_device *ndev,43 struct ethtool_stats *stats, u64 *data)44{45 struct rkcanfd_priv *priv = netdev_priv(ndev);46 struct rkcanfd_stats *rkcanfd_stats;47 unsigned int start;48 49 rkcanfd_stats = &priv->stats;50 51 do {52 start = u64_stats_fetch_begin(&rkcanfd_stats->syncp);53 54 data[RKCANFD_STATS_TYPE_RX_FIFO_EMPTY_ERRORS] =55 u64_stats_read(&rkcanfd_stats->rx_fifo_empty_errors);56 data[RKCANFD_STATS_TYPE_TX_EXTENDED_AS_STANDARD_ERRORS] =57 u64_stats_read(&rkcanfd_stats->tx_extended_as_standard_errors);58 } while (u64_stats_fetch_retry(&rkcanfd_stats->syncp, start));59}60 61static const struct ethtool_ops rkcanfd_ethtool_ops = {62 .get_ts_info = can_ethtool_op_get_ts_info_hwts,63 .get_strings = rkcanfd_ethtool_get_strings,64 .get_sset_count = rkcanfd_ethtool_get_sset_count,65 .get_ethtool_stats = rkcanfd_ethtool_get_ethtool_stats,66};67 68void rkcanfd_ethtool_init(struct rkcanfd_priv *priv)69{70 priv->ndev->ethtool_ops = &rkcanfd_ethtool_ops;71 72 u64_stats_init(&priv->stats.syncp);73}74