| // SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause) |
| /* |
| * NXP NETC switch driver |
| * Copyright 2025-2026 NXP |
| */ |
| |
| #include <linux/ethtool_netlink.h> |
| |
| #include "netc_switch.h" |
| |
| static const struct ethtool_rmon_hist_range netc_rmon_ranges[] = { |
| { 64, 64 }, |
| { 65, 127 }, |
| { 128, 255 }, |
| { 256, 511 }, |
| { 512, 1023 }, |
| { 1024, 1522 }, |
| { 1523, NETC_MAX_FRAME_LEN }, |
| { } |
| }; |
| |
| static const struct netc_port_stat netc_port_counters[] = { |
| { NETC_PTGSLACR, "port gate late arrival frames" }, |
| { NETC_PSDFTCR, "port SDF transmit frames" }, |
| { NETC_PSDFDDCR, "port SDF drop duplicate frames" }, |
| { NETC_PRXDCR, "port rx discard frames" }, |
| { NETC_PRXDCRRR, "port rx discard read-reset" }, |
| { NETC_PRXDCRR0, "port rx discard reason 0" }, |
| { NETC_PRXDCRR1, "port rx discard reason 1" }, |
| { NETC_PTXDCR, "port tx discard frames" }, |
| { NETC_BPDCR, "bridge port discard frames" }, |
| }; |
| |
| static const struct netc_port_stat netc_emac_counters[] = { |
| { NETC_PM_ROCT(0), "eMAC rx octets" }, |
| { NETC_PM_RVLAN(0), "eMAC rx VLAN frames" }, |
| { NETC_PM_RERR(0), "eMAC rx frame errors" }, |
| { NETC_PM_RUCA(0), "eMAC rx unicast frames" }, |
| { NETC_PM_RDRP(0), "eMAC rx dropped packets" }, |
| { NETC_PM_RPKT(0), "eMAC rx packets" }, |
| { NETC_PM_TOCT(0), "eMAC tx octets" }, |
| { NETC_PM_TVLAN(0), "eMAC tx VLAN frames" }, |
| { NETC_PM_TFCS(0), "eMAC tx FCS errors" }, |
| { NETC_PM_TUCA(0), "eMAC tx unicast frames" }, |
| { NETC_PM_TPKT(0), "eMAC tx packets" }, |
| { NETC_PM_TUND(0), "eMAC tx undersized packets" }, |
| { NETC_PM_TIOCT(0), "eMAC tx invalid octets" }, |
| }; |
| |
| static const struct netc_port_stat netc_pmac_counters[] = { |
| { NETC_PM_ROCT(1), "pMAC rx octets" }, |
| { NETC_PM_RVLAN(1), "pMAC rx VLAN frames" }, |
| { NETC_PM_RERR(1), "pMAC rx frame errors" }, |
| { NETC_PM_RUCA(1), "pMAC rx unicast frames" }, |
| { NETC_PM_RDRP(1), "pMAC rx dropped packets" }, |
| { NETC_PM_RPKT(1), "pMAC rx packets" }, |
| { NETC_PM_TOCT(1), "pMAC tx octets" }, |
| { NETC_PM_TVLAN(1), "pMAC tx VLAN frames" }, |
| { NETC_PM_TFCS(1), "pMAC tx FCS errors" }, |
| { NETC_PM_TUCA(1), "pMAC tx unicast frames" }, |
| { NETC_PM_TPKT(1), "pMAC tx packets" }, |
| { NETC_PM_TUND(1), "pMAC tx undersized packets" }, |
| { NETC_PM_TIOCT(1), "pMAC tx invalid octets" }, |
| }; |
| |
| static void netc_port_pause_stats(struct netc_port *np, int mac, |
| struct ethtool_pause_stats *stats) |
| { |
| if (mac && !np->caps.pmac) |
| return; |
| |
| stats->tx_pause_frames = netc_port_rd64(np, NETC_PM_TXPF(mac)); |
| stats->rx_pause_frames = netc_port_rd64(np, NETC_PM_RXPF(mac)); |
| } |
| |
| void netc_port_get_pause_stats(struct dsa_switch *ds, int port, |
| struct ethtool_pause_stats *pause_stats) |
| { |
| struct netc_port *np = NETC_PORT(ds, port); |
| struct net_device *ndev; |
| |
| switch (pause_stats->src) { |
| case ETHTOOL_MAC_STATS_SRC_EMAC: |
| netc_port_pause_stats(np, 0, pause_stats); |
| break; |
| case ETHTOOL_MAC_STATS_SRC_PMAC: |
| netc_port_pause_stats(np, 1, pause_stats); |
| break; |
| case ETHTOOL_MAC_STATS_SRC_AGGREGATE: |
| ndev = dsa_to_port(ds, port)->user; |
| ethtool_aggregate_pause_stats(ndev, pause_stats); |
| break; |
| } |
| } |
| |
| static void netc_port_rmon_stats(struct netc_port *np, int mac, |
| struct ethtool_rmon_stats *stats) |
| { |
| if (mac && !np->caps.pmac) |
| return; |
| |
| stats->undersize_pkts = netc_port_rd64(np, NETC_PM_RUND(mac)); |
| stats->oversize_pkts = netc_port_rd64(np, NETC_PM_ROVR(mac)); |
| stats->fragments = netc_port_rd64(np, NETC_PM_RFRG(mac)); |
| stats->jabbers = netc_port_rd64(np, NETC_PM_RJBR(mac)); |
| |
| stats->hist[0] = netc_port_rd64(np, NETC_PM_R64(mac)); |
| stats->hist[1] = netc_port_rd64(np, NETC_PM_R127(mac)); |
| stats->hist[2] = netc_port_rd64(np, NETC_PM_R255(mac)); |
| stats->hist[3] = netc_port_rd64(np, NETC_PM_R511(mac)); |
| stats->hist[4] = netc_port_rd64(np, NETC_PM_R1023(mac)); |
| stats->hist[5] = netc_port_rd64(np, NETC_PM_R1522(mac)); |
| stats->hist[6] = netc_port_rd64(np, NETC_PM_R1523X(mac)); |
| |
| stats->hist_tx[0] = netc_port_rd64(np, NETC_PM_T64(mac)); |
| stats->hist_tx[1] = netc_port_rd64(np, NETC_PM_T127(mac)); |
| stats->hist_tx[2] = netc_port_rd64(np, NETC_PM_T255(mac)); |
| stats->hist_tx[3] = netc_port_rd64(np, NETC_PM_T511(mac)); |
| stats->hist_tx[4] = netc_port_rd64(np, NETC_PM_T1023(mac)); |
| stats->hist_tx[5] = netc_port_rd64(np, NETC_PM_T1522(mac)); |
| stats->hist_tx[6] = netc_port_rd64(np, NETC_PM_T1523X(mac)); |
| } |
| |
| void netc_port_get_rmon_stats(struct dsa_switch *ds, int port, |
| struct ethtool_rmon_stats *rmon_stats, |
| const struct ethtool_rmon_hist_range **ranges) |
| { |
| struct netc_port *np = NETC_PORT(ds, port); |
| struct net_device *ndev; |
| |
| *ranges = netc_rmon_ranges; |
| |
| switch (rmon_stats->src) { |
| case ETHTOOL_MAC_STATS_SRC_EMAC: |
| netc_port_rmon_stats(np, 0, rmon_stats); |
| break; |
| case ETHTOOL_MAC_STATS_SRC_PMAC: |
| netc_port_rmon_stats(np, 1, rmon_stats); |
| break; |
| case ETHTOOL_MAC_STATS_SRC_AGGREGATE: |
| ndev = dsa_to_port(ds, port)->user; |
| ethtool_aggregate_rmon_stats(ndev, rmon_stats); |
| break; |
| } |
| } |
| |
| static void netc_port_ctrl_stats(struct netc_port *np, int mac, |
| struct ethtool_eth_ctrl_stats *stats) |
| { |
| if (mac && !np->caps.pmac) |
| return; |
| |
| stats->MACControlFramesTransmitted = |
| netc_port_rd64(np, NETC_PM_TCNP(mac)); |
| stats->MACControlFramesReceived = |
| netc_port_rd64(np, NETC_PM_RCNP(mac)); |
| } |
| |
| void netc_port_get_eth_ctrl_stats(struct dsa_switch *ds, int port, |
| struct ethtool_eth_ctrl_stats *ctrl_stats) |
| { |
| struct netc_port *np = NETC_PORT(ds, port); |
| struct net_device *ndev; |
| |
| switch (ctrl_stats->src) { |
| case ETHTOOL_MAC_STATS_SRC_EMAC: |
| netc_port_ctrl_stats(np, 0, ctrl_stats); |
| break; |
| case ETHTOOL_MAC_STATS_SRC_PMAC: |
| netc_port_ctrl_stats(np, 1, ctrl_stats); |
| break; |
| case ETHTOOL_MAC_STATS_SRC_AGGREGATE: |
| ndev = dsa_to_port(ds, port)->user; |
| ethtool_aggregate_ctrl_stats(ndev, ctrl_stats); |
| break; |
| } |
| } |
| |
| static void netc_port_mac_stats(struct netc_port *np, int mac, |
| struct ethtool_eth_mac_stats *stats) |
| { |
| if (mac && !np->caps.pmac) |
| return; |
| |
| stats->FramesTransmittedOK = netc_port_rd64(np, NETC_PM_TFRM(mac)); |
| stats->SingleCollisionFrames = netc_port_rd64(np, NETC_PM_TSCOL(mac)); |
| stats->MultipleCollisionFrames = |
| netc_port_rd64(np, NETC_PM_TMCOL(mac)); |
| stats->FramesReceivedOK = netc_port_rd64(np, NETC_PM_RFRM(mac)); |
| stats->FrameCheckSequenceErrors = |
| netc_port_rd64(np, NETC_PM_RFCS(mac)); |
| stats->AlignmentErrors = netc_port_rd64(np, NETC_PM_RALN(mac)); |
| stats->OctetsTransmittedOK = netc_port_rd64(np, NETC_PM_TEOCT(mac)); |
| stats->FramesWithDeferredXmissions = |
| netc_port_rd64(np, NETC_PM_TDFR(mac)); |
| stats->LateCollisions = netc_port_rd64(np, NETC_PM_TLCOL(mac)); |
| stats->FramesAbortedDueToXSColls = |
| netc_port_rd64(np, NETC_PM_TECOL(mac)); |
| stats->FramesLostDueToIntMACXmitError = |
| netc_port_rd64(np, NETC_PM_TERR(mac)); |
| stats->OctetsReceivedOK = netc_port_rd64(np, NETC_PM_REOCT(mac)); |
| stats->FramesLostDueToIntMACRcvError = |
| netc_port_rd64(np, NETC_PM_RDRNTP(mac)); |
| stats->MulticastFramesXmittedOK = |
| netc_port_rd64(np, NETC_PM_TMCA(mac)); |
| stats->BroadcastFramesXmittedOK = |
| netc_port_rd64(np, NETC_PM_TBCA(mac)); |
| stats->MulticastFramesReceivedOK = |
| netc_port_rd64(np, NETC_PM_RMCA(mac)); |
| stats->BroadcastFramesReceivedOK = |
| netc_port_rd64(np, NETC_PM_RBCA(mac)); |
| stats->FramesWithExcessiveDeferral = |
| netc_port_rd64(np, NETC_PM_TEDFR(mac)); |
| } |
| |
| void netc_port_get_eth_mac_stats(struct dsa_switch *ds, int port, |
| struct ethtool_eth_mac_stats *mac_stats) |
| { |
| struct netc_port *np = NETC_PORT(ds, port); |
| struct net_device *ndev; |
| |
| switch (mac_stats->src) { |
| case ETHTOOL_MAC_STATS_SRC_EMAC: |
| netc_port_mac_stats(np, 0, mac_stats); |
| break; |
| case ETHTOOL_MAC_STATS_SRC_PMAC: |
| netc_port_mac_stats(np, 1, mac_stats); |
| break; |
| case ETHTOOL_MAC_STATS_SRC_AGGREGATE: |
| ndev = dsa_to_port(ds, port)->user; |
| ethtool_aggregate_mac_stats(ndev, mac_stats); |
| break; |
| } |
| } |
| |
| int netc_port_get_sset_count(struct dsa_switch *ds, int port, int sset) |
| { |
| struct netc_port *np = NETC_PORT(ds, port); |
| int size; |
| |
| if (sset != ETH_SS_STATS) |
| return -EOPNOTSUPP; |
| |
| size = ARRAY_SIZE(netc_port_counters) + |
| ARRAY_SIZE(netc_emac_counters); |
| |
| if (np->caps.pmac) |
| size += ARRAY_SIZE(netc_pmac_counters); |
| |
| return size; |
| } |
| |
| void netc_port_get_strings(struct dsa_switch *ds, int port, |
| u32 sset, u8 *data) |
| { |
| struct netc_port *np = NETC_PORT(ds, port); |
| int i; |
| |
| if (sset != ETH_SS_STATS) |
| return; |
| |
| for (i = 0; i < ARRAY_SIZE(netc_port_counters); i++) |
| ethtool_cpy(&data, netc_port_counters[i].name); |
| |
| for (i = 0; i < ARRAY_SIZE(netc_emac_counters); i++) |
| ethtool_cpy(&data, netc_emac_counters[i].name); |
| |
| if (!np->caps.pmac) |
| return; |
| |
| for (i = 0; i < ARRAY_SIZE(netc_pmac_counters); i++) |
| ethtool_cpy(&data, netc_pmac_counters[i].name); |
| } |
| |
| void netc_port_get_ethtool_stats(struct dsa_switch *ds, int port, u64 *data) |
| { |
| struct netc_port *np = NETC_PORT(ds, port); |
| int i; |
| |
| for (i = 0; i < ARRAY_SIZE(netc_port_counters); i++) |
| *data++ = netc_port_rd(np, netc_port_counters[i].reg); |
| |
| for (i = 0; i < ARRAY_SIZE(netc_emac_counters); i++) |
| *data++ = netc_port_rd64(np, netc_emac_counters[i].reg); |
| |
| if (!np->caps.pmac) |
| return; |
| |
| for (i = 0; i < ARRAY_SIZE(netc_pmac_counters); i++) |
| *data++ = netc_port_rd64(np, netc_pmac_counters[i].reg); |
| } |
