[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <20200504213136.26458-3-michael@walle.cc>
Date: Mon, 4 May 2020 23:31:35 +0200
From: Michael Walle <michael@...le.cc>
To: linux-kernel@...r.kernel.org, netdev@...r.kernel.org
Cc: Andrew Lunn <andrew@...n.ch>,
Florian Fainelli <f.fainelli@...il.com>,
Heiner Kallweit <hkallweit1@...il.com>,
Russell King <linux@...linux.org.uk>,
"David S . Miller" <davem@...emloft.net>,
Vladimir Oltean <vladimir.oltean@....com>,
Antoine Tenart <antoine.tenart@...tlin.com>,
Michael Walle <michael@...le.cc>
Subject: [PATCH net-next v2 2/3] net: phy: bcm54140: use phy_package_shared
Use the new phy_package_shared common storage to ease the package
initialization and to access the global registers.
Signed-off-by: Michael Walle <michael@...le.cc>
---
drivers/net/phy/bcm54140.c | 57 ++++++++------------------------------
1 file changed, 11 insertions(+), 46 deletions(-)
diff --git a/drivers/net/phy/bcm54140.c b/drivers/net/phy/bcm54140.c
index 400d7c3c405a..9ef37a3bc2bb 100644
--- a/drivers/net/phy/bcm54140.c
+++ b/drivers/net/phy/bcm54140.c
@@ -132,7 +132,6 @@ struct bcm54140_priv {
int port;
int base_addr;
#if IS_ENABLED(CONFIG_HWMON)
- bool pkg_init;
/* protect the alarm bits */
struct mutex alarm_lock;
u16 alarm;
@@ -407,36 +406,6 @@ static int bcm54140_enable_monitoring(struct phy_device *phydev)
return bcm_phy_modify_rdb(phydev, BCM54140_RDB_MON_CTRL, mask, set);
}
-/* Check if one PHY has already done the init of the parts common to all PHYs
- * in the Quad PHY package.
- */
-static bool bcm54140_is_pkg_init(struct phy_device *phydev)
-{
- struct bcm54140_priv *priv = phydev->priv;
- struct mii_bus *bus = phydev->mdio.bus;
- int base_addr = priv->base_addr;
- struct phy_device *phy;
- int i;
-
- /* Quad PHY */
- for (i = 0; i < 4; i++) {
- phy = mdiobus_get_phy(bus, base_addr + i);
- if (!phy)
- continue;
-
- if ((phy->phy_id & phydev->drv->phy_id_mask) !=
- (phydev->drv->phy_id & phydev->drv->phy_id_mask))
- continue;
-
- priv = phy->priv;
-
- if (priv && priv->pkg_init)
- return true;
- }
-
- return false;
-}
-
static int bcm54140_probe_once(struct phy_device *phydev)
{
struct device *hwmon;
@@ -457,38 +426,34 @@ static int bcm54140_probe_once(struct phy_device *phydev)
static int bcm54140_base_read_rdb(struct phy_device *phydev, u16 rdb)
{
- struct bcm54140_priv *priv = phydev->priv;
- struct mii_bus *bus = phydev->mdio.bus;
int ret;
- mutex_lock(&bus->mdio_lock);
- ret = __mdiobus_write(bus, priv->base_addr, MII_BCM54XX_RDB_ADDR, rdb);
+ phy_lock_mdio_bus(phydev);
+ ret = __phy_package_write(phydev, MII_BCM54XX_RDB_ADDR, rdb);
if (ret < 0)
goto out;
- ret = __mdiobus_read(bus, priv->base_addr, MII_BCM54XX_RDB_DATA);
+ ret = __phy_package_read(phydev, MII_BCM54XX_RDB_DATA);
out:
- mutex_unlock(&bus->mdio_lock);
+ phy_unlock_mdio_bus(phydev);
return ret;
}
static int bcm54140_base_write_rdb(struct phy_device *phydev,
u16 rdb, u16 val)
{
- struct bcm54140_priv *priv = phydev->priv;
- struct mii_bus *bus = phydev->mdio.bus;
int ret;
- mutex_lock(&bus->mdio_lock);
- ret = __mdiobus_write(bus, priv->base_addr, MII_BCM54XX_RDB_ADDR, rdb);
+ phy_lock_mdio_bus(phydev);
+ ret = __phy_package_write(phydev, MII_BCM54XX_RDB_ADDR, rdb);
if (ret < 0)
goto out;
- ret = __mdiobus_write(bus, priv->base_addr, MII_BCM54XX_RDB_DATA, val);
+ ret = __phy_package_write(phydev, MII_BCM54XX_RDB_DATA, val);
out:
- mutex_unlock(&bus->mdio_lock);
+ phy_unlock_mdio_bus(phydev);
return ret;
}
@@ -618,16 +583,16 @@ static int bcm54140_probe(struct phy_device *phydev)
if (ret)
return ret;
+ devm_phy_package_join(&phydev->mdio.dev, phydev, priv->base_addr, 0);
+
#if IS_ENABLED(CONFIG_HWMON)
mutex_init(&priv->alarm_lock);
- if (!bcm54140_is_pkg_init(phydev)) {
+ if (phy_package_init_once(phydev)) {
ret = bcm54140_probe_once(phydev);
if (ret)
return ret;
}
-
- priv->pkg_init = true;
#endif
phydev_dbg(phydev, "probed (port %d, base PHY address %d)\n",
--
2.20.1
Powered by blists - more mailing lists