Commit | Line | Data |
---|---|---|
801d233b DN |
1 | /* Copyright Altera Corporation (C) 2014. All rights reserved. |
2 | * | |
3 | * This program is free software; you can redistribute it and/or modify | |
4 | * it under the terms of the GNU General Public License, version 2, | |
5 | * as published by the Free Software Foundation. | |
6 | * | |
7 | * This program is distributed in the hope that it will be useful, | |
8 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
9 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
10 | * GNU General Public License for more details. | |
11 | * | |
12 | * You should have received a copy of the GNU General Public License | |
13 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | |
14 | * | |
15 | * Adopted from dwmac-sti.c | |
16 | */ | |
17 | ||
18 | #include <linux/mfd/syscon.h> | |
19 | #include <linux/of.h> | |
b4834c86 | 20 | #include <linux/of_address.h> |
801d233b DN |
21 | #include <linux/of_net.h> |
22 | #include <linux/phy.h> | |
23 | #include <linux/regmap.h> | |
2d871aa0 | 24 | #include <linux/reset.h> |
801d233b | 25 | #include <linux/stmmac.h> |
f10f9fb2 | 26 | |
2d871aa0 | 27 | #include "stmmac.h" |
f10f9fb2 | 28 | #include "stmmac_platform.h" |
801d233b DN |
29 | |
30 | #define SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_GMII_MII 0x0 | |
31 | #define SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RGMII 0x1 | |
32 | #define SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RMII 0x2 | |
33 | #define SYSMGR_EMACGRP_CTRL_PHYSEL_WIDTH 2 | |
34 | #define SYSMGR_EMACGRP_CTRL_PHYSEL_MASK 0x00000003 | |
35 | ||
b4834c86 LFT |
36 | #define EMAC_SPLITTER_CTRL_REG 0x0 |
37 | #define EMAC_SPLITTER_CTRL_SPEED_MASK 0x3 | |
38 | #define EMAC_SPLITTER_CTRL_SPEED_10 0x2 | |
39 | #define EMAC_SPLITTER_CTRL_SPEED_100 0x3 | |
40 | #define EMAC_SPLITTER_CTRL_SPEED_1000 0x0 | |
41 | ||
801d233b DN |
42 | struct socfpga_dwmac { |
43 | int interface; | |
44 | u32 reg_offset; | |
45 | u32 reg_shift; | |
46 | struct device *dev; | |
47 | struct regmap *sys_mgr_base_addr; | |
2d871aa0 | 48 | struct reset_control *stmmac_rst; |
b4834c86 | 49 | void __iomem *splitter_base; |
801d233b DN |
50 | }; |
51 | ||
b4834c86 LFT |
52 | static void socfpga_dwmac_fix_mac_speed(void *priv, unsigned int speed) |
53 | { | |
54 | struct socfpga_dwmac *dwmac = (struct socfpga_dwmac *)priv; | |
55 | void __iomem *splitter_base = dwmac->splitter_base; | |
56 | u32 val; | |
57 | ||
58 | if (!splitter_base) | |
59 | return; | |
60 | ||
61 | val = readl(splitter_base + EMAC_SPLITTER_CTRL_REG); | |
62 | val &= ~EMAC_SPLITTER_CTRL_SPEED_MASK; | |
63 | ||
64 | switch (speed) { | |
65 | case 1000: | |
66 | val |= EMAC_SPLITTER_CTRL_SPEED_1000; | |
67 | break; | |
68 | case 100: | |
69 | val |= EMAC_SPLITTER_CTRL_SPEED_100; | |
70 | break; | |
71 | case 10: | |
72 | val |= EMAC_SPLITTER_CTRL_SPEED_10; | |
73 | break; | |
74 | default: | |
75 | return; | |
76 | } | |
77 | ||
78 | writel(val, splitter_base + EMAC_SPLITTER_CTRL_REG); | |
79 | } | |
80 | ||
801d233b DN |
81 | static int socfpga_dwmac_parse_data(struct socfpga_dwmac *dwmac, struct device *dev) |
82 | { | |
83 | struct device_node *np = dev->of_node; | |
84 | struct regmap *sys_mgr_base_addr; | |
85 | u32 reg_offset, reg_shift; | |
86 | int ret; | |
b4834c86 LFT |
87 | struct device_node *np_splitter; |
88 | struct resource res_splitter; | |
801d233b | 89 | |
2d871aa0 VB |
90 | dwmac->stmmac_rst = devm_reset_control_get(dev, |
91 | STMMAC_RESOURCE_NAME); | |
92 | if (IS_ERR(dwmac->stmmac_rst)) { | |
93 | dev_info(dev, "Could not get reset control!\n"); | |
cbe21d92 DN |
94 | if (PTR_ERR(dwmac->stmmac_rst) == -EPROBE_DEFER) |
95 | return -EPROBE_DEFER; | |
96 | dwmac->stmmac_rst = NULL; | |
2d871aa0 VB |
97 | } |
98 | ||
801d233b DN |
99 | dwmac->interface = of_get_phy_mode(np); |
100 | ||
101 | sys_mgr_base_addr = syscon_regmap_lookup_by_phandle(np, "altr,sysmgr-syscon"); | |
102 | if (IS_ERR(sys_mgr_base_addr)) { | |
103 | dev_info(dev, "No sysmgr-syscon node found\n"); | |
104 | return PTR_ERR(sys_mgr_base_addr); | |
105 | } | |
106 | ||
107 | ret = of_property_read_u32_index(np, "altr,sysmgr-syscon", 1, ®_offset); | |
108 | if (ret) { | |
109 | dev_info(dev, "Could not read reg_offset from sysmgr-syscon!\n"); | |
110 | return -EINVAL; | |
111 | } | |
112 | ||
113 | ret = of_property_read_u32_index(np, "altr,sysmgr-syscon", 2, ®_shift); | |
114 | if (ret) { | |
115 | dev_info(dev, "Could not read reg_shift from sysmgr-syscon!\n"); | |
116 | return -EINVAL; | |
117 | } | |
118 | ||
b4834c86 LFT |
119 | np_splitter = of_parse_phandle(np, "altr,emac-splitter", 0); |
120 | if (np_splitter) { | |
121 | if (of_address_to_resource(np_splitter, 0, &res_splitter)) { | |
122 | dev_info(dev, "Missing emac splitter address\n"); | |
123 | return -EINVAL; | |
124 | } | |
125 | ||
dace1b54 | 126 | dwmac->splitter_base = devm_ioremap_resource(dev, &res_splitter); |
f19f916d | 127 | if (IS_ERR(dwmac->splitter_base)) { |
b4834c86 | 128 | dev_info(dev, "Failed to mapping emac splitter\n"); |
f19f916d | 129 | return PTR_ERR(dwmac->splitter_base); |
b4834c86 LFT |
130 | } |
131 | } | |
132 | ||
801d233b DN |
133 | dwmac->reg_offset = reg_offset; |
134 | dwmac->reg_shift = reg_shift; | |
135 | dwmac->sys_mgr_base_addr = sys_mgr_base_addr; | |
136 | dwmac->dev = dev; | |
137 | ||
138 | return 0; | |
139 | } | |
140 | ||
141 | static int socfpga_dwmac_setup(struct socfpga_dwmac *dwmac) | |
142 | { | |
143 | struct regmap *sys_mgr_base_addr = dwmac->sys_mgr_base_addr; | |
144 | int phymode = dwmac->interface; | |
145 | u32 reg_offset = dwmac->reg_offset; | |
146 | u32 reg_shift = dwmac->reg_shift; | |
147 | u32 ctrl, val; | |
148 | ||
149 | switch (phymode) { | |
150 | case PHY_INTERFACE_MODE_RGMII: | |
b4834c86 | 151 | case PHY_INTERFACE_MODE_RGMII_ID: |
801d233b DN |
152 | val = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RGMII; |
153 | break; | |
154 | case PHY_INTERFACE_MODE_MII: | |
155 | case PHY_INTERFACE_MODE_GMII: | |
156 | val = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_GMII_MII; | |
157 | break; | |
158 | default: | |
159 | dev_err(dwmac->dev, "bad phy mode %d\n", phymode); | |
160 | return -EINVAL; | |
161 | } | |
162 | ||
b4834c86 LFT |
163 | /* Overwrite val to GMII if splitter core is enabled. The phymode here |
164 | * is the actual phy mode on phy hardware, but phy interface from | |
165 | * EMAC core is GMII. | |
166 | */ | |
167 | if (dwmac->splitter_base) | |
168 | val = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_GMII_MII; | |
169 | ||
801d233b DN |
170 | regmap_read(sys_mgr_base_addr, reg_offset, &ctrl); |
171 | ctrl &= ~(SYSMGR_EMACGRP_CTRL_PHYSEL_MASK << reg_shift); | |
172 | ctrl |= val << reg_shift; | |
173 | ||
174 | regmap_write(sys_mgr_base_addr, reg_offset, ctrl); | |
175 | return 0; | |
176 | } | |
177 | ||
2d871aa0 VB |
178 | static void socfpga_dwmac_exit(struct platform_device *pdev, void *priv) |
179 | { | |
180 | struct socfpga_dwmac *dwmac = priv; | |
181 | ||
182 | /* On socfpga platform exit, assert and hold reset to the | |
183 | * enet controller - the default state after a hard reset. | |
184 | */ | |
185 | if (dwmac->stmmac_rst) | |
186 | reset_control_assert(dwmac->stmmac_rst); | |
187 | } | |
188 | ||
189 | static int socfpga_dwmac_init(struct platform_device *pdev, void *priv) | |
190 | { | |
191 | struct socfpga_dwmac *dwmac = priv; | |
192 | struct net_device *ndev = platform_get_drvdata(pdev); | |
193 | struct stmmac_priv *stpriv = NULL; | |
194 | int ret = 0; | |
195 | ||
196 | if (ndev) | |
197 | stpriv = netdev_priv(ndev); | |
198 | ||
199 | /* Assert reset to the enet controller before changing the phy mode */ | |
200 | if (dwmac->stmmac_rst) | |
201 | reset_control_assert(dwmac->stmmac_rst); | |
202 | ||
203 | /* Setup the phy mode in the system manager registers according to | |
204 | * devicetree configuration | |
205 | */ | |
206 | ret = socfpga_dwmac_setup(dwmac); | |
207 | ||
208 | /* Deassert reset for the phy configuration to be sampled by | |
209 | * the enet controller, and operation to start in requested mode | |
210 | */ | |
211 | if (dwmac->stmmac_rst) | |
212 | reset_control_deassert(dwmac->stmmac_rst); | |
213 | ||
214 | /* Before the enet controller is suspended, the phy is suspended. | |
215 | * This causes the phy clock to be gated. The enet controller is | |
216 | * resumed before the phy, so the clock is still gated "off" when | |
217 | * the enet controller is resumed. This code makes sure the phy | |
218 | * is "resumed" before reinitializing the enet controller since | |
219 | * the enet controller depends on an active phy clock to complete | |
220 | * a DMA reset. A DMA reset will "time out" if executed | |
221 | * with no phy clock input on the Synopsys enet controller. | |
222 | * Verified through Synopsys Case #8000711656. | |
223 | * | |
224 | * Note that the phy clock is also gated when the phy is isolated. | |
225 | * Phy "suspend" and "isolate" controls are located in phy basic | |
226 | * control register 0, and can be modified by the phy driver | |
227 | * framework. | |
228 | */ | |
229 | if (stpriv && stpriv->phydev) | |
230 | phy_resume(stpriv->phydev); | |
231 | ||
232 | return ret; | |
233 | } | |
234 | ||
8880b6c8 | 235 | static int socfpga_dwmac_probe(struct platform_device *pdev) |
82732789 | 236 | { |
8880b6c8 JE |
237 | struct plat_stmmacenet_data *plat_dat; |
238 | struct stmmac_resources stmmac_res; | |
82732789 JE |
239 | struct device *dev = &pdev->dev; |
240 | int ret; | |
241 | struct socfpga_dwmac *dwmac; | |
242 | ||
8880b6c8 JE |
243 | ret = stmmac_get_platform_resources(pdev, &stmmac_res); |
244 | if (ret) | |
245 | return ret; | |
246 | ||
247 | plat_dat = stmmac_probe_config_dt(pdev, &stmmac_res.mac); | |
248 | if (IS_ERR(plat_dat)) | |
249 | return PTR_ERR(plat_dat); | |
250 | ||
82732789 JE |
251 | dwmac = devm_kzalloc(dev, sizeof(*dwmac), GFP_KERNEL); |
252 | if (!dwmac) | |
8880b6c8 | 253 | return -ENOMEM; |
82732789 JE |
254 | |
255 | ret = socfpga_dwmac_parse_data(dwmac, dev); | |
256 | if (ret) { | |
257 | dev_err(dev, "Unable to parse OF data\n"); | |
8880b6c8 | 258 | return ret; |
82732789 JE |
259 | } |
260 | ||
261 | ret = socfpga_dwmac_setup(dwmac); | |
262 | if (ret) { | |
263 | dev_err(dev, "couldn't setup SoC glue (%d)\n", ret); | |
8880b6c8 | 264 | return ret; |
82732789 JE |
265 | } |
266 | ||
8880b6c8 JE |
267 | plat_dat->bsp_priv = dwmac; |
268 | plat_dat->init = socfpga_dwmac_init; | |
269 | plat_dat->exit = socfpga_dwmac_exit; | |
270 | plat_dat->fix_mac_speed = socfpga_dwmac_fix_mac_speed; | |
82732789 | 271 | |
8880b6c8 JE |
272 | ret = socfpga_dwmac_init(pdev, plat_dat->bsp_priv); |
273 | if (ret) | |
274 | return ret; | |
275 | ||
276 | return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); | |
277 | } | |
c7c52ae7 JE |
278 | |
279 | static const struct of_device_id socfpga_dwmac_match[] = { | |
8880b6c8 | 280 | { .compatible = "altr,socfpga-stmmac" }, |
c7c52ae7 JE |
281 | { } |
282 | }; | |
283 | MODULE_DEVICE_TABLE(of, socfpga_dwmac_match); | |
284 | ||
285 | static struct platform_driver socfpga_dwmac_driver = { | |
8880b6c8 | 286 | .probe = socfpga_dwmac_probe, |
c7c52ae7 JE |
287 | .remove = stmmac_pltfr_remove, |
288 | .driver = { | |
289 | .name = "socfpga-dwmac", | |
290 | .pm = &stmmac_pltfr_pm_ops, | |
291 | .of_match_table = socfpga_dwmac_match, | |
292 | }, | |
293 | }; | |
294 | module_platform_driver(socfpga_dwmac_driver); | |
295 | ||
296 | MODULE_LICENSE("GPL v2"); |