Message ID | 5ef40c7da528facddece6820ae387edc10390fcb.1651141197.git.weijie.gao@mediatek.com |
---|---|
State | Superseded |
Delegated to: | Daniel Schwierzeck |
Headers | show |
Series | Add support for MediaTek MT7621 SoC | expand |
On Thu, Apr 28, 2022 at 1:38 PM Weijie Gao <weijie.gao@mediatek.com> wrote: > > This patch adds GMAC support for MediaTek MT7621 SoC. > MT7621 has the same GMAC/Switch configuration as MT7623. > > Signed-off-by: Weijie Gao <weijie.gao@mediatek.com> > --- > v3 changes: > Add register remap needed by mt7621 > Fix use of noncached_alloc > v2 changes: none > --- > drivers/net/mtk_eth.c | 45 ++++++++++++++++++++++++++----------------- > 1 file changed, 27 insertions(+), 18 deletions(-) > > diff --git a/drivers/net/mtk_eth.c b/drivers/net/mtk_eth.c > index 666ddeb10d..4fe7ee0d36 100644 > --- a/drivers/net/mtk_eth.c > +++ b/drivers/net/mtk_eth.c > @@ -145,7 +145,8 @@ enum mtk_switch { > enum mtk_soc { > SOC_MT7623, > SOC_MT7629, > - SOC_MT7622 > + SOC_MT7622, > + SOC_MT7621 > }; > > struct mtk_eth_priv { > @@ -159,9 +160,10 @@ struct mtk_eth_priv { > > void __iomem *fe_base; > void __iomem *gmac_base; > - void __iomem *ethsys_base; > void __iomem *sgmii_base; > > + struct regmap *ethsys_regmap; > + > struct mii_dev *mdio_bus; > int (*mii_read)(struct mtk_eth_priv *priv, u8 phy, u8 reg); > int (*mii_write)(struct mtk_eth_priv *priv, u8 phy, u8 reg, u16 val); > @@ -233,7 +235,12 @@ static void mtk_gmac_rmw(struct mtk_eth_priv *priv, u32 reg, u32 clr, u32 set) > static void mtk_ethsys_rmw(struct mtk_eth_priv *priv, u32 reg, u32 clr, > u32 set) > { > - clrsetbits_le32(priv->ethsys_base + reg, clr, set); > + uint val; > + > + regmap_read(priv->ethsys_regmap, reg, &val); > + val &= ~clr; > + val |= set; > + regmap_write(priv->ethsys_regmap, reg, val); > } Changing the registers to regmap is not part of the support for the MT7621. please separate into two patches. > > /* Direct MDIO clause 22/45 access via SoC */ > @@ -669,12 +676,18 @@ static int mt7530_pad_clk_setup(struct mtk_eth_priv *priv, int mode) > static int mt7530_setup(struct mtk_eth_priv *priv) > { > u16 phy_addr, phy_val; > - u32 val; > + u32 val, txdrv; > int i; > > - /* Select 250MHz clk for RGMII mode */ > - mtk_ethsys_rmw(priv, ETHSYS_CLKCFG0_REG, > - ETHSYS_TRGMII_CLK_SEL362_5, 0); > + if (priv->soc != SOC_MT7621) { > + /* Select 250MHz clk for RGMII mode */ > + mtk_ethsys_rmw(priv, ETHSYS_CLKCFG0_REG, > + ETHSYS_TRGMII_CLK_SEL362_5, 0); > + > + txdrv = 8; > + } else { > + txdrv = 4; > + } > > /* Modify HWTRAP first to allow direct access to internal PHYs */ > mt753x_reg_read(priv, HWTRAP_REG, &val); > @@ -732,7 +745,8 @@ static int mt7530_setup(struct mtk_eth_priv *priv) > /* Lower Tx Driving for TRGMII path */ > for (i = 0 ; i < NUM_TRGMII_CTRL ; i++) > mt753x_reg_write(priv, MT7530_TRGMII_TD_ODT(i), > - (8 << TD_DM_DRVP_S) | (8 << TD_DM_DRVN_S)); > + (txdrv << TD_DM_DRVP_S) | > + (txdrv << TD_DM_DRVN_S)); > > for (i = 0 ; i < NUM_TRGMII_CTRL; i++) > mt753x_reg_rmw(priv, MT7530_TRGMII_RD(i), RD_TAP_M, 16); > @@ -1419,7 +1433,7 @@ static int mtk_eth_of_to_plat(struct udevice *dev) > > priv->soc = dev_get_driver_data(dev); > > - pdata->iobase = dev_read_addr(dev); > + pdata->iobase = (phys_addr_t)dev_remap_addr(dev); This also needs a patch of it's own. > > /* get corresponding ethsys phandle */ > ret = dev_read_phandle_with_args(dev, "mediatek,ethsys", NULL, 0, 0, > @@ -1427,15 +1441,9 @@ static int mtk_eth_of_to_plat(struct udevice *dev) > if (ret) > return ret; > > - regmap = syscon_node_to_regmap(args.node); > - if (IS_ERR(regmap)) > - return PTR_ERR(regmap); > - > - priv->ethsys_base = regmap_get_range(regmap, 0); > - if (!priv->ethsys_base) { > - dev_err(dev, "Unable to find ethsys\n"); > - return -ENODEV; > - } > + priv->ethsys_regmap = syscon_node_to_regmap(args.node); > + if (IS_ERR(priv->ethsys_regmap)) > + return PTR_ERR(priv->ethsys_regmap); > > /* Reset controllers */ > ret = reset_get_by_name(dev, "fe", &priv->rst_fe); > @@ -1540,6 +1548,7 @@ static const struct udevice_id mtk_eth_ids[] = { > { .compatible = "mediatek,mt7629-eth", .data = SOC_MT7629 }, > { .compatible = "mediatek,mt7623-eth", .data = SOC_MT7623 }, > { .compatible = "mediatek,mt7622-eth", .data = SOC_MT7622 }, > + { .compatible = "mediatek,mt7621-eth", .data = SOC_MT7621 }, > {} > }; > > -- > 2.17.1 >
On Sat, 2022-04-30 at 20:13 +0300, Ramon Fried wrote: > On Thu, Apr 28, 2022 at 1:38 PM Weijie Gao <weijie.gao@mediatek.com> > wrote: > > > > This patch adds GMAC support for MediaTek MT7621 SoC. > > MT7621 has the same GMAC/Switch configuration as MT7623. > > > > Signed-off-by: Weijie Gao <weijie.gao@mediatek.com> > > --- > > v3 changes: > > Add register remap needed by mt7621 > > Fix use of noncached_alloc > > v2 changes: none > > --- > > drivers/net/mtk_eth.c | 45 ++++++++++++++++++++++++++------------- > > ---- > > 1 file changed, 27 insertions(+), 18 deletions(-) > > > > diff --git a/drivers/net/mtk_eth.c b/drivers/net/mtk_eth.c > > index 666ddeb10d..4fe7ee0d36 100644 > > --- a/drivers/net/mtk_eth.c > > +++ b/drivers/net/mtk_eth.c > > @@ -145,7 +145,8 @@ enum mtk_switch { > > enum mtk_soc { > > SOC_MT7623, > > SOC_MT7629, > > - SOC_MT7622 > > + SOC_MT7622, > > + SOC_MT7621 > > }; > > > > struct mtk_eth_priv { > > @@ -159,9 +160,10 @@ struct mtk_eth_priv { > > > > void __iomem *fe_base; > > void __iomem *gmac_base; > > - void __iomem *ethsys_base; > > void __iomem *sgmii_base; > > > > + struct regmap *ethsys_regmap; > > + > > struct mii_dev *mdio_bus; > > int (*mii_read)(struct mtk_eth_priv *priv, u8 phy, u8 reg); > > int (*mii_write)(struct mtk_eth_priv *priv, u8 phy, u8 reg, > > u16 val); > > @@ -233,7 +235,12 @@ static void mtk_gmac_rmw(struct mtk_eth_priv > > *priv, u32 reg, u32 clr, u32 set) > > static void mtk_ethsys_rmw(struct mtk_eth_priv *priv, u32 reg, u32 > > clr, > > u32 set) > > { > > - clrsetbits_le32(priv->ethsys_base + reg, clr, set); > > + uint val; > > + > > + regmap_read(priv->ethsys_regmap, reg, &val); > > + val &= ~clr; > > + val |= set; > > + regmap_write(priv->ethsys_regmap, reg, val); > > } > > Changing the registers to regmap is not part of the support for the > MT7621. please separate into two patches. OK. I'll split this into three patches. > > > > /* Direct MDIO clause 22/45 access via SoC */ > > @@ -669,12 +676,18 @@ static int mt7530_pad_clk_setup(struct > > mtk_eth_priv *priv, int mode) > > static int mt7530_setup(struct mtk_eth_priv *priv) > > { > > u16 phy_addr, phy_val; > > - u32 val; > > + u32 val, txdrv; > > int i; > > > > - /* Select 250MHz clk for RGMII mode */ > > - mtk_ethsys_rmw(priv, ETHSYS_CLKCFG0_REG, > > - ETHSYS_TRGMII_CLK_SEL362_5, 0); > > + if (priv->soc != SOC_MT7621) { > > + /* Select 250MHz clk for RGMII mode */ > > + mtk_ethsys_rmw(priv, ETHSYS_CLKCFG0_REG, > > + ETHSYS_TRGMII_CLK_SEL362_5, 0); > > + > > + txdrv = 8; > > + } else { > > + txdrv = 4; > > + } > > > > /* Modify HWTRAP first to allow direct access to internal > > PHYs */ > > mt753x_reg_read(priv, HWTRAP_REG, &val); > > @@ -732,7 +745,8 @@ static int mt7530_setup(struct mtk_eth_priv > > *priv) > > /* Lower Tx Driving for TRGMII path */ > > for (i = 0 ; i < NUM_TRGMII_CTRL ; i++) > > mt753x_reg_write(priv, MT7530_TRGMII_TD_ODT(i), > > - (8 << TD_DM_DRVP_S) | (8 << > > TD_DM_DRVN_S)); > > + (txdrv << TD_DM_DRVP_S) | > > + (txdrv << TD_DM_DRVN_S)); > > > > for (i = 0 ; i < NUM_TRGMII_CTRL; i++) > > mt753x_reg_rmw(priv, MT7530_TRGMII_RD(i), RD_TAP_M, > > 16); > > @@ -1419,7 +1433,7 @@ static int mtk_eth_of_to_plat(struct udevice > > *dev) > > > > priv->soc = dev_get_driver_data(dev); > > > > - pdata->iobase = dev_read_addr(dev); > > + pdata->iobase = (phys_addr_t)dev_remap_addr(dev); > > This also needs a patch of it's own. > > > > /* get corresponding ethsys phandle */ > > ret = dev_read_phandle_with_args(dev, "mediatek,ethsys", > > NULL, 0, 0, > > @@ -1427,15 +1441,9 @@ static int mtk_eth_of_to_plat(struct udevice > > *dev) > > if (ret) > > return ret; > > > > - regmap = syscon_node_to_regmap(args.node); > > - if (IS_ERR(regmap)) > > - return PTR_ERR(regmap); > > - > > - priv->ethsys_base = regmap_get_range(regmap, 0); > > - if (!priv->ethsys_base) { > > - dev_err(dev, "Unable to find ethsys\n"); > > - return -ENODEV; > > - } > > + priv->ethsys_regmap = syscon_node_to_regmap(args.node); > > + if (IS_ERR(priv->ethsys_regmap)) > > + return PTR_ERR(priv->ethsys_regmap); > > > > /* Reset controllers */ > > ret = reset_get_by_name(dev, "fe", &priv->rst_fe); > > @@ -1540,6 +1548,7 @@ static const struct udevice_id mtk_eth_ids[] > > = { > > { .compatible = "mediatek,mt7629-eth", .data = SOC_MT7629 > > }, > > { .compatible = "mediatek,mt7623-eth", .data = SOC_MT7623 > > }, > > { .compatible = "mediatek,mt7622-eth", .data = SOC_MT7622 > > }, > > + { .compatible = "mediatek,mt7621-eth", .data = SOC_MT7621 > > }, > > {} > > }; > > > > -- > > 2.17.1 > >
diff --git a/drivers/net/mtk_eth.c b/drivers/net/mtk_eth.c index 666ddeb10d..4fe7ee0d36 100644 --- a/drivers/net/mtk_eth.c +++ b/drivers/net/mtk_eth.c @@ -145,7 +145,8 @@ enum mtk_switch { enum mtk_soc { SOC_MT7623, SOC_MT7629, - SOC_MT7622 + SOC_MT7622, + SOC_MT7621 }; struct mtk_eth_priv { @@ -159,9 +160,10 @@ struct mtk_eth_priv { void __iomem *fe_base; void __iomem *gmac_base; - void __iomem *ethsys_base; void __iomem *sgmii_base; + struct regmap *ethsys_regmap; + struct mii_dev *mdio_bus; int (*mii_read)(struct mtk_eth_priv *priv, u8 phy, u8 reg); int (*mii_write)(struct mtk_eth_priv *priv, u8 phy, u8 reg, u16 val); @@ -233,7 +235,12 @@ static void mtk_gmac_rmw(struct mtk_eth_priv *priv, u32 reg, u32 clr, u32 set) static void mtk_ethsys_rmw(struct mtk_eth_priv *priv, u32 reg, u32 clr, u32 set) { - clrsetbits_le32(priv->ethsys_base + reg, clr, set); + uint val; + + regmap_read(priv->ethsys_regmap, reg, &val); + val &= ~clr; + val |= set; + regmap_write(priv->ethsys_regmap, reg, val); } /* Direct MDIO clause 22/45 access via SoC */ @@ -669,12 +676,18 @@ static int mt7530_pad_clk_setup(struct mtk_eth_priv *priv, int mode) static int mt7530_setup(struct mtk_eth_priv *priv) { u16 phy_addr, phy_val; - u32 val; + u32 val, txdrv; int i; - /* Select 250MHz clk for RGMII mode */ - mtk_ethsys_rmw(priv, ETHSYS_CLKCFG0_REG, - ETHSYS_TRGMII_CLK_SEL362_5, 0); + if (priv->soc != SOC_MT7621) { + /* Select 250MHz clk for RGMII mode */ + mtk_ethsys_rmw(priv, ETHSYS_CLKCFG0_REG, + ETHSYS_TRGMII_CLK_SEL362_5, 0); + + txdrv = 8; + } else { + txdrv = 4; + } /* Modify HWTRAP first to allow direct access to internal PHYs */ mt753x_reg_read(priv, HWTRAP_REG, &val); @@ -732,7 +745,8 @@ static int mt7530_setup(struct mtk_eth_priv *priv) /* Lower Tx Driving for TRGMII path */ for (i = 0 ; i < NUM_TRGMII_CTRL ; i++) mt753x_reg_write(priv, MT7530_TRGMII_TD_ODT(i), - (8 << TD_DM_DRVP_S) | (8 << TD_DM_DRVN_S)); + (txdrv << TD_DM_DRVP_S) | + (txdrv << TD_DM_DRVN_S)); for (i = 0 ; i < NUM_TRGMII_CTRL; i++) mt753x_reg_rmw(priv, MT7530_TRGMII_RD(i), RD_TAP_M, 16); @@ -1419,7 +1433,7 @@ static int mtk_eth_of_to_plat(struct udevice *dev) priv->soc = dev_get_driver_data(dev); - pdata->iobase = dev_read_addr(dev); + pdata->iobase = (phys_addr_t)dev_remap_addr(dev); /* get corresponding ethsys phandle */ ret = dev_read_phandle_with_args(dev, "mediatek,ethsys", NULL, 0, 0, @@ -1427,15 +1441,9 @@ static int mtk_eth_of_to_plat(struct udevice *dev) if (ret) return ret; - regmap = syscon_node_to_regmap(args.node); - if (IS_ERR(regmap)) - return PTR_ERR(regmap); - - priv->ethsys_base = regmap_get_range(regmap, 0); - if (!priv->ethsys_base) { - dev_err(dev, "Unable to find ethsys\n"); - return -ENODEV; - } + priv->ethsys_regmap = syscon_node_to_regmap(args.node); + if (IS_ERR(priv->ethsys_regmap)) + return PTR_ERR(priv->ethsys_regmap); /* Reset controllers */ ret = reset_get_by_name(dev, "fe", &priv->rst_fe); @@ -1540,6 +1548,7 @@ static const struct udevice_id mtk_eth_ids[] = { { .compatible = "mediatek,mt7629-eth", .data = SOC_MT7629 }, { .compatible = "mediatek,mt7623-eth", .data = SOC_MT7623 }, { .compatible = "mediatek,mt7622-eth", .data = SOC_MT7622 }, + { .compatible = "mediatek,mt7621-eth", .data = SOC_MT7621 }, {} };
This patch adds GMAC support for MediaTek MT7621 SoC. MT7621 has the same GMAC/Switch configuration as MT7623. Signed-off-by: Weijie Gao <weijie.gao@mediatek.com> --- v3 changes: Add register remap needed by mt7621 Fix use of noncached_alloc v2 changes: none --- drivers/net/mtk_eth.c | 45 ++++++++++++++++++++++++++----------------- 1 file changed, 27 insertions(+), 18 deletions(-)