Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/ebiederm...
[deliverable/linux.git] / drivers / net / ethernet / stmicro / stmmac / dwmac-socfpga.c
CommitLineData
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
43569814 35#define SYSMGR_EMACGRP_CTRL_PTP_REF_CLK_MASK 0x00000010
801d233b 36
734e00fa
PR
37#define SYSMGR_FPGAGRP_MODULE_REG 0x00000028
38#define SYSMGR_FPGAGRP_MODULE_EMAC 0x00000004
39
b4834c86
LFT
40#define EMAC_SPLITTER_CTRL_REG 0x0
41#define EMAC_SPLITTER_CTRL_SPEED_MASK 0x3
42#define EMAC_SPLITTER_CTRL_SPEED_10 0x2
43#define EMAC_SPLITTER_CTRL_SPEED_100 0x3
44#define EMAC_SPLITTER_CTRL_SPEED_1000 0x0
45
801d233b
DN
46struct socfpga_dwmac {
47 int interface;
48 u32 reg_offset;
49 u32 reg_shift;
50 struct device *dev;
51 struct regmap *sys_mgr_base_addr;
b4834c86 52 void __iomem *splitter_base;
43569814 53 bool f2h_ptp_ref_clk;
801d233b
DN
54};
55
b4834c86
LFT
56static void socfpga_dwmac_fix_mac_speed(void *priv, unsigned int speed)
57{
58 struct socfpga_dwmac *dwmac = (struct socfpga_dwmac *)priv;
59 void __iomem *splitter_base = dwmac->splitter_base;
60 u32 val;
61
62 if (!splitter_base)
63 return;
64
65 val = readl(splitter_base + EMAC_SPLITTER_CTRL_REG);
66 val &= ~EMAC_SPLITTER_CTRL_SPEED_MASK;
67
68 switch (speed) {
69 case 1000:
70 val |= EMAC_SPLITTER_CTRL_SPEED_1000;
71 break;
72 case 100:
73 val |= EMAC_SPLITTER_CTRL_SPEED_100;
74 break;
75 case 10:
76 val |= EMAC_SPLITTER_CTRL_SPEED_10;
77 break;
78 default:
79 return;
80 }
81
82 writel(val, splitter_base + EMAC_SPLITTER_CTRL_REG);
83}
84
801d233b
DN
85static int socfpga_dwmac_parse_data(struct socfpga_dwmac *dwmac, struct device *dev)
86{
87 struct device_node *np = dev->of_node;
88 struct regmap *sys_mgr_base_addr;
89 u32 reg_offset, reg_shift;
90 int ret;
b4834c86
LFT
91 struct device_node *np_splitter;
92 struct resource res_splitter;
801d233b
DN
93
94 dwmac->interface = of_get_phy_mode(np);
95
96 sys_mgr_base_addr = syscon_regmap_lookup_by_phandle(np, "altr,sysmgr-syscon");
97 if (IS_ERR(sys_mgr_base_addr)) {
98 dev_info(dev, "No sysmgr-syscon node found\n");
99 return PTR_ERR(sys_mgr_base_addr);
100 }
101
102 ret = of_property_read_u32_index(np, "altr,sysmgr-syscon", 1, &reg_offset);
103 if (ret) {
104 dev_info(dev, "Could not read reg_offset from sysmgr-syscon!\n");
105 return -EINVAL;
106 }
107
108 ret = of_property_read_u32_index(np, "altr,sysmgr-syscon", 2, &reg_shift);
109 if (ret) {
110 dev_info(dev, "Could not read reg_shift from sysmgr-syscon!\n");
111 return -EINVAL;
112 }
113
43569814
PR
114 dwmac->f2h_ptp_ref_clk = of_property_read_bool(np, "altr,f2h_ptp_ref_clk");
115
b4834c86
LFT
116 np_splitter = of_parse_phandle(np, "altr,emac-splitter", 0);
117 if (np_splitter) {
118 if (of_address_to_resource(np_splitter, 0, &res_splitter)) {
119 dev_info(dev, "Missing emac splitter address\n");
120 return -EINVAL;
121 }
122
dace1b54 123 dwmac->splitter_base = devm_ioremap_resource(dev, &res_splitter);
f19f916d 124 if (IS_ERR(dwmac->splitter_base)) {
b4834c86 125 dev_info(dev, "Failed to mapping emac splitter\n");
f19f916d 126 return PTR_ERR(dwmac->splitter_base);
b4834c86
LFT
127 }
128 }
129
801d233b
DN
130 dwmac->reg_offset = reg_offset;
131 dwmac->reg_shift = reg_shift;
132 dwmac->sys_mgr_base_addr = sys_mgr_base_addr;
133 dwmac->dev = dev;
134
135 return 0;
136}
137
138static int socfpga_dwmac_setup(struct socfpga_dwmac *dwmac)
139{
140 struct regmap *sys_mgr_base_addr = dwmac->sys_mgr_base_addr;
141 int phymode = dwmac->interface;
142 u32 reg_offset = dwmac->reg_offset;
143 u32 reg_shift = dwmac->reg_shift;
734e00fa 144 u32 ctrl, val, module;
801d233b
DN
145
146 switch (phymode) {
147 case PHY_INTERFACE_MODE_RGMII:
b4834c86 148 case PHY_INTERFACE_MODE_RGMII_ID:
801d233b
DN
149 val = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RGMII;
150 break;
151 case PHY_INTERFACE_MODE_MII:
152 case PHY_INTERFACE_MODE_GMII:
153 val = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_GMII_MII;
154 break;
155 default:
156 dev_err(dwmac->dev, "bad phy mode %d\n", phymode);
157 return -EINVAL;
158 }
159
b4834c86
LFT
160 /* Overwrite val to GMII if splitter core is enabled. The phymode here
161 * is the actual phy mode on phy hardware, but phy interface from
162 * EMAC core is GMII.
163 */
164 if (dwmac->splitter_base)
165 val = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_GMII_MII;
166
801d233b
DN
167 regmap_read(sys_mgr_base_addr, reg_offset, &ctrl);
168 ctrl &= ~(SYSMGR_EMACGRP_CTRL_PHYSEL_MASK << reg_shift);
169 ctrl |= val << reg_shift;
170
734e00fa 171 if (dwmac->f2h_ptp_ref_clk) {
43569814 172 ctrl |= SYSMGR_EMACGRP_CTRL_PTP_REF_CLK_MASK << (reg_shift / 2);
734e00fa
PR
173 regmap_read(sys_mgr_base_addr, SYSMGR_FPGAGRP_MODULE_REG,
174 &module);
175 module |= (SYSMGR_FPGAGRP_MODULE_EMAC << (reg_shift / 2));
176 regmap_write(sys_mgr_base_addr, SYSMGR_FPGAGRP_MODULE_REG,
177 module);
178 } else {
43569814 179 ctrl &= ~(SYSMGR_EMACGRP_CTRL_PTP_REF_CLK_MASK << (reg_shift / 2));
734e00fa 180 }
43569814 181
801d233b 182 regmap_write(sys_mgr_base_addr, reg_offset, ctrl);
734e00fa 183
801d233b
DN
184 return 0;
185}
186
2d871aa0
VB
187static int socfpga_dwmac_init(struct platform_device *pdev, void *priv)
188{
3c201b5a 189 struct socfpga_dwmac *dwmac = priv;
2d871aa0
VB
190 struct net_device *ndev = platform_get_drvdata(pdev);
191 struct stmmac_priv *stpriv = NULL;
192 int ret = 0;
193
3c201b5a
MV
194 if (!ndev)
195 return -EINVAL;
196
197 stpriv = netdev_priv(ndev);
198 if (!stpriv)
199 return -EINVAL;
2d871aa0
VB
200
201 /* Assert reset to the enet controller before changing the phy mode */
3c201b5a
MV
202 if (stpriv->stmmac_rst)
203 reset_control_assert(stpriv->stmmac_rst);
2d871aa0
VB
204
205 /* Setup the phy mode in the system manager registers according to
206 * devicetree configuration
207 */
208 ret = socfpga_dwmac_setup(dwmac);
209
210 /* Deassert reset for the phy configuration to be sampled by
211 * the enet controller, and operation to start in requested mode
212 */
3c201b5a
MV
213 if (stpriv->stmmac_rst)
214 reset_control_deassert(stpriv->stmmac_rst);
2d871aa0
VB
215
216 /* Before the enet controller is suspended, the phy is suspended.
217 * This causes the phy clock to be gated. The enet controller is
218 * resumed before the phy, so the clock is still gated "off" when
219 * the enet controller is resumed. This code makes sure the phy
220 * is "resumed" before reinitializing the enet controller since
221 * the enet controller depends on an active phy clock to complete
222 * a DMA reset. A DMA reset will "time out" if executed
223 * with no phy clock input on the Synopsys enet controller.
224 * Verified through Synopsys Case #8000711656.
225 *
226 * Note that the phy clock is also gated when the phy is isolated.
227 * Phy "suspend" and "isolate" controls are located in phy basic
228 * control register 0, and can be modified by the phy driver
229 * framework.
230 */
3c201b5a 231 if (stpriv->phydev)
2d871aa0
VB
232 phy_resume(stpriv->phydev);
233
234 return ret;
235}
236
8880b6c8 237static int socfpga_dwmac_probe(struct platform_device *pdev)
82732789 238{
8880b6c8
JE
239 struct plat_stmmacenet_data *plat_dat;
240 struct stmmac_resources stmmac_res;
82732789
JE
241 struct device *dev = &pdev->dev;
242 int ret;
243 struct socfpga_dwmac *dwmac;
244
8880b6c8
JE
245 ret = stmmac_get_platform_resources(pdev, &stmmac_res);
246 if (ret)
247 return ret;
248
249 plat_dat = stmmac_probe_config_dt(pdev, &stmmac_res.mac);
250 if (IS_ERR(plat_dat))
251 return PTR_ERR(plat_dat);
252
82732789
JE
253 dwmac = devm_kzalloc(dev, sizeof(*dwmac), GFP_KERNEL);
254 if (!dwmac)
8880b6c8 255 return -ENOMEM;
82732789
JE
256
257 ret = socfpga_dwmac_parse_data(dwmac, dev);
258 if (ret) {
259 dev_err(dev, "Unable to parse OF data\n");
8880b6c8 260 return ret;
82732789
JE
261 }
262
263 ret = socfpga_dwmac_setup(dwmac);
264 if (ret) {
265 dev_err(dev, "couldn't setup SoC glue (%d)\n", ret);
8880b6c8 266 return ret;
82732789
JE
267 }
268
8880b6c8
JE
269 plat_dat->bsp_priv = dwmac;
270 plat_dat->init = socfpga_dwmac_init;
8880b6c8 271 plat_dat->fix_mac_speed = socfpga_dwmac_fix_mac_speed;
82732789 272
3c201b5a
MV
273 ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
274 if (!ret)
275 ret = socfpga_dwmac_init(pdev, dwmac);
8880b6c8 276
3c201b5a 277 return ret;
8880b6c8 278}
c7c52ae7
JE
279
280static const struct of_device_id socfpga_dwmac_match[] = {
8880b6c8 281 { .compatible = "altr,socfpga-stmmac" },
c7c52ae7
JE
282 { }
283};
284MODULE_DEVICE_TABLE(of, socfpga_dwmac_match);
285
286static struct platform_driver socfpga_dwmac_driver = {
8880b6c8 287 .probe = socfpga_dwmac_probe,
c7c52ae7
JE
288 .remove = stmmac_pltfr_remove,
289 .driver = {
290 .name = "socfpga-dwmac",
291 .pm = &stmmac_pltfr_pm_ops,
292 .of_match_table = socfpga_dwmac_match,
293 },
294};
295module_platform_driver(socfpga_dwmac_driver);
296
297MODULE_LICENSE("GPL v2");
This page took 0.168471 seconds and 5 git commands to generate.