Loading...
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Marvell 88x2222 dual-port multi-speed ethernet transceiver.
4 *
5 * Supports:
6 * XAUI on the host side.
7 * 1000Base-X or 10GBase-R on the line side.
8 * SGMII over 1000Base-X.
9 */
10#include <linux/module.h>
11#include <linux/phy.h>
12#include <linux/gpio.h>
13#include <linux/delay.h>
14#include <linux/mdio.h>
15#include <linux/marvell_phy.h>
16#include <linux/of.h>
17#include <linux/of_gpio.h>
18#include <linux/sfp.h>
19#include <linux/netdevice.h>
20
21/* Port PCS Configuration */
22#define MV_PCS_CONFIG 0xF002
23#define MV_PCS_HOST_XAUI 0x73
24#define MV_PCS_LINE_10GBR (0x71 << 8)
25#define MV_PCS_LINE_1GBX_AN (0x7B << 8)
26#define MV_PCS_LINE_SGMII_AN (0x7F << 8)
27
28/* Port Reset and Power Down */
29#define MV_PORT_RST 0xF003
30#define MV_LINE_RST_SW BIT(15)
31#define MV_HOST_RST_SW BIT(7)
32#define MV_PORT_RST_SW (MV_LINE_RST_SW | MV_HOST_RST_SW)
33
34/* PMD Receive Signal Detect */
35#define MV_RX_SIGNAL_DETECT 0x000A
36#define MV_RX_SIGNAL_DETECT_GLOBAL BIT(0)
37
38/* 1000Base-X/SGMII Control Register */
39#define MV_1GBX_CTRL (0x2000 + MII_BMCR)
40
41/* 1000BASE-X/SGMII Status Register */
42#define MV_1GBX_STAT (0x2000 + MII_BMSR)
43
44/* 1000Base-X Auto-Negotiation Advertisement Register */
45#define MV_1GBX_ADVERTISE (0x2000 + MII_ADVERTISE)
46
47/* 1000Base-X PHY Specific Status Register */
48#define MV_1GBX_PHY_STAT 0xA003
49#define MV_1GBX_PHY_STAT_AN_RESOLVED BIT(11)
50#define MV_1GBX_PHY_STAT_DUPLEX BIT(13)
51#define MV_1GBX_PHY_STAT_SPEED100 BIT(14)
52#define MV_1GBX_PHY_STAT_SPEED1000 BIT(15)
53
54#define AUTONEG_TIMEOUT 3
55
56struct mv2222_data {
57 phy_interface_t line_interface;
58 __ETHTOOL_DECLARE_LINK_MODE_MASK(supported);
59 bool sfp_link;
60};
61
62/* SFI PMA transmit enable */
63static int mv2222_tx_enable(struct phy_device *phydev)
64{
65 return phy_clear_bits_mmd(phydev, MDIO_MMD_PMAPMD, MDIO_PMA_TXDIS,
66 MDIO_PMD_TXDIS_GLOBAL);
67}
68
69/* SFI PMA transmit disable */
70static int mv2222_tx_disable(struct phy_device *phydev)
71{
72 return phy_set_bits_mmd(phydev, MDIO_MMD_PMAPMD, MDIO_PMA_TXDIS,
73 MDIO_PMD_TXDIS_GLOBAL);
74}
75
76static int mv2222_soft_reset(struct phy_device *phydev)
77{
78 int val, ret;
79
80 ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, MV_PORT_RST,
81 MV_PORT_RST_SW);
82 if (ret < 0)
83 return ret;
84
85 return phy_read_mmd_poll_timeout(phydev, MDIO_MMD_VEND2, MV_PORT_RST,
86 val, !(val & MV_PORT_RST_SW),
87 5000, 1000000, true);
88}
89
90static int mv2222_disable_aneg(struct phy_device *phydev)
91{
92 int ret = phy_clear_bits_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_CTRL,
93 BMCR_ANENABLE | BMCR_ANRESTART);
94 if (ret < 0)
95 return ret;
96
97 return mv2222_soft_reset(phydev);
98}
99
100static int mv2222_enable_aneg(struct phy_device *phydev)
101{
102 int ret = phy_set_bits_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_CTRL,
103 BMCR_ANENABLE | BMCR_RESET);
104 if (ret < 0)
105 return ret;
106
107 return mv2222_soft_reset(phydev);
108}
109
110static int mv2222_set_sgmii_speed(struct phy_device *phydev)
111{
112 struct mv2222_data *priv = phydev->priv;
113
114 switch (phydev->speed) {
115 default:
116 case SPEED_1000:
117 if ((linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
118 priv->supported) ||
119 linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT,
120 priv->supported)))
121 return phy_modify_mmd(phydev, MDIO_MMD_PCS,
122 MV_1GBX_CTRL,
123 BMCR_SPEED1000 | BMCR_SPEED100,
124 BMCR_SPEED1000);
125
126 fallthrough;
127 case SPEED_100:
128 if ((linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
129 priv->supported) ||
130 linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT,
131 priv->supported)))
132 return phy_modify_mmd(phydev, MDIO_MMD_PCS,
133 MV_1GBX_CTRL,
134 BMCR_SPEED1000 | BMCR_SPEED100,
135 BMCR_SPEED100);
136 fallthrough;
137 case SPEED_10:
138 if ((linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT,
139 priv->supported) ||
140 linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT,
141 priv->supported)))
142 return phy_modify_mmd(phydev, MDIO_MMD_PCS,
143 MV_1GBX_CTRL,
144 BMCR_SPEED1000 | BMCR_SPEED100,
145 BMCR_SPEED10);
146
147 return -EINVAL;
148 }
149}
150
151static bool mv2222_is_10g_capable(struct phy_device *phydev)
152{
153 struct mv2222_data *priv = phydev->priv;
154
155 return (linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
156 priv->supported) ||
157 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseCR_Full_BIT,
158 priv->supported) ||
159 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseSR_Full_BIT,
160 priv->supported) ||
161 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseLR_Full_BIT,
162 priv->supported) ||
163 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseLRM_Full_BIT,
164 priv->supported) ||
165 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseER_Full_BIT,
166 priv->supported));
167}
168
169static bool mv2222_is_1gbx_capable(struct phy_device *phydev)
170{
171 struct mv2222_data *priv = phydev->priv;
172
173 return linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT,
174 priv->supported);
175}
176
177static bool mv2222_is_sgmii_capable(struct phy_device *phydev)
178{
179 struct mv2222_data *priv = phydev->priv;
180
181 return (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
182 priv->supported) ||
183 linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT,
184 priv->supported) ||
185 linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
186 priv->supported) ||
187 linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT,
188 priv->supported) ||
189 linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT,
190 priv->supported) ||
191 linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT,
192 priv->supported));
193}
194
195static int mv2222_config_line(struct phy_device *phydev)
196{
197 struct mv2222_data *priv = phydev->priv;
198
199 switch (priv->line_interface) {
200 case PHY_INTERFACE_MODE_10GBASER:
201 return phy_write_mmd(phydev, MDIO_MMD_VEND2, MV_PCS_CONFIG,
202 MV_PCS_HOST_XAUI | MV_PCS_LINE_10GBR);
203 case PHY_INTERFACE_MODE_1000BASEX:
204 return phy_write_mmd(phydev, MDIO_MMD_VEND2, MV_PCS_CONFIG,
205 MV_PCS_HOST_XAUI | MV_PCS_LINE_1GBX_AN);
206 case PHY_INTERFACE_MODE_SGMII:
207 return phy_write_mmd(phydev, MDIO_MMD_VEND2, MV_PCS_CONFIG,
208 MV_PCS_HOST_XAUI | MV_PCS_LINE_SGMII_AN);
209 default:
210 return -EINVAL;
211 }
212}
213
214/* Switch between 1G (1000Base-X/SGMII) and 10G (10GBase-R) modes */
215static int mv2222_swap_line_type(struct phy_device *phydev)
216{
217 struct mv2222_data *priv = phydev->priv;
218 bool changed = false;
219 int ret;
220
221 switch (priv->line_interface) {
222 case PHY_INTERFACE_MODE_10GBASER:
223 if (mv2222_is_1gbx_capable(phydev)) {
224 priv->line_interface = PHY_INTERFACE_MODE_1000BASEX;
225 changed = true;
226 }
227
228 if (mv2222_is_sgmii_capable(phydev)) {
229 priv->line_interface = PHY_INTERFACE_MODE_SGMII;
230 changed = true;
231 }
232
233 break;
234 case PHY_INTERFACE_MODE_1000BASEX:
235 case PHY_INTERFACE_MODE_SGMII:
236 if (mv2222_is_10g_capable(phydev)) {
237 priv->line_interface = PHY_INTERFACE_MODE_10GBASER;
238 changed = true;
239 }
240
241 break;
242 default:
243 return -EINVAL;
244 }
245
246 if (changed) {
247 ret = mv2222_config_line(phydev);
248 if (ret < 0)
249 return ret;
250 }
251
252 return 0;
253}
254
255static int mv2222_setup_forced(struct phy_device *phydev)
256{
257 struct mv2222_data *priv = phydev->priv;
258 int ret;
259
260 if (priv->line_interface == PHY_INTERFACE_MODE_10GBASER) {
261 if (phydev->speed < SPEED_10000 &&
262 phydev->speed != SPEED_UNKNOWN) {
263 ret = mv2222_swap_line_type(phydev);
264 if (ret < 0)
265 return ret;
266 }
267 }
268
269 if (priv->line_interface == PHY_INTERFACE_MODE_SGMII) {
270 ret = mv2222_set_sgmii_speed(phydev);
271 if (ret < 0)
272 return ret;
273 }
274
275 return mv2222_disable_aneg(phydev);
276}
277
278static int mv2222_config_aneg(struct phy_device *phydev)
279{
280 struct mv2222_data *priv = phydev->priv;
281 int ret, adv;
282
283 /* SFP is not present, do nothing */
284 if (priv->line_interface == PHY_INTERFACE_MODE_NA)
285 return 0;
286
287 if (phydev->autoneg == AUTONEG_DISABLE ||
288 priv->line_interface == PHY_INTERFACE_MODE_10GBASER)
289 return mv2222_setup_forced(phydev);
290
291 adv = linkmode_adv_to_mii_adv_x(priv->supported,
292 ETHTOOL_LINK_MODE_1000baseX_Full_BIT);
293
294 ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_ADVERTISE,
295 ADVERTISE_1000XFULL |
296 ADVERTISE_1000XPAUSE | ADVERTISE_1000XPSE_ASYM,
297 adv);
298 if (ret < 0)
299 return ret;
300
301 return mv2222_enable_aneg(phydev);
302}
303
304static int mv2222_aneg_done(struct phy_device *phydev)
305{
306 int ret;
307
308 if (mv2222_is_10g_capable(phydev)) {
309 ret = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_STAT1);
310 if (ret < 0)
311 return ret;
312
313 if (ret & MDIO_STAT1_LSTATUS)
314 return 1;
315 }
316
317 ret = phy_read_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_STAT);
318 if (ret < 0)
319 return ret;
320
321 return (ret & BMSR_ANEGCOMPLETE);
322}
323
324/* Returns negative on error, 0 if link is down, 1 if link is up */
325static int mv2222_read_status_10g(struct phy_device *phydev)
326{
327 static int timeout;
328 int val, link = 0;
329
330 val = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_STAT1);
331 if (val < 0)
332 return val;
333
334 if (val & MDIO_STAT1_LSTATUS) {
335 link = 1;
336
337 /* 10GBASE-R do not support auto-negotiation */
338 phydev->autoneg = AUTONEG_DISABLE;
339 phydev->speed = SPEED_10000;
340 phydev->duplex = DUPLEX_FULL;
341 } else {
342 if (phydev->autoneg == AUTONEG_ENABLE) {
343 timeout++;
344
345 if (timeout > AUTONEG_TIMEOUT) {
346 timeout = 0;
347
348 val = mv2222_swap_line_type(phydev);
349 if (val < 0)
350 return val;
351
352 return mv2222_config_aneg(phydev);
353 }
354 }
355 }
356
357 return link;
358}
359
360/* Returns negative on error, 0 if link is down, 1 if link is up */
361static int mv2222_read_status_1g(struct phy_device *phydev)
362{
363 static int timeout;
364 int val, link = 0;
365
366 val = phy_read_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_STAT);
367 if (val < 0)
368 return val;
369
370 if (phydev->autoneg == AUTONEG_ENABLE &&
371 !(val & BMSR_ANEGCOMPLETE)) {
372 timeout++;
373
374 if (timeout > AUTONEG_TIMEOUT) {
375 timeout = 0;
376
377 val = mv2222_swap_line_type(phydev);
378 if (val < 0)
379 return val;
380
381 return mv2222_config_aneg(phydev);
382 }
383
384 return 0;
385 }
386
387 if (!(val & BMSR_LSTATUS))
388 return 0;
389
390 link = 1;
391
392 val = phy_read_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_PHY_STAT);
393 if (val < 0)
394 return val;
395
396 if (val & MV_1GBX_PHY_STAT_AN_RESOLVED) {
397 if (val & MV_1GBX_PHY_STAT_DUPLEX)
398 phydev->duplex = DUPLEX_FULL;
399 else
400 phydev->duplex = DUPLEX_HALF;
401
402 if (val & MV_1GBX_PHY_STAT_SPEED1000)
403 phydev->speed = SPEED_1000;
404 else if (val & MV_1GBX_PHY_STAT_SPEED100)
405 phydev->speed = SPEED_100;
406 else
407 phydev->speed = SPEED_10;
408 }
409
410 return link;
411}
412
413static bool mv2222_link_is_operational(struct phy_device *phydev)
414{
415 struct mv2222_data *priv = phydev->priv;
416 int val;
417
418 val = phy_read_mmd(phydev, MDIO_MMD_PMAPMD, MV_RX_SIGNAL_DETECT);
419 if (val < 0 || !(val & MV_RX_SIGNAL_DETECT_GLOBAL))
420 return false;
421
422 if (phydev->sfp_bus && !priv->sfp_link)
423 return false;
424
425 return true;
426}
427
428static int mv2222_read_status(struct phy_device *phydev)
429{
430 struct mv2222_data *priv = phydev->priv;
431 int link;
432
433 phydev->link = 0;
434 phydev->speed = SPEED_UNKNOWN;
435 phydev->duplex = DUPLEX_UNKNOWN;
436
437 if (!mv2222_link_is_operational(phydev))
438 return 0;
439
440 if (priv->line_interface == PHY_INTERFACE_MODE_10GBASER)
441 link = mv2222_read_status_10g(phydev);
442 else
443 link = mv2222_read_status_1g(phydev);
444
445 if (link < 0)
446 return link;
447
448 phydev->link = link;
449
450 return 0;
451}
452
453static int mv2222_resume(struct phy_device *phydev)
454{
455 return mv2222_tx_enable(phydev);
456}
457
458static int mv2222_suspend(struct phy_device *phydev)
459{
460 return mv2222_tx_disable(phydev);
461}
462
463static int mv2222_get_features(struct phy_device *phydev)
464{
465 /* All supported linkmodes are set at probe */
466
467 return 0;
468}
469
470static int mv2222_config_init(struct phy_device *phydev)
471{
472 if (phydev->interface != PHY_INTERFACE_MODE_XAUI)
473 return -EINVAL;
474
475 return 0;
476}
477
478static int mv2222_sfp_insert(void *upstream, const struct sfp_eeprom_id *id)
479{
480 DECLARE_PHY_INTERFACE_MASK(interfaces);
481 struct phy_device *phydev = upstream;
482 phy_interface_t sfp_interface;
483 struct mv2222_data *priv;
484 struct device *dev;
485 int ret;
486
487 __ETHTOOL_DECLARE_LINK_MODE_MASK(sfp_supported) = { 0, };
488
489 priv = phydev->priv;
490 dev = &phydev->mdio.dev;
491
492 sfp_parse_support(phydev->sfp_bus, id, sfp_supported, interfaces);
493 phydev->port = sfp_parse_port(phydev->sfp_bus, id, sfp_supported);
494 sfp_interface = sfp_select_interface(phydev->sfp_bus, sfp_supported);
495
496 dev_info(dev, "%s SFP module inserted\n", phy_modes(sfp_interface));
497
498 if (sfp_interface != PHY_INTERFACE_MODE_10GBASER &&
499 sfp_interface != PHY_INTERFACE_MODE_1000BASEX &&
500 sfp_interface != PHY_INTERFACE_MODE_SGMII) {
501 dev_err(dev, "Incompatible SFP module inserted\n");
502
503 return -EINVAL;
504 }
505
506 priv->line_interface = sfp_interface;
507 linkmode_and(priv->supported, phydev->supported, sfp_supported);
508
509 ret = mv2222_config_line(phydev);
510 if (ret < 0)
511 return ret;
512
513 if (mutex_trylock(&phydev->lock)) {
514 ret = mv2222_config_aneg(phydev);
515 mutex_unlock(&phydev->lock);
516 }
517
518 return ret;
519}
520
521static void mv2222_sfp_remove(void *upstream)
522{
523 struct phy_device *phydev = upstream;
524 struct mv2222_data *priv;
525
526 priv = phydev->priv;
527
528 priv->line_interface = PHY_INTERFACE_MODE_NA;
529 linkmode_zero(priv->supported);
530 phydev->port = PORT_NONE;
531}
532
533static void mv2222_sfp_link_up(void *upstream)
534{
535 struct phy_device *phydev = upstream;
536 struct mv2222_data *priv;
537
538 priv = phydev->priv;
539 priv->sfp_link = true;
540}
541
542static void mv2222_sfp_link_down(void *upstream)
543{
544 struct phy_device *phydev = upstream;
545 struct mv2222_data *priv;
546
547 priv = phydev->priv;
548 priv->sfp_link = false;
549}
550
551static const struct sfp_upstream_ops sfp_phy_ops = {
552 .module_insert = mv2222_sfp_insert,
553 .module_remove = mv2222_sfp_remove,
554 .link_up = mv2222_sfp_link_up,
555 .link_down = mv2222_sfp_link_down,
556 .attach = phy_sfp_attach,
557 .detach = phy_sfp_detach,
558};
559
560static int mv2222_probe(struct phy_device *phydev)
561{
562 struct device *dev = &phydev->mdio.dev;
563 struct mv2222_data *priv = NULL;
564
565 __ETHTOOL_DECLARE_LINK_MODE_MASK(supported) = { 0, };
566
567 linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, supported);
568 linkmode_set_bit(ETHTOOL_LINK_MODE_Pause_BIT, supported);
569 linkmode_set_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, supported);
570 linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT, supported);
571 linkmode_set_bit(ETHTOOL_LINK_MODE_TP_BIT, supported);
572 linkmode_set_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, supported);
573 linkmode_set_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, supported);
574 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, supported);
575 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, supported);
576 linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT, supported);
577 linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, supported);
578 linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT, supported);
579 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT, supported);
580 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseCR_Full_BIT, supported);
581 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseSR_Full_BIT, supported);
582 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseLR_Full_BIT, supported);
583 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseLRM_Full_BIT, supported);
584 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseER_Full_BIT, supported);
585
586 linkmode_copy(phydev->supported, supported);
587
588 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
589 if (!priv)
590 return -ENOMEM;
591
592 priv->line_interface = PHY_INTERFACE_MODE_NA;
593 phydev->priv = priv;
594
595 return phy_sfp_probe(phydev, &sfp_phy_ops);
596}
597
598static struct phy_driver mv2222_drivers[] = {
599 {
600 .phy_id = MARVELL_PHY_ID_88X2222,
601 .phy_id_mask = MARVELL_PHY_ID_MASK,
602 .name = "Marvell 88X2222",
603 .get_features = mv2222_get_features,
604 .soft_reset = mv2222_soft_reset,
605 .config_init = mv2222_config_init,
606 .config_aneg = mv2222_config_aneg,
607 .aneg_done = mv2222_aneg_done,
608 .probe = mv2222_probe,
609 .suspend = mv2222_suspend,
610 .resume = mv2222_resume,
611 .read_status = mv2222_read_status,
612 },
613};
614module_phy_driver(mv2222_drivers);
615
616static struct mdio_device_id __maybe_unused mv2222_tbl[] = {
617 { MARVELL_PHY_ID_88X2222, MARVELL_PHY_ID_MASK },
618 { }
619};
620MODULE_DEVICE_TABLE(mdio, mv2222_tbl);
621
622MODULE_DESCRIPTION("Marvell 88x2222 ethernet transceiver driver");
623MODULE_LICENSE("GPL");
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Marvell 88x2222 dual-port multi-speed ethernet transceiver.
4 *
5 * Supports:
6 * XAUI on the host side.
7 * 1000Base-X or 10GBase-R on the line side.
8 * SGMII over 1000Base-X.
9 */
10#include <linux/module.h>
11#include <linux/phy.h>
12#include <linux/gpio.h>
13#include <linux/delay.h>
14#include <linux/mdio.h>
15#include <linux/marvell_phy.h>
16#include <linux/of.h>
17#include <linux/of_device.h>
18#include <linux/of_gpio.h>
19#include <linux/sfp.h>
20#include <linux/netdevice.h>
21
22/* Port PCS Configuration */
23#define MV_PCS_CONFIG 0xF002
24#define MV_PCS_HOST_XAUI 0x73
25#define MV_PCS_LINE_10GBR (0x71 << 8)
26#define MV_PCS_LINE_1GBX_AN (0x7B << 8)
27#define MV_PCS_LINE_SGMII_AN (0x7F << 8)
28
29/* Port Reset and Power Down */
30#define MV_PORT_RST 0xF003
31#define MV_LINE_RST_SW BIT(15)
32#define MV_HOST_RST_SW BIT(7)
33#define MV_PORT_RST_SW (MV_LINE_RST_SW | MV_HOST_RST_SW)
34
35/* PMD Receive Signal Detect */
36#define MV_RX_SIGNAL_DETECT 0x000A
37#define MV_RX_SIGNAL_DETECT_GLOBAL BIT(0)
38
39/* 1000Base-X/SGMII Control Register */
40#define MV_1GBX_CTRL (0x2000 + MII_BMCR)
41
42/* 1000BASE-X/SGMII Status Register */
43#define MV_1GBX_STAT (0x2000 + MII_BMSR)
44
45/* 1000Base-X Auto-Negotiation Advertisement Register */
46#define MV_1GBX_ADVERTISE (0x2000 + MII_ADVERTISE)
47
48/* 1000Base-X PHY Specific Status Register */
49#define MV_1GBX_PHY_STAT 0xA003
50#define MV_1GBX_PHY_STAT_AN_RESOLVED BIT(11)
51#define MV_1GBX_PHY_STAT_DUPLEX BIT(13)
52#define MV_1GBX_PHY_STAT_SPEED100 BIT(14)
53#define MV_1GBX_PHY_STAT_SPEED1000 BIT(15)
54
55#define AUTONEG_TIMEOUT 3
56
57struct mv2222_data {
58 phy_interface_t line_interface;
59 __ETHTOOL_DECLARE_LINK_MODE_MASK(supported);
60 bool sfp_link;
61};
62
63/* SFI PMA transmit enable */
64static int mv2222_tx_enable(struct phy_device *phydev)
65{
66 return phy_clear_bits_mmd(phydev, MDIO_MMD_PMAPMD, MDIO_PMA_TXDIS,
67 MDIO_PMD_TXDIS_GLOBAL);
68}
69
70/* SFI PMA transmit disable */
71static int mv2222_tx_disable(struct phy_device *phydev)
72{
73 return phy_set_bits_mmd(phydev, MDIO_MMD_PMAPMD, MDIO_PMA_TXDIS,
74 MDIO_PMD_TXDIS_GLOBAL);
75}
76
77static int mv2222_soft_reset(struct phy_device *phydev)
78{
79 int val, ret;
80
81 ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, MV_PORT_RST,
82 MV_PORT_RST_SW);
83 if (ret < 0)
84 return ret;
85
86 return phy_read_mmd_poll_timeout(phydev, MDIO_MMD_VEND2, MV_PORT_RST,
87 val, !(val & MV_PORT_RST_SW),
88 5000, 1000000, true);
89}
90
91static int mv2222_disable_aneg(struct phy_device *phydev)
92{
93 int ret = phy_clear_bits_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_CTRL,
94 BMCR_ANENABLE | BMCR_ANRESTART);
95 if (ret < 0)
96 return ret;
97
98 return mv2222_soft_reset(phydev);
99}
100
101static int mv2222_enable_aneg(struct phy_device *phydev)
102{
103 int ret = phy_set_bits_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_CTRL,
104 BMCR_ANENABLE | BMCR_RESET);
105 if (ret < 0)
106 return ret;
107
108 return mv2222_soft_reset(phydev);
109}
110
111static int mv2222_set_sgmii_speed(struct phy_device *phydev)
112{
113 struct mv2222_data *priv = phydev->priv;
114
115 switch (phydev->speed) {
116 default:
117 case SPEED_1000:
118 if ((linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
119 priv->supported) ||
120 linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT,
121 priv->supported)))
122 return phy_modify_mmd(phydev, MDIO_MMD_PCS,
123 MV_1GBX_CTRL,
124 BMCR_SPEED1000 | BMCR_SPEED100,
125 BMCR_SPEED1000);
126
127 fallthrough;
128 case SPEED_100:
129 if ((linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
130 priv->supported) ||
131 linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT,
132 priv->supported)))
133 return phy_modify_mmd(phydev, MDIO_MMD_PCS,
134 MV_1GBX_CTRL,
135 BMCR_SPEED1000 | BMCR_SPEED100,
136 BMCR_SPEED100);
137 fallthrough;
138 case SPEED_10:
139 if ((linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT,
140 priv->supported) ||
141 linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT,
142 priv->supported)))
143 return phy_modify_mmd(phydev, MDIO_MMD_PCS,
144 MV_1GBX_CTRL,
145 BMCR_SPEED1000 | BMCR_SPEED100,
146 BMCR_SPEED10);
147
148 return -EINVAL;
149 }
150}
151
152static bool mv2222_is_10g_capable(struct phy_device *phydev)
153{
154 struct mv2222_data *priv = phydev->priv;
155
156 return (linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
157 priv->supported) ||
158 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseCR_Full_BIT,
159 priv->supported) ||
160 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseSR_Full_BIT,
161 priv->supported) ||
162 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseLR_Full_BIT,
163 priv->supported) ||
164 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseLRM_Full_BIT,
165 priv->supported) ||
166 linkmode_test_bit(ETHTOOL_LINK_MODE_10000baseER_Full_BIT,
167 priv->supported));
168}
169
170static bool mv2222_is_1gbx_capable(struct phy_device *phydev)
171{
172 struct mv2222_data *priv = phydev->priv;
173
174 return linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT,
175 priv->supported);
176}
177
178static bool mv2222_is_sgmii_capable(struct phy_device *phydev)
179{
180 struct mv2222_data *priv = phydev->priv;
181
182 return (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
183 priv->supported) ||
184 linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT,
185 priv->supported) ||
186 linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
187 priv->supported) ||
188 linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT,
189 priv->supported) ||
190 linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT,
191 priv->supported) ||
192 linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT,
193 priv->supported));
194}
195
196static int mv2222_config_line(struct phy_device *phydev)
197{
198 struct mv2222_data *priv = phydev->priv;
199
200 switch (priv->line_interface) {
201 case PHY_INTERFACE_MODE_10GBASER:
202 return phy_write_mmd(phydev, MDIO_MMD_VEND2, MV_PCS_CONFIG,
203 MV_PCS_HOST_XAUI | MV_PCS_LINE_10GBR);
204 case PHY_INTERFACE_MODE_1000BASEX:
205 return phy_write_mmd(phydev, MDIO_MMD_VEND2, MV_PCS_CONFIG,
206 MV_PCS_HOST_XAUI | MV_PCS_LINE_1GBX_AN);
207 case PHY_INTERFACE_MODE_SGMII:
208 return phy_write_mmd(phydev, MDIO_MMD_VEND2, MV_PCS_CONFIG,
209 MV_PCS_HOST_XAUI | MV_PCS_LINE_SGMII_AN);
210 default:
211 return -EINVAL;
212 }
213}
214
215/* Switch between 1G (1000Base-X/SGMII) and 10G (10GBase-R) modes */
216static int mv2222_swap_line_type(struct phy_device *phydev)
217{
218 struct mv2222_data *priv = phydev->priv;
219 bool changed = false;
220 int ret;
221
222 switch (priv->line_interface) {
223 case PHY_INTERFACE_MODE_10GBASER:
224 if (mv2222_is_1gbx_capable(phydev)) {
225 priv->line_interface = PHY_INTERFACE_MODE_1000BASEX;
226 changed = true;
227 }
228
229 if (mv2222_is_sgmii_capable(phydev)) {
230 priv->line_interface = PHY_INTERFACE_MODE_SGMII;
231 changed = true;
232 }
233
234 break;
235 case PHY_INTERFACE_MODE_1000BASEX:
236 case PHY_INTERFACE_MODE_SGMII:
237 if (mv2222_is_10g_capable(phydev)) {
238 priv->line_interface = PHY_INTERFACE_MODE_10GBASER;
239 changed = true;
240 }
241
242 break;
243 default:
244 return -EINVAL;
245 }
246
247 if (changed) {
248 ret = mv2222_config_line(phydev);
249 if (ret < 0)
250 return ret;
251 }
252
253 return 0;
254}
255
256static int mv2222_setup_forced(struct phy_device *phydev)
257{
258 struct mv2222_data *priv = phydev->priv;
259 int ret;
260
261 if (priv->line_interface == PHY_INTERFACE_MODE_10GBASER) {
262 if (phydev->speed < SPEED_10000 &&
263 phydev->speed != SPEED_UNKNOWN) {
264 ret = mv2222_swap_line_type(phydev);
265 if (ret < 0)
266 return ret;
267 }
268 }
269
270 if (priv->line_interface == PHY_INTERFACE_MODE_SGMII) {
271 ret = mv2222_set_sgmii_speed(phydev);
272 if (ret < 0)
273 return ret;
274 }
275
276 return mv2222_disable_aneg(phydev);
277}
278
279static int mv2222_config_aneg(struct phy_device *phydev)
280{
281 struct mv2222_data *priv = phydev->priv;
282 int ret, adv;
283
284 /* SFP is not present, do nothing */
285 if (priv->line_interface == PHY_INTERFACE_MODE_NA)
286 return 0;
287
288 if (phydev->autoneg == AUTONEG_DISABLE ||
289 priv->line_interface == PHY_INTERFACE_MODE_10GBASER)
290 return mv2222_setup_forced(phydev);
291
292 adv = linkmode_adv_to_mii_adv_x(priv->supported,
293 ETHTOOL_LINK_MODE_1000baseX_Full_BIT);
294
295 ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_ADVERTISE,
296 ADVERTISE_1000XFULL |
297 ADVERTISE_1000XPAUSE | ADVERTISE_1000XPSE_ASYM,
298 adv);
299 if (ret < 0)
300 return ret;
301
302 return mv2222_enable_aneg(phydev);
303}
304
305static int mv2222_aneg_done(struct phy_device *phydev)
306{
307 int ret;
308
309 if (mv2222_is_10g_capable(phydev)) {
310 ret = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_STAT1);
311 if (ret < 0)
312 return ret;
313
314 if (ret & MDIO_STAT1_LSTATUS)
315 return 1;
316 }
317
318 ret = phy_read_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_STAT);
319 if (ret < 0)
320 return ret;
321
322 return (ret & BMSR_ANEGCOMPLETE);
323}
324
325/* Returns negative on error, 0 if link is down, 1 if link is up */
326static int mv2222_read_status_10g(struct phy_device *phydev)
327{
328 static int timeout;
329 int val, link = 0;
330
331 val = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_STAT1);
332 if (val < 0)
333 return val;
334
335 if (val & MDIO_STAT1_LSTATUS) {
336 link = 1;
337
338 /* 10GBASE-R do not support auto-negotiation */
339 phydev->autoneg = AUTONEG_DISABLE;
340 phydev->speed = SPEED_10000;
341 phydev->duplex = DUPLEX_FULL;
342 } else {
343 if (phydev->autoneg == AUTONEG_ENABLE) {
344 timeout++;
345
346 if (timeout > AUTONEG_TIMEOUT) {
347 timeout = 0;
348
349 val = mv2222_swap_line_type(phydev);
350 if (val < 0)
351 return val;
352
353 return mv2222_config_aneg(phydev);
354 }
355 }
356 }
357
358 return link;
359}
360
361/* Returns negative on error, 0 if link is down, 1 if link is up */
362static int mv2222_read_status_1g(struct phy_device *phydev)
363{
364 static int timeout;
365 int val, link = 0;
366
367 val = phy_read_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_STAT);
368 if (val < 0)
369 return val;
370
371 if (phydev->autoneg == AUTONEG_ENABLE &&
372 !(val & BMSR_ANEGCOMPLETE)) {
373 timeout++;
374
375 if (timeout > AUTONEG_TIMEOUT) {
376 timeout = 0;
377
378 val = mv2222_swap_line_type(phydev);
379 if (val < 0)
380 return val;
381
382 return mv2222_config_aneg(phydev);
383 }
384
385 return 0;
386 }
387
388 if (!(val & BMSR_LSTATUS))
389 return 0;
390
391 link = 1;
392
393 val = phy_read_mmd(phydev, MDIO_MMD_PCS, MV_1GBX_PHY_STAT);
394 if (val < 0)
395 return val;
396
397 if (val & MV_1GBX_PHY_STAT_AN_RESOLVED) {
398 if (val & MV_1GBX_PHY_STAT_DUPLEX)
399 phydev->duplex = DUPLEX_FULL;
400 else
401 phydev->duplex = DUPLEX_HALF;
402
403 if (val & MV_1GBX_PHY_STAT_SPEED1000)
404 phydev->speed = SPEED_1000;
405 else if (val & MV_1GBX_PHY_STAT_SPEED100)
406 phydev->speed = SPEED_100;
407 else
408 phydev->speed = SPEED_10;
409 }
410
411 return link;
412}
413
414static bool mv2222_link_is_operational(struct phy_device *phydev)
415{
416 struct mv2222_data *priv = phydev->priv;
417 int val;
418
419 val = phy_read_mmd(phydev, MDIO_MMD_PMAPMD, MV_RX_SIGNAL_DETECT);
420 if (val < 0 || !(val & MV_RX_SIGNAL_DETECT_GLOBAL))
421 return false;
422
423 if (phydev->sfp_bus && !priv->sfp_link)
424 return false;
425
426 return true;
427}
428
429static int mv2222_read_status(struct phy_device *phydev)
430{
431 struct mv2222_data *priv = phydev->priv;
432 int link;
433
434 phydev->link = 0;
435 phydev->speed = SPEED_UNKNOWN;
436 phydev->duplex = DUPLEX_UNKNOWN;
437
438 if (!mv2222_link_is_operational(phydev))
439 return 0;
440
441 if (priv->line_interface == PHY_INTERFACE_MODE_10GBASER)
442 link = mv2222_read_status_10g(phydev);
443 else
444 link = mv2222_read_status_1g(phydev);
445
446 if (link < 0)
447 return link;
448
449 phydev->link = link;
450
451 return 0;
452}
453
454static int mv2222_resume(struct phy_device *phydev)
455{
456 return mv2222_tx_enable(phydev);
457}
458
459static int mv2222_suspend(struct phy_device *phydev)
460{
461 return mv2222_tx_disable(phydev);
462}
463
464static int mv2222_get_features(struct phy_device *phydev)
465{
466 /* All supported linkmodes are set at probe */
467
468 return 0;
469}
470
471static int mv2222_config_init(struct phy_device *phydev)
472{
473 if (phydev->interface != PHY_INTERFACE_MODE_XAUI)
474 return -EINVAL;
475
476 return 0;
477}
478
479static int mv2222_sfp_insert(void *upstream, const struct sfp_eeprom_id *id)
480{
481 struct phy_device *phydev = upstream;
482 phy_interface_t sfp_interface;
483 struct mv2222_data *priv;
484 struct device *dev;
485 int ret;
486
487 __ETHTOOL_DECLARE_LINK_MODE_MASK(sfp_supported) = { 0, };
488
489 priv = (struct mv2222_data *)phydev->priv;
490 dev = &phydev->mdio.dev;
491
492 sfp_parse_support(phydev->sfp_bus, id, sfp_supported);
493 sfp_interface = sfp_select_interface(phydev->sfp_bus, sfp_supported);
494
495 dev_info(dev, "%s SFP module inserted\n", phy_modes(sfp_interface));
496
497 if (sfp_interface != PHY_INTERFACE_MODE_10GBASER &&
498 sfp_interface != PHY_INTERFACE_MODE_1000BASEX &&
499 sfp_interface != PHY_INTERFACE_MODE_SGMII) {
500 dev_err(dev, "Incompatible SFP module inserted\n");
501
502 return -EINVAL;
503 }
504
505 priv->line_interface = sfp_interface;
506 linkmode_and(priv->supported, phydev->supported, sfp_supported);
507
508 ret = mv2222_config_line(phydev);
509 if (ret < 0)
510 return ret;
511
512 if (mutex_trylock(&phydev->lock)) {
513 ret = mv2222_config_aneg(phydev);
514 mutex_unlock(&phydev->lock);
515 }
516
517 return ret;
518}
519
520static void mv2222_sfp_remove(void *upstream)
521{
522 struct phy_device *phydev = upstream;
523 struct mv2222_data *priv;
524
525 priv = (struct mv2222_data *)phydev->priv;
526
527 priv->line_interface = PHY_INTERFACE_MODE_NA;
528 linkmode_zero(priv->supported);
529}
530
531static void mv2222_sfp_link_up(void *upstream)
532{
533 struct phy_device *phydev = upstream;
534 struct mv2222_data *priv;
535
536 priv = phydev->priv;
537 priv->sfp_link = true;
538}
539
540static void mv2222_sfp_link_down(void *upstream)
541{
542 struct phy_device *phydev = upstream;
543 struct mv2222_data *priv;
544
545 priv = phydev->priv;
546 priv->sfp_link = false;
547}
548
549static const struct sfp_upstream_ops sfp_phy_ops = {
550 .module_insert = mv2222_sfp_insert,
551 .module_remove = mv2222_sfp_remove,
552 .link_up = mv2222_sfp_link_up,
553 .link_down = mv2222_sfp_link_down,
554 .attach = phy_sfp_attach,
555 .detach = phy_sfp_detach,
556};
557
558static int mv2222_probe(struct phy_device *phydev)
559{
560 struct device *dev = &phydev->mdio.dev;
561 struct mv2222_data *priv = NULL;
562
563 __ETHTOOL_DECLARE_LINK_MODE_MASK(supported) = { 0, };
564
565 linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, supported);
566 linkmode_set_bit(ETHTOOL_LINK_MODE_Pause_BIT, supported);
567 linkmode_set_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, supported);
568 linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT, supported);
569 linkmode_set_bit(ETHTOOL_LINK_MODE_TP_BIT, supported);
570 linkmode_set_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, supported);
571 linkmode_set_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, supported);
572 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, supported);
573 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, supported);
574 linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT, supported);
575 linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, supported);
576 linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT, supported);
577 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT, supported);
578 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseCR_Full_BIT, supported);
579 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseSR_Full_BIT, supported);
580 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseLR_Full_BIT, supported);
581 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseLRM_Full_BIT, supported);
582 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseER_Full_BIT, supported);
583
584 linkmode_copy(phydev->supported, supported);
585
586 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
587 if (!priv)
588 return -ENOMEM;
589
590 priv->line_interface = PHY_INTERFACE_MODE_NA;
591 phydev->priv = priv;
592
593 return phy_sfp_probe(phydev, &sfp_phy_ops);
594}
595
596static struct phy_driver mv2222_drivers[] = {
597 {
598 .phy_id = MARVELL_PHY_ID_88X2222,
599 .phy_id_mask = MARVELL_PHY_ID_MASK,
600 .name = "Marvell 88X2222",
601 .get_features = mv2222_get_features,
602 .soft_reset = mv2222_soft_reset,
603 .config_init = mv2222_config_init,
604 .config_aneg = mv2222_config_aneg,
605 .aneg_done = mv2222_aneg_done,
606 .probe = mv2222_probe,
607 .suspend = mv2222_suspend,
608 .resume = mv2222_resume,
609 .read_status = mv2222_read_status,
610 },
611};
612module_phy_driver(mv2222_drivers);
613
614static struct mdio_device_id __maybe_unused mv2222_tbl[] = {
615 { MARVELL_PHY_ID_88X2222, MARVELL_PHY_ID_MASK },
616 { }
617};
618MODULE_DEVICE_TABLE(mdio, mv2222_tbl);
619
620MODULE_DESCRIPTION("Marvell 88x2222 ethernet transceiver driver");
621MODULE_LICENSE("GPL");