1265 lines
50 KiB
C
1265 lines
50 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/* Microchip Sparx5 Switch driver
|
|
*
|
|
* Copyright (c) 2021 Microchip Technology Inc. and its subsidiaries.
|
|
*/
|
|
|
|
#include <linux/ethtool.h>
|
|
|
|
#include "sparx5_main_regs.h"
|
|
#include "sparx5_main.h"
|
|
#include "sparx5_port.h"
|
|
|
|
/* Index of ANA_AC port counters */
|
|
#define SPX5_PORT_POLICER_DROPS 0
|
|
|
|
/* Add a potentially wrapping 32 bit value to a 64 bit counter */
|
|
static void sparx5_update_counter(u64 *cnt, u32 val)
|
|
{
|
|
if (val < (*cnt & U32_MAX))
|
|
*cnt += (u64)1 << 32; /* value has wrapped */
|
|
*cnt = (*cnt & ~(u64)U32_MAX) + val;
|
|
}
|
|
|
|
enum sparx5_stats_entry {
|
|
spx5_stats_rx_symbol_err_cnt = 0,
|
|
spx5_stats_pmac_rx_symbol_err_cnt = 1,
|
|
spx5_stats_tx_uc_cnt = 2,
|
|
spx5_stats_pmac_tx_uc_cnt = 3,
|
|
spx5_stats_tx_mc_cnt = 4,
|
|
spx5_stats_tx_bc_cnt = 5,
|
|
spx5_stats_tx_backoff1_cnt = 6,
|
|
spx5_stats_tx_multi_coll_cnt = 7,
|
|
spx5_stats_rx_uc_cnt = 8,
|
|
spx5_stats_pmac_rx_uc_cnt = 9,
|
|
spx5_stats_rx_mc_cnt = 10,
|
|
spx5_stats_rx_bc_cnt = 11,
|
|
spx5_stats_rx_crc_err_cnt = 12,
|
|
spx5_stats_pmac_rx_crc_err_cnt = 13,
|
|
spx5_stats_rx_alignment_lost_cnt = 14,
|
|
spx5_stats_pmac_rx_alignment_lost_cnt = 15,
|
|
spx5_stats_tx_ok_bytes_cnt = 16,
|
|
spx5_stats_pmac_tx_ok_bytes_cnt = 17,
|
|
spx5_stats_tx_defer_cnt = 18,
|
|
spx5_stats_tx_late_coll_cnt = 19,
|
|
spx5_stats_tx_xcoll_cnt = 20,
|
|
spx5_stats_tx_csense_cnt = 21,
|
|
spx5_stats_rx_ok_bytes_cnt = 22,
|
|
spx5_stats_pmac_rx_ok_bytes_cnt = 23,
|
|
spx5_stats_pmac_tx_mc_cnt = 24,
|
|
spx5_stats_pmac_tx_bc_cnt = 25,
|
|
spx5_stats_tx_xdefer_cnt = 26,
|
|
spx5_stats_pmac_rx_mc_cnt = 27,
|
|
spx5_stats_pmac_rx_bc_cnt = 28,
|
|
spx5_stats_rx_in_range_len_err_cnt = 29,
|
|
spx5_stats_pmac_rx_in_range_len_err_cnt = 30,
|
|
spx5_stats_rx_out_of_range_len_err_cnt = 31,
|
|
spx5_stats_pmac_rx_out_of_range_len_err_cnt = 32,
|
|
spx5_stats_rx_oversize_cnt = 33,
|
|
spx5_stats_pmac_rx_oversize_cnt = 34,
|
|
spx5_stats_tx_pause_cnt = 35,
|
|
spx5_stats_pmac_tx_pause_cnt = 36,
|
|
spx5_stats_rx_pause_cnt = 37,
|
|
spx5_stats_pmac_rx_pause_cnt = 38,
|
|
spx5_stats_rx_unsup_opcode_cnt = 39,
|
|
spx5_stats_pmac_rx_unsup_opcode_cnt = 40,
|
|
spx5_stats_rx_undersize_cnt = 41,
|
|
spx5_stats_pmac_rx_undersize_cnt = 42,
|
|
spx5_stats_rx_fragments_cnt = 43,
|
|
spx5_stats_pmac_rx_fragments_cnt = 44,
|
|
spx5_stats_rx_jabbers_cnt = 45,
|
|
spx5_stats_pmac_rx_jabbers_cnt = 46,
|
|
spx5_stats_rx_size64_cnt = 47,
|
|
spx5_stats_pmac_rx_size64_cnt = 48,
|
|
spx5_stats_rx_size65to127_cnt = 49,
|
|
spx5_stats_pmac_rx_size65to127_cnt = 50,
|
|
spx5_stats_rx_size128to255_cnt = 51,
|
|
spx5_stats_pmac_rx_size128to255_cnt = 52,
|
|
spx5_stats_rx_size256to511_cnt = 53,
|
|
spx5_stats_pmac_rx_size256to511_cnt = 54,
|
|
spx5_stats_rx_size512to1023_cnt = 55,
|
|
spx5_stats_pmac_rx_size512to1023_cnt = 56,
|
|
spx5_stats_rx_size1024to1518_cnt = 57,
|
|
spx5_stats_pmac_rx_size1024to1518_cnt = 58,
|
|
spx5_stats_rx_size1519tomax_cnt = 59,
|
|
spx5_stats_pmac_rx_size1519tomax_cnt = 60,
|
|
spx5_stats_tx_size64_cnt = 61,
|
|
spx5_stats_pmac_tx_size64_cnt = 62,
|
|
spx5_stats_tx_size65to127_cnt = 63,
|
|
spx5_stats_pmac_tx_size65to127_cnt = 64,
|
|
spx5_stats_tx_size128to255_cnt = 65,
|
|
spx5_stats_pmac_tx_size128to255_cnt = 66,
|
|
spx5_stats_tx_size256to511_cnt = 67,
|
|
spx5_stats_pmac_tx_size256to511_cnt = 68,
|
|
spx5_stats_tx_size512to1023_cnt = 69,
|
|
spx5_stats_pmac_tx_size512to1023_cnt = 70,
|
|
spx5_stats_tx_size1024to1518_cnt = 71,
|
|
spx5_stats_pmac_tx_size1024to1518_cnt = 72,
|
|
spx5_stats_tx_size1519tomax_cnt = 73,
|
|
spx5_stats_pmac_tx_size1519tomax_cnt = 74,
|
|
spx5_stats_mm_rx_assembly_err_cnt = 75,
|
|
spx5_stats_mm_rx_assembly_ok_cnt = 76,
|
|
spx5_stats_mm_rx_merge_frag_cnt = 77,
|
|
spx5_stats_mm_rx_smd_err_cnt = 78,
|
|
spx5_stats_mm_tx_pfragment_cnt = 79,
|
|
spx5_stats_rx_bad_bytes_cnt = 80,
|
|
spx5_stats_pmac_rx_bad_bytes_cnt = 81,
|
|
spx5_stats_rx_in_bytes_cnt = 82,
|
|
spx5_stats_rx_ipg_shrink_cnt = 83,
|
|
spx5_stats_rx_sync_lost_err_cnt = 84,
|
|
spx5_stats_rx_tagged_frms_cnt = 85,
|
|
spx5_stats_rx_untagged_frms_cnt = 86,
|
|
spx5_stats_tx_out_bytes_cnt = 87,
|
|
spx5_stats_tx_tagged_frms_cnt = 88,
|
|
spx5_stats_tx_untagged_frms_cnt = 89,
|
|
spx5_stats_rx_hih_cksm_err_cnt = 90,
|
|
spx5_stats_pmac_rx_hih_cksm_err_cnt = 91,
|
|
spx5_stats_rx_xgmii_prot_err_cnt = 92,
|
|
spx5_stats_pmac_rx_xgmii_prot_err_cnt = 93,
|
|
spx5_stats_ana_ac_port_stat_lsb_cnt = 94,
|
|
spx5_stats_green_p0_rx_fwd = 95,
|
|
spx5_stats_green_p0_rx_port_drop = 111,
|
|
spx5_stats_green_p0_tx_port = 127,
|
|
spx5_stats_rx_local_drop = 143,
|
|
spx5_stats_tx_local_drop = 144,
|
|
spx5_stats_count = 145,
|
|
};
|
|
|
|
static const char *const sparx5_stats_layout[] = {
|
|
"mm_rx_assembly_err_cnt",
|
|
"mm_rx_assembly_ok_cnt",
|
|
"mm_rx_merge_frag_cnt",
|
|
"mm_rx_smd_err_cnt",
|
|
"mm_tx_pfragment_cnt",
|
|
"rx_bad_bytes_cnt",
|
|
"pmac_rx_bad_bytes_cnt",
|
|
"rx_in_bytes_cnt",
|
|
"rx_ipg_shrink_cnt",
|
|
"rx_sync_lost_err_cnt",
|
|
"rx_tagged_frms_cnt",
|
|
"rx_untagged_frms_cnt",
|
|
"tx_out_bytes_cnt",
|
|
"tx_tagged_frms_cnt",
|
|
"tx_untagged_frms_cnt",
|
|
"rx_hih_cksm_err_cnt",
|
|
"pmac_rx_hih_cksm_err_cnt",
|
|
"rx_xgmii_prot_err_cnt",
|
|
"pmac_rx_xgmii_prot_err_cnt",
|
|
"rx_port_policer_drop",
|
|
"rx_fwd_green_p0",
|
|
"rx_fwd_green_p1",
|
|
"rx_fwd_green_p2",
|
|
"rx_fwd_green_p3",
|
|
"rx_fwd_green_p4",
|
|
"rx_fwd_green_p5",
|
|
"rx_fwd_green_p6",
|
|
"rx_fwd_green_p7",
|
|
"rx_fwd_yellow_p0",
|
|
"rx_fwd_yellow_p1",
|
|
"rx_fwd_yellow_p2",
|
|
"rx_fwd_yellow_p3",
|
|
"rx_fwd_yellow_p4",
|
|
"rx_fwd_yellow_p5",
|
|
"rx_fwd_yellow_p6",
|
|
"rx_fwd_yellow_p7",
|
|
"rx_port_drop_green_p0",
|
|
"rx_port_drop_green_p1",
|
|
"rx_port_drop_green_p2",
|
|
"rx_port_drop_green_p3",
|
|
"rx_port_drop_green_p4",
|
|
"rx_port_drop_green_p5",
|
|
"rx_port_drop_green_p6",
|
|
"rx_port_drop_green_p7",
|
|
"rx_port_drop_yellow_p0",
|
|
"rx_port_drop_yellow_p1",
|
|
"rx_port_drop_yellow_p2",
|
|
"rx_port_drop_yellow_p3",
|
|
"rx_port_drop_yellow_p4",
|
|
"rx_port_drop_yellow_p5",
|
|
"rx_port_drop_yellow_p6",
|
|
"rx_port_drop_yellow_p7",
|
|
"tx_port_green_p0",
|
|
"tx_port_green_p1",
|
|
"tx_port_green_p2",
|
|
"tx_port_green_p3",
|
|
"tx_port_green_p4",
|
|
"tx_port_green_p5",
|
|
"tx_port_green_p6",
|
|
"tx_port_green_p7",
|
|
"tx_port_yellow_p0",
|
|
"tx_port_yellow_p1",
|
|
"tx_port_yellow_p2",
|
|
"tx_port_yellow_p3",
|
|
"tx_port_yellow_p4",
|
|
"tx_port_yellow_p5",
|
|
"tx_port_yellow_p6",
|
|
"tx_port_yellow_p7",
|
|
"rx_local_drop",
|
|
"tx_local_drop",
|
|
};
|
|
|
|
static void sparx5_get_queue_sys_stats(struct sparx5 *sparx5, int portno)
|
|
{
|
|
u64 *portstats;
|
|
u64 *stats;
|
|
u32 addr;
|
|
int idx;
|
|
|
|
portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
mutex_lock(&sparx5->queue_stats_lock);
|
|
spx5_wr(XQS_STAT_CFG_STAT_VIEW_SET(portno), sparx5, XQS_STAT_CFG);
|
|
addr = 0;
|
|
stats = &portstats[spx5_stats_green_p0_rx_fwd];
|
|
for (idx = 0; idx < 2 * SPX5_PRIOS; ++idx, ++addr, ++stats)
|
|
sparx5_update_counter(stats, spx5_rd(sparx5, XQS_CNT(addr)));
|
|
addr = 16;
|
|
stats = &portstats[spx5_stats_green_p0_rx_port_drop];
|
|
for (idx = 0; idx < 2 * SPX5_PRIOS; ++idx, ++addr, ++stats)
|
|
sparx5_update_counter(stats, spx5_rd(sparx5, XQS_CNT(addr)));
|
|
addr = 256;
|
|
stats = &portstats[spx5_stats_green_p0_tx_port];
|
|
for (idx = 0; idx < 2 * SPX5_PRIOS; ++idx, ++addr, ++stats)
|
|
sparx5_update_counter(stats, spx5_rd(sparx5, XQS_CNT(addr)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_local_drop],
|
|
spx5_rd(sparx5, XQS_CNT(32)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_local_drop],
|
|
spx5_rd(sparx5, XQS_CNT(272)));
|
|
mutex_unlock(&sparx5->queue_stats_lock);
|
|
}
|
|
|
|
static void sparx5_get_ana_ac_stats_stats(struct sparx5 *sparx5, int portno)
|
|
{
|
|
u64 *portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
|
|
sparx5_update_counter(&portstats[spx5_stats_ana_ac_port_stat_lsb_cnt],
|
|
spx5_rd(sparx5, ANA_AC_PORT_STAT_LSB_CNT(portno,
|
|
SPX5_PORT_POLICER_DROPS)));
|
|
}
|
|
|
|
static void sparx5_get_dev_phy_stats(u64 *portstats, void __iomem *inst, u32
|
|
tinst)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_symbol_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_SYMBOL_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_symbol_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_SYMBOL_ERR_CNT(tinst)));
|
|
}
|
|
|
|
static void sparx5_get_dev_mac_stats(u64 *portstats, void __iomem *inst, u32
|
|
tinst)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_uc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_TX_UC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_uc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_PMAC_TX_UC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_mc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_TX_MC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_bc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_TX_BC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_uc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_UC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_uc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_PMAC_RX_UC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_mc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_MC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_bc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_BC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_crc_err_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_CRC_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_crc_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_CRC_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_alignment_lost_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_ALIGNMENT_LOST_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_alignment_lost_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_ALIGNMENT_LOST_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_ok_bytes_cnt],
|
|
spx5_inst_rd(inst, DEV5G_TX_OK_BYTES_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_ok_bytes_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_OK_BYTES_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_ok_bytes_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_OK_BYTES_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_ok_bytes_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_OK_BYTES_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_mc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_PMAC_TX_MC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_bc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_PMAC_TX_BC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_mc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_PMAC_RX_MC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_bc_cnt],
|
|
spx5_inst_rd(inst, DEV5G_PMAC_RX_BC_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_in_range_len_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_IN_RANGE_LEN_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_in_range_len_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_IN_RANGE_LEN_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_out_of_range_len_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_OUT_OF_RANGE_LEN_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_out_of_range_len_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_OUT_OF_RANGE_LEN_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_oversize_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_OVERSIZE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_oversize_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_OVERSIZE_CNT(tinst)));
|
|
}
|
|
|
|
static void sparx5_get_dev_mac_ctrl_stats(u64 *portstats, void __iomem *inst,
|
|
u32 tinst)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_pause_cnt],
|
|
spx5_inst_rd(inst, DEV5G_TX_PAUSE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_pause_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_PAUSE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_pause_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_PAUSE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_pause_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_PAUSE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_unsup_opcode_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_UNSUP_OPCODE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_unsup_opcode_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_UNSUP_OPCODE_CNT(tinst)));
|
|
}
|
|
|
|
static void sparx5_get_dev_rmon_stats(u64 *portstats, void __iomem *inst, u32
|
|
tinst)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_undersize_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_UNDERSIZE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_undersize_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_UNDERSIZE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_oversize_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_OVERSIZE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_oversize_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_OVERSIZE_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_fragments_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_FRAGMENTS_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_fragments_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_FRAGMENTS_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_jabbers_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_JABBERS_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_jabbers_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_JABBERS_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size64_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_SIZE64_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size64_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_SIZE64_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size65to127_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_SIZE65TO127_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size65to127_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_SIZE65TO127_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size128to255_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_SIZE128TO255_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size128to255_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_SIZE128TO255_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size256to511_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_SIZE256TO511_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size256to511_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_SIZE256TO511_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size512to1023_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_SIZE512TO1023_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size512to1023_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_SIZE512TO1023_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size1024to1518_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_SIZE1024TO1518_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size1024to1518_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_SIZE1024TO1518_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size1519tomax_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_SIZE1519TOMAX_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size1519tomax_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_SIZE1519TOMAX_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size64_cnt],
|
|
spx5_inst_rd(inst, DEV5G_TX_SIZE64_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size64_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_SIZE64_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size65to127_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_SIZE65TO127_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size65to127_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_SIZE65TO127_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size128to255_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_SIZE128TO255_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size128to255_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_SIZE128TO255_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size256to511_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_SIZE256TO511_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size256to511_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_SIZE256TO511_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size512to1023_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_SIZE512TO1023_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size512to1023_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_SIZE512TO1023_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size1024to1518_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_SIZE1024TO1518_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size1024to1518_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_SIZE1024TO1518_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size1519tomax_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_SIZE1519TOMAX_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size1519tomax_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_TX_SIZE1519TOMAX_CNT(tinst)));
|
|
}
|
|
|
|
static void sparx5_get_dev_misc_stats(u64 *portstats, void __iomem *inst, u32
|
|
tinst)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_rx_assembly_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_MM_RX_ASSEMBLY_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_rx_assembly_ok_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_MM_RX_ASSEMBLY_OK_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_rx_merge_frag_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_MM_RX_MERGE_FRAG_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_rx_smd_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_MM_RX_SMD_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_tx_pfragment_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_MM_TX_PFRAGMENT_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_bad_bytes_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_BAD_BYTES_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_bad_bytes_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_BAD_BYTES_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_in_bytes_cnt],
|
|
spx5_inst_rd(inst, DEV5G_RX_IN_BYTES_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_ipg_shrink_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_IPG_SHRINK_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_tagged_frms_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_TAGGED_FRMS_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_untagged_frms_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_UNTAGGED_FRMS_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_out_bytes_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_OUT_BYTES_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_tagged_frms_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_TAGGED_FRMS_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_untagged_frms_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_TX_UNTAGGED_FRMS_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_hih_cksm_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_HIH_CKSM_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_hih_cksm_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_HIH_CKSM_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_xgmii_prot_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_RX_XGMII_PROT_ERR_CNT(tinst)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_xgmii_prot_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
DEV5G_PMAC_RX_XGMII_PROT_ERR_CNT(tinst)));
|
|
}
|
|
|
|
static void sparx5_get_device_stats(struct sparx5 *sparx5, int portno)
|
|
{
|
|
u64 *portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
u32 tinst = sparx5_port_dev_index(portno);
|
|
u32 dev = sparx5_to_high_dev(portno);
|
|
void __iomem *inst;
|
|
|
|
inst = spx5_inst_get(sparx5, dev, tinst);
|
|
sparx5_get_dev_phy_stats(portstats, inst, tinst);
|
|
sparx5_get_dev_mac_stats(portstats, inst, tinst);
|
|
sparx5_get_dev_mac_ctrl_stats(portstats, inst, tinst);
|
|
sparx5_get_dev_rmon_stats(portstats, inst, tinst);
|
|
sparx5_get_dev_misc_stats(portstats, inst, tinst);
|
|
}
|
|
|
|
static void sparx5_get_asm_phy_stats(u64 *portstats, void __iomem *inst, int
|
|
portno)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_symbol_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_SYMBOL_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_symbol_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_SYMBOL_ERR_CNT(portno)));
|
|
}
|
|
|
|
static void sparx5_get_asm_mac_stats(u64 *portstats, void __iomem *inst, int
|
|
portno)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_uc_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_UC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_uc_cnt],
|
|
spx5_inst_rd(inst, ASM_PMAC_TX_UC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_mc_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_MC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_bc_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_BC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_backoff1_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_BACKOFF1_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_multi_coll_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_MULTI_COLL_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_uc_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_UC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_uc_cnt],
|
|
spx5_inst_rd(inst, ASM_PMAC_RX_UC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_mc_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_MC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_bc_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_BC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_crc_err_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_CRC_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_crc_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_CRC_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_alignment_lost_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_ALIGNMENT_LOST_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_alignment_lost_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_ALIGNMENT_LOST_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_ok_bytes_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_OK_BYTES_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_ok_bytes_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_OK_BYTES_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_defer_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_DEFER_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_late_coll_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_LATE_COLL_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_xcoll_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_XCOLL_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_csense_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_CSENSE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_ok_bytes_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_OK_BYTES_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_ok_bytes_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_OK_BYTES_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_mc_cnt],
|
|
spx5_inst_rd(inst, ASM_PMAC_TX_MC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_bc_cnt],
|
|
spx5_inst_rd(inst, ASM_PMAC_TX_BC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_xdefer_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_XDEFER_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_mc_cnt],
|
|
spx5_inst_rd(inst, ASM_PMAC_RX_MC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_bc_cnt],
|
|
spx5_inst_rd(inst, ASM_PMAC_RX_BC_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_in_range_len_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_IN_RANGE_LEN_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_in_range_len_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_IN_RANGE_LEN_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_out_of_range_len_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_OUT_OF_RANGE_LEN_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_out_of_range_len_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_OUT_OF_RANGE_LEN_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_oversize_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_OVERSIZE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_oversize_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_OVERSIZE_CNT(portno)));
|
|
}
|
|
|
|
static void sparx5_get_asm_mac_ctrl_stats(u64 *portstats, void __iomem *inst,
|
|
int portno)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_pause_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_PAUSE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_pause_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_PAUSE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_pause_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_PAUSE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_pause_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_PAUSE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_unsup_opcode_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_UNSUP_OPCODE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_unsup_opcode_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_UNSUP_OPCODE_CNT(portno)));
|
|
}
|
|
|
|
static void sparx5_get_asm_rmon_stats(u64 *portstats, void __iomem *inst, int
|
|
portno)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_undersize_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_UNDERSIZE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_undersize_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_UNDERSIZE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_oversize_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_OVERSIZE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_oversize_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_OVERSIZE_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_fragments_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_FRAGMENTS_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_fragments_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_FRAGMENTS_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_jabbers_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_JABBERS_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_jabbers_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_JABBERS_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size64_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_SIZE64_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size64_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_SIZE64_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size65to127_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_SIZE65TO127_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size65to127_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_SIZE65TO127_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size128to255_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_SIZE128TO255_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size128to255_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_SIZE128TO255_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size256to511_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_SIZE256TO511_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size256to511_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_SIZE256TO511_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size512to1023_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_SIZE512TO1023_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size512to1023_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_SIZE512TO1023_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size1024to1518_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_SIZE1024TO1518_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size1024to1518_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_SIZE1024TO1518_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_size1519tomax_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_SIZE1519TOMAX_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_size1519tomax_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_SIZE1519TOMAX_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size64_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_SIZE64_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size64_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_SIZE64_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size65to127_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_SIZE65TO127_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size65to127_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_SIZE65TO127_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size128to255_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_SIZE128TO255_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size128to255_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_SIZE128TO255_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size256to511_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_SIZE256TO511_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size256to511_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_SIZE256TO511_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size512to1023_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_SIZE512TO1023_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size512to1023_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_SIZE512TO1023_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size1024to1518_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_SIZE1024TO1518_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size1024to1518_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_SIZE1024TO1518_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_size1519tomax_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_SIZE1519TOMAX_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_tx_size1519tomax_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_TX_SIZE1519TOMAX_CNT(portno)));
|
|
}
|
|
|
|
static void sparx5_get_asm_misc_stats(u64 *portstats, void __iomem *inst, int
|
|
portno)
|
|
{
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_rx_assembly_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_MM_RX_ASSEMBLY_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_rx_assembly_ok_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_MM_RX_ASSEMBLY_OK_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_rx_merge_frag_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_MM_RX_MERGE_FRAG_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_rx_smd_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_MM_RX_SMD_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_mm_tx_pfragment_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_MM_TX_PFRAGMENT_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_bad_bytes_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_BAD_BYTES_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_pmac_rx_bad_bytes_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_PMAC_RX_BAD_BYTES_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_in_bytes_cnt],
|
|
spx5_inst_rd(inst, ASM_RX_IN_BYTES_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_ipg_shrink_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_IPG_SHRINK_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_sync_lost_err_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_SYNC_LOST_ERR_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_tagged_frms_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_TAGGED_FRMS_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_rx_untagged_frms_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_RX_UNTAGGED_FRMS_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_out_bytes_cnt],
|
|
spx5_inst_rd(inst, ASM_TX_OUT_BYTES_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_tagged_frms_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_TAGGED_FRMS_CNT(portno)));
|
|
sparx5_update_counter(&portstats[spx5_stats_tx_untagged_frms_cnt],
|
|
spx5_inst_rd(inst,
|
|
ASM_TX_UNTAGGED_FRMS_CNT(portno)));
|
|
}
|
|
|
|
static void sparx5_get_asm_stats(struct sparx5 *sparx5, int portno)
|
|
{
|
|
u64 *portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
void __iomem *inst = spx5_inst_get(sparx5, TARGET_ASM, 0);
|
|
|
|
sparx5_get_asm_phy_stats(portstats, inst, portno);
|
|
sparx5_get_asm_mac_stats(portstats, inst, portno);
|
|
sparx5_get_asm_mac_ctrl_stats(portstats, inst, portno);
|
|
sparx5_get_asm_rmon_stats(portstats, inst, portno);
|
|
sparx5_get_asm_misc_stats(portstats, inst, portno);
|
|
}
|
|
|
|
static const struct ethtool_rmon_hist_range sparx5_rmon_ranges[] = {
|
|
{ 0, 64 },
|
|
{ 65, 127 },
|
|
{ 128, 255 },
|
|
{ 256, 511 },
|
|
{ 512, 1023 },
|
|
{ 1024, 1518 },
|
|
{ 1519, 10239 },
|
|
{}
|
|
};
|
|
|
|
static void sparx5_get_eth_phy_stats(struct net_device *ndev,
|
|
struct ethtool_eth_phy_stats *phy_stats)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
int portno = port->portno;
|
|
void __iomem *inst;
|
|
u64 *portstats;
|
|
|
|
portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
if (sparx5_is_baser(port->conf.portmode)) {
|
|
u32 tinst = sparx5_port_dev_index(portno);
|
|
u32 dev = sparx5_to_high_dev(portno);
|
|
|
|
inst = spx5_inst_get(sparx5, dev, tinst);
|
|
sparx5_get_dev_phy_stats(portstats, inst, tinst);
|
|
} else {
|
|
inst = spx5_inst_get(sparx5, TARGET_ASM, 0);
|
|
sparx5_get_asm_phy_stats(portstats, inst, portno);
|
|
}
|
|
phy_stats->SymbolErrorDuringCarrier =
|
|
portstats[spx5_stats_rx_symbol_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_symbol_err_cnt];
|
|
}
|
|
|
|
static void sparx5_get_eth_mac_stats(struct net_device *ndev,
|
|
struct ethtool_eth_mac_stats *mac_stats)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
int portno = port->portno;
|
|
void __iomem *inst;
|
|
u64 *portstats;
|
|
|
|
portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
if (sparx5_is_baser(port->conf.portmode)) {
|
|
u32 tinst = sparx5_port_dev_index(portno);
|
|
u32 dev = sparx5_to_high_dev(portno);
|
|
|
|
inst = spx5_inst_get(sparx5, dev, tinst);
|
|
sparx5_get_dev_mac_stats(portstats, inst, tinst);
|
|
} else {
|
|
inst = spx5_inst_get(sparx5, TARGET_ASM, 0);
|
|
sparx5_get_asm_mac_stats(portstats, inst, portno);
|
|
}
|
|
mac_stats->FramesTransmittedOK = portstats[spx5_stats_tx_uc_cnt] +
|
|
portstats[spx5_stats_pmac_tx_uc_cnt] +
|
|
portstats[spx5_stats_tx_mc_cnt] +
|
|
portstats[spx5_stats_tx_bc_cnt];
|
|
mac_stats->SingleCollisionFrames =
|
|
portstats[spx5_stats_tx_backoff1_cnt];
|
|
mac_stats->MultipleCollisionFrames =
|
|
portstats[spx5_stats_tx_multi_coll_cnt];
|
|
mac_stats->FramesReceivedOK = portstats[spx5_stats_rx_uc_cnt] +
|
|
portstats[spx5_stats_pmac_rx_uc_cnt] +
|
|
portstats[spx5_stats_rx_mc_cnt] +
|
|
portstats[spx5_stats_rx_bc_cnt];
|
|
mac_stats->FrameCheckSequenceErrors =
|
|
portstats[spx5_stats_rx_crc_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_crc_err_cnt];
|
|
mac_stats->AlignmentErrors = portstats[spx5_stats_rx_alignment_lost_cnt]
|
|
+ portstats[spx5_stats_pmac_rx_alignment_lost_cnt];
|
|
mac_stats->OctetsTransmittedOK = portstats[spx5_stats_tx_ok_bytes_cnt] +
|
|
portstats[spx5_stats_pmac_tx_ok_bytes_cnt];
|
|
mac_stats->FramesWithDeferredXmissions =
|
|
portstats[spx5_stats_tx_defer_cnt];
|
|
mac_stats->LateCollisions =
|
|
portstats[spx5_stats_tx_late_coll_cnt];
|
|
mac_stats->FramesAbortedDueToXSColls =
|
|
portstats[spx5_stats_tx_xcoll_cnt];
|
|
mac_stats->CarrierSenseErrors = portstats[spx5_stats_tx_csense_cnt];
|
|
mac_stats->OctetsReceivedOK = portstats[spx5_stats_rx_ok_bytes_cnt] +
|
|
portstats[spx5_stats_pmac_rx_ok_bytes_cnt];
|
|
mac_stats->MulticastFramesXmittedOK = portstats[spx5_stats_tx_mc_cnt] +
|
|
portstats[spx5_stats_pmac_tx_mc_cnt];
|
|
mac_stats->BroadcastFramesXmittedOK = portstats[spx5_stats_tx_bc_cnt] +
|
|
portstats[spx5_stats_pmac_tx_bc_cnt];
|
|
mac_stats->FramesWithExcessiveDeferral =
|
|
portstats[spx5_stats_tx_xdefer_cnt];
|
|
mac_stats->MulticastFramesReceivedOK = portstats[spx5_stats_rx_mc_cnt] +
|
|
portstats[spx5_stats_pmac_rx_mc_cnt];
|
|
mac_stats->BroadcastFramesReceivedOK = portstats[spx5_stats_rx_bc_cnt] +
|
|
portstats[spx5_stats_pmac_rx_bc_cnt];
|
|
mac_stats->InRangeLengthErrors =
|
|
portstats[spx5_stats_rx_in_range_len_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_in_range_len_err_cnt];
|
|
mac_stats->OutOfRangeLengthField =
|
|
portstats[spx5_stats_rx_out_of_range_len_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_out_of_range_len_err_cnt];
|
|
mac_stats->FrameTooLongErrors = portstats[spx5_stats_rx_oversize_cnt] +
|
|
portstats[spx5_stats_pmac_rx_oversize_cnt];
|
|
}
|
|
|
|
static void sparx5_get_eth_mac_ctrl_stats(struct net_device *ndev,
|
|
struct ethtool_eth_ctrl_stats *mac_ctrl_stats)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
int portno = port->portno;
|
|
void __iomem *inst;
|
|
u64 *portstats;
|
|
|
|
portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
if (sparx5_is_baser(port->conf.portmode)) {
|
|
u32 tinst = sparx5_port_dev_index(portno);
|
|
u32 dev = sparx5_to_high_dev(portno);
|
|
|
|
inst = spx5_inst_get(sparx5, dev, tinst);
|
|
sparx5_get_dev_mac_ctrl_stats(portstats, inst, tinst);
|
|
} else {
|
|
inst = spx5_inst_get(sparx5, TARGET_ASM, 0);
|
|
sparx5_get_asm_mac_ctrl_stats(portstats, inst, portno);
|
|
}
|
|
mac_ctrl_stats->MACControlFramesTransmitted =
|
|
portstats[spx5_stats_tx_pause_cnt] +
|
|
portstats[spx5_stats_pmac_tx_pause_cnt];
|
|
mac_ctrl_stats->MACControlFramesReceived =
|
|
portstats[spx5_stats_rx_pause_cnt] +
|
|
portstats[spx5_stats_pmac_rx_pause_cnt];
|
|
mac_ctrl_stats->UnsupportedOpcodesReceived =
|
|
portstats[spx5_stats_rx_unsup_opcode_cnt] +
|
|
portstats[spx5_stats_pmac_rx_unsup_opcode_cnt];
|
|
}
|
|
|
|
static void sparx5_get_eth_rmon_stats(struct net_device *ndev,
|
|
struct ethtool_rmon_stats *rmon_stats,
|
|
const struct ethtool_rmon_hist_range **ranges)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
int portno = port->portno;
|
|
void __iomem *inst;
|
|
u64 *portstats;
|
|
|
|
portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
if (sparx5_is_baser(port->conf.portmode)) {
|
|
u32 tinst = sparx5_port_dev_index(portno);
|
|
u32 dev = sparx5_to_high_dev(portno);
|
|
|
|
inst = spx5_inst_get(sparx5, dev, tinst);
|
|
sparx5_get_dev_rmon_stats(portstats, inst, tinst);
|
|
} else {
|
|
inst = spx5_inst_get(sparx5, TARGET_ASM, 0);
|
|
sparx5_get_asm_rmon_stats(portstats, inst, portno);
|
|
}
|
|
rmon_stats->undersize_pkts = portstats[spx5_stats_rx_undersize_cnt] +
|
|
portstats[spx5_stats_pmac_rx_undersize_cnt];
|
|
rmon_stats->oversize_pkts = portstats[spx5_stats_rx_oversize_cnt] +
|
|
portstats[spx5_stats_pmac_rx_oversize_cnt];
|
|
rmon_stats->fragments = portstats[spx5_stats_rx_fragments_cnt] +
|
|
portstats[spx5_stats_pmac_rx_fragments_cnt];
|
|
rmon_stats->jabbers = portstats[spx5_stats_rx_jabbers_cnt] +
|
|
portstats[spx5_stats_pmac_rx_jabbers_cnt];
|
|
rmon_stats->hist[0] = portstats[spx5_stats_rx_size64_cnt] +
|
|
portstats[spx5_stats_pmac_rx_size64_cnt];
|
|
rmon_stats->hist[1] = portstats[spx5_stats_rx_size65to127_cnt] +
|
|
portstats[spx5_stats_pmac_rx_size65to127_cnt];
|
|
rmon_stats->hist[2] = portstats[spx5_stats_rx_size128to255_cnt] +
|
|
portstats[spx5_stats_pmac_rx_size128to255_cnt];
|
|
rmon_stats->hist[3] = portstats[spx5_stats_rx_size256to511_cnt] +
|
|
portstats[spx5_stats_pmac_rx_size256to511_cnt];
|
|
rmon_stats->hist[4] = portstats[spx5_stats_rx_size512to1023_cnt] +
|
|
portstats[spx5_stats_pmac_rx_size512to1023_cnt];
|
|
rmon_stats->hist[5] = portstats[spx5_stats_rx_size1024to1518_cnt] +
|
|
portstats[spx5_stats_pmac_rx_size1024to1518_cnt];
|
|
rmon_stats->hist[6] = portstats[spx5_stats_rx_size1519tomax_cnt] +
|
|
portstats[spx5_stats_pmac_rx_size1519tomax_cnt];
|
|
rmon_stats->hist_tx[0] = portstats[spx5_stats_tx_size64_cnt] +
|
|
portstats[spx5_stats_pmac_tx_size64_cnt];
|
|
rmon_stats->hist_tx[1] = portstats[spx5_stats_tx_size65to127_cnt] +
|
|
portstats[spx5_stats_pmac_tx_size65to127_cnt];
|
|
rmon_stats->hist_tx[2] = portstats[spx5_stats_tx_size128to255_cnt] +
|
|
portstats[spx5_stats_pmac_tx_size128to255_cnt];
|
|
rmon_stats->hist_tx[3] = portstats[spx5_stats_tx_size256to511_cnt] +
|
|
portstats[spx5_stats_pmac_tx_size256to511_cnt];
|
|
rmon_stats->hist_tx[4] = portstats[spx5_stats_tx_size512to1023_cnt] +
|
|
portstats[spx5_stats_pmac_tx_size512to1023_cnt];
|
|
rmon_stats->hist_tx[5] = portstats[spx5_stats_tx_size1024to1518_cnt] +
|
|
portstats[spx5_stats_pmac_tx_size1024to1518_cnt];
|
|
rmon_stats->hist_tx[6] = portstats[spx5_stats_tx_size1519tomax_cnt] +
|
|
portstats[spx5_stats_pmac_tx_size1519tomax_cnt];
|
|
*ranges = sparx5_rmon_ranges;
|
|
}
|
|
|
|
static int sparx5_get_sset_count(struct net_device *ndev, int sset)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
|
|
if (sset != ETH_SS_STATS)
|
|
return -EOPNOTSUPP;
|
|
return sparx5->num_ethtool_stats;
|
|
}
|
|
|
|
static void sparx5_get_sset_strings(struct net_device *ndev, u32 sset, u8 *data)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
int idx;
|
|
|
|
if (sset != ETH_SS_STATS)
|
|
return;
|
|
|
|
for (idx = 0; idx < sparx5->num_ethtool_stats; idx++)
|
|
strncpy(data + idx * ETH_GSTRING_LEN,
|
|
sparx5->stats_layout[idx], ETH_GSTRING_LEN);
|
|
}
|
|
|
|
static void sparx5_get_sset_data(struct net_device *ndev,
|
|
struct ethtool_stats *stats, u64 *data)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
int portno = port->portno;
|
|
void __iomem *inst;
|
|
u64 *portstats;
|
|
int idx;
|
|
|
|
portstats = &sparx5->stats[portno * sparx5->num_stats];
|
|
if (sparx5_is_baser(port->conf.portmode)) {
|
|
u32 tinst = sparx5_port_dev_index(portno);
|
|
u32 dev = sparx5_to_high_dev(portno);
|
|
|
|
inst = spx5_inst_get(sparx5, dev, tinst);
|
|
sparx5_get_dev_misc_stats(portstats, inst, tinst);
|
|
} else {
|
|
inst = spx5_inst_get(sparx5, TARGET_ASM, 0);
|
|
sparx5_get_asm_misc_stats(portstats, inst, portno);
|
|
}
|
|
sparx5_get_ana_ac_stats_stats(sparx5, portno);
|
|
sparx5_get_queue_sys_stats(sparx5, portno);
|
|
/* Copy port counters to the ethtool buffer */
|
|
for (idx = spx5_stats_mm_rx_assembly_err_cnt;
|
|
idx < spx5_stats_mm_rx_assembly_err_cnt +
|
|
sparx5->num_ethtool_stats; idx++)
|
|
*data++ = portstats[idx];
|
|
}
|
|
|
|
void sparx5_get_stats64(struct net_device *ndev,
|
|
struct rtnl_link_stats64 *stats)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
u64 *portstats;
|
|
int idx;
|
|
|
|
if (!sparx5->stats)
|
|
return; /* Not initialized yet */
|
|
|
|
portstats = &sparx5->stats[port->portno * sparx5->num_stats];
|
|
|
|
stats->rx_packets = portstats[spx5_stats_rx_uc_cnt] +
|
|
portstats[spx5_stats_pmac_rx_uc_cnt] +
|
|
portstats[spx5_stats_rx_mc_cnt] +
|
|
portstats[spx5_stats_rx_bc_cnt];
|
|
stats->tx_packets = portstats[spx5_stats_tx_uc_cnt] +
|
|
portstats[spx5_stats_pmac_tx_uc_cnt] +
|
|
portstats[spx5_stats_tx_mc_cnt] +
|
|
portstats[spx5_stats_tx_bc_cnt];
|
|
stats->rx_bytes = portstats[spx5_stats_rx_ok_bytes_cnt] +
|
|
portstats[spx5_stats_pmac_rx_ok_bytes_cnt];
|
|
stats->tx_bytes = portstats[spx5_stats_tx_ok_bytes_cnt] +
|
|
portstats[spx5_stats_pmac_tx_ok_bytes_cnt];
|
|
stats->rx_errors = portstats[spx5_stats_rx_in_range_len_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_in_range_len_err_cnt] +
|
|
portstats[spx5_stats_rx_out_of_range_len_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_out_of_range_len_err_cnt] +
|
|
portstats[spx5_stats_rx_oversize_cnt] +
|
|
portstats[spx5_stats_pmac_rx_oversize_cnt] +
|
|
portstats[spx5_stats_rx_crc_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_crc_err_cnt] +
|
|
portstats[spx5_stats_rx_alignment_lost_cnt] +
|
|
portstats[spx5_stats_pmac_rx_alignment_lost_cnt];
|
|
stats->tx_errors = portstats[spx5_stats_tx_xcoll_cnt] +
|
|
portstats[spx5_stats_tx_csense_cnt] +
|
|
portstats[spx5_stats_tx_late_coll_cnt];
|
|
stats->multicast = portstats[spx5_stats_rx_mc_cnt] +
|
|
portstats[spx5_stats_pmac_rx_mc_cnt];
|
|
stats->collisions = portstats[spx5_stats_tx_late_coll_cnt] +
|
|
portstats[spx5_stats_tx_xcoll_cnt] +
|
|
portstats[spx5_stats_tx_backoff1_cnt];
|
|
stats->rx_length_errors = portstats[spx5_stats_rx_in_range_len_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_in_range_len_err_cnt] +
|
|
portstats[spx5_stats_rx_out_of_range_len_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_out_of_range_len_err_cnt] +
|
|
portstats[spx5_stats_rx_oversize_cnt] +
|
|
portstats[spx5_stats_pmac_rx_oversize_cnt];
|
|
stats->rx_crc_errors = portstats[spx5_stats_rx_crc_err_cnt] +
|
|
portstats[spx5_stats_pmac_rx_crc_err_cnt];
|
|
stats->rx_frame_errors = portstats[spx5_stats_rx_alignment_lost_cnt] +
|
|
portstats[spx5_stats_pmac_rx_alignment_lost_cnt];
|
|
stats->tx_aborted_errors = portstats[spx5_stats_tx_xcoll_cnt];
|
|
stats->tx_carrier_errors = portstats[spx5_stats_tx_csense_cnt];
|
|
stats->tx_window_errors = portstats[spx5_stats_tx_late_coll_cnt];
|
|
stats->rx_dropped = portstats[spx5_stats_ana_ac_port_stat_lsb_cnt];
|
|
for (idx = 0; idx < 2 * SPX5_PRIOS; ++idx)
|
|
stats->rx_dropped += portstats[spx5_stats_green_p0_rx_port_drop
|
|
+ idx];
|
|
stats->tx_dropped = portstats[spx5_stats_tx_local_drop];
|
|
}
|
|
|
|
static void sparx5_update_port_stats(struct sparx5 *sparx5, int portno)
|
|
{
|
|
if (sparx5_is_baser(sparx5->ports[portno]->conf.portmode))
|
|
sparx5_get_device_stats(sparx5, portno);
|
|
else
|
|
sparx5_get_asm_stats(sparx5, portno);
|
|
sparx5_get_ana_ac_stats_stats(sparx5, portno);
|
|
sparx5_get_queue_sys_stats(sparx5, portno);
|
|
}
|
|
|
|
static void sparx5_update_stats(struct sparx5 *sparx5)
|
|
{
|
|
int idx;
|
|
|
|
for (idx = 0; idx < SPX5_PORTS; idx++)
|
|
if (sparx5->ports[idx])
|
|
sparx5_update_port_stats(sparx5, idx);
|
|
}
|
|
|
|
static void sparx5_check_stats_work(struct work_struct *work)
|
|
{
|
|
struct delayed_work *dwork = to_delayed_work(work);
|
|
struct sparx5 *sparx5 = container_of(dwork,
|
|
struct sparx5,
|
|
stats_work);
|
|
|
|
sparx5_update_stats(sparx5);
|
|
|
|
queue_delayed_work(sparx5->stats_queue, &sparx5->stats_work,
|
|
SPX5_STATS_CHECK_DELAY);
|
|
}
|
|
|
|
static int sparx5_get_link_settings(struct net_device *ndev,
|
|
struct ethtool_link_ksettings *cmd)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
|
|
return phylink_ethtool_ksettings_get(port->phylink, cmd);
|
|
}
|
|
|
|
static int sparx5_set_link_settings(struct net_device *ndev,
|
|
const struct ethtool_link_ksettings *cmd)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(ndev);
|
|
|
|
return phylink_ethtool_ksettings_set(port->phylink, cmd);
|
|
}
|
|
|
|
static void sparx5_config_stats(struct sparx5 *sparx5)
|
|
{
|
|
/* Enable global events for port policer drops */
|
|
spx5_rmw(ANA_AC_PORT_SGE_CFG_MASK_SET(0xf0f0),
|
|
ANA_AC_PORT_SGE_CFG_MASK,
|
|
sparx5,
|
|
ANA_AC_PORT_SGE_CFG(SPX5_PORT_POLICER_DROPS));
|
|
}
|
|
|
|
static void sparx5_config_port_stats(struct sparx5 *sparx5, int portno)
|
|
{
|
|
/* Clear Queue System counters */
|
|
spx5_wr(XQS_STAT_CFG_STAT_VIEW_SET(portno) |
|
|
XQS_STAT_CFG_STAT_CLEAR_SHOT_SET(3), sparx5,
|
|
XQS_STAT_CFG);
|
|
|
|
/* Use counter for port policer drop count */
|
|
spx5_rmw(ANA_AC_PORT_STAT_CFG_CFG_CNT_FRM_TYPE_SET(1) |
|
|
ANA_AC_PORT_STAT_CFG_CFG_CNT_BYTE_SET(0) |
|
|
ANA_AC_PORT_STAT_CFG_CFG_PRIO_MASK_SET(0xff),
|
|
ANA_AC_PORT_STAT_CFG_CFG_CNT_FRM_TYPE |
|
|
ANA_AC_PORT_STAT_CFG_CFG_CNT_BYTE |
|
|
ANA_AC_PORT_STAT_CFG_CFG_PRIO_MASK,
|
|
sparx5, ANA_AC_PORT_STAT_CFG(portno, SPX5_PORT_POLICER_DROPS));
|
|
}
|
|
|
|
static int sparx5_get_ts_info(struct net_device *dev,
|
|
struct ethtool_ts_info *info)
|
|
{
|
|
struct sparx5_port *port = netdev_priv(dev);
|
|
struct sparx5 *sparx5 = port->sparx5;
|
|
struct sparx5_phc *phc;
|
|
|
|
if (!sparx5->ptp)
|
|
return ethtool_op_get_ts_info(dev, info);
|
|
|
|
phc = &sparx5->phc[SPARX5_PHC_PORT];
|
|
|
|
info->phc_index = phc->clock ? ptp_clock_index(phc->clock) : -1;
|
|
if (info->phc_index == -1) {
|
|
info->so_timestamping |= SOF_TIMESTAMPING_TX_SOFTWARE |
|
|
SOF_TIMESTAMPING_RX_SOFTWARE |
|
|
SOF_TIMESTAMPING_SOFTWARE;
|
|
return 0;
|
|
}
|
|
info->so_timestamping |= SOF_TIMESTAMPING_TX_SOFTWARE |
|
|
SOF_TIMESTAMPING_RX_SOFTWARE |
|
|
SOF_TIMESTAMPING_SOFTWARE |
|
|
SOF_TIMESTAMPING_TX_HARDWARE |
|
|
SOF_TIMESTAMPING_RX_HARDWARE |
|
|
SOF_TIMESTAMPING_RAW_HARDWARE;
|
|
info->tx_types = BIT(HWTSTAMP_TX_OFF) | BIT(HWTSTAMP_TX_ON) |
|
|
BIT(HWTSTAMP_TX_ONESTEP_SYNC);
|
|
info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) |
|
|
BIT(HWTSTAMP_FILTER_ALL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
const struct ethtool_ops sparx5_ethtool_ops = {
|
|
.get_sset_count = sparx5_get_sset_count,
|
|
.get_strings = sparx5_get_sset_strings,
|
|
.get_ethtool_stats = sparx5_get_sset_data,
|
|
.get_link_ksettings = sparx5_get_link_settings,
|
|
.set_link_ksettings = sparx5_set_link_settings,
|
|
.get_link = ethtool_op_get_link,
|
|
.get_eth_phy_stats = sparx5_get_eth_phy_stats,
|
|
.get_eth_mac_stats = sparx5_get_eth_mac_stats,
|
|
.get_eth_ctrl_stats = sparx5_get_eth_mac_ctrl_stats,
|
|
.get_rmon_stats = sparx5_get_eth_rmon_stats,
|
|
.get_ts_info = sparx5_get_ts_info,
|
|
};
|
|
|
|
int sparx_stats_init(struct sparx5 *sparx5)
|
|
{
|
|
char queue_name[32];
|
|
int portno;
|
|
|
|
sparx5->stats_layout = sparx5_stats_layout;
|
|
sparx5->num_stats = spx5_stats_count;
|
|
sparx5->num_ethtool_stats = ARRAY_SIZE(sparx5_stats_layout);
|
|
sparx5->stats = devm_kcalloc(sparx5->dev,
|
|
SPX5_PORTS_ALL * sparx5->num_stats,
|
|
sizeof(u64), GFP_KERNEL);
|
|
if (!sparx5->stats)
|
|
return -ENOMEM;
|
|
|
|
mutex_init(&sparx5->queue_stats_lock);
|
|
sparx5_config_stats(sparx5);
|
|
for (portno = 0; portno < SPX5_PORTS; portno++)
|
|
if (sparx5->ports[portno])
|
|
sparx5_config_port_stats(sparx5, portno);
|
|
|
|
snprintf(queue_name, sizeof(queue_name), "%s-stats",
|
|
dev_name(sparx5->dev));
|
|
sparx5->stats_queue = create_singlethread_workqueue(queue_name);
|
|
if (!sparx5->stats_queue)
|
|
return -ENOMEM;
|
|
|
|
INIT_DELAYED_WORK(&sparx5->stats_work, sparx5_check_stats_work);
|
|
queue_delayed_work(sparx5->stats_queue, &sparx5->stats_work,
|
|
SPX5_STATS_CHECK_DELAY);
|
|
|
|
return 0;
|
|
}
|