1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright 2021 NXP
3 */
4 #include <linux/pcs/pcs-xpcs.h>
5 #include <linux/of_mdio.h>
6 #include "sja1105.h"
7
8 #define SJA1110_PCS_BANK_REG SJA1110_SPI_ADDR(0x3fc)
9
sja1105_pcs_mdio_read(struct mii_bus * bus,int phy,int reg)10 int sja1105_pcs_mdio_read(struct mii_bus *bus, int phy, int reg)
11 {
12 struct sja1105_mdio_private *mdio_priv = bus->priv;
13 struct sja1105_private *priv = mdio_priv->priv;
14 u64 addr;
15 u32 tmp;
16 u16 mmd;
17 int rc;
18
19 if (!(reg & MII_ADDR_C45))
20 return -EINVAL;
21
22 mmd = (reg >> MII_DEVADDR_C45_SHIFT) & 0x1f;
23 addr = (mmd << 16) | (reg & GENMASK(15, 0));
24
25 if (mmd != MDIO_MMD_VEND1 && mmd != MDIO_MMD_VEND2)
26 return 0xffff;
27
28 if (mmd == MDIO_MMD_VEND2 && (reg & GENMASK(15, 0)) == MII_PHYSID1)
29 return NXP_SJA1105_XPCS_ID >> 16;
30 if (mmd == MDIO_MMD_VEND2 && (reg & GENMASK(15, 0)) == MII_PHYSID2)
31 return NXP_SJA1105_XPCS_ID & GENMASK(15, 0);
32
33 rc = sja1105_xfer_u32(priv, SPI_READ, addr, &tmp, NULL);
34 if (rc < 0)
35 return rc;
36
37 return tmp & 0xffff;
38 }
39
sja1105_pcs_mdio_write(struct mii_bus * bus,int phy,int reg,u16 val)40 int sja1105_pcs_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val)
41 {
42 struct sja1105_mdio_private *mdio_priv = bus->priv;
43 struct sja1105_private *priv = mdio_priv->priv;
44 u64 addr;
45 u32 tmp;
46 u16 mmd;
47
48 if (!(reg & MII_ADDR_C45))
49 return -EINVAL;
50
51 mmd = (reg >> MII_DEVADDR_C45_SHIFT) & 0x1f;
52 addr = (mmd << 16) | (reg & GENMASK(15, 0));
53 tmp = val;
54
55 if (mmd != MDIO_MMD_VEND1 && mmd != MDIO_MMD_VEND2)
56 return -EINVAL;
57
58 return sja1105_xfer_u32(priv, SPI_WRITE, addr, &tmp, NULL);
59 }
60
sja1110_pcs_mdio_read(struct mii_bus * bus,int phy,int reg)61 int sja1110_pcs_mdio_read(struct mii_bus *bus, int phy, int reg)
62 {
63 struct sja1105_mdio_private *mdio_priv = bus->priv;
64 struct sja1105_private *priv = mdio_priv->priv;
65 const struct sja1105_regs *regs = priv->info->regs;
66 int offset, bank;
67 u64 addr;
68 u32 tmp;
69 u16 mmd;
70 int rc;
71
72 if (!(reg & MII_ADDR_C45))
73 return -EINVAL;
74
75 if (regs->pcs_base[phy] == SJA1105_RSV_ADDR)
76 return -ENODEV;
77
78 mmd = (reg >> MII_DEVADDR_C45_SHIFT) & 0x1f;
79 addr = (mmd << 16) | (reg & GENMASK(15, 0));
80
81 if (mmd == MDIO_MMD_VEND2 && (reg & GENMASK(15, 0)) == MII_PHYSID1)
82 return NXP_SJA1110_XPCS_ID >> 16;
83 if (mmd == MDIO_MMD_VEND2 && (reg & GENMASK(15, 0)) == MII_PHYSID2)
84 return NXP_SJA1110_XPCS_ID & GENMASK(15, 0);
85
86 bank = addr >> 8;
87 offset = addr & GENMASK(7, 0);
88
89 /* This addressing scheme reserves register 0xff for the bank address
90 * register, so that can never be addressed.
91 */
92 if (WARN_ON(offset == 0xff))
93 return -ENODEV;
94
95 tmp = bank;
96
97 rc = sja1105_xfer_u32(priv, SPI_WRITE,
98 regs->pcs_base[phy] + SJA1110_PCS_BANK_REG,
99 &tmp, NULL);
100 if (rc < 0)
101 return rc;
102
103 rc = sja1105_xfer_u32(priv, SPI_READ, regs->pcs_base[phy] + offset,
104 &tmp, NULL);
105 if (rc < 0)
106 return rc;
107
108 return tmp & 0xffff;
109 }
110
sja1110_pcs_mdio_write(struct mii_bus * bus,int phy,int reg,u16 val)111 int sja1110_pcs_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val)
112 {
113 struct sja1105_mdio_private *mdio_priv = bus->priv;
114 struct sja1105_private *priv = mdio_priv->priv;
115 const struct sja1105_regs *regs = priv->info->regs;
116 int offset, bank;
117 u64 addr;
118 u32 tmp;
119 u16 mmd;
120 int rc;
121
122 if (!(reg & MII_ADDR_C45))
123 return -EINVAL;
124
125 if (regs->pcs_base[phy] == SJA1105_RSV_ADDR)
126 return -ENODEV;
127
128 mmd = (reg >> MII_DEVADDR_C45_SHIFT) & 0x1f;
129 addr = (mmd << 16) | (reg & GENMASK(15, 0));
130
131 bank = addr >> 8;
132 offset = addr & GENMASK(7, 0);
133
134 /* This addressing scheme reserves register 0xff for the bank address
135 * register, so that can never be addressed.
136 */
137 if (WARN_ON(offset == 0xff))
138 return -ENODEV;
139
140 tmp = bank;
141
142 rc = sja1105_xfer_u32(priv, SPI_WRITE,
143 regs->pcs_base[phy] + SJA1110_PCS_BANK_REG,
144 &tmp, NULL);
145 if (rc < 0)
146 return rc;
147
148 tmp = val;
149
150 return sja1105_xfer_u32(priv, SPI_WRITE, regs->pcs_base[phy] + offset,
151 &tmp, NULL);
152 }
153
154 enum sja1105_mdio_opcode {
155 SJA1105_C45_ADDR = 0,
156 SJA1105_C22 = 1,
157 SJA1105_C45_DATA = 2,
158 SJA1105_C45_DATA_AUTOINC = 3,
159 };
160
sja1105_base_t1_encode_addr(struct sja1105_private * priv,int phy,enum sja1105_mdio_opcode op,int xad)161 static u64 sja1105_base_t1_encode_addr(struct sja1105_private *priv,
162 int phy, enum sja1105_mdio_opcode op,
163 int xad)
164 {
165 const struct sja1105_regs *regs = priv->info->regs;
166
167 return regs->mdio_100base_t1 | (phy << 7) | (op << 5) | (xad << 0);
168 }
169
sja1105_base_t1_mdio_read(struct mii_bus * bus,int phy,int reg)170 static int sja1105_base_t1_mdio_read(struct mii_bus *bus, int phy, int reg)
171 {
172 struct sja1105_mdio_private *mdio_priv = bus->priv;
173 struct sja1105_private *priv = mdio_priv->priv;
174 u64 addr;
175 u32 tmp;
176 int rc;
177
178 if (reg & MII_ADDR_C45) {
179 u16 mmd = (reg >> MII_DEVADDR_C45_SHIFT) & 0x1f;
180
181 addr = sja1105_base_t1_encode_addr(priv, phy, SJA1105_C45_ADDR,
182 mmd);
183
184 tmp = reg & MII_REGADDR_C45_MASK;
185
186 rc = sja1105_xfer_u32(priv, SPI_WRITE, addr, &tmp, NULL);
187 if (rc < 0)
188 return rc;
189
190 addr = sja1105_base_t1_encode_addr(priv, phy, SJA1105_C45_DATA,
191 mmd);
192
193 rc = sja1105_xfer_u32(priv, SPI_READ, addr, &tmp, NULL);
194 if (rc < 0)
195 return rc;
196
197 return tmp & 0xffff;
198 }
199
200 /* Clause 22 read */
201 addr = sja1105_base_t1_encode_addr(priv, phy, SJA1105_C22, reg & 0x1f);
202
203 rc = sja1105_xfer_u32(priv, SPI_READ, addr, &tmp, NULL);
204 if (rc < 0)
205 return rc;
206
207 return tmp & 0xffff;
208 }
209
sja1105_base_t1_mdio_write(struct mii_bus * bus,int phy,int reg,u16 val)210 static int sja1105_base_t1_mdio_write(struct mii_bus *bus, int phy, int reg,
211 u16 val)
212 {
213 struct sja1105_mdio_private *mdio_priv = bus->priv;
214 struct sja1105_private *priv = mdio_priv->priv;
215 u64 addr;
216 u32 tmp;
217 int rc;
218
219 if (reg & MII_ADDR_C45) {
220 u16 mmd = (reg >> MII_DEVADDR_C45_SHIFT) & 0x1f;
221
222 addr = sja1105_base_t1_encode_addr(priv, phy, SJA1105_C45_ADDR,
223 mmd);
224
225 tmp = reg & MII_REGADDR_C45_MASK;
226
227 rc = sja1105_xfer_u32(priv, SPI_WRITE, addr, &tmp, NULL);
228 if (rc < 0)
229 return rc;
230
231 addr = sja1105_base_t1_encode_addr(priv, phy, SJA1105_C45_DATA,
232 mmd);
233
234 tmp = val & 0xffff;
235
236 rc = sja1105_xfer_u32(priv, SPI_WRITE, addr, &tmp, NULL);
237 if (rc < 0)
238 return rc;
239
240 return 0;
241 }
242
243 /* Clause 22 write */
244 addr = sja1105_base_t1_encode_addr(priv, phy, SJA1105_C22, reg & 0x1f);
245
246 tmp = val & 0xffff;
247
248 return sja1105_xfer_u32(priv, SPI_WRITE, addr, &tmp, NULL);
249 }
250
sja1105_base_tx_mdio_read(struct mii_bus * bus,int phy,int reg)251 static int sja1105_base_tx_mdio_read(struct mii_bus *bus, int phy, int reg)
252 {
253 struct sja1105_mdio_private *mdio_priv = bus->priv;
254 struct sja1105_private *priv = mdio_priv->priv;
255 const struct sja1105_regs *regs = priv->info->regs;
256 u32 tmp;
257 int rc;
258
259 rc = sja1105_xfer_u32(priv, SPI_READ, regs->mdio_100base_tx + reg,
260 &tmp, NULL);
261 if (rc < 0)
262 return rc;
263
264 return tmp & 0xffff;
265 }
266
sja1105_base_tx_mdio_write(struct mii_bus * bus,int phy,int reg,u16 val)267 static int sja1105_base_tx_mdio_write(struct mii_bus *bus, int phy, int reg,
268 u16 val)
269 {
270 struct sja1105_mdio_private *mdio_priv = bus->priv;
271 struct sja1105_private *priv = mdio_priv->priv;
272 const struct sja1105_regs *regs = priv->info->regs;
273 u32 tmp = val;
274
275 return sja1105_xfer_u32(priv, SPI_WRITE, regs->mdio_100base_tx + reg,
276 &tmp, NULL);
277 }
278
sja1105_mdiobus_base_tx_register(struct sja1105_private * priv,struct device_node * mdio_node)279 static int sja1105_mdiobus_base_tx_register(struct sja1105_private *priv,
280 struct device_node *mdio_node)
281 {
282 struct sja1105_mdio_private *mdio_priv;
283 struct device_node *np;
284 struct mii_bus *bus;
285 int rc = 0;
286
287 np = of_get_compatible_child(mdio_node, "nxp,sja1110-base-tx-mdio");
288 if (!np)
289 return 0;
290
291 if (!of_device_is_available(np))
292 goto out_put_np;
293
294 bus = mdiobus_alloc_size(sizeof(*mdio_priv));
295 if (!bus) {
296 rc = -ENOMEM;
297 goto out_put_np;
298 }
299
300 bus->name = "SJA1110 100base-TX MDIO bus";
301 snprintf(bus->id, MII_BUS_ID_SIZE, "%s-base-tx",
302 dev_name(priv->ds->dev));
303 bus->read = sja1105_base_tx_mdio_read;
304 bus->write = sja1105_base_tx_mdio_write;
305 bus->parent = priv->ds->dev;
306 mdio_priv = bus->priv;
307 mdio_priv->priv = priv;
308
309 rc = of_mdiobus_register(bus, np);
310 if (rc) {
311 mdiobus_free(bus);
312 goto out_put_np;
313 }
314
315 priv->mdio_base_tx = bus;
316
317 out_put_np:
318 of_node_put(np);
319
320 return rc;
321 }
322
sja1105_mdiobus_base_tx_unregister(struct sja1105_private * priv)323 static void sja1105_mdiobus_base_tx_unregister(struct sja1105_private *priv)
324 {
325 if (!priv->mdio_base_tx)
326 return;
327
328 mdiobus_unregister(priv->mdio_base_tx);
329 mdiobus_free(priv->mdio_base_tx);
330 priv->mdio_base_tx = NULL;
331 }
332
sja1105_mdiobus_base_t1_register(struct sja1105_private * priv,struct device_node * mdio_node)333 static int sja1105_mdiobus_base_t1_register(struct sja1105_private *priv,
334 struct device_node *mdio_node)
335 {
336 struct sja1105_mdio_private *mdio_priv;
337 struct device_node *np;
338 struct mii_bus *bus;
339 int rc = 0;
340
341 np = of_get_compatible_child(mdio_node, "nxp,sja1110-base-t1-mdio");
342 if (!np)
343 return 0;
344
345 if (!of_device_is_available(np))
346 goto out_put_np;
347
348 bus = mdiobus_alloc_size(sizeof(*mdio_priv));
349 if (!bus) {
350 rc = -ENOMEM;
351 goto out_put_np;
352 }
353
354 bus->name = "SJA1110 100base-T1 MDIO bus";
355 snprintf(bus->id, MII_BUS_ID_SIZE, "%s-base-t1",
356 dev_name(priv->ds->dev));
357 bus->read = sja1105_base_t1_mdio_read;
358 bus->write = sja1105_base_t1_mdio_write;
359 bus->parent = priv->ds->dev;
360 mdio_priv = bus->priv;
361 mdio_priv->priv = priv;
362
363 rc = of_mdiobus_register(bus, np);
364 if (rc) {
365 mdiobus_free(bus);
366 goto out_put_np;
367 }
368
369 priv->mdio_base_t1 = bus;
370
371 out_put_np:
372 of_node_put(np);
373
374 return rc;
375 }
376
sja1105_mdiobus_base_t1_unregister(struct sja1105_private * priv)377 static void sja1105_mdiobus_base_t1_unregister(struct sja1105_private *priv)
378 {
379 if (!priv->mdio_base_t1)
380 return;
381
382 mdiobus_unregister(priv->mdio_base_t1);
383 mdiobus_free(priv->mdio_base_t1);
384 priv->mdio_base_t1 = NULL;
385 }
386
sja1105_mdiobus_pcs_register(struct sja1105_private * priv)387 static int sja1105_mdiobus_pcs_register(struct sja1105_private *priv)
388 {
389 struct sja1105_mdio_private *mdio_priv;
390 struct dsa_switch *ds = priv->ds;
391 struct mii_bus *bus;
392 int rc = 0;
393 int port;
394
395 if (!priv->info->pcs_mdio_read || !priv->info->pcs_mdio_write)
396 return 0;
397
398 bus = mdiobus_alloc_size(sizeof(*mdio_priv));
399 if (!bus)
400 return -ENOMEM;
401
402 bus->name = "SJA1105 PCS MDIO bus";
403 snprintf(bus->id, MII_BUS_ID_SIZE, "%s-pcs",
404 dev_name(ds->dev));
405 bus->read = priv->info->pcs_mdio_read;
406 bus->write = priv->info->pcs_mdio_write;
407 bus->parent = ds->dev;
408 /* There is no PHY on this MDIO bus => mask out all PHY addresses
409 * from auto probing.
410 */
411 bus->phy_mask = ~0;
412 mdio_priv = bus->priv;
413 mdio_priv->priv = priv;
414
415 rc = mdiobus_register(bus);
416 if (rc) {
417 mdiobus_free(bus);
418 return rc;
419 }
420
421 for (port = 0; port < ds->num_ports; port++) {
422 struct mdio_device *mdiodev;
423 struct dw_xpcs *xpcs;
424
425 if (dsa_is_unused_port(ds, port))
426 continue;
427
428 if (priv->phy_mode[port] != PHY_INTERFACE_MODE_SGMII &&
429 priv->phy_mode[port] != PHY_INTERFACE_MODE_2500BASEX)
430 continue;
431
432 mdiodev = mdio_device_create(bus, port);
433 if (IS_ERR(mdiodev)) {
434 rc = PTR_ERR(mdiodev);
435 goto out_pcs_free;
436 }
437
438 xpcs = xpcs_create(mdiodev, priv->phy_mode[port]);
439 if (IS_ERR(xpcs)) {
440 rc = PTR_ERR(xpcs);
441 goto out_pcs_free;
442 }
443
444 priv->xpcs[port] = xpcs;
445 }
446
447 priv->mdio_pcs = bus;
448
449 return 0;
450
451 out_pcs_free:
452 for (port = 0; port < ds->num_ports; port++) {
453 if (!priv->xpcs[port])
454 continue;
455
456 mdio_device_free(priv->xpcs[port]->mdiodev);
457 xpcs_destroy(priv->xpcs[port]);
458 priv->xpcs[port] = NULL;
459 }
460
461 mdiobus_unregister(bus);
462 mdiobus_free(bus);
463
464 return rc;
465 }
466
sja1105_mdiobus_pcs_unregister(struct sja1105_private * priv)467 static void sja1105_mdiobus_pcs_unregister(struct sja1105_private *priv)
468 {
469 struct dsa_switch *ds = priv->ds;
470 int port;
471
472 if (!priv->mdio_pcs)
473 return;
474
475 for (port = 0; port < ds->num_ports; port++) {
476 if (!priv->xpcs[port])
477 continue;
478
479 mdio_device_free(priv->xpcs[port]->mdiodev);
480 xpcs_destroy(priv->xpcs[port]);
481 priv->xpcs[port] = NULL;
482 }
483
484 mdiobus_unregister(priv->mdio_pcs);
485 mdiobus_free(priv->mdio_pcs);
486 priv->mdio_pcs = NULL;
487 }
488
sja1105_mdiobus_register(struct dsa_switch * ds)489 int sja1105_mdiobus_register(struct dsa_switch *ds)
490 {
491 struct sja1105_private *priv = ds->priv;
492 const struct sja1105_regs *regs = priv->info->regs;
493 struct device_node *switch_node = ds->dev->of_node;
494 struct device_node *mdio_node;
495 int rc;
496
497 rc = sja1105_mdiobus_pcs_register(priv);
498 if (rc)
499 return rc;
500
501 mdio_node = of_get_child_by_name(switch_node, "mdios");
502 if (!mdio_node)
503 return 0;
504
505 if (!of_device_is_available(mdio_node))
506 goto out_put_mdio_node;
507
508 if (regs->mdio_100base_tx != SJA1105_RSV_ADDR) {
509 rc = sja1105_mdiobus_base_tx_register(priv, mdio_node);
510 if (rc)
511 goto err_put_mdio_node;
512 }
513
514 if (regs->mdio_100base_t1 != SJA1105_RSV_ADDR) {
515 rc = sja1105_mdiobus_base_t1_register(priv, mdio_node);
516 if (rc)
517 goto err_free_base_tx_mdiobus;
518 }
519
520 out_put_mdio_node:
521 of_node_put(mdio_node);
522
523 return 0;
524
525 err_free_base_tx_mdiobus:
526 sja1105_mdiobus_base_tx_unregister(priv);
527 err_put_mdio_node:
528 of_node_put(mdio_node);
529 sja1105_mdiobus_pcs_unregister(priv);
530
531 return rc;
532 }
533
sja1105_mdiobus_unregister(struct dsa_switch * ds)534 void sja1105_mdiobus_unregister(struct dsa_switch *ds)
535 {
536 struct sja1105_private *priv = ds->priv;
537
538 sja1105_mdiobus_base_t1_unregister(priv);
539 sja1105_mdiobus_base_tx_unregister(priv);
540 sja1105_mdiobus_pcs_unregister(priv);
541 }
542