net: stmmac: dwmac-rk: support RK3399 GMAC driver

Change-Id: Ib584d3526929fa37ae1e701c01971a61188d213b
Signed-off-by: Roger Chen <roger.chen@rock-chips.com>

diff --git a/Documentation/devicetree/bindings/net/rockchip-dwmac.txt b/Documentation/devicetree/bindings/net/rockchip-dwmac.txt
index bf5b03a8d67deb68535fbb636bd5d7383e5d9509..c9ab3cba84def6854baecc9dd161d050b43c36c1 100644 (file)
--- a/Documentation/devicetree/bindings/net/rockchip-dwmac.txt
+++ b/Documentation/devicetree/bindings/net/rockchip-dwmac.txt
@@ -4,7 +4,7 @@ The device node has following properties.
 
 Required properties:
  - compatible: Can be one of "rockchip,rk3288-gmac", "rockchip,rk3366-gmac",
-   "rockchip, rk3368-gmac"
+   "rockchip, rk3368-gmac", "rockchip,rk3399-gmac"
  - reg: addresses and length of the register sets for the device.
  - interrupts: Should contain the GMAC interrupts.
  - interrupt-names: Should contain the interrupt names "macirq".

diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c b/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
index b5669282f0206465a0e6a14e0be7ae753b275f59..35145b2ee114111c4850ab08549c7e4ccfbfbd56 100644 (file)
--- a/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
+++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
@@ -408,6 +408,118 @@ static const struct rk_gmac_ops rk3368_ops = {
        .set_rmii_speed = rk3368_set_rmii_speed,
 };
 
+#define RK3399_GRF_SOC_CON5    0xc214
+#define RK3399_GRF_SOC_CON6    0xc218
+
+/* RK3399_GRF_SOC_CON5 */
+#define RK3399_GMAC_PHY_INTF_SEL_RGMII (GRF_BIT(9) | GRF_CLR_BIT(10) | \
+                                        GRF_CLR_BIT(11))
+#define RK3399_GMAC_PHY_INTF_SEL_RMII  (GRF_CLR_BIT(9) | GRF_CLR_BIT(10) | \
+                                        GRF_BIT(11))
+#define RK3399_GMAC_FLOW_CTRL          GRF_BIT(8)
+#define RK3399_GMAC_FLOW_CTRL_CLR      GRF_CLR_BIT(8)
+#define RK3399_GMAC_SPEED_10M          GRF_CLR_BIT(7)
+#define RK3399_GMAC_SPEED_100M         GRF_BIT(7)
+#define RK3399_GMAC_RMII_CLK_25M       GRF_BIT(3)
+#define RK3399_GMAC_RMII_CLK_2_5M      GRF_CLR_BIT(3)
+#define RK3399_GMAC_CLK_125M           (GRF_CLR_BIT(4) | GRF_CLR_BIT(5))
+#define RK3399_GMAC_CLK_25M            (GRF_BIT(4) | GRF_BIT(5))
+#define RK3399_GMAC_CLK_2_5M           (GRF_CLR_BIT(4) | GRF_BIT(5))
+#define RK3399_GMAC_RMII_MODE          GRF_BIT(6)
+#define RK3399_GMAC_RMII_MODE_CLR      GRF_CLR_BIT(6)
+
+/* RK3399_GRF_SOC_CON6 */
+#define RK3399_GMAC_TXCLK_DLY_ENABLE   GRF_BIT(7)
+#define RK3399_GMAC_TXCLK_DLY_DISABLE  GRF_CLR_BIT(7)
+#define RK3399_GMAC_RXCLK_DLY_ENABLE   GRF_BIT(15)
+#define RK3399_GMAC_RXCLK_DLY_DISABLE  GRF_CLR_BIT(15)
+#define RK3399_GMAC_CLK_RX_DL_CFG(val) HIWORD_UPDATE(val, 0x7F, 8)
+#define RK3399_GMAC_CLK_TX_DL_CFG(val) HIWORD_UPDATE(val, 0x7F, 0)
+
+static void rk3399_set_to_rgmii(struct rk_priv_data *bsp_priv,
+                               int tx_delay, int rx_delay)
+{
+       struct device *dev = &bsp_priv->pdev->dev;
+
+       if (IS_ERR(bsp_priv->grf)) {
+               dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
+               return;
+       }
+
+       regmap_write(bsp_priv->grf, RK3399_GRF_SOC_CON5,
+                    RK3399_GMAC_PHY_INTF_SEL_RGMII |
+                    RK3399_GMAC_RMII_MODE_CLR);
+       regmap_write(bsp_priv->grf, RK3399_GRF_SOC_CON6,
+                    RK3399_GMAC_RXCLK_DLY_ENABLE |
+                    RK3399_GMAC_TXCLK_DLY_ENABLE |
+                    RK3399_GMAC_CLK_RX_DL_CFG(rx_delay) |
+                    RK3399_GMAC_CLK_TX_DL_CFG(tx_delay));
+}
+
+static void rk3399_set_to_rmii(struct rk_priv_data *bsp_priv)
+{
+       struct device *dev = &bsp_priv->pdev->dev;
+
+       if (IS_ERR(bsp_priv->grf)) {
+               dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
+               return;
+       }
+
+       regmap_write(bsp_priv->grf, RK3399_GRF_SOC_CON5,
+                    RK3399_GMAC_PHY_INTF_SEL_RMII | RK3399_GMAC_RMII_MODE);
+}
+
+static void rk3399_set_rgmii_speed(struct rk_priv_data *bsp_priv, int speed)
+{
+       struct device *dev = &bsp_priv->pdev->dev;
+
+       if (IS_ERR(bsp_priv->grf)) {
+               dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
+               return;
+       }
+
+       if (speed == 10)
+               regmap_write(bsp_priv->grf, RK3399_GRF_SOC_CON5,
+                            RK3399_GMAC_CLK_2_5M);
+       else if (speed == 100)
+               regmap_write(bsp_priv->grf, RK3399_GRF_SOC_CON5,
+                            RK3399_GMAC_CLK_25M);
+       else if (speed == 1000)
+               regmap_write(bsp_priv->grf, RK3399_GRF_SOC_CON5,
+                            RK3399_GMAC_CLK_125M);
+       else
+               dev_err(dev, "unknown speed value for RGMII! speed=%d", speed);
+}
+
+static void rk3399_set_rmii_speed(struct rk_priv_data *bsp_priv, int speed)
+{
+       struct device *dev = &bsp_priv->pdev->dev;
+
+       if (IS_ERR(bsp_priv->grf)) {
+               dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
+               return;
+       }
+
+       if (speed == 10) {
+               regmap_write(bsp_priv->grf, RK3399_GRF_SOC_CON5,
+                            RK3399_GMAC_RMII_CLK_2_5M |
+                            RK3399_GMAC_SPEED_10M);
+       } else if (speed == 100) {
+               regmap_write(bsp_priv->grf, RK3399_GRF_SOC_CON5,
+                            RK3399_GMAC_RMII_CLK_25M |
+                            RK3399_GMAC_SPEED_100M);
+       } else {
+               dev_err(dev, "unknown speed value for RMII! speed=%d", speed);
+       }
+}
+
+static const struct rk_gmac_ops rk3399_ops = {
+       .set_to_rgmii = rk3399_set_to_rgmii,
+       .set_to_rmii = rk3399_set_to_rmii,
+       .set_rgmii_speed = rk3399_set_rgmii_speed,
+       .set_rmii_speed = rk3399_set_rmii_speed,
+};
+
 static int gmac_clk_init(struct rk_priv_data *bsp_priv)
 {
        struct device *dev = &bsp_priv->pdev->dev;
@@ -719,6 +831,7 @@ static const struct of_device_id rk_gmac_dwmac_match[] = {
        { .compatible = "rockchip,rk3288-gmac", .data = &rk3288_ops },
        { .compatible = "rockchip,rk3366-gmac", .data = &rk3366_ops },
        { .compatible = "rockchip,rk3368-gmac", .data = &rk3368_ops },
+       { .compatible = "rockchip,rk3399-gmac", .data = &rk3399_ops },
        { }
 };
 MODULE_DEVICE_TABLE(of, rk_gmac_dwmac_match);