From 3056d09b4046e0eb0f6de0f3f5432cd9fa86fc51 Mon Sep 17 00:00:00 2001 From: Thibaut VARENE Date: Fri, 4 Aug 2017 12:29:19 +0200 Subject: [PATCH] generic: provide get_port_stats() on b53 switches This patch provides a generic switch_dev_ops 'get_port_stats()' callback by taping into the relevant port MIB counters. This callback is used by swconfig_leds led trigger to blink LEDs with port network traffic. Signed-off-by: Thibaut VARENE --- .../files/drivers/net/phy/b53/b53_common.c | 58 ++++++++++++++++++- 1 file changed, 57 insertions(+), 1 deletion(-) diff --git a/target/linux/generic/files/drivers/net/phy/b53/b53_common.c b/target/linux/generic/files/drivers/net/phy/b53/b53_common.c index 482966a909de..4b88d1f8fe8d 100644 --- a/target/linux/generic/files/drivers/net/phy/b53/b53_common.c +++ b/target/linux/generic/files/drivers/net/phy/b53/b53_common.c @@ -40,7 +40,6 @@ struct b53_mib_desc { const char *name; }; - /* BCM5365 MIB counters */ static const struct b53_mib_desc b53_mibs_65[] = { { 8, 0x00, "TxOctets" }, @@ -78,6 +77,9 @@ static const struct b53_mib_desc b53_mibs_65[] = { { }, }; +#define B63XX_MIB_TXB_ID 0 /* TxOctets */ +#define B63XX_MIB_RXB_ID 14 /* RxOctets */ + /* BCM63xx MIB counters */ static const struct b53_mib_desc b53_mibs_63xx[] = { { 8, 0x00, "TxOctets" }, @@ -125,6 +127,9 @@ static const struct b53_mib_desc b53_mibs_63xx[] = { { } }; +#define B53XX_MIB_TXB_ID 0 /* TxOctets */ +#define B53XX_MIB_RXB_ID 12 /* RxOctets */ + /* MIB counters */ static const struct b53_mib_desc b53_mibs[] = { { 8, 0x00, "TxOctets" }, @@ -1047,6 +1052,54 @@ static int b53_port_get_mib(struct switch_dev *sw_dev, return 0; } +static int b53_port_get_stats(struct switch_dev *sw_dev, int port, + struct switch_port_stats *stats) +{ + struct b53_device *dev = sw_to_b53(sw_dev); + const struct b53_mib_desc *mibs; + int txb_id, rxb_id; + u64 rxb, txb; + + if (!(BIT(port) & dev->enabled_ports)) + return -EINVAL; + + txb_id = B53XX_MIB_TXB_ID; + rxb_id = B53XX_MIB_RXB_ID; + + if (is5365(dev)) { + if (port == 5) + port = 8; + + mibs = b53_mibs_65; + } else if (is63xx(dev)) { + mibs = b53_mibs_63xx; + txb_id = B63XX_MIB_TXB_ID; + rxb_id = B63XX_MIB_RXB_ID; + } else { + mibs = b53_mibs; + } + + dev->buf[0] = 0; + + if (mibs->size == 8) { + b53_read64(dev, B53_MIB_PAGE(port), mibs[txb_id].offset, &txb); + b53_read64(dev, B53_MIB_PAGE(port), mibs[rxb_id].offset, &rxb); + } else { + u32 val32; + + b53_read32(dev, B53_MIB_PAGE(port), mibs[txb_id].offset, &val32); + txb = val32; + + b53_read32(dev, B53_MIB_PAGE(port), mibs[rxb_id].offset, &val32); + rxb = val32; + } + + stats->tx_bytes = txb; + stats->rx_bytes = rxb; + + return 0; +} + static struct switch_attr b53_global_ops_25[] = { { .type = SWITCH_TYPE_INT, @@ -1160,6 +1213,7 @@ static const struct switch_dev_ops b53_switch_ops_25 = { .reset_switch = b53_global_reset_switch, .get_port_link = b53_port_get_link, .set_port_link = b53_port_set_link, + .get_port_stats = b53_port_get_stats, .phy_read16 = b53_phy_read16, .phy_write16 = b53_phy_write16, }; @@ -1186,6 +1240,7 @@ static const struct switch_dev_ops b53_switch_ops_65 = { .reset_switch = b53_global_reset_switch, .get_port_link = b53_port_get_link, .set_port_link = b53_port_set_link, + .get_port_stats = b53_port_get_stats, .phy_read16 = b53_phy_read16, .phy_write16 = b53_phy_write16, }; @@ -1212,6 +1267,7 @@ static const struct switch_dev_ops b53_switch_ops = { .reset_switch = b53_global_reset_switch, .get_port_link = b53_port_get_link, .set_port_link = b53_port_set_link, + .get_port_stats = b53_port_get_stats, .phy_read16 = b53_phy_read16, .phy_write16 = b53_phy_write16, }; -- 2.30.2