Loading...
1// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2/* Copyright (c) 2015, The Linux Foundation. All rights reserved. */
3/* Copyright (c) 2020 Sartura Ltd. */
4
5#include <linux/delay.h>
6#include <linux/io.h>
7#include <linux/iopoll.h>
8#include <linux/kernel.h>
9#include <linux/module.h>
10#include <linux/of_address.h>
11#include <linux/of_mdio.h>
12#include <linux/phy.h>
13#include <linux/platform_device.h>
14#include <linux/clk.h>
15
16#define MDIO_MODE_REG 0x40
17#define MDIO_MODE_MDC_MODE BIT(12)
18/* 0 = Clause 22, 1 = Clause 45 */
19#define MDIO_MODE_C45 BIT(8)
20#define MDIO_MODE_DIV_MASK GENMASK(7, 0)
21#define MDIO_MODE_DIV(x) FIELD_PREP(MDIO_MODE_DIV_MASK, (x) - 1)
22#define MDIO_MODE_DIV_1 0x0
23#define MDIO_MODE_DIV_2 0x1
24#define MDIO_MODE_DIV_4 0x3
25#define MDIO_MODE_DIV_8 0x7
26#define MDIO_MODE_DIV_16 0xf
27#define MDIO_MODE_DIV_32 0x1f
28#define MDIO_MODE_DIV_64 0x3f
29#define MDIO_MODE_DIV_128 0x7f
30#define MDIO_MODE_DIV_256 0xff
31#define MDIO_ADDR_REG 0x44
32#define MDIO_DATA_WRITE_REG 0x48
33#define MDIO_DATA_READ_REG 0x4c
34#define MDIO_CMD_REG 0x50
35#define MDIO_CMD_ACCESS_BUSY BIT(16)
36#define MDIO_CMD_ACCESS_START BIT(8)
37#define MDIO_CMD_ACCESS_CODE_READ 0
38#define MDIO_CMD_ACCESS_CODE_WRITE 1
39#define MDIO_CMD_ACCESS_CODE_C45_ADDR 0
40#define MDIO_CMD_ACCESS_CODE_C45_WRITE 1
41#define MDIO_CMD_ACCESS_CODE_C45_READ 2
42
43#define IPQ4019_MDIO_TIMEOUT 10000
44#define IPQ4019_MDIO_SLEEP 10
45
46/* MDIO clock source frequency is fixed to 100M */
47#define IPQ_MDIO_CLK_RATE 100000000
48
49#define IPQ_PHY_SET_DELAY_US 100000
50
51struct ipq4019_mdio_data {
52 void __iomem *membase;
53 void __iomem *eth_ldo_rdy;
54 struct clk *mdio_clk;
55 unsigned int mdc_rate;
56};
57
58static int ipq4019_mdio_wait_busy(struct mii_bus *bus)
59{
60 struct ipq4019_mdio_data *priv = bus->priv;
61 unsigned int busy;
62
63 return readl_poll_timeout(priv->membase + MDIO_CMD_REG, busy,
64 (busy & MDIO_CMD_ACCESS_BUSY) == 0,
65 IPQ4019_MDIO_SLEEP, IPQ4019_MDIO_TIMEOUT);
66}
67
68static int ipq4019_mdio_read_c45(struct mii_bus *bus, int mii_id, int mmd,
69 int reg)
70{
71 struct ipq4019_mdio_data *priv = bus->priv;
72 unsigned int data;
73 unsigned int cmd;
74
75 if (ipq4019_mdio_wait_busy(bus))
76 return -ETIMEDOUT;
77
78 data = readl(priv->membase + MDIO_MODE_REG);
79
80 data |= MDIO_MODE_C45;
81
82 writel(data, priv->membase + MDIO_MODE_REG);
83
84 /* issue the phy address and mmd */
85 writel((mii_id << 8) | mmd, priv->membase + MDIO_ADDR_REG);
86
87 /* issue reg */
88 writel(reg, priv->membase + MDIO_DATA_WRITE_REG);
89
90 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_C45_ADDR;
91
92 /* issue read command */
93 writel(cmd, priv->membase + MDIO_CMD_REG);
94
95 /* Wait read complete */
96 if (ipq4019_mdio_wait_busy(bus))
97 return -ETIMEDOUT;
98
99 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_C45_READ;
100
101 writel(cmd, priv->membase + MDIO_CMD_REG);
102
103 if (ipq4019_mdio_wait_busy(bus))
104 return -ETIMEDOUT;
105
106 /* Read and return data */
107 return readl(priv->membase + MDIO_DATA_READ_REG);
108}
109
110static int ipq4019_mdio_read_c22(struct mii_bus *bus, int mii_id, int regnum)
111{
112 struct ipq4019_mdio_data *priv = bus->priv;
113 unsigned int data;
114 unsigned int cmd;
115
116 if (ipq4019_mdio_wait_busy(bus))
117 return -ETIMEDOUT;
118
119 data = readl(priv->membase + MDIO_MODE_REG);
120
121 data &= ~MDIO_MODE_C45;
122
123 writel(data, priv->membase + MDIO_MODE_REG);
124
125 /* issue the phy address and reg */
126 writel((mii_id << 8) | regnum, priv->membase + MDIO_ADDR_REG);
127
128 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_READ;
129
130 /* issue read command */
131 writel(cmd, priv->membase + MDIO_CMD_REG);
132
133 /* Wait read complete */
134 if (ipq4019_mdio_wait_busy(bus))
135 return -ETIMEDOUT;
136
137 /* Read and return data */
138 return readl(priv->membase + MDIO_DATA_READ_REG);
139}
140
141static int ipq4019_mdio_write_c45(struct mii_bus *bus, int mii_id, int mmd,
142 int reg, u16 value)
143{
144 struct ipq4019_mdio_data *priv = bus->priv;
145 unsigned int data;
146 unsigned int cmd;
147
148 if (ipq4019_mdio_wait_busy(bus))
149 return -ETIMEDOUT;
150
151 data = readl(priv->membase + MDIO_MODE_REG);
152
153 data |= MDIO_MODE_C45;
154
155 writel(data, priv->membase + MDIO_MODE_REG);
156
157 /* issue the phy address and mmd */
158 writel((mii_id << 8) | mmd, priv->membase + MDIO_ADDR_REG);
159
160 /* issue reg */
161 writel(reg, priv->membase + MDIO_DATA_WRITE_REG);
162
163 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_C45_ADDR;
164
165 writel(cmd, priv->membase + MDIO_CMD_REG);
166
167 if (ipq4019_mdio_wait_busy(bus))
168 return -ETIMEDOUT;
169
170 /* issue write data */
171 writel(value, priv->membase + MDIO_DATA_WRITE_REG);
172
173 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_C45_WRITE;
174 writel(cmd, priv->membase + MDIO_CMD_REG);
175
176 /* Wait write complete */
177 if (ipq4019_mdio_wait_busy(bus))
178 return -ETIMEDOUT;
179
180 return 0;
181}
182
183static int ipq4019_mdio_write_c22(struct mii_bus *bus, int mii_id, int regnum,
184 u16 value)
185{
186 struct ipq4019_mdio_data *priv = bus->priv;
187 unsigned int data;
188 unsigned int cmd;
189
190 if (ipq4019_mdio_wait_busy(bus))
191 return -ETIMEDOUT;
192
193 /* Enter Clause 22 mode */
194 data = readl(priv->membase + MDIO_MODE_REG);
195
196 data &= ~MDIO_MODE_C45;
197
198 writel(data, priv->membase + MDIO_MODE_REG);
199
200 /* issue the phy address and reg */
201 writel((mii_id << 8) | regnum, priv->membase + MDIO_ADDR_REG);
202
203 /* issue write data */
204 writel(value, priv->membase + MDIO_DATA_WRITE_REG);
205
206 /* issue write command */
207 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_WRITE;
208
209 writel(cmd, priv->membase + MDIO_CMD_REG);
210
211 /* Wait write complete */
212 if (ipq4019_mdio_wait_busy(bus))
213 return -ETIMEDOUT;
214
215 return 0;
216}
217
218static int ipq4019_mdio_set_div(struct ipq4019_mdio_data *priv)
219{
220 unsigned long ahb_rate;
221 int div;
222 u32 val;
223
224 /* If we don't have a clock for AHB use the fixed value */
225 ahb_rate = IPQ_MDIO_CLK_RATE;
226 if (priv->mdio_clk)
227 ahb_rate = clk_get_rate(priv->mdio_clk);
228
229 /* MDC rate is ahb_rate/(MDIO_MODE_DIV + 1)
230 * While supported, internal documentation doesn't
231 * assure correct functionality of the MDIO bus
232 * with divider of 1, 2 or 4.
233 */
234 for (div = 8; div <= 256; div *= 2) {
235 /* The requested rate is supported by the div */
236 if (priv->mdc_rate == DIV_ROUND_UP(ahb_rate, div)) {
237 val = readl(priv->membase + MDIO_MODE_REG);
238 val &= ~MDIO_MODE_DIV_MASK;
239 val |= MDIO_MODE_DIV(div);
240 writel(val, priv->membase + MDIO_MODE_REG);
241
242 return 0;
243 }
244 }
245
246 /* The requested rate is not supported */
247 return -EINVAL;
248}
249
250static int ipq_mdio_reset(struct mii_bus *bus)
251{
252 struct ipq4019_mdio_data *priv = bus->priv;
253 u32 val;
254 int ret;
255
256 /* To indicate CMN_PLL that ethernet_ldo has been ready if platform resource 1
257 * is specified in the device tree.
258 */
259 if (priv->eth_ldo_rdy) {
260 val = readl(priv->eth_ldo_rdy);
261 val |= BIT(0);
262 writel(val, priv->eth_ldo_rdy);
263 fsleep(IPQ_PHY_SET_DELAY_US);
264 }
265
266 /* Configure MDIO clock source frequency if clock is specified in the device tree */
267 ret = clk_set_rate(priv->mdio_clk, IPQ_MDIO_CLK_RATE);
268 if (ret)
269 return ret;
270
271 ret = clk_prepare_enable(priv->mdio_clk);
272 if (ret)
273 return ret;
274
275 mdelay(10);
276
277 /* Restore MDC rate */
278 return ipq4019_mdio_set_div(priv);
279}
280
281static void ipq4019_mdio_select_mdc_rate(struct platform_device *pdev,
282 struct ipq4019_mdio_data *priv)
283{
284 unsigned long ahb_rate;
285 int div;
286 u32 val;
287
288 /* MDC rate defined in DT, we don't have to decide a default value */
289 if (!of_property_read_u32(pdev->dev.of_node, "clock-frequency",
290 &priv->mdc_rate))
291 return;
292
293 /* If we don't have a clock for AHB use the fixed value */
294 ahb_rate = IPQ_MDIO_CLK_RATE;
295 if (priv->mdio_clk)
296 ahb_rate = clk_get_rate(priv->mdio_clk);
297
298 /* Check what is the current div set */
299 val = readl(priv->membase + MDIO_MODE_REG);
300 div = FIELD_GET(MDIO_MODE_DIV_MASK, val);
301
302 /* div is not set to the default value of /256
303 * Probably someone changed that (bootloader, other drivers)
304 * Keep this and don't overwrite it.
305 */
306 if (div != MDIO_MODE_DIV_256) {
307 priv->mdc_rate = DIV_ROUND_UP(ahb_rate, div + 1);
308 return;
309 }
310
311 /* If div is /256 assume nobody have set this value and
312 * try to find one MDC rate that is close the 802.3 spec of
313 * 2.5MHz
314 */
315 for (div = 256; div >= 8; div /= 2) {
316 /* Stop as soon as we found a divider that
317 * reached the closest value to 2.5MHz
318 */
319 if (DIV_ROUND_UP(ahb_rate, div) > 2500000)
320 break;
321
322 priv->mdc_rate = DIV_ROUND_UP(ahb_rate, div);
323 }
324}
325
326static int ipq4019_mdio_probe(struct platform_device *pdev)
327{
328 struct ipq4019_mdio_data *priv;
329 struct mii_bus *bus;
330 struct resource *res;
331 int ret;
332
333 bus = devm_mdiobus_alloc_size(&pdev->dev, sizeof(*priv));
334 if (!bus)
335 return -ENOMEM;
336
337 priv = bus->priv;
338
339 priv->membase = devm_platform_ioremap_resource(pdev, 0);
340 if (IS_ERR(priv->membase))
341 return PTR_ERR(priv->membase);
342
343 priv->mdio_clk = devm_clk_get_optional(&pdev->dev, "gcc_mdio_ahb_clk");
344 if (IS_ERR(priv->mdio_clk))
345 return PTR_ERR(priv->mdio_clk);
346
347 ipq4019_mdio_select_mdc_rate(pdev, priv);
348 ret = ipq4019_mdio_set_div(priv);
349 if (ret)
350 return ret;
351
352 /* The platform resource is provided on the chipset IPQ5018 */
353 /* This resource is optional */
354 res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
355 if (res) {
356 priv->eth_ldo_rdy = devm_ioremap_resource(&pdev->dev, res);
357 if (IS_ERR(priv->eth_ldo_rdy))
358 return PTR_ERR(priv->eth_ldo_rdy);
359 }
360
361 bus->name = "ipq4019_mdio";
362 bus->read = ipq4019_mdio_read_c22;
363 bus->write = ipq4019_mdio_write_c22;
364 bus->read_c45 = ipq4019_mdio_read_c45;
365 bus->write_c45 = ipq4019_mdio_write_c45;
366 bus->reset = ipq_mdio_reset;
367 bus->parent = &pdev->dev;
368 snprintf(bus->id, MII_BUS_ID_SIZE, "%s%d", pdev->name, pdev->id);
369
370 ret = of_mdiobus_register(bus, pdev->dev.of_node);
371 if (ret) {
372 dev_err(&pdev->dev, "Cannot register MDIO bus!\n");
373 return ret;
374 }
375
376 platform_set_drvdata(pdev, bus);
377
378 return 0;
379}
380
381static void ipq4019_mdio_remove(struct platform_device *pdev)
382{
383 struct mii_bus *bus = platform_get_drvdata(pdev);
384
385 mdiobus_unregister(bus);
386}
387
388static const struct of_device_id ipq4019_mdio_dt_ids[] = {
389 { .compatible = "qcom,ipq4019-mdio" },
390 { .compatible = "qcom,ipq5018-mdio" },
391 { }
392};
393MODULE_DEVICE_TABLE(of, ipq4019_mdio_dt_ids);
394
395static struct platform_driver ipq4019_mdio_driver = {
396 .probe = ipq4019_mdio_probe,
397 .remove = ipq4019_mdio_remove,
398 .driver = {
399 .name = "ipq4019-mdio",
400 .of_match_table = ipq4019_mdio_dt_ids,
401 },
402};
403
404module_platform_driver(ipq4019_mdio_driver);
405
406MODULE_DESCRIPTION("ipq4019 MDIO interface driver");
407MODULE_AUTHOR("Qualcomm Atheros");
408MODULE_LICENSE("Dual BSD/GPL");
1// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2/* Copyright (c) 2015, The Linux Foundation. All rights reserved. */
3/* Copyright (c) 2020 Sartura Ltd. */
4
5#include <linux/delay.h>
6#include <linux/io.h>
7#include <linux/iopoll.h>
8#include <linux/kernel.h>
9#include <linux/module.h>
10#include <linux/of_address.h>
11#include <linux/of_mdio.h>
12#include <linux/phy.h>
13#include <linux/platform_device.h>
14#include <linux/clk.h>
15
16#define MDIO_MODE_REG 0x40
17#define MDIO_ADDR_REG 0x44
18#define MDIO_DATA_WRITE_REG 0x48
19#define MDIO_DATA_READ_REG 0x4c
20#define MDIO_CMD_REG 0x50
21#define MDIO_CMD_ACCESS_BUSY BIT(16)
22#define MDIO_CMD_ACCESS_START BIT(8)
23#define MDIO_CMD_ACCESS_CODE_READ 0
24#define MDIO_CMD_ACCESS_CODE_WRITE 1
25#define MDIO_CMD_ACCESS_CODE_C45_ADDR 0
26#define MDIO_CMD_ACCESS_CODE_C45_WRITE 1
27#define MDIO_CMD_ACCESS_CODE_C45_READ 2
28
29/* 0 = Clause 22, 1 = Clause 45 */
30#define MDIO_MODE_C45 BIT(8)
31
32#define IPQ4019_MDIO_TIMEOUT 10000
33#define IPQ4019_MDIO_SLEEP 10
34
35/* MDIO clock source frequency is fixed to 100M */
36#define IPQ_MDIO_CLK_RATE 100000000
37
38#define IPQ_PHY_SET_DELAY_US 100000
39
40struct ipq4019_mdio_data {
41 void __iomem *membase;
42 void __iomem *eth_ldo_rdy;
43 struct clk *mdio_clk;
44};
45
46static int ipq4019_mdio_wait_busy(struct mii_bus *bus)
47{
48 struct ipq4019_mdio_data *priv = bus->priv;
49 unsigned int busy;
50
51 return readl_poll_timeout(priv->membase + MDIO_CMD_REG, busy,
52 (busy & MDIO_CMD_ACCESS_BUSY) == 0,
53 IPQ4019_MDIO_SLEEP, IPQ4019_MDIO_TIMEOUT);
54}
55
56static int ipq4019_mdio_read(struct mii_bus *bus, int mii_id, int regnum)
57{
58 struct ipq4019_mdio_data *priv = bus->priv;
59 unsigned int data;
60 unsigned int cmd;
61
62 if (ipq4019_mdio_wait_busy(bus))
63 return -ETIMEDOUT;
64
65 /* Clause 45 support */
66 if (regnum & MII_ADDR_C45) {
67 unsigned int mmd = (regnum >> 16) & 0x1F;
68 unsigned int reg = regnum & 0xFFFF;
69
70 /* Enter Clause 45 mode */
71 data = readl(priv->membase + MDIO_MODE_REG);
72
73 data |= MDIO_MODE_C45;
74
75 writel(data, priv->membase + MDIO_MODE_REG);
76
77 /* issue the phy address and mmd */
78 writel((mii_id << 8) | mmd, priv->membase + MDIO_ADDR_REG);
79
80 /* issue reg */
81 writel(reg, priv->membase + MDIO_DATA_WRITE_REG);
82
83 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_C45_ADDR;
84 } else {
85 /* Enter Clause 22 mode */
86 data = readl(priv->membase + MDIO_MODE_REG);
87
88 data &= ~MDIO_MODE_C45;
89
90 writel(data, priv->membase + MDIO_MODE_REG);
91
92 /* issue the phy address and reg */
93 writel((mii_id << 8) | regnum, priv->membase + MDIO_ADDR_REG);
94
95 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_READ;
96 }
97
98 /* issue read command */
99 writel(cmd, priv->membase + MDIO_CMD_REG);
100
101 /* Wait read complete */
102 if (ipq4019_mdio_wait_busy(bus))
103 return -ETIMEDOUT;
104
105 if (regnum & MII_ADDR_C45) {
106 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_C45_READ;
107
108 writel(cmd, priv->membase + MDIO_CMD_REG);
109
110 if (ipq4019_mdio_wait_busy(bus))
111 return -ETIMEDOUT;
112 }
113
114 /* Read and return data */
115 return readl(priv->membase + MDIO_DATA_READ_REG);
116}
117
118static int ipq4019_mdio_write(struct mii_bus *bus, int mii_id, int regnum,
119 u16 value)
120{
121 struct ipq4019_mdio_data *priv = bus->priv;
122 unsigned int data;
123 unsigned int cmd;
124
125 if (ipq4019_mdio_wait_busy(bus))
126 return -ETIMEDOUT;
127
128 /* Clause 45 support */
129 if (regnum & MII_ADDR_C45) {
130 unsigned int mmd = (regnum >> 16) & 0x1F;
131 unsigned int reg = regnum & 0xFFFF;
132
133 /* Enter Clause 45 mode */
134 data = readl(priv->membase + MDIO_MODE_REG);
135
136 data |= MDIO_MODE_C45;
137
138 writel(data, priv->membase + MDIO_MODE_REG);
139
140 /* issue the phy address and mmd */
141 writel((mii_id << 8) | mmd, priv->membase + MDIO_ADDR_REG);
142
143 /* issue reg */
144 writel(reg, priv->membase + MDIO_DATA_WRITE_REG);
145
146 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_C45_ADDR;
147
148 writel(cmd, priv->membase + MDIO_CMD_REG);
149
150 if (ipq4019_mdio_wait_busy(bus))
151 return -ETIMEDOUT;
152 } else {
153 /* Enter Clause 22 mode */
154 data = readl(priv->membase + MDIO_MODE_REG);
155
156 data &= ~MDIO_MODE_C45;
157
158 writel(data, priv->membase + MDIO_MODE_REG);
159
160 /* issue the phy address and reg */
161 writel((mii_id << 8) | regnum, priv->membase + MDIO_ADDR_REG);
162 }
163
164 /* issue write data */
165 writel(value, priv->membase + MDIO_DATA_WRITE_REG);
166
167 /* issue write command */
168 if (regnum & MII_ADDR_C45)
169 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_C45_WRITE;
170 else
171 cmd = MDIO_CMD_ACCESS_START | MDIO_CMD_ACCESS_CODE_WRITE;
172
173 writel(cmd, priv->membase + MDIO_CMD_REG);
174
175 /* Wait write complete */
176 if (ipq4019_mdio_wait_busy(bus))
177 return -ETIMEDOUT;
178
179 return 0;
180}
181
182static int ipq_mdio_reset(struct mii_bus *bus)
183{
184 struct ipq4019_mdio_data *priv = bus->priv;
185 u32 val;
186 int ret;
187
188 /* To indicate CMN_PLL that ethernet_ldo has been ready if platform resource 1
189 * is specified in the device tree.
190 */
191 if (priv->eth_ldo_rdy) {
192 val = readl(priv->eth_ldo_rdy);
193 val |= BIT(0);
194 writel(val, priv->eth_ldo_rdy);
195 fsleep(IPQ_PHY_SET_DELAY_US);
196 }
197
198 /* Configure MDIO clock source frequency if clock is specified in the device tree */
199 ret = clk_set_rate(priv->mdio_clk, IPQ_MDIO_CLK_RATE);
200 if (ret)
201 return ret;
202
203 ret = clk_prepare_enable(priv->mdio_clk);
204 if (ret == 0)
205 mdelay(10);
206
207 return ret;
208}
209
210static int ipq4019_mdio_probe(struct platform_device *pdev)
211{
212 struct ipq4019_mdio_data *priv;
213 struct mii_bus *bus;
214 struct resource *res;
215 int ret;
216
217 bus = devm_mdiobus_alloc_size(&pdev->dev, sizeof(*priv));
218 if (!bus)
219 return -ENOMEM;
220
221 priv = bus->priv;
222
223 priv->membase = devm_platform_ioremap_resource(pdev, 0);
224 if (IS_ERR(priv->membase))
225 return PTR_ERR(priv->membase);
226
227 priv->mdio_clk = devm_clk_get_optional(&pdev->dev, "gcc_mdio_ahb_clk");
228 if (IS_ERR(priv->mdio_clk))
229 return PTR_ERR(priv->mdio_clk);
230
231 /* The platform resource is provided on the chipset IPQ5018 */
232 /* This resource is optional */
233 res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
234 if (res)
235 priv->eth_ldo_rdy = devm_ioremap_resource(&pdev->dev, res);
236
237 bus->name = "ipq4019_mdio";
238 bus->read = ipq4019_mdio_read;
239 bus->write = ipq4019_mdio_write;
240 bus->reset = ipq_mdio_reset;
241 bus->parent = &pdev->dev;
242 snprintf(bus->id, MII_BUS_ID_SIZE, "%s%d", pdev->name, pdev->id);
243
244 ret = of_mdiobus_register(bus, pdev->dev.of_node);
245 if (ret) {
246 dev_err(&pdev->dev, "Cannot register MDIO bus!\n");
247 return ret;
248 }
249
250 platform_set_drvdata(pdev, bus);
251
252 return 0;
253}
254
255static int ipq4019_mdio_remove(struct platform_device *pdev)
256{
257 struct mii_bus *bus = platform_get_drvdata(pdev);
258
259 mdiobus_unregister(bus);
260
261 return 0;
262}
263
264static const struct of_device_id ipq4019_mdio_dt_ids[] = {
265 { .compatible = "qcom,ipq4019-mdio" },
266 { .compatible = "qcom,ipq5018-mdio" },
267 { }
268};
269MODULE_DEVICE_TABLE(of, ipq4019_mdio_dt_ids);
270
271static struct platform_driver ipq4019_mdio_driver = {
272 .probe = ipq4019_mdio_probe,
273 .remove = ipq4019_mdio_remove,
274 .driver = {
275 .name = "ipq4019-mdio",
276 .of_match_table = ipq4019_mdio_dt_ids,
277 },
278};
279
280module_platform_driver(ipq4019_mdio_driver);
281
282MODULE_DESCRIPTION("ipq4019 MDIO interface driver");
283MODULE_AUTHOR("Qualcomm Atheros");
284MODULE_LICENSE("Dual BSD/GPL");