xref: /linux/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c (revision 27ffefd2d10902352c01394169e577f3b91113f2)
17ad269eaSRoger Chen /**
27ad269eaSRoger Chen  * dwmac-rk.c - Rockchip RK3288 DWMAC specific glue layer
37ad269eaSRoger Chen  *
47ad269eaSRoger Chen  * Copyright (C) 2014 Chen-Zhi (Roger Chen)
57ad269eaSRoger Chen  *
67ad269eaSRoger Chen  * Chen-Zhi (Roger Chen)  <roger.chen@rock-chips.com>
77ad269eaSRoger Chen  *
87ad269eaSRoger Chen  * This program is free software; you can redistribute it and/or modify
97ad269eaSRoger Chen  * it under the terms of the GNU General Public License as published by
107ad269eaSRoger Chen  * the Free Software Foundation; either version 2 of the License, or
117ad269eaSRoger Chen  * (at your option) any later version.
127ad269eaSRoger Chen  *
137ad269eaSRoger Chen  * This program is distributed in the hope that it will be useful,
147ad269eaSRoger Chen  * but WITHOUT ANY WARRANTY; without even the implied warranty of
157ad269eaSRoger Chen  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
167ad269eaSRoger Chen  * GNU General Public License for more details.
177ad269eaSRoger Chen  */
187ad269eaSRoger Chen 
197ad269eaSRoger Chen #include <linux/stmmac.h>
207ad269eaSRoger Chen #include <linux/bitops.h>
217ad269eaSRoger Chen #include <linux/clk.h>
227ad269eaSRoger Chen #include <linux/phy.h>
237ad269eaSRoger Chen #include <linux/of_net.h>
247ad269eaSRoger Chen #include <linux/gpio.h>
25e0fb4013SJoachim Eastwood #include <linux/module.h>
267ad269eaSRoger Chen #include <linux/of_gpio.h>
277ad269eaSRoger Chen #include <linux/of_device.h>
28e0fb4013SJoachim Eastwood #include <linux/platform_device.h>
297ad269eaSRoger Chen #include <linux/regulator/consumer.h>
307ad269eaSRoger Chen #include <linux/delay.h>
317ad269eaSRoger Chen #include <linux/mfd/syscon.h>
327ad269eaSRoger Chen #include <linux/regmap.h>
337ad269eaSRoger Chen 
34e0fb4013SJoachim Eastwood #include "stmmac_platform.h"
35e0fb4013SJoachim Eastwood 
360fb98db1SHeiko Stübner struct rk_priv_data;
370fb98db1SHeiko Stübner struct rk_gmac_ops {
380fb98db1SHeiko Stübner 	void (*set_to_rgmii)(struct rk_priv_data *bsp_priv,
390fb98db1SHeiko Stübner 			     int tx_delay, int rx_delay);
400fb98db1SHeiko Stübner 	void (*set_to_rmii)(struct rk_priv_data *bsp_priv);
410fb98db1SHeiko Stübner 	void (*set_rgmii_speed)(struct rk_priv_data *bsp_priv, int speed);
420fb98db1SHeiko Stübner 	void (*set_rmii_speed)(struct rk_priv_data *bsp_priv, int speed);
430fb98db1SHeiko Stübner };
440fb98db1SHeiko Stübner 
457ad269eaSRoger Chen struct rk_priv_data {
467ad269eaSRoger Chen 	struct platform_device *pdev;
477ad269eaSRoger Chen 	int phy_iface;
482e12f536SRomain Perier 	struct regulator *regulator;
490fb98db1SHeiko Stübner 	struct rk_gmac_ops *ops;
507ad269eaSRoger Chen 
517ad269eaSRoger Chen 	bool clk_enabled;
527ad269eaSRoger Chen 	bool clock_input;
537ad269eaSRoger Chen 
547ad269eaSRoger Chen 	struct clk *clk_mac;
557ad269eaSRoger Chen 	struct clk *gmac_clkin;
567ad269eaSRoger Chen 	struct clk *mac_clk_rx;
577ad269eaSRoger Chen 	struct clk *mac_clk_tx;
587ad269eaSRoger Chen 	struct clk *clk_mac_ref;
597ad269eaSRoger Chen 	struct clk *clk_mac_refout;
607ad269eaSRoger Chen 	struct clk *aclk_mac;
617ad269eaSRoger Chen 	struct clk *pclk_mac;
627ad269eaSRoger Chen 
637ad269eaSRoger Chen 	int tx_delay;
647ad269eaSRoger Chen 	int rx_delay;
657ad269eaSRoger Chen 
667ad269eaSRoger Chen 	struct regmap *grf;
677ad269eaSRoger Chen };
687ad269eaSRoger Chen 
697ad269eaSRoger Chen #define HIWORD_UPDATE(val, mask, shift) \
707ad269eaSRoger Chen 		((val) << (shift) | (mask) << ((shift) + 16))
717ad269eaSRoger Chen 
727ad269eaSRoger Chen #define GRF_BIT(nr)	(BIT(nr) | BIT(nr+16))
737ad269eaSRoger Chen #define GRF_CLR_BIT(nr)	(BIT(nr+16))
747ad269eaSRoger Chen 
757ad269eaSRoger Chen #define RK3288_GRF_SOC_CON1	0x0248
767ad269eaSRoger Chen #define RK3288_GRF_SOC_CON3	0x0250
777ad269eaSRoger Chen 
787ad269eaSRoger Chen /*RK3288_GRF_SOC_CON1*/
790fb98db1SHeiko Stübner #define RK3288_GMAC_PHY_INTF_SEL_RGMII	(GRF_BIT(6) | GRF_CLR_BIT(7) | \
800fb98db1SHeiko Stübner 					 GRF_CLR_BIT(8))
810fb98db1SHeiko Stübner #define RK3288_GMAC_PHY_INTF_SEL_RMII	(GRF_CLR_BIT(6) | GRF_CLR_BIT(7) | \
820fb98db1SHeiko Stübner 					 GRF_BIT(8))
830fb98db1SHeiko Stübner #define RK3288_GMAC_FLOW_CTRL		GRF_BIT(9)
840fb98db1SHeiko Stübner #define RK3288_GMAC_FLOW_CTRL_CLR	GRF_CLR_BIT(9)
850fb98db1SHeiko Stübner #define RK3288_GMAC_SPEED_10M		GRF_CLR_BIT(10)
860fb98db1SHeiko Stübner #define RK3288_GMAC_SPEED_100M		GRF_BIT(10)
870fb98db1SHeiko Stübner #define RK3288_GMAC_RMII_CLK_25M	GRF_BIT(11)
880fb98db1SHeiko Stübner #define RK3288_GMAC_RMII_CLK_2_5M	GRF_CLR_BIT(11)
890fb98db1SHeiko Stübner #define RK3288_GMAC_CLK_125M		(GRF_CLR_BIT(12) | GRF_CLR_BIT(13))
900fb98db1SHeiko Stübner #define RK3288_GMAC_CLK_25M		(GRF_BIT(12) | GRF_BIT(13))
910fb98db1SHeiko Stübner #define RK3288_GMAC_CLK_2_5M		(GRF_CLR_BIT(12) | GRF_BIT(13))
920fb98db1SHeiko Stübner #define RK3288_GMAC_RMII_MODE		GRF_BIT(14)
930fb98db1SHeiko Stübner #define RK3288_GMAC_RMII_MODE_CLR	GRF_CLR_BIT(14)
947ad269eaSRoger Chen 
957ad269eaSRoger Chen /*RK3288_GRF_SOC_CON3*/
960fb98db1SHeiko Stübner #define RK3288_GMAC_TXCLK_DLY_ENABLE	GRF_BIT(14)
970fb98db1SHeiko Stübner #define RK3288_GMAC_TXCLK_DLY_DISABLE	GRF_CLR_BIT(14)
980fb98db1SHeiko Stübner #define RK3288_GMAC_RXCLK_DLY_ENABLE	GRF_BIT(15)
990fb98db1SHeiko Stübner #define RK3288_GMAC_RXCLK_DLY_DISABLE	GRF_CLR_BIT(15)
1000fb98db1SHeiko Stübner #define RK3288_GMAC_CLK_RX_DL_CFG(val)	HIWORD_UPDATE(val, 0x7F, 7)
1010fb98db1SHeiko Stübner #define RK3288_GMAC_CLK_TX_DL_CFG(val)	HIWORD_UPDATE(val, 0x7F, 0)
1027ad269eaSRoger Chen 
1030fb98db1SHeiko Stübner static void rk3288_set_to_rgmii(struct rk_priv_data *bsp_priv,
1047ad269eaSRoger Chen 				int tx_delay, int rx_delay)
1057ad269eaSRoger Chen {
1067ad269eaSRoger Chen 	struct device *dev = &bsp_priv->pdev->dev;
1077ad269eaSRoger Chen 
1087ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->grf)) {
109d42202dcSRomain Perier 		dev_err(dev, "Missing rockchip,grf property\n");
1107ad269eaSRoger Chen 		return;
1117ad269eaSRoger Chen 	}
1127ad269eaSRoger Chen 
1137ad269eaSRoger Chen 	regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
1140fb98db1SHeiko Stübner 		     RK3288_GMAC_PHY_INTF_SEL_RGMII |
1150fb98db1SHeiko Stübner 		     RK3288_GMAC_RMII_MODE_CLR);
1167ad269eaSRoger Chen 	regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON3,
1170fb98db1SHeiko Stübner 		     RK3288_GMAC_RXCLK_DLY_ENABLE |
1180fb98db1SHeiko Stübner 		     RK3288_GMAC_TXCLK_DLY_ENABLE |
1190fb98db1SHeiko Stübner 		     RK3288_GMAC_CLK_RX_DL_CFG(rx_delay) |
1200fb98db1SHeiko Stübner 		     RK3288_GMAC_CLK_TX_DL_CFG(tx_delay));
1217ad269eaSRoger Chen }
1227ad269eaSRoger Chen 
1230fb98db1SHeiko Stübner static void rk3288_set_to_rmii(struct rk_priv_data *bsp_priv)
1247ad269eaSRoger Chen {
1257ad269eaSRoger Chen 	struct device *dev = &bsp_priv->pdev->dev;
1267ad269eaSRoger Chen 
1277ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->grf)) {
128d42202dcSRomain Perier 		dev_err(dev, "Missing rockchip,grf property\n");
1297ad269eaSRoger Chen 		return;
1307ad269eaSRoger Chen 	}
1317ad269eaSRoger Chen 
1327ad269eaSRoger Chen 	regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
1330fb98db1SHeiko Stübner 		     RK3288_GMAC_PHY_INTF_SEL_RMII | RK3288_GMAC_RMII_MODE);
1347ad269eaSRoger Chen }
1357ad269eaSRoger Chen 
1360fb98db1SHeiko Stübner static void rk3288_set_rgmii_speed(struct rk_priv_data *bsp_priv, int speed)
1377ad269eaSRoger Chen {
1387ad269eaSRoger Chen 	struct device *dev = &bsp_priv->pdev->dev;
1397ad269eaSRoger Chen 
1407ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->grf)) {
141d42202dcSRomain Perier 		dev_err(dev, "Missing rockchip,grf property\n");
1427ad269eaSRoger Chen 		return;
1437ad269eaSRoger Chen 	}
1447ad269eaSRoger Chen 
1457ad269eaSRoger Chen 	if (speed == 10)
1460fb98db1SHeiko Stübner 		regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
1470fb98db1SHeiko Stübner 			     RK3288_GMAC_CLK_2_5M);
1487ad269eaSRoger Chen 	else if (speed == 100)
1490fb98db1SHeiko Stübner 		regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
1500fb98db1SHeiko Stübner 			     RK3288_GMAC_CLK_25M);
1517ad269eaSRoger Chen 	else if (speed == 1000)
1520fb98db1SHeiko Stübner 		regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
1530fb98db1SHeiko Stübner 			     RK3288_GMAC_CLK_125M);
1547ad269eaSRoger Chen 	else
1557ad269eaSRoger Chen 		dev_err(dev, "unknown speed value for RGMII! speed=%d", speed);
1567ad269eaSRoger Chen }
1577ad269eaSRoger Chen 
1580fb98db1SHeiko Stübner static void rk3288_set_rmii_speed(struct rk_priv_data *bsp_priv, int speed)
1597ad269eaSRoger Chen {
1607ad269eaSRoger Chen 	struct device *dev = &bsp_priv->pdev->dev;
1617ad269eaSRoger Chen 
1627ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->grf)) {
163d42202dcSRomain Perier 		dev_err(dev, "Missing rockchip,grf property\n");
1647ad269eaSRoger Chen 		return;
1657ad269eaSRoger Chen 	}
1667ad269eaSRoger Chen 
1677ad269eaSRoger Chen 	if (speed == 10) {
1687ad269eaSRoger Chen 		regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
1690fb98db1SHeiko Stübner 			     RK3288_GMAC_RMII_CLK_2_5M |
1700fb98db1SHeiko Stübner 			     RK3288_GMAC_SPEED_10M);
1717ad269eaSRoger Chen 	} else if (speed == 100) {
1727ad269eaSRoger Chen 		regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
1730fb98db1SHeiko Stübner 			     RK3288_GMAC_RMII_CLK_25M |
1740fb98db1SHeiko Stübner 			     RK3288_GMAC_SPEED_100M);
1757ad269eaSRoger Chen 	} else {
1767ad269eaSRoger Chen 		dev_err(dev, "unknown speed value for RMII! speed=%d", speed);
1777ad269eaSRoger Chen 	}
1787ad269eaSRoger Chen }
1797ad269eaSRoger Chen 
1800fb98db1SHeiko Stübner struct rk_gmac_ops rk3288_ops = {
1810fb98db1SHeiko Stübner 	.set_to_rgmii = rk3288_set_to_rgmii,
1820fb98db1SHeiko Stübner 	.set_to_rmii = rk3288_set_to_rmii,
1830fb98db1SHeiko Stübner 	.set_rgmii_speed = rk3288_set_rgmii_speed,
1840fb98db1SHeiko Stübner 	.set_rmii_speed = rk3288_set_rmii_speed,
1850fb98db1SHeiko Stübner };
1860fb98db1SHeiko Stübner 
187df558854SHeiko Stübner #define RK3368_GRF_SOC_CON15	0x043c
188df558854SHeiko Stübner #define RK3368_GRF_SOC_CON16	0x0440
189df558854SHeiko Stübner 
190df558854SHeiko Stübner /* RK3368_GRF_SOC_CON15 */
191df558854SHeiko Stübner #define RK3368_GMAC_PHY_INTF_SEL_RGMII	(GRF_BIT(9) | GRF_CLR_BIT(10) | \
192df558854SHeiko Stübner 					 GRF_CLR_BIT(11))
193df558854SHeiko Stübner #define RK3368_GMAC_PHY_INTF_SEL_RMII	(GRF_CLR_BIT(9) | GRF_CLR_BIT(10) | \
194df558854SHeiko Stübner 					 GRF_BIT(11))
195df558854SHeiko Stübner #define RK3368_GMAC_FLOW_CTRL		GRF_BIT(8)
196df558854SHeiko Stübner #define RK3368_GMAC_FLOW_CTRL_CLR	GRF_CLR_BIT(8)
197df558854SHeiko Stübner #define RK3368_GMAC_SPEED_10M		GRF_CLR_BIT(7)
198df558854SHeiko Stübner #define RK3368_GMAC_SPEED_100M		GRF_BIT(7)
199df558854SHeiko Stübner #define RK3368_GMAC_RMII_CLK_25M	GRF_BIT(3)
200df558854SHeiko Stübner #define RK3368_GMAC_RMII_CLK_2_5M	GRF_CLR_BIT(3)
201df558854SHeiko Stübner #define RK3368_GMAC_CLK_125M		(GRF_CLR_BIT(4) | GRF_CLR_BIT(5))
202df558854SHeiko Stübner #define RK3368_GMAC_CLK_25M		(GRF_BIT(4) | GRF_BIT(5))
203df558854SHeiko Stübner #define RK3368_GMAC_CLK_2_5M		(GRF_CLR_BIT(4) | GRF_BIT(5))
204df558854SHeiko Stübner #define RK3368_GMAC_RMII_MODE		GRF_BIT(6)
205df558854SHeiko Stübner #define RK3368_GMAC_RMII_MODE_CLR	GRF_CLR_BIT(6)
206df558854SHeiko Stübner 
207df558854SHeiko Stübner /* RK3368_GRF_SOC_CON16 */
208df558854SHeiko Stübner #define RK3368_GMAC_TXCLK_DLY_ENABLE	GRF_BIT(7)
209df558854SHeiko Stübner #define RK3368_GMAC_TXCLK_DLY_DISABLE	GRF_CLR_BIT(7)
210df558854SHeiko Stübner #define RK3368_GMAC_RXCLK_DLY_ENABLE	GRF_BIT(15)
211df558854SHeiko Stübner #define RK3368_GMAC_RXCLK_DLY_DISABLE	GRF_CLR_BIT(15)
212df558854SHeiko Stübner #define RK3368_GMAC_CLK_RX_DL_CFG(val)	HIWORD_UPDATE(val, 0x7F, 8)
213df558854SHeiko Stübner #define RK3368_GMAC_CLK_TX_DL_CFG(val)	HIWORD_UPDATE(val, 0x7F, 0)
214df558854SHeiko Stübner 
215df558854SHeiko Stübner static void rk3368_set_to_rgmii(struct rk_priv_data *bsp_priv,
216df558854SHeiko Stübner 				int tx_delay, int rx_delay)
217df558854SHeiko Stübner {
218df558854SHeiko Stübner 	struct device *dev = &bsp_priv->pdev->dev;
219df558854SHeiko Stübner 
220df558854SHeiko Stübner 	if (IS_ERR(bsp_priv->grf)) {
221df558854SHeiko Stübner 		dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
222df558854SHeiko Stübner 		return;
223df558854SHeiko Stübner 	}
224df558854SHeiko Stübner 
225df558854SHeiko Stübner 	regmap_write(bsp_priv->grf, RK3368_GRF_SOC_CON15,
226df558854SHeiko Stübner 		     RK3368_GMAC_PHY_INTF_SEL_RGMII |
227df558854SHeiko Stübner 		     RK3368_GMAC_RMII_MODE_CLR);
228df558854SHeiko Stübner 	regmap_write(bsp_priv->grf, RK3368_GRF_SOC_CON16,
229df558854SHeiko Stübner 		     RK3368_GMAC_RXCLK_DLY_ENABLE |
230df558854SHeiko Stübner 		     RK3368_GMAC_TXCLK_DLY_ENABLE |
231df558854SHeiko Stübner 		     RK3368_GMAC_CLK_RX_DL_CFG(rx_delay) |
232df558854SHeiko Stübner 		     RK3368_GMAC_CLK_TX_DL_CFG(tx_delay));
233df558854SHeiko Stübner }
234df558854SHeiko Stübner 
235df558854SHeiko Stübner static void rk3368_set_to_rmii(struct rk_priv_data *bsp_priv)
236df558854SHeiko Stübner {
237df558854SHeiko Stübner 	struct device *dev = &bsp_priv->pdev->dev;
238df558854SHeiko Stübner 
239df558854SHeiko Stübner 	if (IS_ERR(bsp_priv->grf)) {
240df558854SHeiko Stübner 		dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
241df558854SHeiko Stübner 		return;
242df558854SHeiko Stübner 	}
243df558854SHeiko Stübner 
244df558854SHeiko Stübner 	regmap_write(bsp_priv->grf, RK3368_GRF_SOC_CON15,
245df558854SHeiko Stübner 		     RK3368_GMAC_PHY_INTF_SEL_RMII | RK3368_GMAC_RMII_MODE);
246df558854SHeiko Stübner }
247df558854SHeiko Stübner 
248df558854SHeiko Stübner static void rk3368_set_rgmii_speed(struct rk_priv_data *bsp_priv, int speed)
249df558854SHeiko Stübner {
250df558854SHeiko Stübner 	struct device *dev = &bsp_priv->pdev->dev;
251df558854SHeiko Stübner 
252df558854SHeiko Stübner 	if (IS_ERR(bsp_priv->grf)) {
253df558854SHeiko Stübner 		dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
254df558854SHeiko Stübner 		return;
255df558854SHeiko Stübner 	}
256df558854SHeiko Stübner 
257df558854SHeiko Stübner 	if (speed == 10)
258df558854SHeiko Stübner 		regmap_write(bsp_priv->grf, RK3368_GRF_SOC_CON15,
259df558854SHeiko Stübner 			     RK3368_GMAC_CLK_2_5M);
260df558854SHeiko Stübner 	else if (speed == 100)
261df558854SHeiko Stübner 		regmap_write(bsp_priv->grf, RK3368_GRF_SOC_CON15,
262df558854SHeiko Stübner 			     RK3368_GMAC_CLK_25M);
263df558854SHeiko Stübner 	else if (speed == 1000)
264df558854SHeiko Stübner 		regmap_write(bsp_priv->grf, RK3368_GRF_SOC_CON15,
265df558854SHeiko Stübner 			     RK3368_GMAC_CLK_125M);
266df558854SHeiko Stübner 	else
267df558854SHeiko Stübner 		dev_err(dev, "unknown speed value for RGMII! speed=%d", speed);
268df558854SHeiko Stübner }
269df558854SHeiko Stübner 
270df558854SHeiko Stübner static void rk3368_set_rmii_speed(struct rk_priv_data *bsp_priv, int speed)
271df558854SHeiko Stübner {
272df558854SHeiko Stübner 	struct device *dev = &bsp_priv->pdev->dev;
273df558854SHeiko Stübner 
274df558854SHeiko Stübner 	if (IS_ERR(bsp_priv->grf)) {
275df558854SHeiko Stübner 		dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
276df558854SHeiko Stübner 		return;
277df558854SHeiko Stübner 	}
278df558854SHeiko Stübner 
279df558854SHeiko Stübner 	if (speed == 10) {
280df558854SHeiko Stübner 		regmap_write(bsp_priv->grf, RK3368_GRF_SOC_CON15,
281df558854SHeiko Stübner 			     RK3368_GMAC_RMII_CLK_2_5M |
282df558854SHeiko Stübner 			     RK3368_GMAC_SPEED_10M);
283df558854SHeiko Stübner 	} else if (speed == 100) {
284df558854SHeiko Stübner 		regmap_write(bsp_priv->grf, RK3368_GRF_SOC_CON15,
285df558854SHeiko Stübner 			     RK3368_GMAC_RMII_CLK_25M |
286df558854SHeiko Stübner 			     RK3368_GMAC_SPEED_100M);
287df558854SHeiko Stübner 	} else {
288df558854SHeiko Stübner 		dev_err(dev, "unknown speed value for RMII! speed=%d", speed);
289df558854SHeiko Stübner 	}
290df558854SHeiko Stübner }
291df558854SHeiko Stübner 
292df558854SHeiko Stübner struct rk_gmac_ops rk3368_ops = {
293df558854SHeiko Stübner 	.set_to_rgmii = rk3368_set_to_rgmii,
294df558854SHeiko Stübner 	.set_to_rmii = rk3368_set_to_rmii,
295df558854SHeiko Stübner 	.set_rgmii_speed = rk3368_set_rgmii_speed,
296df558854SHeiko Stübner 	.set_rmii_speed = rk3368_set_rmii_speed,
297df558854SHeiko Stübner };
298df558854SHeiko Stübner 
2997ad269eaSRoger Chen static int gmac_clk_init(struct rk_priv_data *bsp_priv)
3007ad269eaSRoger Chen {
3017ad269eaSRoger Chen 	struct device *dev = &bsp_priv->pdev->dev;
3027ad269eaSRoger Chen 
3037ad269eaSRoger Chen 	bsp_priv->clk_enabled = false;
3047ad269eaSRoger Chen 
3057ad269eaSRoger Chen 	bsp_priv->mac_clk_rx = devm_clk_get(dev, "mac_clk_rx");
3067ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->mac_clk_rx))
307d42202dcSRomain Perier 		dev_err(dev, "cannot get clock %s\n",
308d42202dcSRomain Perier 			"mac_clk_rx");
3097ad269eaSRoger Chen 
3107ad269eaSRoger Chen 	bsp_priv->mac_clk_tx = devm_clk_get(dev, "mac_clk_tx");
3117ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->mac_clk_tx))
312d42202dcSRomain Perier 		dev_err(dev, "cannot get clock %s\n",
313d42202dcSRomain Perier 			"mac_clk_tx");
3147ad269eaSRoger Chen 
3157ad269eaSRoger Chen 	bsp_priv->aclk_mac = devm_clk_get(dev, "aclk_mac");
3167ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->aclk_mac))
317d42202dcSRomain Perier 		dev_err(dev, "cannot get clock %s\n",
318d42202dcSRomain Perier 			"aclk_mac");
3197ad269eaSRoger Chen 
3207ad269eaSRoger Chen 	bsp_priv->pclk_mac = devm_clk_get(dev, "pclk_mac");
3217ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->pclk_mac))
322d42202dcSRomain Perier 		dev_err(dev, "cannot get clock %s\n",
323d42202dcSRomain Perier 			"pclk_mac");
3247ad269eaSRoger Chen 
3257ad269eaSRoger Chen 	bsp_priv->clk_mac = devm_clk_get(dev, "stmmaceth");
3267ad269eaSRoger Chen 	if (IS_ERR(bsp_priv->clk_mac))
327d42202dcSRomain Perier 		dev_err(dev, "cannot get clock %s\n",
328d42202dcSRomain Perier 			"stmmaceth");
3297ad269eaSRoger Chen 
3307ad269eaSRoger Chen 	if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RMII) {
3317ad269eaSRoger Chen 		bsp_priv->clk_mac_ref = devm_clk_get(dev, "clk_mac_ref");
3327ad269eaSRoger Chen 		if (IS_ERR(bsp_priv->clk_mac_ref))
333d42202dcSRomain Perier 			dev_err(dev, "cannot get clock %s\n",
334d42202dcSRomain Perier 				"clk_mac_ref");
3357ad269eaSRoger Chen 
3367ad269eaSRoger Chen 		if (!bsp_priv->clock_input) {
3377ad269eaSRoger Chen 			bsp_priv->clk_mac_refout =
3387ad269eaSRoger Chen 				devm_clk_get(dev, "clk_mac_refout");
3397ad269eaSRoger Chen 			if (IS_ERR(bsp_priv->clk_mac_refout))
340d42202dcSRomain Perier 				dev_err(dev, "cannot get clock %s\n",
341d42202dcSRomain Perier 					"clk_mac_refout");
3427ad269eaSRoger Chen 		}
3437ad269eaSRoger Chen 	}
3447ad269eaSRoger Chen 
3457ad269eaSRoger Chen 	if (bsp_priv->clock_input) {
346d42202dcSRomain Perier 		dev_info(dev, "clock input from PHY\n");
3477ad269eaSRoger Chen 	} else {
3487ad269eaSRoger Chen 		if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RMII)
349c48fa33cSHeiko Stübner 			clk_set_rate(bsp_priv->clk_mac, 50000000);
3507ad269eaSRoger Chen 	}
3517ad269eaSRoger Chen 
3527ad269eaSRoger Chen 	return 0;
3537ad269eaSRoger Chen }
3547ad269eaSRoger Chen 
3557ad269eaSRoger Chen static int gmac_clk_enable(struct rk_priv_data *bsp_priv, bool enable)
3567ad269eaSRoger Chen {
3577ad269eaSRoger Chen 	int phy_iface = phy_iface = bsp_priv->phy_iface;
3587ad269eaSRoger Chen 
3597ad269eaSRoger Chen 	if (enable) {
3607ad269eaSRoger Chen 		if (!bsp_priv->clk_enabled) {
3617ad269eaSRoger Chen 			if (phy_iface == PHY_INTERFACE_MODE_RMII) {
3627ad269eaSRoger Chen 				if (!IS_ERR(bsp_priv->mac_clk_rx))
3637ad269eaSRoger Chen 					clk_prepare_enable(
3647ad269eaSRoger Chen 						bsp_priv->mac_clk_rx);
3657ad269eaSRoger Chen 
3667ad269eaSRoger Chen 				if (!IS_ERR(bsp_priv->clk_mac_ref))
3677ad269eaSRoger Chen 					clk_prepare_enable(
3687ad269eaSRoger Chen 						bsp_priv->clk_mac_ref);
3697ad269eaSRoger Chen 
3707ad269eaSRoger Chen 				if (!IS_ERR(bsp_priv->clk_mac_refout))
3717ad269eaSRoger Chen 					clk_prepare_enable(
3727ad269eaSRoger Chen 						bsp_priv->clk_mac_refout);
3737ad269eaSRoger Chen 			}
3747ad269eaSRoger Chen 
3757ad269eaSRoger Chen 			if (!IS_ERR(bsp_priv->aclk_mac))
3767ad269eaSRoger Chen 				clk_prepare_enable(bsp_priv->aclk_mac);
3777ad269eaSRoger Chen 
3787ad269eaSRoger Chen 			if (!IS_ERR(bsp_priv->pclk_mac))
3797ad269eaSRoger Chen 				clk_prepare_enable(bsp_priv->pclk_mac);
3807ad269eaSRoger Chen 
3817ad269eaSRoger Chen 			if (!IS_ERR(bsp_priv->mac_clk_tx))
3827ad269eaSRoger Chen 				clk_prepare_enable(bsp_priv->mac_clk_tx);
3837ad269eaSRoger Chen 
3847ad269eaSRoger Chen 			/**
3857ad269eaSRoger Chen 			 * if (!IS_ERR(bsp_priv->clk_mac))
3867ad269eaSRoger Chen 			 *	clk_prepare_enable(bsp_priv->clk_mac);
3877ad269eaSRoger Chen 			 */
3887ad269eaSRoger Chen 			mdelay(5);
3897ad269eaSRoger Chen 			bsp_priv->clk_enabled = true;
3907ad269eaSRoger Chen 		}
3917ad269eaSRoger Chen 	} else {
3927ad269eaSRoger Chen 		if (bsp_priv->clk_enabled) {
3937ad269eaSRoger Chen 			if (phy_iface == PHY_INTERFACE_MODE_RMII) {
3947ad269eaSRoger Chen 				if (!IS_ERR(bsp_priv->mac_clk_rx))
3957ad269eaSRoger Chen 					clk_disable_unprepare(
3967ad269eaSRoger Chen 						bsp_priv->mac_clk_rx);
3977ad269eaSRoger Chen 
3987ad269eaSRoger Chen 				if (!IS_ERR(bsp_priv->clk_mac_ref))
3997ad269eaSRoger Chen 					clk_disable_unprepare(
4007ad269eaSRoger Chen 						bsp_priv->clk_mac_ref);
4017ad269eaSRoger Chen 
4027ad269eaSRoger Chen 				if (!IS_ERR(bsp_priv->clk_mac_refout))
4037ad269eaSRoger Chen 					clk_disable_unprepare(
4047ad269eaSRoger Chen 						bsp_priv->clk_mac_refout);
4057ad269eaSRoger Chen 			}
4067ad269eaSRoger Chen 
4077ad269eaSRoger Chen 			if (!IS_ERR(bsp_priv->aclk_mac))
4087ad269eaSRoger Chen 				clk_disable_unprepare(bsp_priv->aclk_mac);
4097ad269eaSRoger Chen 
4107ad269eaSRoger Chen 			if (!IS_ERR(bsp_priv->pclk_mac))
4117ad269eaSRoger Chen 				clk_disable_unprepare(bsp_priv->pclk_mac);
4127ad269eaSRoger Chen 
4137ad269eaSRoger Chen 			if (!IS_ERR(bsp_priv->mac_clk_tx))
4147ad269eaSRoger Chen 				clk_disable_unprepare(bsp_priv->mac_clk_tx);
4157ad269eaSRoger Chen 			/**
4167ad269eaSRoger Chen 			 * if (!IS_ERR(bsp_priv->clk_mac))
4177ad269eaSRoger Chen 			 *	clk_disable_unprepare(bsp_priv->clk_mac);
4187ad269eaSRoger Chen 			 */
4197ad269eaSRoger Chen 			bsp_priv->clk_enabled = false;
4207ad269eaSRoger Chen 		}
4217ad269eaSRoger Chen 	}
4227ad269eaSRoger Chen 
4237ad269eaSRoger Chen 	return 0;
4247ad269eaSRoger Chen }
4257ad269eaSRoger Chen 
4267ad269eaSRoger Chen static int phy_power_on(struct rk_priv_data *bsp_priv, bool enable)
4277ad269eaSRoger Chen {
4282e12f536SRomain Perier 	struct regulator *ldo = bsp_priv->regulator;
4297ad269eaSRoger Chen 	int ret;
4307ad269eaSRoger Chen 	struct device *dev = &bsp_priv->pdev->dev;
4317ad269eaSRoger Chen 
4322e12f536SRomain Perier 	if (!ldo) {
433d42202dcSRomain Perier 		dev_err(dev, "no regulator found\n");
4347ad269eaSRoger Chen 		return -1;
4357ad269eaSRoger Chen 	}
4367ad269eaSRoger Chen 
4377ad269eaSRoger Chen 	if (enable) {
4387ad269eaSRoger Chen 		ret = regulator_enable(ldo);
4392e12f536SRomain Perier 		if (ret)
440d42202dcSRomain Perier 			dev_err(dev, "fail to enable phy-supply\n");
4417ad269eaSRoger Chen 	} else {
4427ad269eaSRoger Chen 		ret = regulator_disable(ldo);
4432e12f536SRomain Perier 		if (ret)
444d42202dcSRomain Perier 			dev_err(dev, "fail to disable phy-supply\n");
4457ad269eaSRoger Chen 	}
4467ad269eaSRoger Chen 
4477ad269eaSRoger Chen 	return 0;
4487ad269eaSRoger Chen }
4497ad269eaSRoger Chen 
4500fb98db1SHeiko Stübner static struct rk_priv_data *rk_gmac_setup(struct platform_device *pdev,
4510fb98db1SHeiko Stübner 					  struct rk_gmac_ops *ops)
4527ad269eaSRoger Chen {
4537ad269eaSRoger Chen 	struct rk_priv_data *bsp_priv;
4547ad269eaSRoger Chen 	struct device *dev = &pdev->dev;
4557ad269eaSRoger Chen 	int ret;
4567ad269eaSRoger Chen 	const char *strings = NULL;
4577ad269eaSRoger Chen 	int value;
4587ad269eaSRoger Chen 
4597ad269eaSRoger Chen 	bsp_priv = devm_kzalloc(dev, sizeof(*bsp_priv), GFP_KERNEL);
4607ad269eaSRoger Chen 	if (!bsp_priv)
4617ad269eaSRoger Chen 		return ERR_PTR(-ENOMEM);
4627ad269eaSRoger Chen 
4637ad269eaSRoger Chen 	bsp_priv->phy_iface = of_get_phy_mode(dev->of_node);
4640fb98db1SHeiko Stübner 	bsp_priv->ops = ops;
4657ad269eaSRoger Chen 
4662e12f536SRomain Perier 	bsp_priv->regulator = devm_regulator_get_optional(dev, "phy");
4672e12f536SRomain Perier 	if (IS_ERR(bsp_priv->regulator)) {
4682e12f536SRomain Perier 		if (PTR_ERR(bsp_priv->regulator) == -EPROBE_DEFER) {
4692e12f536SRomain Perier 			dev_err(dev, "phy regulator is not available yet, deferred probing\n");
4702e12f536SRomain Perier 			return ERR_PTR(-EPROBE_DEFER);
4712e12f536SRomain Perier 		}
4722e12f536SRomain Perier 		dev_err(dev, "no regulator found\n");
4732e12f536SRomain Perier 		bsp_priv->regulator = NULL;
4747ad269eaSRoger Chen 	}
4757ad269eaSRoger Chen 
4767ad269eaSRoger Chen 	ret = of_property_read_string(dev->of_node, "clock_in_out", &strings);
4777ad269eaSRoger Chen 	if (ret) {
478d42202dcSRomain Perier 		dev_err(dev, "Can not read property: clock_in_out.\n");
4797ad269eaSRoger Chen 		bsp_priv->clock_input = true;
4807ad269eaSRoger Chen 	} else {
481d42202dcSRomain Perier 		dev_info(dev, "clock input or output? (%s).\n",
482d42202dcSRomain Perier 			 strings);
4837ad269eaSRoger Chen 		if (!strcmp(strings, "input"))
4847ad269eaSRoger Chen 			bsp_priv->clock_input = true;
4857ad269eaSRoger Chen 		else
4867ad269eaSRoger Chen 			bsp_priv->clock_input = false;
4877ad269eaSRoger Chen 	}
4887ad269eaSRoger Chen 
4897ad269eaSRoger Chen 	ret = of_property_read_u32(dev->of_node, "tx_delay", &value);
4907ad269eaSRoger Chen 	if (ret) {
4917ad269eaSRoger Chen 		bsp_priv->tx_delay = 0x30;
492d42202dcSRomain Perier 		dev_err(dev, "Can not read property: tx_delay.");
493d42202dcSRomain Perier 		dev_err(dev, "set tx_delay to 0x%x\n",
494d42202dcSRomain Perier 			bsp_priv->tx_delay);
4957ad269eaSRoger Chen 	} else {
496d42202dcSRomain Perier 		dev_info(dev, "TX delay(0x%x).\n", value);
4977ad269eaSRoger Chen 		bsp_priv->tx_delay = value;
4987ad269eaSRoger Chen 	}
4997ad269eaSRoger Chen 
5007ad269eaSRoger Chen 	ret = of_property_read_u32(dev->of_node, "rx_delay", &value);
5017ad269eaSRoger Chen 	if (ret) {
5027ad269eaSRoger Chen 		bsp_priv->rx_delay = 0x10;
503d42202dcSRomain Perier 		dev_err(dev, "Can not read property: rx_delay.");
504d42202dcSRomain Perier 		dev_err(dev, "set rx_delay to 0x%x\n",
505d42202dcSRomain Perier 			bsp_priv->rx_delay);
5067ad269eaSRoger Chen 	} else {
507d42202dcSRomain Perier 		dev_info(dev, "RX delay(0x%x).\n", value);
5087ad269eaSRoger Chen 		bsp_priv->rx_delay = value;
5097ad269eaSRoger Chen 	}
5107ad269eaSRoger Chen 
5117ad269eaSRoger Chen 	bsp_priv->grf = syscon_regmap_lookup_by_phandle(dev->of_node,
5127ad269eaSRoger Chen 							"rockchip,grf");
5137ad269eaSRoger Chen 	bsp_priv->pdev = pdev;
5147ad269eaSRoger Chen 
5157ad269eaSRoger Chen 	/*rmii or rgmii*/
5167ad269eaSRoger Chen 	if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RGMII) {
517d42202dcSRomain Perier 		dev_info(dev, "init for RGMII\n");
5180fb98db1SHeiko Stübner 		bsp_priv->ops->set_to_rgmii(bsp_priv, bsp_priv->tx_delay,
5190fb98db1SHeiko Stübner 					    bsp_priv->rx_delay);
5207ad269eaSRoger Chen 	} else if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RMII) {
521d42202dcSRomain Perier 		dev_info(dev, "init for RMII\n");
5220fb98db1SHeiko Stübner 		bsp_priv->ops->set_to_rmii(bsp_priv);
5237ad269eaSRoger Chen 	} else {
524d42202dcSRomain Perier 		dev_err(dev, "NO interface defined!\n");
5257ad269eaSRoger Chen 	}
5267ad269eaSRoger Chen 
5277ad269eaSRoger Chen 	gmac_clk_init(bsp_priv);
5287ad269eaSRoger Chen 
5297ad269eaSRoger Chen 	return bsp_priv;
5307ad269eaSRoger Chen }
5317ad269eaSRoger Chen 
5320fb98db1SHeiko Stübner static void *rk3288_gmac_setup(struct platform_device *pdev)
5330fb98db1SHeiko Stübner {
5340fb98db1SHeiko Stübner 	return rk_gmac_setup(pdev, &rk3288_ops);
5350fb98db1SHeiko Stübner }
5360fb98db1SHeiko Stübner 
537df558854SHeiko Stübner static void *rk3368_gmac_setup(struct platform_device *pdev)
538df558854SHeiko Stübner {
539df558854SHeiko Stübner 	return rk_gmac_setup(pdev, &rk3368_ops);
540df558854SHeiko Stübner }
541df558854SHeiko Stübner 
5427ad269eaSRoger Chen static int rk_gmac_init(struct platform_device *pdev, void *priv)
5437ad269eaSRoger Chen {
5447ad269eaSRoger Chen 	struct rk_priv_data *bsp_priv = priv;
5457ad269eaSRoger Chen 	int ret;
5467ad269eaSRoger Chen 
5477ad269eaSRoger Chen 	ret = phy_power_on(bsp_priv, true);
5487ad269eaSRoger Chen 	if (ret)
5497ad269eaSRoger Chen 		return ret;
5507ad269eaSRoger Chen 
5517ad269eaSRoger Chen 	ret = gmac_clk_enable(bsp_priv, true);
5527ad269eaSRoger Chen 	if (ret)
5537ad269eaSRoger Chen 		return ret;
5547ad269eaSRoger Chen 
5557ad269eaSRoger Chen 	return 0;
5567ad269eaSRoger Chen }
5577ad269eaSRoger Chen 
5587ad269eaSRoger Chen static void rk_gmac_exit(struct platform_device *pdev, void *priv)
5597ad269eaSRoger Chen {
5607ad269eaSRoger Chen 	struct rk_priv_data *gmac = priv;
5617ad269eaSRoger Chen 
5627ad269eaSRoger Chen 	phy_power_on(gmac, false);
5637ad269eaSRoger Chen 	gmac_clk_enable(gmac, false);
5647ad269eaSRoger Chen }
5657ad269eaSRoger Chen 
5667ad269eaSRoger Chen static void rk_fix_speed(void *priv, unsigned int speed)
5677ad269eaSRoger Chen {
5687ad269eaSRoger Chen 	struct rk_priv_data *bsp_priv = priv;
5697ad269eaSRoger Chen 	struct device *dev = &bsp_priv->pdev->dev;
5707ad269eaSRoger Chen 
5717ad269eaSRoger Chen 	if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RGMII)
5720fb98db1SHeiko Stübner 		bsp_priv->ops->set_rgmii_speed(bsp_priv, speed);
5737ad269eaSRoger Chen 	else if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RMII)
5740fb98db1SHeiko Stübner 		bsp_priv->ops->set_rmii_speed(bsp_priv, speed);
5757ad269eaSRoger Chen 	else
5767ad269eaSRoger Chen 		dev_err(dev, "unsupported interface %d", bsp_priv->phy_iface);
5777ad269eaSRoger Chen }
5787ad269eaSRoger Chen 
579*27ffefd2SJoachim Eastwood static int rk_gmac_probe(struct platform_device *pdev)
580*27ffefd2SJoachim Eastwood {
581*27ffefd2SJoachim Eastwood 	struct plat_stmmacenet_data *plat_dat;
582*27ffefd2SJoachim Eastwood 	struct stmmac_resources stmmac_res;
583*27ffefd2SJoachim Eastwood 	int ret;
584*27ffefd2SJoachim Eastwood 
585*27ffefd2SJoachim Eastwood 	ret = stmmac_get_platform_resources(pdev, &stmmac_res);
586*27ffefd2SJoachim Eastwood 	if (ret)
587*27ffefd2SJoachim Eastwood 		return ret;
588*27ffefd2SJoachim Eastwood 
589*27ffefd2SJoachim Eastwood 	plat_dat = stmmac_probe_config_dt(pdev, &stmmac_res.mac);
590*27ffefd2SJoachim Eastwood 	if (IS_ERR(plat_dat))
591*27ffefd2SJoachim Eastwood 		return PTR_ERR(plat_dat);
592*27ffefd2SJoachim Eastwood 
593*27ffefd2SJoachim Eastwood 	plat_dat->has_gmac = true;
594*27ffefd2SJoachim Eastwood 	plat_dat->init = rk_gmac_init;
595*27ffefd2SJoachim Eastwood 	plat_dat->exit = rk_gmac_exit;
596*27ffefd2SJoachim Eastwood 	plat_dat->fix_mac_speed = rk_fix_speed;
597*27ffefd2SJoachim Eastwood 
598*27ffefd2SJoachim Eastwood 	plat_dat->bsp_priv = plat_dat->setup(pdev);
599*27ffefd2SJoachim Eastwood 	if (IS_ERR(plat_dat->bsp_priv))
600*27ffefd2SJoachim Eastwood 		return PTR_ERR(plat_dat->bsp_priv);
601*27ffefd2SJoachim Eastwood 
602*27ffefd2SJoachim Eastwood 	ret = rk_gmac_init(pdev, plat_dat->bsp_priv);
603*27ffefd2SJoachim Eastwood 	if (ret)
604*27ffefd2SJoachim Eastwood 		return ret;
605*27ffefd2SJoachim Eastwood 
606*27ffefd2SJoachim Eastwood 	return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
607*27ffefd2SJoachim Eastwood }
608*27ffefd2SJoachim Eastwood 
609e0fb4013SJoachim Eastwood static const struct stmmac_of_data rk3288_gmac_data = {
6100fb98db1SHeiko Stübner 	.setup = rk3288_gmac_setup,
6117ad269eaSRoger Chen };
612e0fb4013SJoachim Eastwood 
613df558854SHeiko Stübner static const struct stmmac_of_data rk3368_gmac_data = {
614df558854SHeiko Stübner 	.setup = rk3368_gmac_setup,
615df558854SHeiko Stübner };
616df558854SHeiko Stübner 
617e0fb4013SJoachim Eastwood static const struct of_device_id rk_gmac_dwmac_match[] = {
618e0fb4013SJoachim Eastwood 	{ .compatible = "rockchip,rk3288-gmac", .data = &rk3288_gmac_data},
619df558854SHeiko Stübner 	{ .compatible = "rockchip,rk3368-gmac", .data = &rk3368_gmac_data},
620e0fb4013SJoachim Eastwood 	{ }
621e0fb4013SJoachim Eastwood };
622e0fb4013SJoachim Eastwood MODULE_DEVICE_TABLE(of, rk_gmac_dwmac_match);
623e0fb4013SJoachim Eastwood 
624e0fb4013SJoachim Eastwood static struct platform_driver rk_gmac_dwmac_driver = {
625*27ffefd2SJoachim Eastwood 	.probe  = rk_gmac_probe,
626e0fb4013SJoachim Eastwood 	.remove = stmmac_pltfr_remove,
627e0fb4013SJoachim Eastwood 	.driver = {
628e0fb4013SJoachim Eastwood 		.name           = "rk_gmac-dwmac",
629e0fb4013SJoachim Eastwood 		.pm		= &stmmac_pltfr_pm_ops,
630e0fb4013SJoachim Eastwood 		.of_match_table = rk_gmac_dwmac_match,
631e0fb4013SJoachim Eastwood 	},
632e0fb4013SJoachim Eastwood };
633e0fb4013SJoachim Eastwood module_platform_driver(rk_gmac_dwmac_driver);
634e0fb4013SJoachim Eastwood 
635e0fb4013SJoachim Eastwood MODULE_AUTHOR("Chen-Zhi (Roger Chen) <roger.chen@rock-chips.com>");
636e0fb4013SJoachim Eastwood MODULE_DESCRIPTION("Rockchip RK3288 DWMAC specific glue layer");
637e0fb4013SJoachim Eastwood MODULE_LICENSE("GPL");
638