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 <hacks@slashdirt.org>

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 482966a909de43b74af2c30588c5ddda2e0ca8b6..4b88d1f8fe8d3e12e7bba5b45b78affdf9cd960f 100644 (file)
--- 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,
 };