From ca89ea7e0760c096c6fd807d321ecb8416f8cd9d Mon Sep 17 00:00:00 2001 From: David Wu Date: Thu, 31 Dec 2020 18:32:03 +0800 Subject: [PATCH] ethernet: stmicro: stmmac: Add SGMII/QSGMII support for RK3568 After the completion of Clause 37 auto-negotiation, xpcs automatically switches to the negotiated speed for 10/100/1000M. Change-Id: Iab9dd6ee61a35bf89fd3a0721f5d398de501a7ec Signed-off-by: David Wu --- .../net/ethernet/stmicro/stmmac/dwmac-rk.c | 228 +++++++++++++++++- 1 file changed, 217 insertions(+), 11 deletions(-) --- a/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c +++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c @@ -11,6 +11,7 @@ #include #include #include +#include #include #include #include @@ -30,6 +31,8 @@ struct rk_gmac_ops { void (*set_to_rgmii)(struct rk_priv_data *bsp_priv, int tx_delay, int rx_delay); void (*set_to_rmii)(struct rk_priv_data *bsp_priv); + void (*set_to_sgmii)(struct rk_priv_data *bsp_priv); + void (*set_to_qsgmii)(struct rk_priv_data *bsp_priv); void (*set_rgmii_speed)(struct rk_priv_data *bsp_priv, int speed); void (*set_rmii_speed)(struct rk_priv_data *bsp_priv, int speed); void (*integrated_phy_powerup)(struct rk_priv_data *bsp_priv); @@ -58,6 +61,7 @@ struct rk_priv_data { struct clk *clk_mac_speed; struct clk *aclk_mac; struct clk *pclk_mac; + struct clk *pclk_xpcs; struct clk *clk_phy; struct reset_control *phy_reset; @@ -66,6 +70,7 @@ struct rk_priv_data { int rx_delay; struct regmap *grf; + struct regmap *xpcs; }; #define HIWORD_UPDATE(val, mask, shift) \ @@ -78,6 +83,128 @@ struct rk_priv_data { (((tx) ? soc##_GMAC_TXCLK_DLY_ENABLE : soc##_GMAC_TXCLK_DLY_DISABLE) | \ ((rx) ? soc##_GMAC_RXCLK_DLY_ENABLE : soc##_GMAC_RXCLK_DLY_DISABLE)) +/* XPCS */ +#define XPCS_APB_INCREMENT (0x4) +#define XPCS_APB_MASK GENMASK_ULL(20, 0) + +#define SR_MII_BASE (0x1F0000) +#define SR_MII1_BASE (0x1A0000) + +#define VR_MII_DIG_CTRL1 (0x8000) +#define VR_MII_AN_CTRL (0x8001) +#define VR_MII_AN_INTR_STS (0x8002) +#define VR_MII_LINK_TIMER_CTRL (0x800A) + +#define SR_MII_CTRL_AN_ENABLE \ + (BMCR_ANENABLE | BMCR_ANRESTART | BMCR_FULLDPLX | BMCR_SPEED1000) +#define MII_MAC_AUTO_SW (0x0200) +#define PCS_MODE_OFFSET (0x1) +#define MII_AN_INTR_EN (0x1) +#define PCS_SGMII_MODE (0x2 << PCS_MODE_OFFSET) +#define PCS_QSGMII_MODE (0X3 << PCS_MODE_OFFSET) +#define VR_MII_CTRL_SGMII_AN_EN (PCS_SGMII_MODE | MII_AN_INTR_EN) +#define VR_MII_CTRL_QSGMII_AN_EN (PCS_QSGMII_MODE | MII_AN_INTR_EN) + +#define SR_MII_OFFSET(_x) ({ \ + typeof(_x) (x) = (_x); \ + (((x) == 0) ? SR_MII_BASE : (SR_MII1_BASE + ((x) - 1) * 0x10000)); \ +}) \ + +static int xpcs_read(void *priv, int reg) +{ + struct rk_priv_data *bsp_priv = (struct rk_priv_data *)priv; + int ret, val; + + ret = regmap_read(bsp_priv->xpcs, + (u32)(reg * XPCS_APB_INCREMENT) & XPCS_APB_MASK, + &val); + if (ret) + return ret; + + return val; +} + +static int xpcs_write(void *priv, int reg, u16 value) +{ + struct rk_priv_data *bsp_priv = (struct rk_priv_data *)priv; + + return regmap_write(bsp_priv->xpcs, + (reg * XPCS_APB_INCREMENT) & XPCS_APB_MASK, value); +} + +static int xpcs_poll_reset(struct rk_priv_data *bsp_priv, int dev) +{ + /* Poll until the reset bit clears (50ms per retry == 0.6 sec) */ + unsigned int retries = 12; + int ret; + + do { + msleep(50); + ret = xpcs_read(bsp_priv, SR_MII_OFFSET(dev) + MDIO_CTRL1); + if (ret < 0) + return ret; + } while (ret & MDIO_CTRL1_RESET && --retries); + + return (ret & MDIO_CTRL1_RESET) ? -ETIMEDOUT : 0; +} + +static int xpcs_soft_reset(struct rk_priv_data *bsp_priv, int dev) +{ + int ret; + + ret = xpcs_write(bsp_priv, SR_MII_OFFSET(dev) + MDIO_CTRL1, + MDIO_CTRL1_RESET); + if (ret < 0) + return ret; + + return xpcs_poll_reset(bsp_priv, dev); +} + +static int xpcs_setup(struct rk_priv_data *bsp_priv, int mode) +{ + int ret, i, idx = bsp_priv->id; + u32 val; + + if (mode == PHY_INTERFACE_MODE_QSGMII && idx > 0) + return 0; + + ret = xpcs_soft_reset(bsp_priv, idx); + if (ret) { + dev_err(&bsp_priv->pdev->dev, "xpcs_soft_reset fail %d\n", ret); + return ret; + } + + xpcs_write(bsp_priv, SR_MII_OFFSET(0) + VR_MII_AN_INTR_STS, 0x0); + xpcs_write(bsp_priv, SR_MII_OFFSET(0) + VR_MII_LINK_TIMER_CTRL, 0x1); + + if (mode == PHY_INTERFACE_MODE_SGMII) + xpcs_write(bsp_priv, SR_MII_OFFSET(0) + VR_MII_AN_CTRL, + VR_MII_CTRL_SGMII_AN_EN); + else + xpcs_write(bsp_priv, SR_MII_OFFSET(0) + VR_MII_AN_CTRL, + VR_MII_CTRL_QSGMII_AN_EN); + + if (mode == PHY_INTERFACE_MODE_QSGMII) { + for (i = 0; i < 4; i++) { + val = xpcs_read(bsp_priv, + SR_MII_OFFSET(i) + VR_MII_DIG_CTRL1); + xpcs_write(bsp_priv, + SR_MII_OFFSET(i) + VR_MII_DIG_CTRL1, + val | MII_MAC_AUTO_SW); + xpcs_write(bsp_priv, SR_MII_OFFSET(i) + MII_BMCR, + SR_MII_CTRL_AN_ENABLE); + } + } else { + val = xpcs_read(bsp_priv, SR_MII_OFFSET(idx) + VR_MII_DIG_CTRL1); + xpcs_write(bsp_priv, SR_MII_OFFSET(idx) + VR_MII_DIG_CTRL1, + val | MII_MAC_AUTO_SW); + xpcs_write(bsp_priv, SR_MII_OFFSET(idx) + MII_BMCR, + SR_MII_CTRL_AN_ENABLE); + } + + return ret; +} + #define PX30_GRF_GMAC_CON1 0x0904 /* PX30_GRF_GMAC_CON1 */ @@ -1005,6 +1132,7 @@ static const struct rk_gmac_ops rk3399_o #define RK3568_GRF_GMAC1_CON1 0x038c /* RK3568_GRF_GMAC0_CON1 && RK3568_GRF_GMAC1_CON1 */ +#define RK3568_GMAC_GMII_MODE GRF_BIT(7) #define RK3568_GMAC_PHY_INTF_SEL_RGMII \ (GRF_BIT(4) | GRF_CLR_BIT(5) | GRF_CLR_BIT(6)) #define RK3568_GMAC_PHY_INTF_SEL_RMII \ @@ -1020,6 +1148,46 @@ static const struct rk_gmac_ops rk3399_o #define RK3568_GMAC_CLK_RX_DL_CFG(val) HIWORD_UPDATE(val, 0x7F, 8) #define RK3568_GMAC_CLK_TX_DL_CFG(val) HIWORD_UPDATE(val, 0x7F, 0) +#define RK3568_PIPE_GRF_XPCS_CON0 0X0040 + +#define RK3568_PIPE_GRF_XPCS_QGMII_MAC_SEL GRF_BIT(0) +#define RK3568_PIPE_GRF_XPCS_SGMII_MAC_SEL GRF_BIT(1) +#define RK3568_PIPE_GRF_XPCS_PHY_READY GRF_BIT(2) + +static void rk3568_set_to_sgmii(struct rk_priv_data *bsp_priv) +{ + struct device *dev = &bsp_priv->pdev->dev; + u32 con1; + + if (IS_ERR(bsp_priv->grf)) { + dev_err(dev, "Missing rockchip,grf property\n"); + return; + } + + con1 = (bsp_priv->id == 1) ? RK3568_GRF_GMAC1_CON1 : + RK3568_GRF_GMAC0_CON1; + regmap_write(bsp_priv->grf, con1, RK3568_GMAC_GMII_MODE); + + xpcs_setup(bsp_priv, PHY_INTERFACE_MODE_SGMII); +} + +static void rk3568_set_to_qsgmii(struct rk_priv_data *bsp_priv) +{ + struct device *dev = &bsp_priv->pdev->dev; + u32 con1; + + if (IS_ERR(bsp_priv->grf)) { + dev_err(dev, "Missing rockchip,grf property\n"); + return; + } + + con1 = (bsp_priv->id == 1) ? RK3568_GRF_GMAC1_CON1 : + RK3568_GRF_GMAC0_CON1; + regmap_write(bsp_priv->grf, con1, RK3568_GMAC_GMII_MODE); + + xpcs_setup(bsp_priv, PHY_INTERFACE_MODE_QSGMII); +} + static void rk3568_set_to_rgmii(struct rk_priv_data *bsp_priv, int tx_delay, int rx_delay) { @@ -1091,6 +1259,8 @@ static void rk3568_set_gmac_speed(struct static const struct rk_gmac_ops rk3568_ops = { .set_to_rgmii = rk3568_set_to_rgmii, .set_to_rmii = rk3568_set_to_rmii, + .set_to_sgmii = rk3568_set_to_sgmii, + .set_to_qsgmii = rk3568_set_to_qsgmii, .set_rgmii_speed = rk3568_set_gmac_speed, .set_rmii_speed = rk3568_set_gmac_speed, .regs_valid = true, @@ -1243,6 +1413,12 @@ static int rk_gmac_clk_init(struct plat_ dev_err(dev, "cannot get clock %s\n", "clk_mac_refout"); } + } else if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_SGMII || + bsp_priv->phy_iface == PHY_INTERFACE_MODE_QSGMII) { + bsp_priv->pclk_xpcs = devm_clk_get(dev, "pclk_xpcs"); + if (IS_ERR(bsp_priv->pclk_xpcs)) + dev_err(dev, "cannot get clock %s\n", + "pclk_xpcs"); } bsp_priv->clk_mac_speed = devm_clk_get(dev, "clk_mac_speed"); @@ -1298,6 +1474,9 @@ static int gmac_clk_enable(struct rk_pri if (!IS_ERR(bsp_priv->pclk_mac)) clk_prepare_enable(bsp_priv->pclk_mac); + if (!IS_ERR(bsp_priv->pclk_xpcs)) + clk_prepare_enable(bsp_priv->pclk_xpcs); + if (!IS_ERR(bsp_priv->mac_clk_tx)) clk_prepare_enable(bsp_priv->mac_clk_tx); @@ -1327,6 +1506,8 @@ static int gmac_clk_enable(struct rk_pri clk_disable_unprepare(bsp_priv->pclk_mac); + clk_disable_unprepare(bsp_priv->pclk_xpcs); + clk_disable_unprepare(bsp_priv->mac_clk_tx); clk_disable_unprepare(bsp_priv->clk_mac_speed); @@ -1341,7 +1522,7 @@ static int gmac_clk_enable(struct rk_pri return 0; } -static int phy_power_on(struct rk_priv_data *bsp_priv, bool enable) +static int rk_gmac_phy_power_on(struct rk_priv_data *bsp_priv, bool enable) { struct regulator *ldo = bsp_priv->regulator; int ret; @@ -1444,6 +1625,18 @@ static struct rk_priv_data *rk_gmac_setu bsp_priv->grf = syscon_regmap_lookup_by_phandle(dev->of_node, "rockchip,grf"); + bsp_priv->xpcs = syscon_regmap_lookup_by_phandle(dev->of_node, + "rockchip,xpcs"); + if (!IS_ERR(bsp_priv->xpcs)) { + struct phy *comphy; + + comphy = devm_of_phy_get(&pdev->dev, dev->of_node, NULL); + if (IS_ERR(comphy)) + dev_err(dev, "devm_of_phy_get error\n"); + ret = phy_init(comphy); + if (ret) + dev_err(dev, "phy_init error\n"); + } if (plat->phy_node) { bsp_priv->integrated_phy = of_property_read_bool(plat->phy_node, @@ -1521,11 +1714,19 @@ static int rk_gmac_powerup(struct rk_pri dev_info(dev, "init for RMII\n"); bsp_priv->ops->set_to_rmii(bsp_priv); break; + case PHY_INTERFACE_MODE_SGMII: + dev_info(dev, "init for SGMII\n"); + bsp_priv->ops->set_to_sgmii(bsp_priv); + break; + case PHY_INTERFACE_MODE_QSGMII: + dev_info(dev, "init for QSGMII\n"); + bsp_priv->ops->set_to_qsgmii(bsp_priv); + break; default: dev_err(dev, "NO interface defined!\n"); } - ret = phy_power_on(bsp_priv, true); + ret = rk_gmac_phy_power_on(bsp_priv, true); if (ret) { gmac_clk_enable(bsp_priv, false); return ret; @@ -1546,7 +1747,7 @@ static void rk_gmac_powerdown(struct rk_ pm_runtime_put_sync(&gmac->pdev->dev); - phy_power_on(gmac, false); + rk_gmac_phy_power_on(gmac, false); gmac_clk_enable(gmac, false); } @@ -1567,6 +1768,9 @@ static void rk_fix_speed(void *priv, uns if (bsp_priv->ops->set_rmii_speed) bsp_priv->ops->set_rmii_speed(bsp_priv, speed); break; + case PHY_INTERFACE_MODE_SGMII: + case PHY_INTERFACE_MODE_QSGMII: + break; default: dev_err(dev, "unsupported interface %d", bsp_priv->phy_iface); }