Get rid of the last usage of the locked mv88e6xxx_reg_read function with
a new mv88e6xxx_port_read helper, useful later for chips with different
port registers base address.

Signed-off-by: Vivien Didelot <vivien.dide...@savoirfairelinux.com>
---
 drivers/net/dsa/mv88e6xxx/chip.c | 35 +++++++++++++++++++----------------
 1 file changed, 19 insertions(+), 16 deletions(-)

diff --git a/drivers/net/dsa/mv88e6xxx/chip.c b/drivers/net/dsa/mv88e6xxx/chip.c
index f95f1d4..4c6fc6d 100644
--- a/drivers/net/dsa/mv88e6xxx/chip.c
+++ b/drivers/net/dsa/mv88e6xxx/chip.c
@@ -254,17 +254,6 @@ static int _mv88e6xxx_reg_read(struct mv88e6xxx_chip 
*chip, int addr, int reg)
        return val;
 }
 
-static int mv88e6xxx_reg_read(struct mv88e6xxx_chip *chip, int addr, int reg)
-{
-       int ret;
-
-       mutex_lock(&chip->reg_lock);
-       ret = _mv88e6xxx_reg_read(chip, addr, reg);
-       mutex_unlock(&chip->reg_lock);
-
-       return ret;
-}
-
 static int _mv88e6xxx_reg_write(struct mv88e6xxx_chip *chip, int addr,
                                int reg, u16 val)
 {
@@ -2426,6 +2415,17 @@ static int mv88e6xxx_power_on_serdes(struct 
mv88e6xxx_chip *chip)
        return ret;
 }
 
+static int mv88e6xxx_port_read(struct mv88e6xxx_chip *chip, int port,
+                              int reg, u16 *data)
+{
+       int addr = chip->info->port_base_addr + port;
+
+       if (port >= chip->info->num_ports)
+               return -EINVAL;
+
+       return mv88e6xxx_read(chip, addr, reg, data);
+}
+
 static int mv88e6xxx_setup_port(struct mv88e6xxx_chip *chip, int port)
 {
        struct dsa_switch *ds = chip->ds;
@@ -3830,12 +3830,15 @@ static const struct mv88e6xxx_info 
*mv88e6xxx_lookup_info(unsigned int prod_num)
 static int mv88e6xxx_detect(struct mv88e6xxx_chip *chip)
 {
        const struct mv88e6xxx_info *info;
-       int id, prod_num, rev;
+       unsigned int prod_num, rev;
+       u16 id;
+       int err;
 
-       id = mv88e6xxx_reg_read(chip, chip->info->port_base_addr,
-                               PORT_SWITCH_ID);
-       if (id < 0)
-               return id;
+       mutex_lock(&chip->reg_lock);
+       err = mv88e6xxx_port_read(chip, 0, PORT_SWITCH_ID, &id);
+       mutex_unlock(&chip->reg_lock);
+       if (err)
+               return err;
 
        prod_num = (id & 0xfff0) >> 4;
        rev = id & 0x000f;
-- 
2.9.0

Reply via email to