[librecmc/librecmc.git] /

From a08c045580e060a6886bbb656c50ae20b0c780b5 Mon Sep 17 00:00:00 2001
From: Daniel Golle <daniel@makrotopia.org>
Date: Mon, 3 Apr 2023 02:17:52 +0100
Subject: [PATCH 07/16] net: dsa: mt7530: use regmap to access switch register
 space

Use regmap API to access the switch register space.

Signed-off-by: Daniel Golle <daniel@makrotopia.org>
Signed-off-by: David S. Miller <davem@davemloft.net>
---
 drivers/net/dsa/mt7530.c | 99 ++++++++++++++++++++++++----------------
 drivers/net/dsa/mt7530.h |  2 +
 2 files changed, 62 insertions(+), 39 deletions(-)

--- a/drivers/net/dsa/mt7530.c
+++ b/drivers/net/dsa/mt7530.c
@@ -184,9 +184,9 @@ core_clear(struct mt7530_priv *priv, u32
 }
 
 static int
-mt7530_mii_write(struct mt7530_priv *priv, u32 reg, u32 val)
+mt7530_regmap_write(void *context, unsigned int reg, unsigned int val)
 {
-       struct mii_bus *bus = priv->bus;
+       struct mii_bus *bus = context;
        u16 page, r, lo, hi;
        int ret;
 
@@ -198,24 +198,34 @@ mt7530_mii_write(struct mt7530_priv *pri
        /* MT7530 uses 31 as the pseudo port */
        ret = bus->write(bus, 0x1f, 0x1f, page);
        if (ret < 0)
-               goto err;
+               return ret;
 
        ret = bus->write(bus, 0x1f, r,  lo);
        if (ret < 0)
-               goto err;
+               return ret;
 
        ret = bus->write(bus, 0x1f, 0x10, hi);
-err:
+       return ret;
+}
+
+static int
+mt7530_mii_write(struct mt7530_priv *priv, u32 reg, u32 val)
+{
+       int ret;
+
+       ret = regmap_write(priv->regmap, reg, val);
+
        if (ret < 0)
-               dev_err(&bus->dev,
+               dev_err(priv->dev,
                        "failed to write mt7530 register\n");
+
        return ret;
 }
 
-static u32
-mt7530_mii_read(struct mt7530_priv *priv, u32 reg)
+static int
+mt7530_regmap_read(void *context, unsigned int reg, unsigned int *val)
 {
-       struct mii_bus *bus = priv->bus;
+       struct mii_bus *bus = context;
        u16 page, r, lo, hi;
        int ret;
 
@@ -224,17 +234,32 @@ mt7530_mii_read(struct mt7530_priv *priv
 
        /* MT7530 uses 31 as the pseudo port */
        ret = bus->write(bus, 0x1f, 0x1f, page);
-       if (ret < 0) {
+       if (ret < 0)
+               return ret;
+
+       lo = bus->read(bus, 0x1f, r);
+       hi = bus->read(bus, 0x1f, 0x10);
+
+       *val = (hi << 16) | (lo & 0xffff);
+
+       return 0;
+}
+
+static u32
+mt7530_mii_read(struct mt7530_priv *priv, u32 reg)
+{
+       int ret;
+       u32 val;
+
+       ret = regmap_read(priv->regmap, reg, &val);
+       if (ret) {
                WARN_ON_ONCE(1);
-               dev_err(&bus->dev,
+               dev_err(priv->dev,
                        "failed to read mt7530 register\n");
                return 0;
        }
 
-       lo = bus->read(bus, 0x1f, r);
-       hi = bus->read(bus, 0x1f, 0x10);
-
-       return (hi << 16) | (lo & 0xffff);
+       return val;
 }
 
 static void
@@ -284,14 +309,10 @@ mt7530_rmw(struct mt7530_priv *priv, u32
           u32 mask, u32 set)
 {
        struct mii_bus *bus = priv->bus;
-       u32 val;
 
        mutex_lock_nested(&bus->mdio_lock, MDIO_MUTEX_NESTED);
 
-       val = mt7530_mii_read(priv, reg);
-       val &= ~mask;
-       val |= set;
-       mt7530_mii_write(priv, reg, val);
+       regmap_update_bits(priv->regmap, reg, mask, set);
 
        mutex_unlock(&bus->mdio_lock);
 }
@@ -299,7 +320,7 @@ mt7530_rmw(struct mt7530_priv *priv, u32
 static void
 mt7530_set(struct mt7530_priv *priv, u32 reg, u32 val)
 {
-       mt7530_rmw(priv, reg, 0, val);
+       mt7530_rmw(priv, reg, val, val);
 }
 
 static void
@@ -3126,22 +3147,6 @@ static const struct phylink_pcs_ops mt75
        .pcs_an_restart = mt7530_pcs_an_restart,
 };
 
-static int mt7530_regmap_read(void *context, unsigned int reg, unsigned int *val)
-{
-       struct mt7530_priv *priv = context;
-
-       *val = mt7530_mii_read(priv, reg);
-       return 0;
-};
-
-static int mt7530_regmap_write(void *context, unsigned int reg, unsigned int val)
-{
-       struct mt7530_priv *priv = context;
-
-       mt7530_mii_write(priv, reg, val);
-       return 0;
-};
-
 static void
 mt7530_mdio_regmap_lock(void *mdio_lock)
 {
@@ -3154,7 +3159,7 @@ mt7530_mdio_regmap_unlock(void *mdio_loc
        mutex_unlock(mdio_lock);
 }
 
-static const struct regmap_bus mt7531_regmap_bus = {
+static const struct regmap_bus mt7530_regmap_bus = {
        .reg_write = mt7530_regmap_write,
        .reg_read = mt7530_regmap_read,
 };
@@ -3187,7 +3192,7 @@ mt7531_create_sgmii(struct mt7530_priv *
                mt7531_pcs_config[i]->lock_arg = &priv->bus->mdio_lock;
 
                regmap = devm_regmap_init(priv->dev,
-                                         &mt7531_regmap_bus, priv,
+                                         &mt7530_regmap_bus, priv->bus,
                                          mt7531_pcs_config[i]);
                if (IS_ERR(regmap)) {
                        ret = PTR_ERR(regmap);
@@ -3352,6 +3357,7 @@ MODULE_DEVICE_TABLE(of, mt7530_of_match)
 static int
 mt7530_probe(struct mdio_device *mdiodev)
 {
+       static struct regmap_config *regmap_config;
        struct mt7530_priv *priv;
        struct device_node *dn;
 
@@ -3431,6 +3437,21 @@ mt7530_probe(struct mdio_device *mdiodev
        mutex_init(&priv->reg_mutex);
        dev_set_drvdata(&mdiodev->dev, priv);
 
+       regmap_config = devm_kzalloc(&mdiodev->dev, sizeof(*regmap_config),
+                                    GFP_KERNEL);
+       if (!regmap_config)
+               return -ENOMEM;
+
+       regmap_config->reg_bits = 16;
+       regmap_config->val_bits = 32;
+       regmap_config->reg_stride = 4;
+       regmap_config->max_register = MT7530_CREV;
+       regmap_config->disable_locking = true;
+       priv->regmap = devm_regmap_init(priv->dev, &mt7530_regmap_bus,
+                                       priv->bus, regmap_config);
+       if (IS_ERR(priv->regmap))
+               return PTR_ERR(priv->regmap);
+
        return dsa_register_switch(priv->ds);
 }
 
--- a/drivers/net/dsa/mt7530.h
+++ b/drivers/net/dsa/mt7530.h
@@ -779,6 +779,7 @@ struct mt753x_info {
  * @dev:               The device pointer
  * @ds:                        The pointer to the dsa core structure
  * @bus:               The bus used for the device and built-in PHY
+ * @regmap:            The regmap instance representing all switch registers
  * @rstc:              The pointer to reset control used by MCM
  * @core_pwr:          The power supplied into the core
  * @io_pwr:            The power supplied into the I/O
@@ -799,6 +800,7 @@ struct mt7530_priv {
        struct device           *dev;
        struct dsa_switch       *ds;
        struct mii_bus          *bus;
+       struct regmap           *regmap;
        struct reset_control    *rstc;
        struct regulator        *core_pwr;
        struct regulator        *io_pwr;