97 lines
3.4 KiB
Diff
97 lines
3.4 KiB
Diff
From 30da8769107ce2112f3dc356fd06f0fa5bed7742 Mon Sep 17 00:00:00 2001
|
|
From: Alex Marginean <alexandru.marginean@nxp.com>
|
|
Date: Mon, 6 Jan 2020 17:57:10 +0200
|
|
Subject: [PATCH] drivers: net: phy: aquantia: Add XFI counters
|
|
|
|
Adds XFI counters and enables counters for AQR112/412. These are gen 3
|
|
PHYs, the register map is compatible with AQR107 which is gen 2.
|
|
|
|
Signed-off-by: Alex Marginean <alexandru.marginean@nxp.com>
|
|
---
|
|
drivers/net/phy/aquantia_main.c | 27 ++++++++++++++++++++++++---
|
|
1 file changed, 24 insertions(+), 3 deletions(-)
|
|
|
|
--- a/drivers/net/phy/aquantia_main.c
|
|
+++ b/drivers/net/phy/aquantia_main.c
|
|
@@ -25,6 +25,12 @@
|
|
#define PHY_ID_AQR112 0x03a1b662
|
|
#define PHY_ID_AQR412 0x03a1b712
|
|
|
|
+/* PCS counters */
|
|
+#define MDIO_C45_PCS_STAT_XFI_TX_GOOD_FRAMES 0xc860
|
|
+#define MDIO_C45_PCS_STAT_XFI_TX_BAD_FRAMES 0xc862
|
|
+#define MDIO_C45_PCS_STAT_XFI_RX_GOOD_FRAMES 0xe860
|
|
+#define MDIO_C45_PCS_STAT_XFI_RX_BAD_FRAMES 0xe862
|
|
+
|
|
#define MDIO_PHYXS_VEND_IF_STATUS 0xe812
|
|
#define MDIO_PHYXS_VEND_IF_STATUS_TYPE_MASK GENMASK(7, 3)
|
|
#define MDIO_PHYXS_VEND_IF_STATUS_TYPE_KR 0
|
|
@@ -153,9 +159,12 @@ struct aqr107_hw_stat {
|
|
const char *name;
|
|
int reg;
|
|
int size;
|
|
+ int devad;
|
|
};
|
|
|
|
-#define SGMII_STAT(n, r, s) { n, MDIO_C22EXT_STAT_SGMII_ ## r, s }
|
|
+#define SGMII_STAT(n, r, s) { n, MDIO_C22EXT_STAT_SGMII_ ## r, s, \
|
|
+ MDIO_MMD_C22EXT}
|
|
+#define C45_PCS_STAT(n, r, s) { n, MDIO_C45_PCS_STAT_ ## r, s, MDIO_MMD_PCS }
|
|
static const struct aqr107_hw_stat aqr107_hw_stats[] = {
|
|
SGMII_STAT("sgmii_rx_good_frames", RX_GOOD_FRAMES, 26),
|
|
SGMII_STAT("sgmii_rx_bad_frames", RX_BAD_FRAMES, 26),
|
|
@@ -167,6 +176,10 @@ static const struct aqr107_hw_stat aqr10
|
|
SGMII_STAT("sgmii_tx_line_collisions", TX_LINE_COLLISIONS, 8),
|
|
SGMII_STAT("sgmii_tx_frame_alignment_err", TX_FRAME_ALIGN_ERR, 16),
|
|
SGMII_STAT("sgmii_tx_runt_frames", TX_RUNT_FRAMES, 22),
|
|
+ C45_PCS_STAT("xfi_rx_good_frames", XFI_RX_GOOD_FRAMES, 26),
|
|
+ C45_PCS_STAT("xfi_rx_bad_frames", XFI_RX_BAD_FRAMES, 26),
|
|
+ C45_PCS_STAT("xfi_tx_good_frames", XFI_TX_GOOD_FRAMES, 26),
|
|
+ C45_PCS_STAT("xfi_tx_bad_frames", XFI_TX_BAD_FRAMES, 26),
|
|
};
|
|
#define AQR107_SGMII_STAT_SZ ARRAY_SIZE(aqr107_hw_stats)
|
|
|
|
@@ -196,13 +209,13 @@ static u64 aqr107_get_stat(struct phy_de
|
|
u64 ret;
|
|
int val;
|
|
|
|
- val = phy_read_mmd(phydev, MDIO_MMD_C22EXT, stat->reg);
|
|
+ val = phy_read_mmd(phydev, stat->devad, stat->reg);
|
|
if (val < 0)
|
|
return U64_MAX;
|
|
|
|
ret = val & GENMASK(len_l - 1, 0);
|
|
if (len_h) {
|
|
- val = phy_read_mmd(phydev, MDIO_MMD_C22EXT, stat->reg + 1);
|
|
+ val = phy_read_mmd(phydev, stat->devad, stat->reg + 1);
|
|
if (val < 0)
|
|
return U64_MAX;
|
|
|
|
@@ -768,18 +781,26 @@ static struct phy_driver aqr_driver[] =
|
|
{
|
|
PHY_ID_MATCH_MODEL(PHY_ID_AQR112),
|
|
.name = "Aquantia AQR112",
|
|
+ .probe = aqr107_probe,
|
|
.config_aneg = aqr_config_aneg_set_prot,
|
|
.config_intr = aqr_config_intr,
|
|
.ack_interrupt = aqr_ack_interrupt,
|
|
.read_status = aqr_read_status,
|
|
+ .get_sset_count = aqr107_get_sset_count,
|
|
+ .get_strings = aqr107_get_strings,
|
|
+ .get_stats = aqr107_get_stats,
|
|
},
|
|
{
|
|
PHY_ID_MATCH_MODEL(PHY_ID_AQR412),
|
|
.name = "Aquantia AQR412",
|
|
+ .probe = aqr107_probe,
|
|
.config_aneg = aqr_config_aneg_set_prot,
|
|
.config_intr = aqr_config_intr,
|
|
.ack_interrupt = aqr_ack_interrupt,
|
|
.read_status = aqr_read_status,
|
|
+ .get_sset_count = aqr107_get_sset_count,
|
|
+ .get_strings = aqr107_get_strings,
|
|
+ .get_stats = aqr107_get_stats,
|
|
},
|
|
};
|
|
|