Implement serdes_power, serdes_get_lane and serdes_pcs_get_state ops for
the MV88E6097 so that ports 8 & 9 can be supported as serdes ports and
directly connected to other network interfaces or to SFPs without a PHY.

Signed-off-by: Chris Packham <chris.pack...@alliedtelesis.co.nz>
---

This should be usable for all variants of the 88E6185 that have
tri-speed capable ports (which is why I used the mv88e6185 prefix
instead of mv88e6097). But my hardware only has a 88e6097 so I've only
connected up the ops for that chip.

 drivers/net/dsa/mv88e6xxx/chip.c | 61 ++++++++++++++++++++++++++++++++
 1 file changed, 61 insertions(+)

diff --git a/drivers/net/dsa/mv88e6xxx/chip.c b/drivers/net/dsa/mv88e6xxx/chip.c
index 1ef392ee52c5..1c6cd5c43eb1 100644
--- a/drivers/net/dsa/mv88e6xxx/chip.c
+++ b/drivers/net/dsa/mv88e6xxx/chip.c
@@ -3436,6 +3436,64 @@ static int mv88e6xxx_set_eeprom(struct dsa_switch *ds,
        return err;
 }
 
+static int mv88e6185_serdes_power(struct mv88e6xxx_chip *chip, int port, u8 
lane,
+                                 bool up)
+{
+       /* The serdes power can't be controlled on this switch chip but we need
+        * to supply this function to avoid returning -EOPNOTSUPP in
+        * mv88e6xxx_serdes_power_up/mv88e6xxx_serdes_power_down
+        */
+       return 0;
+}
+
+static u8 mv88e6185_serdes_get_lane(struct mv88e6xxx_chip *chip, int port)
+{
+       switch (chip->ports[port].cmode) {
+       case MV88E6185_PORT_STS_CMODE_SERDES:
+       case MV88E6185_PORT_STS_CMODE_1000BASE_X:
+               return port;
+       default:
+               return 0;
+       }
+}
+
+static int mv88e6185_serdes_pcs_get_state(struct mv88e6xxx_chip *chip, int 
port,
+                                         u8 lane, struct phylink_link_state 
*state)
+{
+       int err;
+       u16 status;
+
+       err = mv88e6xxx_port_read(chip, port, MV88E6XXX_PORT_STS, &status);
+       if (err)
+               return err;
+
+       state->link = !!(status & MV88E6XXX_PORT_STS_LINK);
+
+       if (state->link) {
+               state->duplex = status & MV88E6XXX_PORT_STS_DUPLEX ? 
DUPLEX_FULL : DUPLEX_HALF;
+
+               switch (status &  MV88E6XXX_PORT_STS_SPEED_MASK) {
+               case MV88E6XXX_PORT_STS_SPEED_1000:
+                       state->speed = SPEED_1000;
+                       break;
+               case MV88E6XXX_PORT_STS_SPEED_100:
+                       state->speed = SPEED_100;
+                       break;
+               case MV88E6XXX_PORT_STS_SPEED_10:
+                       state->speed = SPEED_10;
+                       break;
+               default:
+                       dev_err(chip->dev, "invalid PHY speed\n");
+                       return -EINVAL;
+               }
+       } else {
+               state->duplex = DUPLEX_UNKNOWN;
+               state->speed = SPEED_UNKNOWN;
+       }
+
+       return 0;
+}
+
 static const struct mv88e6xxx_ops mv88e6085_ops = {
        /* MV88E6XXX_FAMILY_6097 */
        .ieee_pri_map = mv88e6085_g1_ieee_pri_map,
@@ -3534,6 +3592,9 @@ static const struct mv88e6xxx_ops mv88e6097_ops = {
        .set_egress_port = mv88e6095_g1_set_egress_port,
        .watchdog_ops = &mv88e6097_watchdog_ops,
        .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
+       .serdes_power = mv88e6185_serdes_power,
+       .serdes_get_lane = mv88e6185_serdes_get_lane,
+       .serdes_pcs_get_state = mv88e6185_serdes_pcs_get_state,
        .pot_clear = mv88e6xxx_g2_pot_clear,
        .reset = mv88e6352_g1_reset,
        .rmu_disable = mv88e6085_g1_rmu_disable,
-- 
2.28.0

Reply via email to