RE: [PATCH 2/2] net-next: stmmac: add mdio clause 45 access from mac device for dwmac4
From: Ong, Boon Leong
Date: Mon Apr 29 2019 - 11:15:50 EST
>Subject: [PATCH 2/2] net-next: stmmac: add mdio clause 45 access from mac
>device for dwmac4
>
>add clause 45 mdio read and write from mac device for dwmac4.
>
>Signed-off-by: Biao Huang <biao.huang@xxxxxxxxxxxx>
Hi,
I would like to point out that there is another C45 implementation
proposed here "net: stmmac: enable clause 45 mdio support" at
https://marc.info/?l=linux-netdev&m=155609745200339&w=2
What is the preference of the driver maintainer here?
Thanks
Boon Leong
>---
> drivers/net/ethernet/stmicro/stmmac/common.h | 11 +-
> drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c | 3 +
> drivers/net/ethernet/stmicro/stmmac/stmmac_mdio.c | 167
>+++++++++++++++++++--
> 3 files changed, 165 insertions(+), 16 deletions(-)
>
>diff --git a/drivers/net/ethernet/stmicro/stmmac/common.h
>b/drivers/net/ethernet/stmicro/stmmac/common.h
>index 709dcec..06573b3 100644
>--- a/drivers/net/ethernet/stmicro/stmmac/common.h
>+++ b/drivers/net/ethernet/stmicro/stmmac/common.h
>@@ -410,12 +410,15 @@ struct mac_link {
> struct mii_regs {
> unsigned int addr; /* MII Address */
> unsigned int data; /* MII Data */
>- unsigned int addr_shift; /* MII address shift */
>- unsigned int reg_shift; /* MII reg shift */
>- unsigned int addr_mask; /* MII address mask */
>- unsigned int reg_mask; /* MII reg mask */
>+ unsigned int addr_shift; /* PHY address shift */
>+ unsigned int cl45_reg_shift; /* CL45 reg address shift */
>+ unsigned int reg_shift; /* CL22 reg/CL45 dev shift */
>+ unsigned int addr_mask; /* PHY address mask */
>+ unsigned int cl45_reg_mask; /* CL45 reg mask */
>+ unsigned int reg_mask; /* CL22 reg/CL45 dev mask */
> unsigned int clk_csr_shift;
> unsigned int clk_csr_mask;
>+ unsigned int cl45_en; /* CL45 Enable*/
> };
>
> struct mac_device_info {
>diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c
>b/drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c
>index 2a41c64..1ca03f9 100644
>--- a/drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c
>+++ b/drivers/net/ethernet/stmicro/stmmac/dwmac4_core.c
>@@ -835,6 +835,9 @@ int dwmac4_setup(struct stmmac_priv *priv)
> mac->mii.reg_mask = GENMASK(20, 16);
> mac->mii.clk_csr_shift = 8;
> mac->mii.clk_csr_mask = GENMASK(11, 8);
>+ mac->mii.cl45_reg_shift = 16;
>+ mac->mii.cl45_reg_mask = GENMASK(31, 16);
>+ mac->mii.cl45_en = BIT(1);
>
> return 0;
> }
>diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_mdio.c
>b/drivers/net/ethernet/stmicro/stmmac/stmmac_mdio.c
>index bdd3515..a70c967 100644
>--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_mdio.c
>+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_mdio.c
>@@ -150,16 +150,16 @@ static int stmmac_xgmac2_mdio_write(struct
>mii_bus *bus, int phyaddr,
> }
>
> /**
>- * stmmac_mdio_read
>+ * stmmac_c22_read
> * @bus: points to the mii_bus structure
>- * @phyaddr: MII addr
>- * @phyreg: MII reg
>- * Description: it reads data from the MII register from within the phy device.
>+ * @phyaddr: clause 22 phy address
>+ * @phyreg: clause 22 phy register
>+ * Description: it reads data from the MII register follow clause 22.
> * For the 7111 GMAC, we must set the bit 0 in the MII address register while
> * accessing the PHY registers.
> * Fortunately, it seems this has no drawback for the 7109 MAC.
> */
>-static int stmmac_mdio_read(struct mii_bus *bus, int phyaddr, int phyreg)
>+static int stmmac_c22_read(struct mii_bus *bus, int phyaddr, int phyreg)
> {
> struct net_device *ndev = bus->priv;
> struct stmmac_priv *priv = netdev_priv(ndev);
>@@ -194,15 +194,15 @@ static int stmmac_mdio_read(struct mii_bus *bus,
>int phyaddr, int phyreg)
> }
>
> /**
>- * stmmac_mdio_write
>+ * stmmac_c22_write
> * @bus: points to the mii_bus structure
>- * @phyaddr: MII addr
>- * @phyreg: MII reg
>- * @phydata: phy data
>- * Description: it writes the data into the MII register from within the device.
>+ * @phyaddr: clause-22 phy address
>+ * @phyreg: clause-22 phy register
>+ * @phydata: clause-22 phy data
>+ * Description: it writes the data into the MII register follow clause 22.
> */
>-static int stmmac_mdio_write(struct mii_bus *bus, int phyaddr, int phyreg,
>- u16 phydata)
>+static int stmmac_c22_write(struct mii_bus *bus, int phyaddr, int phyreg,
>+ u16 phydata)
> {
> struct net_device *ndev = bus->priv;
> struct stmmac_priv *priv = netdev_priv(ndev);
>@@ -237,6 +237,149 @@ static int stmmac_mdio_write(struct mii_bus *bus,
>int phyaddr, int phyreg,
> }
>
> /**
>+ * stmmac_c45_read
>+ * @bus: points to the mii_bus structure
>+ * @phyaddr: clause-45 phy address
>+ * @devad: clause-45 device address
>+ * @prtad: clause-45 register address
>+ * @phydata: phy data
>+ * Description: it reads the data from the MII register follow clause 45.
>+ */
>+static int stmmac_c45_read(struct mii_bus *bus, int phyaddr,
>+ int devad, int prtad)
>+{
>+ struct net_device *ndev = bus->priv;
>+ struct stmmac_priv *priv = netdev_priv(ndev);
>+ unsigned int mii_address = priv->hw->mii.addr;
>+ unsigned int mii_data = priv->hw->mii.data;
>+ u32 v, value;
>+ int data;
>+
>+ if (readl_poll_timeout(priv->ioaddr + mii_address, v, !(v & MII_BUSY),
>+ 100, 10000))
>+ return -EIO;
>+
>+ value = 0;
>+ value |= (prtad << priv->hw->mii.cl45_reg_shift)
>+ & priv->hw->mii.cl45_reg_mask;
>+ writel(value, priv->ioaddr + mii_data);
>+
>+ /* delay 2ms to avoid error value of get_phy_c45_devs_in_pkg */
>+ mdelay(2);
>+
>+ value = MII_BUSY;
>+ value |= (phyaddr << priv->hw->mii.addr_shift)
>+ & priv->hw->mii.addr_mask;
>+ value |= (devad << priv->hw->mii.reg_shift) & priv->hw->mii.reg_mask;
>+ value |= (priv->clk_csr << priv->hw->mii.clk_csr_shift)
>+ & priv->hw->mii.clk_csr_mask;
>+ if (priv->plat->has_gmac4) {
>+ value |= MII_GMAC4_READ;
>+ value |= priv->hw->mii.cl45_en;
>+ }
>+ writel(value, priv->ioaddr + mii_address);
>+
>+ if (readl_poll_timeout(priv->ioaddr + mii_address, v, !(v & MII_BUSY),
>+ 100, 10000))
>+ return -EIO;
>+
>+ /* Read the data from the MII data register */
>+ data = (int)(readl(priv->ioaddr + mii_data) & 0xffff);
>+
>+ return data;
>+}
>+
>+/**
>+ * stmmac_c45_write
>+ * @bus: points to the mii_bus structure
>+ * @phyaddr: clause-45 phy address
>+ * @devad: clause-45 device address
>+ * @prtad: clause-45 register address
>+ * @phydata: phy data
>+ * Description: it writes the data into the MII register follow clause 45.
>+ */
>+static int stmmac_c45_write(struct mii_bus *bus, int phyaddr, int devad,
>+ int prtad, u16 phydata)
>+{
>+ struct net_device *ndev = bus->priv;
>+ struct stmmac_priv *priv = netdev_priv(ndev);
>+ unsigned int mii_address = priv->hw->mii.addr;
>+ unsigned int mii_data = priv->hw->mii.data;
>+ u32 v, value;
>+
>+ /* Wait until any existing MII operation is complete */
>+ if (readl_poll_timeout(priv->ioaddr + mii_address, v, !(v & MII_BUSY),
>+ 100, 10000))
>+ return -EIO;
>+
>+ value = phydata;
>+ value |= (prtad << priv->hw->mii.cl45_reg_shift) &
>+ priv->hw->mii.cl45_reg_mask;
>+ writel(value, priv->ioaddr + mii_data);
>+
>+ mdelay(2);
>+
>+ value = MII_BUSY;
>+ value |= (phyaddr << priv->hw->mii.addr_shift) &
>+ priv->hw->mii.addr_mask;
>+ value |= (devad << priv->hw->mii.reg_shift) & priv->hw->mii.reg_mask;
>+ value |= (priv->clk_csr << priv->hw->mii.clk_csr_shift) &
>+ priv->hw->mii.clk_csr_mask;
>+
>+ if (priv->plat->has_gmac4) {
>+ value |= MII_GMAC4_WRITE;
>+ value |= priv->hw->mii.cl45_en;
>+ }
>+ writel(value, priv->ioaddr + mii_address);
>+
>+ /* Wait until any existing MII operation is complete */
>+ return readl_poll_timeout(priv->ioaddr + mii_address, v, !(v &
>MII_BUSY),
>+ 100, 10000);
>+}
>+
>+/**
>+ * stmmac_mdio_read
>+ * @bus: points to the mii_bus structure
>+ * @phyaddr: MII addr
>+ * @phyreg: MII reg
>+ * Description: it reads data from the MII register from within the phy device.
>+ */
>+static int stmmac_mdio_read(struct mii_bus *bus, int phyaddr, int phyreg)
>+{
>+ if (phyreg & MII_ADDR_C45) {
>+ int devad, prtad;
>+
>+ devad = (phyreg >> 16) & 0x1f;
>+ prtad = phyreg & 0xffff;
>+ return stmmac_c45_read(bus, phyaddr, devad, prtad);
>+ } else {
>+ return stmmac_c22_read(bus, phyaddr, phyreg);
>+ }
>+}
>+
>+/**
>+ * stmmac_mdio_write
>+ * @bus: points to the mii_bus structure
>+ * @phyaddr: MII addr
>+ * @phyreg: MII reg
>+ * @phydata: phy data
>+ * Description: it writes the data into the MII register from within the device.
>+ */
>+static int stmmac_mdio_write(struct mii_bus *bus, int phyaddr, int phyreg,
>+ u16 phydata)
>+{
>+ if (phyreg & MII_ADDR_C45) {
>+ int devad, prtad;
>+
>+ devad = (phyreg >> 16) & 0x1f;
>+ prtad = phyreg & 0xffff;
>+ return stmmac_c45_write(bus, phyaddr, devad, prtad,
>phydata);
>+ } else {
>+ return stmmac_c22_write(bus, phyaddr, phyreg, phydata);
>+ }
>+}
>+
>+/**
> * stmmac_mdio_reset
> * @bus: points to the mii_bus structure
> * Description: reset the MII bus
>--
>1.7.9.5