net: dsa: mv88e6xxx: Add helper to determining if port has SERDES
Refactor the existing code. This helper will be used for SERDES statistics. Signed-off-by: Andrew Lunn <andrew@lunn.ch> Tested-by: Florian Fainelli <f.fainelli@gmail.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
436fe17d27
commit
eb755c3f6b
1 changed files with 17 additions and 5 deletions
|
@ -55,18 +55,30 @@ static int mv88e6352_serdes_power_set(struct mv88e6xxx_chip *chip, bool on)
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
int mv88e6352_serdes_power(struct mv88e6xxx_chip *chip, int port, bool on)
|
static bool mv88e6352_port_has_serdes(struct mv88e6xxx_chip *chip, int port)
|
||||||
{
|
{
|
||||||
int err;
|
|
||||||
u8 cmode;
|
u8 cmode;
|
||||||
|
int err;
|
||||||
|
|
||||||
err = mv88e6xxx_port_get_cmode(chip, port, &cmode);
|
err = mv88e6xxx_port_get_cmode(chip, port, &cmode);
|
||||||
if (err)
|
if (err) {
|
||||||
return err;
|
dev_err(chip->dev, "failed to read cmode\n");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
if ((cmode == MV88E6XXX_PORT_STS_CMODE_100BASE_X) ||
|
if ((cmode == MV88E6XXX_PORT_STS_CMODE_100BASE_X) ||
|
||||||
(cmode == MV88E6XXX_PORT_STS_CMODE_1000BASE_X) ||
|
(cmode == MV88E6XXX_PORT_STS_CMODE_1000BASE_X) ||
|
||||||
(cmode == MV88E6XXX_PORT_STS_CMODE_SGMII)) {
|
(cmode == MV88E6XXX_PORT_STS_CMODE_SGMII))
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int mv88e6352_serdes_power(struct mv88e6xxx_chip *chip, int port, bool on)
|
||||||
|
{
|
||||||
|
int err;
|
||||||
|
|
||||||
|
if (mv88e6352_port_has_serdes(chip, port)) {
|
||||||
err = mv88e6352_serdes_power_set(chip, on);
|
err = mv88e6352_serdes_power_set(chip, on);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
return err;
|
return err;
|
||||||
|
|
Loading…
Reference in a new issue