[PATCH v3 2/3] ethernet: stmmac: dwmac-rk: Add gmac support for rk3562
Jonas Karlman
jonas at kwiboo.se
Mon Apr 21 09:48:03 PDT 2025
Hi Kever,
On 2025-04-18 11:51, Kever Yang wrote:
> From: David Wu <david.wu at rock-chips.com>
>
> Add constants and callback functions for the dwmac on RK3562 soc.
> As can be seen, the base structure is the same.
>
> Signed-off-by: David Wu <david.wu at rock-chips.com>
> Signed-off-by: Kever Yang <kever.yang at rock-chips.com>
> ---
>
> Changes in v3:
> - remove unreadable MACRO;
> - use two function for rmii and rgmii speed set;
> - don't check grf and php_grf in function call;
> - rebase on v6.15-rc1
>
> Changes in v2:
> - Collect review tag
>
> .../net/ethernet/stmicro/stmmac/dwmac-rk.c | 190 ++++++++++++++++++
> 1 file changed, 190 insertions(+)
>
> diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c b/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
> index 700858ff6f7c..82174054644a 100644
> --- a/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
> +++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
> @@ -2,6 +2,7 @@
> /**
> * DOC: dwmac-rk.c - Rockchip RK3288 DWMAC specific glue layer
> *
> + * Copyright (c) 2014 Rockchip Electronics Co., Ltd.
> * Copyright (C) 2014 Chen-Zhi (Roger Chen)
> *
> * Chen-Zhi (Roger Chen) <roger.chen at rock-chips.com>
> @@ -1048,6 +1049,194 @@ static const struct rk_gmac_ops rk3528_ops = {
> },
> };
>
> +/* sys_grf */
> +#define RK3562_GRF_SYS_SOC_CON0 0X0400
> +#define RK3562_GRF_SYS_SOC_CON1 0X0404
> +
> +#define RK3562_GMAC0_CLK_RMII_MODE GRF_BIT(5)
> +#define RK3562_GMAC0_CLK_RGMII_MODE GRF_CLR_BIT(5)
> +
> +#define RK3562_GMAC0_CLK_RMII_GATE GRF_BIT(6)
> +#define RK3562_GMAC0_CLK_RMII_NOGATE GRF_CLR_BIT(6)
> +
> +#define RK3562_GMAC0_CLK_RMII_DIV2 GRF_BIT(7)
> +#define RK3562_GMAC0_CLK_RMII_DIV20 GRF_CLR_BIT(7)
> +
> +#define RK3562_GMAC0_CLK_RGMII_DIV1 \
> + (GRF_CLR_BIT(7) | GRF_CLR_BIT(8))
> +#define RK3562_GMAC0_CLK_RGMII_DIV5 \
> + (GRF_BIT(7) | GRF_BIT(8))
> +#define RK3562_GMAC0_CLK_RGMII_DIV50 \
> + (GRF_CLR_BIT(7) | GRF_BIT(8))
> +
> +#define RK3562_GMAC0_CLK_RMII_DIV2 GRF_BIT(7)
> +#define RK3562_GMAC0_CLK_RMII_DIV20 GRF_CLR_BIT(7)
> +
> +#define RK3562_GMAC0_CLK_SELET_CRU GRF_CLR_BIT(9)
> +#define RK3562_GMAC0_CLK_SELET_IO GRF_BIT(9)
This is probably a typo, SELET, should probably be SELECT?
> +
> +#define RK3562_GMAC1_CLK_RMII_GATE GRF_BIT(12)
> +#define RK3562_GMAC1_CLK_RMII_NOGATE GRF_CLR_BIT(12)
> +
> +#define RK3562_GMAC1_CLK_RMII_DIV2 GRF_BIT(13)
> +#define RK3562_GMAC1_CLK_RMII_DIV20 GRF_CLR_BIT(13)
> +
> +#define RK3562_GMAC1_RMII_SPEED100 GRF_BIT(11)
> +#define RK3562_GMAC1_RMII_SPEED10 GRF_CLR_BIT(11)
> +
> +#define RK3562_GMAC1_CLK_SELET_CRU GRF_CLR_BIT(15)
> +#define RK3562_GMAC1_CLK_SELET_IO GRF_BIT(15)
Same here.
> +
> +/* ioc_grf */
> +#define RK3562_GRF_IOC_GMAC_IOFUNC0_CON0 0X10400
> +#define RK3562_GRF_IOC_GMAC_IOFUNC0_CON1 0X10404
> +#define RK3562_GRF_IOC_GMAC_IOFUNC1_CON0 0X00400
> +#define RK3562_GRF_IOC_GMAC_IOFUNC1_CON1 0X00404
> +
> +#define RK3562_GMAC_RXCLK_DLY_ENABLE GRF_BIT(1)
> +#define RK3562_GMAC_RXCLK_DLY_DISABLE GRF_CLR_BIT(1)
> +#define RK3562_GMAC_TXCLK_DLY_ENABLE GRF_BIT(0)
> +#define RK3562_GMAC_TXCLK_DLY_DISABLE GRF_CLR_BIT(0)
> +
> +#define RK3562_GMAC_CLK_RX_DL_CFG(val) HIWORD_UPDATE(val, 0xFF, 8)
> +#define RK3562_GMAC_CLK_TX_DL_CFG(val) HIWORD_UPDATE(val, 0xFF, 0)
> +
> +#define RK3562_GMAC0_IO_EXTCLK_SELET_CRU GRF_CLR_BIT(2)
> +#define RK3562_GMAC0_IO_EXTCLK_SELET_IO GRF_BIT(2)
Same here.
> +
> +#define RK3562_GMAC1_IO_EXTCLK_SELET_CRU GRF_CLR_BIT(3)
> +#define RK3562_GMAC1_IO_EXTCLK_SELET_IO GRF_BIT(3)
And here.
> +
> +static void rk3562_set_to_rgmii(struct rk_priv_data *bsp_priv,
> + int tx_delay, int rx_delay)
> +{
> + regmap_write(bsp_priv->grf, RK3562_GRF_SYS_SOC_CON0,
> + RK3562_GMAC0_CLK_RGMII_MODE);
> +
> + regmap_write(bsp_priv->php_grf, RK3562_GRF_IOC_GMAC_IOFUNC0_CON1,
> + DELAY_ENABLE(RK3562, tx_delay, rx_delay));
> + regmap_write(bsp_priv->php_grf, RK3562_GRF_IOC_GMAC_IOFUNC0_CON0,
> + RK3562_GMAC_CLK_RX_DL_CFG(rx_delay) |
> + RK3562_GMAC_CLK_TX_DL_CFG(tx_delay));
> +
> + regmap_write(bsp_priv->php_grf, RK3562_GRF_IOC_GMAC_IOFUNC1_CON1,
> + DELAY_ENABLE(RK3562, tx_delay, rx_delay));
> + regmap_write(bsp_priv->php_grf, RK3562_GRF_IOC_GMAC_IOFUNC1_CON0,
> + RK3562_GMAC_CLK_RX_DL_CFG(rx_delay) |
> + RK3562_GMAC_CLK_TX_DL_CFG(tx_delay));
> +}
> +
> +static void rk3562_set_to_rmii(struct rk_priv_data *bsp_priv)
> +{
> + if (!bsp_priv->id)
> + regmap_write(bsp_priv->grf, RK3562_GRF_SYS_SOC_CON0,
> + RK3562_GMAC0_CLK_RMII_MODE);
> +}
> +
> +static void rk3562_set_gmac_rgmii_speed(struct rk_priv_data *bsp_priv, int speed)
> +{
> + struct device *dev = &bsp_priv->pdev->dev;
> + unsigned int val = 0;
> +
> + switch (speed) {
> + case 10:
> + val = RK3562_GMAC0_CLK_RGMII_DIV50;
> + break;
> + case 100:
> + val = RK3562_GMAC0_CLK_RGMII_DIV5;
> + break;
> + case 1000:
> + val = RK3562_GMAC0_CLK_RGMII_DIV1;
> + break;
> + default:
> + goto err;
> + }
> +
> + regmap_write(bsp_priv->grf, RK3562_GRF_SYS_SOC_CON0, val);
> + return;
> +err:
> + dev_err(dev, "unknown speed value for GMAC speed=%d", speed);
> +}
> +
> +static void rk3562_set_gmac_rmii_speed(struct rk_priv_data *bsp_priv, int speed)
> +{
> + struct device *dev = &bsp_priv->pdev->dev;
> + unsigned int val = 0, offset;
> +
> + switch (speed) {
> + case 10:
> + if (bsp_priv->id == 1) {
> + val = RK3562_GMAC1_CLK_RMII_DIV20;
> + regmap_write(bsp_priv->grf, RK3562_GRF_SYS_SOC_CON0,
> + RK3562_GMAC1_RMII_SPEED10);
> + } else {
> + val = RK3562_GMAC0_CLK_RMII_DIV20;
> + }
> + break;
> + case 100:
> + if (bsp_priv->id == 1) {
> + val = RK3562_GMAC1_CLK_RMII_DIV2;
> + regmap_write(bsp_priv->grf, RK3562_GRF_SYS_SOC_CON0,
> + RK3562_GMAC1_RMII_SPEED100);
> + } else {
> + val = RK3562_GMAC0_CLK_RMII_DIV2;
> + }
> + break;
> + default:
> + goto err;
> + }
> +
> + offset = (bsp_priv->id == 1) ? RK3562_GRF_SYS_SOC_CON1 :
> + RK3562_GRF_SYS_SOC_CON0;
> + regmap_write(bsp_priv->grf, offset, val);
> + return;
> +err:
> + dev_err(dev, "unknown speed value for GMAC speed=%d", speed);
> +}
> +
> +static void rk3562_set_clock_selection(struct rk_priv_data *bsp_priv, bool input,
> + bool enable)
> +{
> + struct device *dev = &bsp_priv->pdev->dev;
> + unsigned int value;
> +
> + if (IS_ERR(bsp_priv->grf) || IS_ERR(bsp_priv->php_grf)) {
> + dev_err(dev, "Missing rockchip,grf or rockchip,php_grf property\n");
> + return;
> + }
This should not be needed after the commit 247e84f66a3d ("net: stmmac:
dwmac-rk: Validate GRF and peripheral GRF during probe") and the use of
php_grf_required=true below.
> +
> + if (!bsp_priv->id) {
> + value = input ? RK3562_GMAC0_CLK_SELET_IO :
> + RK3562_GMAC0_CLK_SELET_CRU;
> + value |= enable ? RK3562_GMAC0_CLK_RMII_NOGATE :
> + RK3562_GMAC0_CLK_RMII_GATE;
> + regmap_write(bsp_priv->grf, RK3562_GRF_SYS_SOC_CON0, value);
> +
> + value = input ? RK3562_GMAC0_IO_EXTCLK_SELET_IO :
> + RK3562_GMAC0_IO_EXTCLK_SELET_CRU;
> + regmap_write(bsp_priv->php_grf, RK3562_GRF_IOC_GMAC_IOFUNC0_CON1, value);
> + regmap_write(bsp_priv->php_grf, RK3562_GRF_IOC_GMAC_IOFUNC1_CON1, value);
> + } else {
> + value = input ? RK3562_GMAC1_CLK_SELET_IO :
> + RK3562_GMAC1_CLK_SELET_CRU;
> + value |= enable ? RK3562_GMAC1_CLK_RMII_NOGATE :
> + RK3562_GMAC1_CLK_RMII_GATE;
> + regmap_write(bsp_priv->grf, RK3562_GRF_SYS_SOC_CON1, value);
> +
> + value = input ? RK3562_GMAC1_IO_EXTCLK_SELET_IO :
> + RK3562_GMAC1_IO_EXTCLK_SELET_CRU;
> + regmap_write(bsp_priv->php_grf, RK3562_GRF_IOC_GMAC_IOFUNC1_CON1, value);
> + }
> +}
> +
> +static const struct rk_gmac_ops rk3562_ops = {
> + .set_to_rgmii = rk3562_set_to_rgmii,
> + .set_to_rmii = rk3562_set_to_rmii,
> + .set_rgmii_speed = rk3562_set_gmac_rgmii_speed,
> + .set_rmii_speed = rk3562_set_gmac_rmii_speed,
> + .set_clock_selection = rk3562_set_clock_selection,
This is missing the recently added:
.php_grf_required = true,
Regards,
Jonas
> +};
> +
> #define RK3568_GRF_GMAC0_CON0 0x0380
> #define RK3568_GRF_GMAC0_CON1 0x0384
> #define RK3568_GRF_GMAC1_CON0 0x0388
> @@ -1996,6 +2185,7 @@ static const struct of_device_id rk_gmac_dwmac_match[] = {
> { .compatible = "rockchip,rk3368-gmac", .data = &rk3368_ops },
> { .compatible = "rockchip,rk3399-gmac", .data = &rk3399_ops },
> { .compatible = "rockchip,rk3528-gmac", .data = &rk3528_ops },
> + { .compatible = "rockchip,rk3562-gmac", .data = &rk3562_ops },
> { .compatible = "rockchip,rk3568-gmac", .data = &rk3568_ops },
> { .compatible = "rockchip,rk3576-gmac", .data = &rk3576_ops },
> { .compatible = "rockchip,rk3588-gmac", .data = &rk3588_ops },
More information about the Linux-rockchip
mailing list