net: dsa: mv88e6xxx: Move g1 stats code in global1.[ch]
Move the stats functions which access global 1 registers into global1.c. Signed-off-by: Andrew Lunn <andrew@lunn.ch> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
e0d8b61556
commit
7f9ef3af39
|
@ -780,23 +780,6 @@ static void mv88e6xxx_adjust_link(struct dsa_switch *ds, int port,
|
|||
netdev_err(ds->ports[port].netdev, "failed to configure MAC\n");
|
||||
}
|
||||
|
||||
static int _mv88e6xxx_stats_wait(struct mv88e6xxx_chip *chip)
|
||||
{
|
||||
u16 val;
|
||||
int i, err;
|
||||
|
||||
for (i = 0; i < 10; i++) {
|
||||
err = mv88e6xxx_g1_read(chip, GLOBAL_STATS_OP, &val);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
if ((val & GLOBAL_STATS_OP_BUSY) == 0)
|
||||
return 0;
|
||||
}
|
||||
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
static int mv88e6xxx_stats_snapshot(struct mv88e6xxx_chip *chip, int port)
|
||||
{
|
||||
if (!chip->info->ops->stats_snapshot)
|
||||
|
@ -805,37 +788,6 @@ static int mv88e6xxx_stats_snapshot(struct mv88e6xxx_chip *chip, int port)
|
|||
return chip->info->ops->stats_snapshot(chip, port);
|
||||
}
|
||||
|
||||
static void _mv88e6xxx_stats_read(struct mv88e6xxx_chip *chip,
|
||||
int stat, u32 *val)
|
||||
{
|
||||
u32 value;
|
||||
u16 reg;
|
||||
int err;
|
||||
|
||||
*val = 0;
|
||||
|
||||
err = mv88e6xxx_g1_write(chip, GLOBAL_STATS_OP,
|
||||
GLOBAL_STATS_OP_READ_CAPTURED | stat);
|
||||
if (err)
|
||||
return;
|
||||
|
||||
err = _mv88e6xxx_stats_wait(chip);
|
||||
if (err)
|
||||
return;
|
||||
|
||||
err = mv88e6xxx_g1_read(chip, GLOBAL_STATS_COUNTER_32, ®);
|
||||
if (err)
|
||||
return;
|
||||
|
||||
value = reg << 16;
|
||||
|
||||
err = mv88e6xxx_g1_read(chip, GLOBAL_STATS_COUNTER_01, ®);
|
||||
if (err)
|
||||
return;
|
||||
|
||||
*val = value | reg;
|
||||
}
|
||||
|
||||
static struct mv88e6xxx_hw_stat mv88e6xxx_hw_stats[] = {
|
||||
{ "in_good_octets", 8, 0x00, STATS_TYPE_BANK0, },
|
||||
{ "in_bad_octets", 4, 0x02, STATS_TYPE_BANK0, },
|
||||
|
@ -928,9 +880,9 @@ static uint64_t _mv88e6xxx_get_ethtool_stat(struct mv88e6xxx_chip *chip,
|
|||
/* fall through */
|
||||
case STATS_TYPE_BANK0:
|
||||
reg |= s->reg | histogram;
|
||||
_mv88e6xxx_stats_read(chip, reg, &low);
|
||||
mv88e6xxx_g1_stats_read(chip, reg, &low);
|
||||
if (s->sizeof_stat == 8)
|
||||
_mv88e6xxx_stats_read(chip, reg + 1, &high);
|
||||
mv88e6xxx_g1_stats_read(chip, reg + 1, &high);
|
||||
}
|
||||
value = (((u64)high) << 16) | low;
|
||||
return value;
|
||||
|
@ -2888,7 +2840,7 @@ static int mv88e6xxx_g1_setup(struct mv88e6xxx_chip *chip)
|
|||
return err;
|
||||
|
||||
/* Wait for the flush to complete. */
|
||||
err = _mv88e6xxx_stats_wait(chip);
|
||||
err = mv88e6xxx_g1_stats_wait(chip);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
|
|
|
@ -53,7 +53,7 @@ int mv88e6390_g1_stats_set_histogram(struct mv88e6xxx_chip *chip)
|
|||
|
||||
/* Offset 0x1d: Statistics Operation 2 */
|
||||
|
||||
static int mv88e6xxx_g1_stats_wait(struct mv88e6xxx_chip *chip)
|
||||
int mv88e6xxx_g1_stats_wait(struct mv88e6xxx_chip *chip)
|
||||
{
|
||||
return mv88e6xxx_g1_wait(chip, GLOBAL_STATS_OP, GLOBAL_STATS_OP_BUSY);
|
||||
}
|
||||
|
@ -95,3 +95,33 @@ int mv88e6390_g1_stats_snapshot(struct mv88e6xxx_chip *chip, int port)
|
|||
/* Wait for the snapshotting to complete. */
|
||||
return mv88e6xxx_g1_stats_wait(chip);
|
||||
}
|
||||
|
||||
void mv88e6xxx_g1_stats_read(struct mv88e6xxx_chip *chip, int stat, u32 *val)
|
||||
{
|
||||
u32 value;
|
||||
u16 reg;
|
||||
int err;
|
||||
|
||||
*val = 0;
|
||||
|
||||
err = mv88e6xxx_g1_write(chip, GLOBAL_STATS_OP,
|
||||
GLOBAL_STATS_OP_READ_CAPTURED | stat);
|
||||
if (err)
|
||||
return;
|
||||
|
||||
err = mv88e6xxx_g1_stats_wait(chip);
|
||||
if (err)
|
||||
return;
|
||||
|
||||
err = mv88e6xxx_g1_read(chip, GLOBAL_STATS_COUNTER_32, ®);
|
||||
if (err)
|
||||
return;
|
||||
|
||||
value = reg << 16;
|
||||
|
||||
err = mv88e6xxx_g1_read(chip, GLOBAL_STATS_COUNTER_01, ®);
|
||||
if (err)
|
||||
return;
|
||||
|
||||
*val = value | reg;
|
||||
}
|
||||
|
|
|
@ -19,9 +19,11 @@
|
|||
int mv88e6xxx_g1_read(struct mv88e6xxx_chip *chip, int reg, u16 *val);
|
||||
int mv88e6xxx_g1_write(struct mv88e6xxx_chip *chip, int reg, u16 val);
|
||||
int mv88e6xxx_g1_wait(struct mv88e6xxx_chip *chip, int reg, u16 mask);
|
||||
int mv88e6xxx_g1_stats_wait(struct mv88e6xxx_chip *chip);
|
||||
int mv88e6xxx_g1_stats_snapshot(struct mv88e6xxx_chip *chip, int port);
|
||||
int mv88e6320_g1_stats_snapshot(struct mv88e6xxx_chip *chip, int port);
|
||||
int mv88e6390_g1_stats_snapshot(struct mv88e6xxx_chip *chip, int port);
|
||||
int mv88e6390_g1_stats_set_histogram(struct mv88e6xxx_chip *chip);
|
||||
void mv88e6xxx_g1_stats_read(struct mv88e6xxx_chip *chip, int stat, u32 *val);
|
||||
|
||||
#endif /* _MV88E6XXX_GLOBAL1_H */
|
||||
|
|
Loading…
Reference in New Issue