generic: provide get_port_stats() on adm6996 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>
owl
Thibaut VARENE 2017-08-04 12:28:56 +02:00 committed by John Crispin
parent 4d8a66d934
commit 4ddbc43cc1
1 changed files with 32 additions and 0 deletions

View File

@ -112,6 +112,9 @@ static const struct adm6996_mib_desc adm6996_mibs[] = {
MIB_DESC(ADM_CL30, "Error"), MIB_DESC(ADM_CL30, "Error"),
}; };
#define ADM6996_MIB_RXB_ID 1
#define ADM6996_MIB_TXB_ID 3
static inline u16 static inline u16
r16(struct adm6996_priv *priv, enum admreg reg) r16(struct adm6996_priv *priv, enum admreg reg)
{ {
@ -888,6 +891,34 @@ adm6996_sw_get_port_mib(struct switch_dev *dev,
return 0; return 0;
} }
static int
adm6996_get_port_stats(struct switch_dev *dev, int port,
struct switch_port_stats *stats)
{
struct adm6996_priv *priv = to_adm(dev);
int id;
u32 reg = 0;
if (port >= ADM_NUM_PORTS)
return -EINVAL;
mutex_lock(&priv->mib_lock);
id = ADM6996_MIB_TXB_ID;
reg = r16(priv, adm6996_mibs[id].offset + ADM_OFFSET_PORT(port));
reg += r16(priv, adm6996_mibs[id].offset + ADM_OFFSET_PORT(port) + 1) << 16;
stats->tx_bytes = reg;
id = ADM6996_MIB_RXB_ID;
reg = r16(priv, adm6996_mibs[id].offset + ADM_OFFSET_PORT(port));
reg += r16(priv, adm6996_mibs[id].offset + ADM_OFFSET_PORT(port) + 1) << 16;
stats->rx_bytes = reg;
mutex_unlock(&priv->mib_lock);
return 0;
}
static struct switch_attr adm6996_globals[] = { static struct switch_attr adm6996_globals[] = {
{ {
.type = SWITCH_TYPE_INT, .type = SWITCH_TYPE_INT,
@ -956,6 +987,7 @@ static struct switch_dev_ops adm6996_ops = {
.apply_config = adm6996_hw_apply, .apply_config = adm6996_hw_apply,
.reset_switch = adm6996_reset_switch, .reset_switch = adm6996_reset_switch,
.get_port_link = adm6996_get_port_link, .get_port_link = adm6996_get_port_link,
.get_port_stats = adm6996_get_port_stats,
}; };
static int adm6996_switch_init(struct adm6996_priv *priv, const char *alias, struct net_device *netdev) static int adm6996_switch_init(struct adm6996_priv *priv, const char *alias, struct net_device *netdev)