Loading...
1// SPDX-License-Identifier: GPL-2.0+
2/* drivers/net/phy/realtek.c
3 *
4 * Driver for Realtek PHYs
5 *
6 * Author: Johnson Leung <r58129@freescale.com>
7 *
8 * Copyright (c) 2004 Freescale Semiconductor, Inc.
9 */
10#include <linux/bitops.h>
11#include <linux/of.h>
12#include <linux/phy.h>
13#include <linux/module.h>
14#include <linux/delay.h>
15#include <linux/clk.h>
16
17#define RTL821x_PHYSR 0x11
18#define RTL821x_PHYSR_DUPLEX BIT(13)
19#define RTL821x_PHYSR_SPEED GENMASK(15, 14)
20
21#define RTL821x_INER 0x12
22#define RTL8211B_INER_INIT 0x6400
23#define RTL8211E_INER_LINK_STATUS BIT(10)
24#define RTL8211F_INER_LINK_STATUS BIT(4)
25
26#define RTL821x_INSR 0x13
27
28#define RTL821x_EXT_PAGE_SELECT 0x1e
29#define RTL821x_PAGE_SELECT 0x1f
30
31#define RTL8211F_PHYCR1 0x18
32#define RTL8211F_PHYCR2 0x19
33#define RTL8211F_INSR 0x1d
34
35#define RTL8211F_LEDCR 0x10
36#define RTL8211F_LEDCR_MODE BIT(15)
37#define RTL8211F_LEDCR_ACT_TXRX BIT(4)
38#define RTL8211F_LEDCR_LINK_1000 BIT(3)
39#define RTL8211F_LEDCR_LINK_100 BIT(1)
40#define RTL8211F_LEDCR_LINK_10 BIT(0)
41#define RTL8211F_LEDCR_MASK GENMASK(4, 0)
42#define RTL8211F_LEDCR_SHIFT 5
43
44#define RTL8211F_TX_DELAY BIT(8)
45#define RTL8211F_RX_DELAY BIT(3)
46
47#define RTL8211F_ALDPS_PLL_OFF BIT(1)
48#define RTL8211F_ALDPS_ENABLE BIT(2)
49#define RTL8211F_ALDPS_XTAL_OFF BIT(12)
50
51#define RTL8211E_CTRL_DELAY BIT(13)
52#define RTL8211E_TX_DELAY BIT(12)
53#define RTL8211E_RX_DELAY BIT(11)
54
55#define RTL8211F_CLKOUT_EN BIT(0)
56
57#define RTL8201F_ISR 0x1e
58#define RTL8201F_ISR_ANERR BIT(15)
59#define RTL8201F_ISR_DUPLEX BIT(13)
60#define RTL8201F_ISR_LINK BIT(11)
61#define RTL8201F_ISR_MASK (RTL8201F_ISR_ANERR | \
62 RTL8201F_ISR_DUPLEX | \
63 RTL8201F_ISR_LINK)
64#define RTL8201F_IER 0x13
65
66#define RTL822X_VND1_SERDES_OPTION 0x697a
67#define RTL822X_VND1_SERDES_OPTION_MODE_MASK GENMASK(5, 0)
68#define RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII 0
69#define RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX 2
70
71#define RTL822X_VND1_SERDES_CTRL3 0x7580
72#define RTL822X_VND1_SERDES_CTRL3_MODE_MASK GENMASK(5, 0)
73#define RTL822X_VND1_SERDES_CTRL3_MODE_SGMII 0x02
74#define RTL822X_VND1_SERDES_CTRL3_MODE_2500BASEX 0x16
75
76/* RTL822X_VND2_XXXXX registers are only accessible when phydev->is_c45
77 * is set, they cannot be accessed by C45-over-C22.
78 */
79#define RTL822X_VND2_GBCR 0xa412
80
81#define RTL822X_VND2_GANLPAR 0xa414
82
83#define RTL8366RB_POWER_SAVE 0x15
84#define RTL8366RB_POWER_SAVE_ON BIT(12)
85
86#define RTL9000A_GINMR 0x14
87#define RTL9000A_GINMR_LINK_STATUS BIT(4)
88
89#define RTL_VND2_PHYSR 0xa434
90#define RTL_VND2_PHYSR_DUPLEX BIT(3)
91#define RTL_VND2_PHYSR_SPEEDL GENMASK(5, 4)
92#define RTL_VND2_PHYSR_SPEEDH GENMASK(10, 9)
93#define RTL_VND2_PHYSR_MASTER BIT(11)
94#define RTL_VND2_PHYSR_SPEED_MASK (RTL_VND2_PHYSR_SPEEDL | RTL_VND2_PHYSR_SPEEDH)
95
96#define RTL_GENERIC_PHYID 0x001cc800
97#define RTL_8211FVD_PHYID 0x001cc878
98#define RTL_8221B 0x001cc840
99#define RTL_8221B_VB_CG 0x001cc849
100#define RTL_8221B_VN_CG 0x001cc84a
101#define RTL_8251B 0x001cc862
102
103#define RTL8211F_LED_COUNT 3
104
105MODULE_DESCRIPTION("Realtek PHY driver");
106MODULE_AUTHOR("Johnson Leung");
107MODULE_LICENSE("GPL");
108
109struct rtl821x_priv {
110 u16 phycr1;
111 u16 phycr2;
112 bool has_phycr2;
113 struct clk *clk;
114};
115
116static int rtl821x_read_page(struct phy_device *phydev)
117{
118 return __phy_read(phydev, RTL821x_PAGE_SELECT);
119}
120
121static int rtl821x_write_page(struct phy_device *phydev, int page)
122{
123 return __phy_write(phydev, RTL821x_PAGE_SELECT, page);
124}
125
126static int rtl821x_probe(struct phy_device *phydev)
127{
128 struct device *dev = &phydev->mdio.dev;
129 struct rtl821x_priv *priv;
130 u32 phy_id = phydev->drv->phy_id;
131 int ret;
132
133 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
134 if (!priv)
135 return -ENOMEM;
136
137 priv->clk = devm_clk_get_optional_enabled(dev, NULL);
138 if (IS_ERR(priv->clk))
139 return dev_err_probe(dev, PTR_ERR(priv->clk),
140 "failed to get phy clock\n");
141
142 ret = phy_read_paged(phydev, 0xa43, RTL8211F_PHYCR1);
143 if (ret < 0)
144 return ret;
145
146 priv->phycr1 = ret & (RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF);
147 if (of_property_read_bool(dev->of_node, "realtek,aldps-enable"))
148 priv->phycr1 |= RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF;
149
150 priv->has_phycr2 = !(phy_id == RTL_8211FVD_PHYID);
151 if (priv->has_phycr2) {
152 ret = phy_read_paged(phydev, 0xa43, RTL8211F_PHYCR2);
153 if (ret < 0)
154 return ret;
155
156 priv->phycr2 = ret & RTL8211F_CLKOUT_EN;
157 if (of_property_read_bool(dev->of_node, "realtek,clkout-disable"))
158 priv->phycr2 &= ~RTL8211F_CLKOUT_EN;
159 }
160
161 phydev->priv = priv;
162
163 return 0;
164}
165
166static int rtl8201_ack_interrupt(struct phy_device *phydev)
167{
168 int err;
169
170 err = phy_read(phydev, RTL8201F_ISR);
171
172 return (err < 0) ? err : 0;
173}
174
175static int rtl821x_ack_interrupt(struct phy_device *phydev)
176{
177 int err;
178
179 err = phy_read(phydev, RTL821x_INSR);
180
181 return (err < 0) ? err : 0;
182}
183
184static int rtl8211f_ack_interrupt(struct phy_device *phydev)
185{
186 int err;
187
188 err = phy_read_paged(phydev, 0xa43, RTL8211F_INSR);
189
190 return (err < 0) ? err : 0;
191}
192
193static int rtl8201_config_intr(struct phy_device *phydev)
194{
195 u16 val;
196 int err;
197
198 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
199 err = rtl8201_ack_interrupt(phydev);
200 if (err)
201 return err;
202
203 val = BIT(13) | BIT(12) | BIT(11);
204 err = phy_write_paged(phydev, 0x7, RTL8201F_IER, val);
205 } else {
206 val = 0;
207 err = phy_write_paged(phydev, 0x7, RTL8201F_IER, val);
208 if (err)
209 return err;
210
211 err = rtl8201_ack_interrupt(phydev);
212 }
213
214 return err;
215}
216
217static int rtl8211b_config_intr(struct phy_device *phydev)
218{
219 int err;
220
221 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
222 err = rtl821x_ack_interrupt(phydev);
223 if (err)
224 return err;
225
226 err = phy_write(phydev, RTL821x_INER,
227 RTL8211B_INER_INIT);
228 } else {
229 err = phy_write(phydev, RTL821x_INER, 0);
230 if (err)
231 return err;
232
233 err = rtl821x_ack_interrupt(phydev);
234 }
235
236 return err;
237}
238
239static int rtl8211e_config_intr(struct phy_device *phydev)
240{
241 int err;
242
243 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
244 err = rtl821x_ack_interrupt(phydev);
245 if (err)
246 return err;
247
248 err = phy_write(phydev, RTL821x_INER,
249 RTL8211E_INER_LINK_STATUS);
250 } else {
251 err = phy_write(phydev, RTL821x_INER, 0);
252 if (err)
253 return err;
254
255 err = rtl821x_ack_interrupt(phydev);
256 }
257
258 return err;
259}
260
261static int rtl8211f_config_intr(struct phy_device *phydev)
262{
263 u16 val;
264 int err;
265
266 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
267 err = rtl8211f_ack_interrupt(phydev);
268 if (err)
269 return err;
270
271 val = RTL8211F_INER_LINK_STATUS;
272 err = phy_write_paged(phydev, 0xa42, RTL821x_INER, val);
273 } else {
274 val = 0;
275 err = phy_write_paged(phydev, 0xa42, RTL821x_INER, val);
276 if (err)
277 return err;
278
279 err = rtl8211f_ack_interrupt(phydev);
280 }
281
282 return err;
283}
284
285static irqreturn_t rtl8201_handle_interrupt(struct phy_device *phydev)
286{
287 int irq_status;
288
289 irq_status = phy_read(phydev, RTL8201F_ISR);
290 if (irq_status < 0) {
291 phy_error(phydev);
292 return IRQ_NONE;
293 }
294
295 if (!(irq_status & RTL8201F_ISR_MASK))
296 return IRQ_NONE;
297
298 phy_trigger_machine(phydev);
299
300 return IRQ_HANDLED;
301}
302
303static irqreturn_t rtl821x_handle_interrupt(struct phy_device *phydev)
304{
305 int irq_status, irq_enabled;
306
307 irq_status = phy_read(phydev, RTL821x_INSR);
308 if (irq_status < 0) {
309 phy_error(phydev);
310 return IRQ_NONE;
311 }
312
313 irq_enabled = phy_read(phydev, RTL821x_INER);
314 if (irq_enabled < 0) {
315 phy_error(phydev);
316 return IRQ_NONE;
317 }
318
319 if (!(irq_status & irq_enabled))
320 return IRQ_NONE;
321
322 phy_trigger_machine(phydev);
323
324 return IRQ_HANDLED;
325}
326
327static irqreturn_t rtl8211f_handle_interrupt(struct phy_device *phydev)
328{
329 int irq_status;
330
331 irq_status = phy_read_paged(phydev, 0xa43, RTL8211F_INSR);
332 if (irq_status < 0) {
333 phy_error(phydev);
334 return IRQ_NONE;
335 }
336
337 if (!(irq_status & RTL8211F_INER_LINK_STATUS))
338 return IRQ_NONE;
339
340 phy_trigger_machine(phydev);
341
342 return IRQ_HANDLED;
343}
344
345static int rtl8211_config_aneg(struct phy_device *phydev)
346{
347 int ret;
348
349 ret = genphy_config_aneg(phydev);
350 if (ret < 0)
351 return ret;
352
353 /* Quirk was copied from vendor driver. Unfortunately it includes no
354 * description of the magic numbers.
355 */
356 if (phydev->speed == SPEED_100 && phydev->autoneg == AUTONEG_DISABLE) {
357 phy_write(phydev, 0x17, 0x2138);
358 phy_write(phydev, 0x0e, 0x0260);
359 } else {
360 phy_write(phydev, 0x17, 0x2108);
361 phy_write(phydev, 0x0e, 0x0000);
362 }
363
364 return 0;
365}
366
367static int rtl8211c_config_init(struct phy_device *phydev)
368{
369 /* RTL8211C has an issue when operating in Gigabit slave mode */
370 return phy_set_bits(phydev, MII_CTRL1000,
371 CTL1000_ENABLE_MASTER | CTL1000_AS_MASTER);
372}
373
374static int rtl8211f_config_init(struct phy_device *phydev)
375{
376 struct rtl821x_priv *priv = phydev->priv;
377 struct device *dev = &phydev->mdio.dev;
378 u16 val_txdly, val_rxdly;
379 int ret;
380
381 ret = phy_modify_paged_changed(phydev, 0xa43, RTL8211F_PHYCR1,
382 RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF,
383 priv->phycr1);
384 if (ret < 0) {
385 dev_err(dev, "aldps mode configuration failed: %pe\n",
386 ERR_PTR(ret));
387 return ret;
388 }
389
390 switch (phydev->interface) {
391 case PHY_INTERFACE_MODE_RGMII:
392 val_txdly = 0;
393 val_rxdly = 0;
394 break;
395
396 case PHY_INTERFACE_MODE_RGMII_RXID:
397 val_txdly = 0;
398 val_rxdly = RTL8211F_RX_DELAY;
399 break;
400
401 case PHY_INTERFACE_MODE_RGMII_TXID:
402 val_txdly = RTL8211F_TX_DELAY;
403 val_rxdly = 0;
404 break;
405
406 case PHY_INTERFACE_MODE_RGMII_ID:
407 val_txdly = RTL8211F_TX_DELAY;
408 val_rxdly = RTL8211F_RX_DELAY;
409 break;
410
411 default: /* the rest of the modes imply leaving delay as is. */
412 return 0;
413 }
414
415 ret = phy_modify_paged_changed(phydev, 0xd08, 0x11, RTL8211F_TX_DELAY,
416 val_txdly);
417 if (ret < 0) {
418 dev_err(dev, "Failed to update the TX delay register\n");
419 return ret;
420 } else if (ret) {
421 dev_dbg(dev,
422 "%s 2ns TX delay (and changing the value from pin-strapping RXD1 or the bootloader)\n",
423 val_txdly ? "Enabling" : "Disabling");
424 } else {
425 dev_dbg(dev,
426 "2ns TX delay was already %s (by pin-strapping RXD1 or bootloader configuration)\n",
427 val_txdly ? "enabled" : "disabled");
428 }
429
430 ret = phy_modify_paged_changed(phydev, 0xd08, 0x15, RTL8211F_RX_DELAY,
431 val_rxdly);
432 if (ret < 0) {
433 dev_err(dev, "Failed to update the RX delay register\n");
434 return ret;
435 } else if (ret) {
436 dev_dbg(dev,
437 "%s 2ns RX delay (and changing the value from pin-strapping RXD0 or the bootloader)\n",
438 val_rxdly ? "Enabling" : "Disabling");
439 } else {
440 dev_dbg(dev,
441 "2ns RX delay was already %s (by pin-strapping RXD0 or bootloader configuration)\n",
442 val_rxdly ? "enabled" : "disabled");
443 }
444
445 if (priv->has_phycr2) {
446 ret = phy_modify_paged(phydev, 0xa43, RTL8211F_PHYCR2,
447 RTL8211F_CLKOUT_EN, priv->phycr2);
448 if (ret < 0) {
449 dev_err(dev, "clkout configuration failed: %pe\n",
450 ERR_PTR(ret));
451 return ret;
452 }
453
454 return genphy_soft_reset(phydev);
455 }
456
457 return 0;
458}
459
460static int rtl821x_suspend(struct phy_device *phydev)
461{
462 struct rtl821x_priv *priv = phydev->priv;
463 int ret = 0;
464
465 if (!phydev->wol_enabled) {
466 ret = genphy_suspend(phydev);
467
468 if (ret)
469 return ret;
470
471 clk_disable_unprepare(priv->clk);
472 }
473
474 return ret;
475}
476
477static int rtl821x_resume(struct phy_device *phydev)
478{
479 struct rtl821x_priv *priv = phydev->priv;
480 int ret;
481
482 if (!phydev->wol_enabled)
483 clk_prepare_enable(priv->clk);
484
485 ret = genphy_resume(phydev);
486 if (ret < 0)
487 return ret;
488
489 msleep(20);
490
491 return 0;
492}
493
494static int rtl8211f_led_hw_is_supported(struct phy_device *phydev, u8 index,
495 unsigned long rules)
496{
497 const unsigned long mask = BIT(TRIGGER_NETDEV_LINK_10) |
498 BIT(TRIGGER_NETDEV_LINK_100) |
499 BIT(TRIGGER_NETDEV_LINK_1000) |
500 BIT(TRIGGER_NETDEV_RX) |
501 BIT(TRIGGER_NETDEV_TX);
502
503 /* The RTL8211F PHY supports these LED settings on up to three LEDs:
504 * - Link: Configurable subset of 10/100/1000 link rates
505 * - Active: Blink on activity, RX or TX is not differentiated
506 * The Active option has two modes, A and B:
507 * - A: Link and Active indication at configurable, but matching,
508 * subset of 10/100/1000 link rates
509 * - B: Link indication at configurable subset of 10/100/1000 link
510 * rates and Active indication always at all three 10+100+1000
511 * link rates.
512 * This code currently uses mode B only.
513 */
514
515 if (index >= RTL8211F_LED_COUNT)
516 return -EINVAL;
517
518 /* Filter out any other unsupported triggers. */
519 if (rules & ~mask)
520 return -EOPNOTSUPP;
521
522 /* RX and TX are not differentiated, either both are set or not set. */
523 if (!(rules & BIT(TRIGGER_NETDEV_RX)) ^ !(rules & BIT(TRIGGER_NETDEV_TX)))
524 return -EOPNOTSUPP;
525
526 return 0;
527}
528
529static int rtl8211f_led_hw_control_get(struct phy_device *phydev, u8 index,
530 unsigned long *rules)
531{
532 int val;
533
534 if (index >= RTL8211F_LED_COUNT)
535 return -EINVAL;
536
537 val = phy_read_paged(phydev, 0xd04, RTL8211F_LEDCR);
538 if (val < 0)
539 return val;
540
541 val >>= RTL8211F_LEDCR_SHIFT * index;
542 val &= RTL8211F_LEDCR_MASK;
543
544 if (val & RTL8211F_LEDCR_LINK_10)
545 set_bit(TRIGGER_NETDEV_LINK_10, rules);
546
547 if (val & RTL8211F_LEDCR_LINK_100)
548 set_bit(TRIGGER_NETDEV_LINK_100, rules);
549
550 if (val & RTL8211F_LEDCR_LINK_1000)
551 set_bit(TRIGGER_NETDEV_LINK_1000, rules);
552
553 if (val & RTL8211F_LEDCR_ACT_TXRX) {
554 set_bit(TRIGGER_NETDEV_RX, rules);
555 set_bit(TRIGGER_NETDEV_TX, rules);
556 }
557
558 return 0;
559}
560
561static int rtl8211f_led_hw_control_set(struct phy_device *phydev, u8 index,
562 unsigned long rules)
563{
564 const u16 mask = RTL8211F_LEDCR_MASK << (RTL8211F_LEDCR_SHIFT * index);
565 u16 reg = 0;
566
567 if (index >= RTL8211F_LED_COUNT)
568 return -EINVAL;
569
570 if (test_bit(TRIGGER_NETDEV_LINK_10, &rules))
571 reg |= RTL8211F_LEDCR_LINK_10;
572
573 if (test_bit(TRIGGER_NETDEV_LINK_100, &rules))
574 reg |= RTL8211F_LEDCR_LINK_100;
575
576 if (test_bit(TRIGGER_NETDEV_LINK_1000, &rules))
577 reg |= RTL8211F_LEDCR_LINK_1000;
578
579 if (test_bit(TRIGGER_NETDEV_RX, &rules) ||
580 test_bit(TRIGGER_NETDEV_TX, &rules)) {
581 reg |= RTL8211F_LEDCR_ACT_TXRX;
582 }
583
584 reg <<= RTL8211F_LEDCR_SHIFT * index;
585 reg |= RTL8211F_LEDCR_MODE; /* Mode B */
586
587 return phy_modify_paged(phydev, 0xd04, RTL8211F_LEDCR, mask, reg);
588}
589
590static int rtl8211e_config_init(struct phy_device *phydev)
591{
592 int ret = 0, oldpage;
593 u16 val;
594
595 /* enable TX/RX delay for rgmii-* modes, and disable them for rgmii. */
596 switch (phydev->interface) {
597 case PHY_INTERFACE_MODE_RGMII:
598 val = RTL8211E_CTRL_DELAY | 0;
599 break;
600 case PHY_INTERFACE_MODE_RGMII_ID:
601 val = RTL8211E_CTRL_DELAY | RTL8211E_TX_DELAY | RTL8211E_RX_DELAY;
602 break;
603 case PHY_INTERFACE_MODE_RGMII_RXID:
604 val = RTL8211E_CTRL_DELAY | RTL8211E_RX_DELAY;
605 break;
606 case PHY_INTERFACE_MODE_RGMII_TXID:
607 val = RTL8211E_CTRL_DELAY | RTL8211E_TX_DELAY;
608 break;
609 default: /* the rest of the modes imply leaving delays as is. */
610 return 0;
611 }
612
613 /* According to a sample driver there is a 0x1c config register on the
614 * 0xa4 extension page (0x7) layout. It can be used to disable/enable
615 * the RX/TX delays otherwise controlled by RXDLY/TXDLY pins.
616 * The configuration register definition:
617 * 14 = reserved
618 * 13 = Force Tx RX Delay controlled by bit12 bit11,
619 * 12 = RX Delay, 11 = TX Delay
620 * 10:0 = Test && debug settings reserved by realtek
621 */
622 oldpage = phy_select_page(phydev, 0x7);
623 if (oldpage < 0)
624 goto err_restore_page;
625
626 ret = __phy_write(phydev, RTL821x_EXT_PAGE_SELECT, 0xa4);
627 if (ret)
628 goto err_restore_page;
629
630 ret = __phy_modify(phydev, 0x1c, RTL8211E_CTRL_DELAY
631 | RTL8211E_TX_DELAY | RTL8211E_RX_DELAY,
632 val);
633
634err_restore_page:
635 return phy_restore_page(phydev, oldpage, ret);
636}
637
638static int rtl8211b_suspend(struct phy_device *phydev)
639{
640 phy_write(phydev, MII_MMD_DATA, BIT(9));
641
642 return genphy_suspend(phydev);
643}
644
645static int rtl8211b_resume(struct phy_device *phydev)
646{
647 phy_write(phydev, MII_MMD_DATA, 0);
648
649 return genphy_resume(phydev);
650}
651
652static int rtl8366rb_config_init(struct phy_device *phydev)
653{
654 int ret;
655
656 ret = phy_set_bits(phydev, RTL8366RB_POWER_SAVE,
657 RTL8366RB_POWER_SAVE_ON);
658 if (ret) {
659 dev_err(&phydev->mdio.dev,
660 "error enabling power management\n");
661 }
662
663 return ret;
664}
665
666/* get actual speed to cover the downshift case */
667static void rtlgen_decode_physr(struct phy_device *phydev, int val)
668{
669 /* bit 3
670 * 0: Half Duplex
671 * 1: Full Duplex
672 */
673 if (val & RTL_VND2_PHYSR_DUPLEX)
674 phydev->duplex = DUPLEX_FULL;
675 else
676 phydev->duplex = DUPLEX_HALF;
677
678 switch (val & RTL_VND2_PHYSR_SPEED_MASK) {
679 case 0x0000:
680 phydev->speed = SPEED_10;
681 break;
682 case 0x0010:
683 phydev->speed = SPEED_100;
684 break;
685 case 0x0020:
686 phydev->speed = SPEED_1000;
687 break;
688 case 0x0200:
689 phydev->speed = SPEED_10000;
690 break;
691 case 0x0210:
692 phydev->speed = SPEED_2500;
693 break;
694 case 0x0220:
695 phydev->speed = SPEED_5000;
696 break;
697 default:
698 break;
699 }
700
701 /* bit 11
702 * 0: Slave Mode
703 * 1: Master Mode
704 */
705 if (phydev->speed >= 1000) {
706 if (val & RTL_VND2_PHYSR_MASTER)
707 phydev->master_slave_state = MASTER_SLAVE_STATE_MASTER;
708 else
709 phydev->master_slave_state = MASTER_SLAVE_STATE_SLAVE;
710 } else {
711 phydev->master_slave_state = MASTER_SLAVE_STATE_UNSUPPORTED;
712 }
713}
714
715static int rtlgen_read_status(struct phy_device *phydev)
716{
717 int ret, val;
718
719 ret = genphy_read_status(phydev);
720 if (ret < 0)
721 return ret;
722
723 if (!phydev->link)
724 return 0;
725
726 val = phy_read_paged(phydev, 0xa43, 0x12);
727 if (val < 0)
728 return val;
729
730 rtlgen_decode_physr(phydev, val);
731
732 return 0;
733}
734
735static int rtlgen_read_mmd(struct phy_device *phydev, int devnum, u16 regnum)
736{
737 int ret;
738
739 if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE) {
740 rtl821x_write_page(phydev, 0xa5c);
741 ret = __phy_read(phydev, 0x12);
742 rtl821x_write_page(phydev, 0);
743 } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV) {
744 rtl821x_write_page(phydev, 0xa5d);
745 ret = __phy_read(phydev, 0x10);
746 rtl821x_write_page(phydev, 0);
747 } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE) {
748 rtl821x_write_page(phydev, 0xa5d);
749 ret = __phy_read(phydev, 0x11);
750 rtl821x_write_page(phydev, 0);
751 } else {
752 ret = -EOPNOTSUPP;
753 }
754
755 return ret;
756}
757
758static int rtlgen_write_mmd(struct phy_device *phydev, int devnum, u16 regnum,
759 u16 val)
760{
761 int ret;
762
763 if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV) {
764 rtl821x_write_page(phydev, 0xa5d);
765 ret = __phy_write(phydev, 0x10, val);
766 rtl821x_write_page(phydev, 0);
767 } else {
768 ret = -EOPNOTSUPP;
769 }
770
771 return ret;
772}
773
774static int rtl822x_read_mmd(struct phy_device *phydev, int devnum, u16 regnum)
775{
776 int ret = rtlgen_read_mmd(phydev, devnum, regnum);
777
778 if (ret != -EOPNOTSUPP)
779 return ret;
780
781 if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE2) {
782 rtl821x_write_page(phydev, 0xa6e);
783 ret = __phy_read(phydev, 0x16);
784 rtl821x_write_page(phydev, 0);
785 } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2) {
786 rtl821x_write_page(phydev, 0xa6d);
787 ret = __phy_read(phydev, 0x12);
788 rtl821x_write_page(phydev, 0);
789 } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE2) {
790 rtl821x_write_page(phydev, 0xa6d);
791 ret = __phy_read(phydev, 0x10);
792 rtl821x_write_page(phydev, 0);
793 }
794
795 return ret;
796}
797
798static int rtl822x_write_mmd(struct phy_device *phydev, int devnum, u16 regnum,
799 u16 val)
800{
801 int ret = rtlgen_write_mmd(phydev, devnum, regnum, val);
802
803 if (ret != -EOPNOTSUPP)
804 return ret;
805
806 if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2) {
807 rtl821x_write_page(phydev, 0xa6d);
808 ret = __phy_write(phydev, 0x12, val);
809 rtl821x_write_page(phydev, 0);
810 }
811
812 return ret;
813}
814
815static int rtl822xb_config_init(struct phy_device *phydev)
816{
817 bool has_2500, has_sgmii;
818 u16 mode;
819 int ret;
820
821 has_2500 = test_bit(PHY_INTERFACE_MODE_2500BASEX,
822 phydev->host_interfaces) ||
823 phydev->interface == PHY_INTERFACE_MODE_2500BASEX;
824
825 has_sgmii = test_bit(PHY_INTERFACE_MODE_SGMII,
826 phydev->host_interfaces) ||
827 phydev->interface == PHY_INTERFACE_MODE_SGMII;
828
829 /* fill in possible interfaces */
830 __assign_bit(PHY_INTERFACE_MODE_2500BASEX, phydev->possible_interfaces,
831 has_2500);
832 __assign_bit(PHY_INTERFACE_MODE_SGMII, phydev->possible_interfaces,
833 has_sgmii);
834
835 if (!has_2500 && !has_sgmii)
836 return 0;
837
838 /* determine SerDes option mode */
839 if (has_2500 && !has_sgmii) {
840 mode = RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX;
841 phydev->rate_matching = RATE_MATCH_PAUSE;
842 } else {
843 mode = RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII;
844 phydev->rate_matching = RATE_MATCH_NONE;
845 }
846
847 /* the following sequence with magic numbers sets up the SerDes
848 * option mode
849 */
850 ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x75f3, 0);
851 if (ret < 0)
852 return ret;
853
854 ret = phy_modify_mmd_changed(phydev, MDIO_MMD_VEND1,
855 RTL822X_VND1_SERDES_OPTION,
856 RTL822X_VND1_SERDES_OPTION_MODE_MASK,
857 mode);
858 if (ret < 0)
859 return ret;
860
861 ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6a04, 0x0503);
862 if (ret < 0)
863 return ret;
864
865 ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6f10, 0xd455);
866 if (ret < 0)
867 return ret;
868
869 return phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6f11, 0x8020);
870}
871
872static int rtl822xb_get_rate_matching(struct phy_device *phydev,
873 phy_interface_t iface)
874{
875 int val;
876
877 /* Only rate matching at 2500base-x */
878 if (iface != PHY_INTERFACE_MODE_2500BASEX)
879 return RATE_MATCH_NONE;
880
881 val = phy_read_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_OPTION);
882 if (val < 0)
883 return val;
884
885 if ((val & RTL822X_VND1_SERDES_OPTION_MODE_MASK) ==
886 RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX)
887 return RATE_MATCH_PAUSE;
888
889 /* RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII */
890 return RATE_MATCH_NONE;
891}
892
893static int rtl822x_get_features(struct phy_device *phydev)
894{
895 int val;
896
897 val = phy_read_paged(phydev, 0xa61, 0x13);
898 if (val < 0)
899 return val;
900
901 linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT,
902 phydev->supported, val & MDIO_PMA_SPEED_2_5G);
903 linkmode_mod_bit(ETHTOOL_LINK_MODE_5000baseT_Full_BIT,
904 phydev->supported, val & MDIO_PMA_SPEED_5G);
905 linkmode_mod_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
906 phydev->supported, val & MDIO_SPEED_10G);
907
908 return genphy_read_abilities(phydev);
909}
910
911static int rtl822x_config_aneg(struct phy_device *phydev)
912{
913 int ret = 0;
914
915 if (phydev->autoneg == AUTONEG_ENABLE) {
916 u16 adv = linkmode_adv_to_mii_10gbt_adv_t(phydev->advertising);
917
918 ret = phy_modify_paged_changed(phydev, 0xa5d, 0x12,
919 MDIO_AN_10GBT_CTRL_ADV2_5G |
920 MDIO_AN_10GBT_CTRL_ADV5G,
921 adv);
922 if (ret < 0)
923 return ret;
924 }
925
926 return __genphy_config_aneg(phydev, ret);
927}
928
929static void rtl822xb_update_interface(struct phy_device *phydev)
930{
931 int val;
932
933 if (!phydev->link)
934 return;
935
936 /* Change interface according to serdes mode */
937 val = phy_read_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_CTRL3);
938 if (val < 0)
939 return;
940
941 switch (val & RTL822X_VND1_SERDES_CTRL3_MODE_MASK) {
942 case RTL822X_VND1_SERDES_CTRL3_MODE_2500BASEX:
943 phydev->interface = PHY_INTERFACE_MODE_2500BASEX;
944 break;
945 case RTL822X_VND1_SERDES_CTRL3_MODE_SGMII:
946 phydev->interface = PHY_INTERFACE_MODE_SGMII;
947 break;
948 }
949}
950
951static int rtl822x_read_status(struct phy_device *phydev)
952{
953 int lpadv, ret;
954
955 mii_10gbt_stat_mod_linkmode_lpa_t(phydev->lp_advertising, 0);
956
957 ret = rtlgen_read_status(phydev);
958 if (ret < 0)
959 return ret;
960
961 if (phydev->autoneg == AUTONEG_DISABLE ||
962 !phydev->autoneg_complete)
963 return 0;
964
965 lpadv = phy_read_paged(phydev, 0xa5d, 0x13);
966 if (lpadv < 0)
967 return lpadv;
968
969 mii_10gbt_stat_mod_linkmode_lpa_t(phydev->lp_advertising, lpadv);
970
971 return 0;
972}
973
974static int rtl822xb_read_status(struct phy_device *phydev)
975{
976 int ret;
977
978 ret = rtl822x_read_status(phydev);
979 if (ret < 0)
980 return ret;
981
982 rtl822xb_update_interface(phydev);
983
984 return 0;
985}
986
987static int rtl822x_c45_get_features(struct phy_device *phydev)
988{
989 linkmode_set_bit(ETHTOOL_LINK_MODE_TP_BIT,
990 phydev->supported);
991
992 return genphy_c45_pma_read_abilities(phydev);
993}
994
995static int rtl822x_c45_config_aneg(struct phy_device *phydev)
996{
997 bool changed = false;
998 int ret, val;
999
1000 if (phydev->autoneg == AUTONEG_DISABLE)
1001 return genphy_c45_pma_setup_forced(phydev);
1002
1003 ret = genphy_c45_an_config_aneg(phydev);
1004 if (ret < 0)
1005 return ret;
1006 if (ret > 0)
1007 changed = true;
1008
1009 val = linkmode_adv_to_mii_ctrl1000_t(phydev->advertising);
1010
1011 /* Vendor register as C45 has no standardized support for 1000BaseT */
1012 ret = phy_modify_mmd_changed(phydev, MDIO_MMD_VEND2, RTL822X_VND2_GBCR,
1013 ADVERTISE_1000FULL, val);
1014 if (ret < 0)
1015 return ret;
1016 if (ret > 0)
1017 changed = true;
1018
1019 return genphy_c45_check_and_restart_aneg(phydev, changed);
1020}
1021
1022static int rtl822x_c45_read_status(struct phy_device *phydev)
1023{
1024 int ret, val;
1025
1026 /* Vendor register as C45 has no standardized support for 1000BaseT */
1027 if (phydev->autoneg == AUTONEG_ENABLE && genphy_c45_aneg_done(phydev)) {
1028 val = phy_read_mmd(phydev, MDIO_MMD_VEND2,
1029 RTL822X_VND2_GANLPAR);
1030 if (val < 0)
1031 return val;
1032 } else {
1033 val = 0;
1034 }
1035 mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, val);
1036
1037 ret = genphy_c45_read_status(phydev);
1038 if (ret < 0)
1039 return ret;
1040
1041 if (!phydev->link) {
1042 phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN;
1043 return 0;
1044 }
1045
1046 /* Read actual speed from vendor register. */
1047 val = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL_VND2_PHYSR);
1048 if (val < 0)
1049 return val;
1050
1051 rtlgen_decode_physr(phydev, val);
1052
1053 return 0;
1054}
1055
1056static int rtl822xb_c45_read_status(struct phy_device *phydev)
1057{
1058 int ret;
1059
1060 ret = rtl822x_c45_read_status(phydev);
1061 if (ret < 0)
1062 return ret;
1063
1064 rtl822xb_update_interface(phydev);
1065
1066 return 0;
1067}
1068
1069static bool rtlgen_supports_2_5gbps(struct phy_device *phydev)
1070{
1071 int val;
1072
1073 phy_write(phydev, RTL821x_PAGE_SELECT, 0xa61);
1074 val = phy_read(phydev, 0x13);
1075 phy_write(phydev, RTL821x_PAGE_SELECT, 0);
1076
1077 return val >= 0 && val & MDIO_PMA_SPEED_2_5G;
1078}
1079
1080/* On internal PHY's MMD reads over C22 always return 0.
1081 * Check a MMD register which is known to be non-zero.
1082 */
1083static bool rtlgen_supports_mmd(struct phy_device *phydev)
1084{
1085 int val;
1086
1087 phy_lock_mdio_bus(phydev);
1088 __phy_write(phydev, MII_MMD_CTRL, MDIO_MMD_PCS);
1089 __phy_write(phydev, MII_MMD_DATA, MDIO_PCS_EEE_ABLE);
1090 __phy_write(phydev, MII_MMD_CTRL, MDIO_MMD_PCS | MII_MMD_CTRL_NOINCR);
1091 val = __phy_read(phydev, MII_MMD_DATA);
1092 phy_unlock_mdio_bus(phydev);
1093
1094 return val > 0;
1095}
1096
1097static int rtlgen_match_phy_device(struct phy_device *phydev)
1098{
1099 return phydev->phy_id == RTL_GENERIC_PHYID &&
1100 !rtlgen_supports_2_5gbps(phydev);
1101}
1102
1103static int rtl8226_match_phy_device(struct phy_device *phydev)
1104{
1105 return phydev->phy_id == RTL_GENERIC_PHYID &&
1106 rtlgen_supports_2_5gbps(phydev) &&
1107 rtlgen_supports_mmd(phydev);
1108}
1109
1110static int rtlgen_is_c45_match(struct phy_device *phydev, unsigned int id,
1111 bool is_c45)
1112{
1113 if (phydev->is_c45)
1114 return is_c45 && (id == phydev->c45_ids.device_ids[1]);
1115 else
1116 return !is_c45 && (id == phydev->phy_id);
1117}
1118
1119static int rtl8221b_match_phy_device(struct phy_device *phydev)
1120{
1121 return phydev->phy_id == RTL_8221B && rtlgen_supports_mmd(phydev);
1122}
1123
1124static int rtl8221b_vb_cg_c22_match_phy_device(struct phy_device *phydev)
1125{
1126 return rtlgen_is_c45_match(phydev, RTL_8221B_VB_CG, false);
1127}
1128
1129static int rtl8221b_vb_cg_c45_match_phy_device(struct phy_device *phydev)
1130{
1131 return rtlgen_is_c45_match(phydev, RTL_8221B_VB_CG, true);
1132}
1133
1134static int rtl8221b_vn_cg_c22_match_phy_device(struct phy_device *phydev)
1135{
1136 return rtlgen_is_c45_match(phydev, RTL_8221B_VN_CG, false);
1137}
1138
1139static int rtl8221b_vn_cg_c45_match_phy_device(struct phy_device *phydev)
1140{
1141 return rtlgen_is_c45_match(phydev, RTL_8221B_VN_CG, true);
1142}
1143
1144static int rtl_internal_nbaset_match_phy_device(struct phy_device *phydev)
1145{
1146 if (phydev->is_c45)
1147 return false;
1148
1149 switch (phydev->phy_id) {
1150 case RTL_GENERIC_PHYID:
1151 case RTL_8221B:
1152 case RTL_8251B:
1153 case 0x001cc841:
1154 break;
1155 default:
1156 return false;
1157 }
1158
1159 return rtlgen_supports_2_5gbps(phydev) && !rtlgen_supports_mmd(phydev);
1160}
1161
1162static int rtl8251b_c45_match_phy_device(struct phy_device *phydev)
1163{
1164 return rtlgen_is_c45_match(phydev, RTL_8251B, true);
1165}
1166
1167static int rtlgen_resume(struct phy_device *phydev)
1168{
1169 int ret = genphy_resume(phydev);
1170
1171 /* Internal PHY's from RTL8168h up may not be instantly ready */
1172 msleep(20);
1173
1174 return ret;
1175}
1176
1177static int rtlgen_c45_resume(struct phy_device *phydev)
1178{
1179 int ret = genphy_c45_pma_resume(phydev);
1180
1181 msleep(20);
1182
1183 return ret;
1184}
1185
1186static int rtl9000a_config_init(struct phy_device *phydev)
1187{
1188 phydev->autoneg = AUTONEG_DISABLE;
1189 phydev->speed = SPEED_100;
1190 phydev->duplex = DUPLEX_FULL;
1191
1192 return 0;
1193}
1194
1195static int rtl9000a_config_aneg(struct phy_device *phydev)
1196{
1197 int ret;
1198 u16 ctl = 0;
1199
1200 switch (phydev->master_slave_set) {
1201 case MASTER_SLAVE_CFG_MASTER_FORCE:
1202 ctl |= CTL1000_AS_MASTER;
1203 break;
1204 case MASTER_SLAVE_CFG_SLAVE_FORCE:
1205 break;
1206 case MASTER_SLAVE_CFG_UNKNOWN:
1207 case MASTER_SLAVE_CFG_UNSUPPORTED:
1208 return 0;
1209 default:
1210 phydev_warn(phydev, "Unsupported Master/Slave mode\n");
1211 return -EOPNOTSUPP;
1212 }
1213
1214 ret = phy_modify_changed(phydev, MII_CTRL1000, CTL1000_AS_MASTER, ctl);
1215 if (ret == 1)
1216 ret = genphy_soft_reset(phydev);
1217
1218 return ret;
1219}
1220
1221static int rtl9000a_read_status(struct phy_device *phydev)
1222{
1223 int ret;
1224
1225 phydev->master_slave_get = MASTER_SLAVE_CFG_UNKNOWN;
1226 phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN;
1227
1228 ret = genphy_update_link(phydev);
1229 if (ret)
1230 return ret;
1231
1232 ret = phy_read(phydev, MII_CTRL1000);
1233 if (ret < 0)
1234 return ret;
1235 if (ret & CTL1000_AS_MASTER)
1236 phydev->master_slave_get = MASTER_SLAVE_CFG_MASTER_FORCE;
1237 else
1238 phydev->master_slave_get = MASTER_SLAVE_CFG_SLAVE_FORCE;
1239
1240 ret = phy_read(phydev, MII_STAT1000);
1241 if (ret < 0)
1242 return ret;
1243 if (ret & LPA_1000MSRES)
1244 phydev->master_slave_state = MASTER_SLAVE_STATE_MASTER;
1245 else
1246 phydev->master_slave_state = MASTER_SLAVE_STATE_SLAVE;
1247
1248 return 0;
1249}
1250
1251static int rtl9000a_ack_interrupt(struct phy_device *phydev)
1252{
1253 int err;
1254
1255 err = phy_read(phydev, RTL8211F_INSR);
1256
1257 return (err < 0) ? err : 0;
1258}
1259
1260static int rtl9000a_config_intr(struct phy_device *phydev)
1261{
1262 u16 val;
1263 int err;
1264
1265 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
1266 err = rtl9000a_ack_interrupt(phydev);
1267 if (err)
1268 return err;
1269
1270 val = (u16)~RTL9000A_GINMR_LINK_STATUS;
1271 err = phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
1272 } else {
1273 val = ~0;
1274 err = phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
1275 if (err)
1276 return err;
1277
1278 err = rtl9000a_ack_interrupt(phydev);
1279 }
1280
1281 return phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
1282}
1283
1284static irqreturn_t rtl9000a_handle_interrupt(struct phy_device *phydev)
1285{
1286 int irq_status;
1287
1288 irq_status = phy_read(phydev, RTL8211F_INSR);
1289 if (irq_status < 0) {
1290 phy_error(phydev);
1291 return IRQ_NONE;
1292 }
1293
1294 if (!(irq_status & RTL8211F_INER_LINK_STATUS))
1295 return IRQ_NONE;
1296
1297 phy_trigger_machine(phydev);
1298
1299 return IRQ_HANDLED;
1300}
1301
1302static struct phy_driver realtek_drvs[] = {
1303 {
1304 PHY_ID_MATCH_EXACT(0x00008201),
1305 .name = "RTL8201CP Ethernet",
1306 .read_page = rtl821x_read_page,
1307 .write_page = rtl821x_write_page,
1308 }, {
1309 PHY_ID_MATCH_EXACT(0x001cc816),
1310 .name = "RTL8201F Fast Ethernet",
1311 .config_intr = &rtl8201_config_intr,
1312 .handle_interrupt = rtl8201_handle_interrupt,
1313 .suspend = genphy_suspend,
1314 .resume = genphy_resume,
1315 .read_page = rtl821x_read_page,
1316 .write_page = rtl821x_write_page,
1317 }, {
1318 PHY_ID_MATCH_MODEL(0x001cc880),
1319 .name = "RTL8208 Fast Ethernet",
1320 .read_mmd = genphy_read_mmd_unsupported,
1321 .write_mmd = genphy_write_mmd_unsupported,
1322 .suspend = genphy_suspend,
1323 .resume = genphy_resume,
1324 .read_page = rtl821x_read_page,
1325 .write_page = rtl821x_write_page,
1326 }, {
1327 PHY_ID_MATCH_EXACT(0x001cc910),
1328 .name = "RTL8211 Gigabit Ethernet",
1329 .config_aneg = rtl8211_config_aneg,
1330 .read_mmd = &genphy_read_mmd_unsupported,
1331 .write_mmd = &genphy_write_mmd_unsupported,
1332 .read_page = rtl821x_read_page,
1333 .write_page = rtl821x_write_page,
1334 }, {
1335 PHY_ID_MATCH_EXACT(0x001cc912),
1336 .name = "RTL8211B Gigabit Ethernet",
1337 .config_intr = &rtl8211b_config_intr,
1338 .handle_interrupt = rtl821x_handle_interrupt,
1339 .read_mmd = &genphy_read_mmd_unsupported,
1340 .write_mmd = &genphy_write_mmd_unsupported,
1341 .suspend = rtl8211b_suspend,
1342 .resume = rtl8211b_resume,
1343 .read_page = rtl821x_read_page,
1344 .write_page = rtl821x_write_page,
1345 }, {
1346 PHY_ID_MATCH_EXACT(0x001cc913),
1347 .name = "RTL8211C Gigabit Ethernet",
1348 .config_init = rtl8211c_config_init,
1349 .read_mmd = &genphy_read_mmd_unsupported,
1350 .write_mmd = &genphy_write_mmd_unsupported,
1351 .read_page = rtl821x_read_page,
1352 .write_page = rtl821x_write_page,
1353 }, {
1354 PHY_ID_MATCH_EXACT(0x001cc914),
1355 .name = "RTL8211DN Gigabit Ethernet",
1356 .config_intr = rtl8211e_config_intr,
1357 .handle_interrupt = rtl821x_handle_interrupt,
1358 .suspend = genphy_suspend,
1359 .resume = genphy_resume,
1360 .read_page = rtl821x_read_page,
1361 .write_page = rtl821x_write_page,
1362 }, {
1363 PHY_ID_MATCH_EXACT(0x001cc915),
1364 .name = "RTL8211E Gigabit Ethernet",
1365 .config_init = &rtl8211e_config_init,
1366 .config_intr = &rtl8211e_config_intr,
1367 .handle_interrupt = rtl821x_handle_interrupt,
1368 .suspend = genphy_suspend,
1369 .resume = genphy_resume,
1370 .read_page = rtl821x_read_page,
1371 .write_page = rtl821x_write_page,
1372 }, {
1373 PHY_ID_MATCH_EXACT(0x001cc916),
1374 .name = "RTL8211F Gigabit Ethernet",
1375 .probe = rtl821x_probe,
1376 .config_init = &rtl8211f_config_init,
1377 .read_status = rtlgen_read_status,
1378 .config_intr = &rtl8211f_config_intr,
1379 .handle_interrupt = rtl8211f_handle_interrupt,
1380 .suspend = rtl821x_suspend,
1381 .resume = rtl821x_resume,
1382 .read_page = rtl821x_read_page,
1383 .write_page = rtl821x_write_page,
1384 .flags = PHY_ALWAYS_CALL_SUSPEND,
1385 .led_hw_is_supported = rtl8211f_led_hw_is_supported,
1386 .led_hw_control_get = rtl8211f_led_hw_control_get,
1387 .led_hw_control_set = rtl8211f_led_hw_control_set,
1388 }, {
1389 PHY_ID_MATCH_EXACT(RTL_8211FVD_PHYID),
1390 .name = "RTL8211F-VD Gigabit Ethernet",
1391 .probe = rtl821x_probe,
1392 .config_init = &rtl8211f_config_init,
1393 .read_status = rtlgen_read_status,
1394 .config_intr = &rtl8211f_config_intr,
1395 .handle_interrupt = rtl8211f_handle_interrupt,
1396 .suspend = rtl821x_suspend,
1397 .resume = rtl821x_resume,
1398 .read_page = rtl821x_read_page,
1399 .write_page = rtl821x_write_page,
1400 .flags = PHY_ALWAYS_CALL_SUSPEND,
1401 }, {
1402 .name = "Generic FE-GE Realtek PHY",
1403 .match_phy_device = rtlgen_match_phy_device,
1404 .read_status = rtlgen_read_status,
1405 .suspend = genphy_suspend,
1406 .resume = rtlgen_resume,
1407 .read_page = rtl821x_read_page,
1408 .write_page = rtl821x_write_page,
1409 .read_mmd = rtlgen_read_mmd,
1410 .write_mmd = rtlgen_write_mmd,
1411 }, {
1412 .name = "RTL8226 2.5Gbps PHY",
1413 .match_phy_device = rtl8226_match_phy_device,
1414 .get_features = rtl822x_get_features,
1415 .config_aneg = rtl822x_config_aneg,
1416 .read_status = rtl822x_read_status,
1417 .suspend = genphy_suspend,
1418 .resume = rtlgen_resume,
1419 .read_page = rtl821x_read_page,
1420 .write_page = rtl821x_write_page,
1421 }, {
1422 .match_phy_device = rtl8221b_match_phy_device,
1423 .name = "RTL8226B_RTL8221B 2.5Gbps PHY",
1424 .get_features = rtl822x_get_features,
1425 .config_aneg = rtl822x_config_aneg,
1426 .config_init = rtl822xb_config_init,
1427 .get_rate_matching = rtl822xb_get_rate_matching,
1428 .read_status = rtl822xb_read_status,
1429 .suspend = genphy_suspend,
1430 .resume = rtlgen_resume,
1431 .read_page = rtl821x_read_page,
1432 .write_page = rtl821x_write_page,
1433 }, {
1434 PHY_ID_MATCH_EXACT(0x001cc838),
1435 .name = "RTL8226-CG 2.5Gbps PHY",
1436 .get_features = rtl822x_get_features,
1437 .config_aneg = rtl822x_config_aneg,
1438 .read_status = rtl822x_read_status,
1439 .suspend = genphy_suspend,
1440 .resume = rtlgen_resume,
1441 .read_page = rtl821x_read_page,
1442 .write_page = rtl821x_write_page,
1443 }, {
1444 PHY_ID_MATCH_EXACT(0x001cc848),
1445 .name = "RTL8226B-CG_RTL8221B-CG 2.5Gbps PHY",
1446 .get_features = rtl822x_get_features,
1447 .config_aneg = rtl822x_config_aneg,
1448 .config_init = rtl822xb_config_init,
1449 .get_rate_matching = rtl822xb_get_rate_matching,
1450 .read_status = rtl822xb_read_status,
1451 .suspend = genphy_suspend,
1452 .resume = rtlgen_resume,
1453 .read_page = rtl821x_read_page,
1454 .write_page = rtl821x_write_page,
1455 }, {
1456 .match_phy_device = rtl8221b_vb_cg_c22_match_phy_device,
1457 .name = "RTL8221B-VB-CG 2.5Gbps PHY (C22)",
1458 .get_features = rtl822x_get_features,
1459 .config_aneg = rtl822x_config_aneg,
1460 .config_init = rtl822xb_config_init,
1461 .get_rate_matching = rtl822xb_get_rate_matching,
1462 .read_status = rtl822xb_read_status,
1463 .suspend = genphy_suspend,
1464 .resume = rtlgen_resume,
1465 .read_page = rtl821x_read_page,
1466 .write_page = rtl821x_write_page,
1467 }, {
1468 .match_phy_device = rtl8221b_vb_cg_c45_match_phy_device,
1469 .name = "RTL8221B-VB-CG 2.5Gbps PHY (C45)",
1470 .config_init = rtl822xb_config_init,
1471 .get_rate_matching = rtl822xb_get_rate_matching,
1472 .get_features = rtl822x_c45_get_features,
1473 .config_aneg = rtl822x_c45_config_aneg,
1474 .read_status = rtl822xb_c45_read_status,
1475 .suspend = genphy_c45_pma_suspend,
1476 .resume = rtlgen_c45_resume,
1477 }, {
1478 .match_phy_device = rtl8221b_vn_cg_c22_match_phy_device,
1479 .name = "RTL8221B-VM-CG 2.5Gbps PHY (C22)",
1480 .get_features = rtl822x_get_features,
1481 .config_aneg = rtl822x_config_aneg,
1482 .config_init = rtl822xb_config_init,
1483 .get_rate_matching = rtl822xb_get_rate_matching,
1484 .read_status = rtl822xb_read_status,
1485 .suspend = genphy_suspend,
1486 .resume = rtlgen_resume,
1487 .read_page = rtl821x_read_page,
1488 .write_page = rtl821x_write_page,
1489 }, {
1490 .match_phy_device = rtl8221b_vn_cg_c45_match_phy_device,
1491 .name = "RTL8221B-VN-CG 2.5Gbps PHY (C45)",
1492 .config_init = rtl822xb_config_init,
1493 .get_rate_matching = rtl822xb_get_rate_matching,
1494 .get_features = rtl822x_c45_get_features,
1495 .config_aneg = rtl822x_c45_config_aneg,
1496 .read_status = rtl822xb_c45_read_status,
1497 .suspend = genphy_c45_pma_suspend,
1498 .resume = rtlgen_c45_resume,
1499 }, {
1500 .match_phy_device = rtl8251b_c45_match_phy_device,
1501 .name = "RTL8251B 5Gbps PHY",
1502 .get_features = rtl822x_get_features,
1503 .config_aneg = rtl822x_config_aneg,
1504 .read_status = rtl822x_read_status,
1505 .suspend = genphy_suspend,
1506 .resume = rtlgen_resume,
1507 .read_page = rtl821x_read_page,
1508 .write_page = rtl821x_write_page,
1509 }, {
1510 .match_phy_device = rtl_internal_nbaset_match_phy_device,
1511 .name = "Realtek Internal NBASE-T PHY",
1512 .flags = PHY_IS_INTERNAL,
1513 .get_features = rtl822x_get_features,
1514 .config_aneg = rtl822x_config_aneg,
1515 .read_status = rtl822x_read_status,
1516 .suspend = genphy_suspend,
1517 .resume = rtlgen_resume,
1518 .read_page = rtl821x_read_page,
1519 .write_page = rtl821x_write_page,
1520 .read_mmd = rtl822x_read_mmd,
1521 .write_mmd = rtl822x_write_mmd,
1522 }, {
1523 PHY_ID_MATCH_EXACT(0x001ccad0),
1524 .name = "RTL8224 2.5Gbps PHY",
1525 .get_features = rtl822x_c45_get_features,
1526 .config_aneg = rtl822x_c45_config_aneg,
1527 .read_status = rtl822x_c45_read_status,
1528 .suspend = genphy_c45_pma_suspend,
1529 .resume = rtlgen_c45_resume,
1530 }, {
1531 PHY_ID_MATCH_EXACT(0x001cc961),
1532 .name = "RTL8366RB Gigabit Ethernet",
1533 .config_init = &rtl8366rb_config_init,
1534 /* These interrupts are handled by the irq controller
1535 * embedded inside the RTL8366RB, they get unmasked when the
1536 * irq is requested and ACKed by reading the status register,
1537 * which is done by the irqchip code.
1538 */
1539 .config_intr = genphy_no_config_intr,
1540 .handle_interrupt = genphy_handle_interrupt_no_ack,
1541 .suspend = genphy_suspend,
1542 .resume = genphy_resume,
1543 }, {
1544 PHY_ID_MATCH_EXACT(0x001ccb00),
1545 .name = "RTL9000AA_RTL9000AN Ethernet",
1546 .features = PHY_BASIC_T1_FEATURES,
1547 .config_init = rtl9000a_config_init,
1548 .config_aneg = rtl9000a_config_aneg,
1549 .read_status = rtl9000a_read_status,
1550 .config_intr = rtl9000a_config_intr,
1551 .handle_interrupt = rtl9000a_handle_interrupt,
1552 .suspend = genphy_suspend,
1553 .resume = genphy_resume,
1554 .read_page = rtl821x_read_page,
1555 .write_page = rtl821x_write_page,
1556 }, {
1557 PHY_ID_MATCH_EXACT(0x001cc942),
1558 .name = "RTL8365MB-VC Gigabit Ethernet",
1559 /* Interrupt handling analogous to RTL8366RB */
1560 .config_intr = genphy_no_config_intr,
1561 .handle_interrupt = genphy_handle_interrupt_no_ack,
1562 .suspend = genphy_suspend,
1563 .resume = genphy_resume,
1564 }, {
1565 PHY_ID_MATCH_EXACT(0x001cc960),
1566 .name = "RTL8366S Gigabit Ethernet",
1567 .suspend = genphy_suspend,
1568 .resume = genphy_resume,
1569 .read_mmd = genphy_read_mmd_unsupported,
1570 .write_mmd = genphy_write_mmd_unsupported,
1571 },
1572};
1573
1574module_phy_driver(realtek_drvs);
1575
1576static const struct mdio_device_id __maybe_unused realtek_tbl[] = {
1577 { PHY_ID_MATCH_VENDOR(0x001cc800) },
1578 { }
1579};
1580
1581MODULE_DEVICE_TABLE(mdio, realtek_tbl);
1// SPDX-License-Identifier: GPL-2.0+
2/* drivers/net/phy/realtek.c
3 *
4 * Driver for Realtek PHYs
5 *
6 * Author: Johnson Leung <r58129@freescale.com>
7 *
8 * Copyright (c) 2004 Freescale Semiconductor, Inc.
9 */
10#include <linux/bitops.h>
11#include <linux/of.h>
12#include <linux/phy.h>
13#include <linux/module.h>
14#include <linux/delay.h>
15
16#define RTL821x_PHYSR 0x11
17#define RTL821x_PHYSR_DUPLEX BIT(13)
18#define RTL821x_PHYSR_SPEED GENMASK(15, 14)
19
20#define RTL821x_INER 0x12
21#define RTL8211B_INER_INIT 0x6400
22#define RTL8211E_INER_LINK_STATUS BIT(10)
23#define RTL8211F_INER_LINK_STATUS BIT(4)
24
25#define RTL821x_INSR 0x13
26
27#define RTL821x_EXT_PAGE_SELECT 0x1e
28#define RTL821x_PAGE_SELECT 0x1f
29
30#define RTL8211F_PHYCR1 0x18
31#define RTL8211F_PHYCR2 0x19
32#define RTL8211F_INSR 0x1d
33
34#define RTL8211F_TX_DELAY BIT(8)
35#define RTL8211F_RX_DELAY BIT(3)
36
37#define RTL8211F_ALDPS_PLL_OFF BIT(1)
38#define RTL8211F_ALDPS_ENABLE BIT(2)
39#define RTL8211F_ALDPS_XTAL_OFF BIT(12)
40
41#define RTL8211E_CTRL_DELAY BIT(13)
42#define RTL8211E_TX_DELAY BIT(12)
43#define RTL8211E_RX_DELAY BIT(11)
44
45#define RTL8211F_CLKOUT_EN BIT(0)
46
47#define RTL8201F_ISR 0x1e
48#define RTL8201F_ISR_ANERR BIT(15)
49#define RTL8201F_ISR_DUPLEX BIT(13)
50#define RTL8201F_ISR_LINK BIT(11)
51#define RTL8201F_ISR_MASK (RTL8201F_ISR_ANERR | \
52 RTL8201F_ISR_DUPLEX | \
53 RTL8201F_ISR_LINK)
54#define RTL8201F_IER 0x13
55
56#define RTL8366RB_POWER_SAVE 0x15
57#define RTL8366RB_POWER_SAVE_ON BIT(12)
58
59#define RTL_SUPPORTS_5000FULL BIT(14)
60#define RTL_SUPPORTS_2500FULL BIT(13)
61#define RTL_SUPPORTS_10000FULL BIT(0)
62#define RTL_ADV_2500FULL BIT(7)
63#define RTL_LPADV_10000FULL BIT(11)
64#define RTL_LPADV_5000FULL BIT(6)
65#define RTL_LPADV_2500FULL BIT(5)
66
67#define RTL9000A_GINMR 0x14
68#define RTL9000A_GINMR_LINK_STATUS BIT(4)
69
70#define RTLGEN_SPEED_MASK 0x0630
71
72#define RTL_GENERIC_PHYID 0x001cc800
73
74MODULE_DESCRIPTION("Realtek PHY driver");
75MODULE_AUTHOR("Johnson Leung");
76MODULE_LICENSE("GPL");
77
78struct rtl821x_priv {
79 u16 phycr1;
80 u16 phycr2;
81};
82
83static int rtl821x_read_page(struct phy_device *phydev)
84{
85 return __phy_read(phydev, RTL821x_PAGE_SELECT);
86}
87
88static int rtl821x_write_page(struct phy_device *phydev, int page)
89{
90 return __phy_write(phydev, RTL821x_PAGE_SELECT, page);
91}
92
93static int rtl821x_probe(struct phy_device *phydev)
94{
95 struct device *dev = &phydev->mdio.dev;
96 struct rtl821x_priv *priv;
97 int ret;
98
99 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
100 if (!priv)
101 return -ENOMEM;
102
103 ret = phy_read_paged(phydev, 0xa43, RTL8211F_PHYCR1);
104 if (ret < 0)
105 return ret;
106
107 priv->phycr1 = ret & (RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF);
108 if (of_property_read_bool(dev->of_node, "realtek,aldps-enable"))
109 priv->phycr1 |= RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF;
110
111 ret = phy_read_paged(phydev, 0xa43, RTL8211F_PHYCR2);
112 if (ret < 0)
113 return ret;
114
115 priv->phycr2 = ret & RTL8211F_CLKOUT_EN;
116 if (of_property_read_bool(dev->of_node, "realtek,clkout-disable"))
117 priv->phycr2 &= ~RTL8211F_CLKOUT_EN;
118
119 phydev->priv = priv;
120
121 return 0;
122}
123
124static int rtl8201_ack_interrupt(struct phy_device *phydev)
125{
126 int err;
127
128 err = phy_read(phydev, RTL8201F_ISR);
129
130 return (err < 0) ? err : 0;
131}
132
133static int rtl821x_ack_interrupt(struct phy_device *phydev)
134{
135 int err;
136
137 err = phy_read(phydev, RTL821x_INSR);
138
139 return (err < 0) ? err : 0;
140}
141
142static int rtl8211f_ack_interrupt(struct phy_device *phydev)
143{
144 int err;
145
146 err = phy_read_paged(phydev, 0xa43, RTL8211F_INSR);
147
148 return (err < 0) ? err : 0;
149}
150
151static int rtl8201_config_intr(struct phy_device *phydev)
152{
153 u16 val;
154 int err;
155
156 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
157 err = rtl8201_ack_interrupt(phydev);
158 if (err)
159 return err;
160
161 val = BIT(13) | BIT(12) | BIT(11);
162 err = phy_write_paged(phydev, 0x7, RTL8201F_IER, val);
163 } else {
164 val = 0;
165 err = phy_write_paged(phydev, 0x7, RTL8201F_IER, val);
166 if (err)
167 return err;
168
169 err = rtl8201_ack_interrupt(phydev);
170 }
171
172 return err;
173}
174
175static int rtl8211b_config_intr(struct phy_device *phydev)
176{
177 int err;
178
179 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
180 err = rtl821x_ack_interrupt(phydev);
181 if (err)
182 return err;
183
184 err = phy_write(phydev, RTL821x_INER,
185 RTL8211B_INER_INIT);
186 } else {
187 err = phy_write(phydev, RTL821x_INER, 0);
188 if (err)
189 return err;
190
191 err = rtl821x_ack_interrupt(phydev);
192 }
193
194 return err;
195}
196
197static int rtl8211e_config_intr(struct phy_device *phydev)
198{
199 int err;
200
201 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
202 err = rtl821x_ack_interrupt(phydev);
203 if (err)
204 return err;
205
206 err = phy_write(phydev, RTL821x_INER,
207 RTL8211E_INER_LINK_STATUS);
208 } else {
209 err = phy_write(phydev, RTL821x_INER, 0);
210 if (err)
211 return err;
212
213 err = rtl821x_ack_interrupt(phydev);
214 }
215
216 return err;
217}
218
219static int rtl8211f_config_intr(struct phy_device *phydev)
220{
221 u16 val;
222 int err;
223
224 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
225 err = rtl8211f_ack_interrupt(phydev);
226 if (err)
227 return err;
228
229 val = RTL8211F_INER_LINK_STATUS;
230 err = phy_write_paged(phydev, 0xa42, RTL821x_INER, val);
231 } else {
232 val = 0;
233 err = phy_write_paged(phydev, 0xa42, RTL821x_INER, val);
234 if (err)
235 return err;
236
237 err = rtl8211f_ack_interrupt(phydev);
238 }
239
240 return err;
241}
242
243static irqreturn_t rtl8201_handle_interrupt(struct phy_device *phydev)
244{
245 int irq_status;
246
247 irq_status = phy_read(phydev, RTL8201F_ISR);
248 if (irq_status < 0) {
249 phy_error(phydev);
250 return IRQ_NONE;
251 }
252
253 if (!(irq_status & RTL8201F_ISR_MASK))
254 return IRQ_NONE;
255
256 phy_trigger_machine(phydev);
257
258 return IRQ_HANDLED;
259}
260
261static irqreturn_t rtl821x_handle_interrupt(struct phy_device *phydev)
262{
263 int irq_status, irq_enabled;
264
265 irq_status = phy_read(phydev, RTL821x_INSR);
266 if (irq_status < 0) {
267 phy_error(phydev);
268 return IRQ_NONE;
269 }
270
271 irq_enabled = phy_read(phydev, RTL821x_INER);
272 if (irq_enabled < 0) {
273 phy_error(phydev);
274 return IRQ_NONE;
275 }
276
277 if (!(irq_status & irq_enabled))
278 return IRQ_NONE;
279
280 phy_trigger_machine(phydev);
281
282 return IRQ_HANDLED;
283}
284
285static irqreturn_t rtl8211f_handle_interrupt(struct phy_device *phydev)
286{
287 int irq_status;
288
289 irq_status = phy_read_paged(phydev, 0xa43, RTL8211F_INSR);
290 if (irq_status < 0) {
291 phy_error(phydev);
292 return IRQ_NONE;
293 }
294
295 if (!(irq_status & RTL8211F_INER_LINK_STATUS))
296 return IRQ_NONE;
297
298 phy_trigger_machine(phydev);
299
300 return IRQ_HANDLED;
301}
302
303static int rtl8211_config_aneg(struct phy_device *phydev)
304{
305 int ret;
306
307 ret = genphy_config_aneg(phydev);
308 if (ret < 0)
309 return ret;
310
311 /* Quirk was copied from vendor driver. Unfortunately it includes no
312 * description of the magic numbers.
313 */
314 if (phydev->speed == SPEED_100 && phydev->autoneg == AUTONEG_DISABLE) {
315 phy_write(phydev, 0x17, 0x2138);
316 phy_write(phydev, 0x0e, 0x0260);
317 } else {
318 phy_write(phydev, 0x17, 0x2108);
319 phy_write(phydev, 0x0e, 0x0000);
320 }
321
322 return 0;
323}
324
325static int rtl8211c_config_init(struct phy_device *phydev)
326{
327 /* RTL8211C has an issue when operating in Gigabit slave mode */
328 return phy_set_bits(phydev, MII_CTRL1000,
329 CTL1000_ENABLE_MASTER | CTL1000_AS_MASTER);
330}
331
332static int rtl8211f_config_init(struct phy_device *phydev)
333{
334 struct rtl821x_priv *priv = phydev->priv;
335 struct device *dev = &phydev->mdio.dev;
336 u16 val_txdly, val_rxdly;
337 int ret;
338
339 ret = phy_modify_paged_changed(phydev, 0xa43, RTL8211F_PHYCR1,
340 RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF,
341 priv->phycr1);
342 if (ret < 0) {
343 dev_err(dev, "aldps mode configuration failed: %pe\n",
344 ERR_PTR(ret));
345 return ret;
346 }
347
348 switch (phydev->interface) {
349 case PHY_INTERFACE_MODE_RGMII:
350 val_txdly = 0;
351 val_rxdly = 0;
352 break;
353
354 case PHY_INTERFACE_MODE_RGMII_RXID:
355 val_txdly = 0;
356 val_rxdly = RTL8211F_RX_DELAY;
357 break;
358
359 case PHY_INTERFACE_MODE_RGMII_TXID:
360 val_txdly = RTL8211F_TX_DELAY;
361 val_rxdly = 0;
362 break;
363
364 case PHY_INTERFACE_MODE_RGMII_ID:
365 val_txdly = RTL8211F_TX_DELAY;
366 val_rxdly = RTL8211F_RX_DELAY;
367 break;
368
369 default: /* the rest of the modes imply leaving delay as is. */
370 return 0;
371 }
372
373 ret = phy_modify_paged_changed(phydev, 0xd08, 0x11, RTL8211F_TX_DELAY,
374 val_txdly);
375 if (ret < 0) {
376 dev_err(dev, "Failed to update the TX delay register\n");
377 return ret;
378 } else if (ret) {
379 dev_dbg(dev,
380 "%s 2ns TX delay (and changing the value from pin-strapping RXD1 or the bootloader)\n",
381 val_txdly ? "Enabling" : "Disabling");
382 } else {
383 dev_dbg(dev,
384 "2ns TX delay was already %s (by pin-strapping RXD1 or bootloader configuration)\n",
385 val_txdly ? "enabled" : "disabled");
386 }
387
388 ret = phy_modify_paged_changed(phydev, 0xd08, 0x15, RTL8211F_RX_DELAY,
389 val_rxdly);
390 if (ret < 0) {
391 dev_err(dev, "Failed to update the RX delay register\n");
392 return ret;
393 } else if (ret) {
394 dev_dbg(dev,
395 "%s 2ns RX delay (and changing the value from pin-strapping RXD0 or the bootloader)\n",
396 val_rxdly ? "Enabling" : "Disabling");
397 } else {
398 dev_dbg(dev,
399 "2ns RX delay was already %s (by pin-strapping RXD0 or bootloader configuration)\n",
400 val_rxdly ? "enabled" : "disabled");
401 }
402
403 ret = phy_modify_paged(phydev, 0xa43, RTL8211F_PHYCR2,
404 RTL8211F_CLKOUT_EN, priv->phycr2);
405 if (ret < 0) {
406 dev_err(dev, "clkout configuration failed: %pe\n",
407 ERR_PTR(ret));
408 return ret;
409 }
410
411 return genphy_soft_reset(phydev);
412}
413
414static int rtl821x_resume(struct phy_device *phydev)
415{
416 int ret;
417
418 ret = genphy_resume(phydev);
419 if (ret < 0)
420 return ret;
421
422 msleep(20);
423
424 return 0;
425}
426
427static int rtl8211e_config_init(struct phy_device *phydev)
428{
429 int ret = 0, oldpage;
430 u16 val;
431
432 /* enable TX/RX delay for rgmii-* modes, and disable them for rgmii. */
433 switch (phydev->interface) {
434 case PHY_INTERFACE_MODE_RGMII:
435 val = RTL8211E_CTRL_DELAY | 0;
436 break;
437 case PHY_INTERFACE_MODE_RGMII_ID:
438 val = RTL8211E_CTRL_DELAY | RTL8211E_TX_DELAY | RTL8211E_RX_DELAY;
439 break;
440 case PHY_INTERFACE_MODE_RGMII_RXID:
441 val = RTL8211E_CTRL_DELAY | RTL8211E_RX_DELAY;
442 break;
443 case PHY_INTERFACE_MODE_RGMII_TXID:
444 val = RTL8211E_CTRL_DELAY | RTL8211E_TX_DELAY;
445 break;
446 default: /* the rest of the modes imply leaving delays as is. */
447 return 0;
448 }
449
450 /* According to a sample driver there is a 0x1c config register on the
451 * 0xa4 extension page (0x7) layout. It can be used to disable/enable
452 * the RX/TX delays otherwise controlled by RXDLY/TXDLY pins.
453 * The configuration register definition:
454 * 14 = reserved
455 * 13 = Force Tx RX Delay controlled by bit12 bit11,
456 * 12 = RX Delay, 11 = TX Delay
457 * 10:0 = Test && debug settings reserved by realtek
458 */
459 oldpage = phy_select_page(phydev, 0x7);
460 if (oldpage < 0)
461 goto err_restore_page;
462
463 ret = __phy_write(phydev, RTL821x_EXT_PAGE_SELECT, 0xa4);
464 if (ret)
465 goto err_restore_page;
466
467 ret = __phy_modify(phydev, 0x1c, RTL8211E_CTRL_DELAY
468 | RTL8211E_TX_DELAY | RTL8211E_RX_DELAY,
469 val);
470
471err_restore_page:
472 return phy_restore_page(phydev, oldpage, ret);
473}
474
475static int rtl8211b_suspend(struct phy_device *phydev)
476{
477 phy_write(phydev, MII_MMD_DATA, BIT(9));
478
479 return genphy_suspend(phydev);
480}
481
482static int rtl8211b_resume(struct phy_device *phydev)
483{
484 phy_write(phydev, MII_MMD_DATA, 0);
485
486 return genphy_resume(phydev);
487}
488
489static int rtl8366rb_config_init(struct phy_device *phydev)
490{
491 int ret;
492
493 ret = phy_set_bits(phydev, RTL8366RB_POWER_SAVE,
494 RTL8366RB_POWER_SAVE_ON);
495 if (ret) {
496 dev_err(&phydev->mdio.dev,
497 "error enabling power management\n");
498 }
499
500 return ret;
501}
502
503/* get actual speed to cover the downshift case */
504static int rtlgen_get_speed(struct phy_device *phydev)
505{
506 int val;
507
508 if (!phydev->link)
509 return 0;
510
511 val = phy_read_paged(phydev, 0xa43, 0x12);
512 if (val < 0)
513 return val;
514
515 switch (val & RTLGEN_SPEED_MASK) {
516 case 0x0000:
517 phydev->speed = SPEED_10;
518 break;
519 case 0x0010:
520 phydev->speed = SPEED_100;
521 break;
522 case 0x0020:
523 phydev->speed = SPEED_1000;
524 break;
525 case 0x0200:
526 phydev->speed = SPEED_10000;
527 break;
528 case 0x0210:
529 phydev->speed = SPEED_2500;
530 break;
531 case 0x0220:
532 phydev->speed = SPEED_5000;
533 break;
534 default:
535 break;
536 }
537
538 return 0;
539}
540
541static int rtlgen_read_status(struct phy_device *phydev)
542{
543 int ret;
544
545 ret = genphy_read_status(phydev);
546 if (ret < 0)
547 return ret;
548
549 return rtlgen_get_speed(phydev);
550}
551
552static int rtlgen_read_mmd(struct phy_device *phydev, int devnum, u16 regnum)
553{
554 int ret;
555
556 if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE) {
557 rtl821x_write_page(phydev, 0xa5c);
558 ret = __phy_read(phydev, 0x12);
559 rtl821x_write_page(phydev, 0);
560 } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV) {
561 rtl821x_write_page(phydev, 0xa5d);
562 ret = __phy_read(phydev, 0x10);
563 rtl821x_write_page(phydev, 0);
564 } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE) {
565 rtl821x_write_page(phydev, 0xa5d);
566 ret = __phy_read(phydev, 0x11);
567 rtl821x_write_page(phydev, 0);
568 } else {
569 ret = -EOPNOTSUPP;
570 }
571
572 return ret;
573}
574
575static int rtlgen_write_mmd(struct phy_device *phydev, int devnum, u16 regnum,
576 u16 val)
577{
578 int ret;
579
580 if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV) {
581 rtl821x_write_page(phydev, 0xa5d);
582 ret = __phy_write(phydev, 0x10, val);
583 rtl821x_write_page(phydev, 0);
584 } else {
585 ret = -EOPNOTSUPP;
586 }
587
588 return ret;
589}
590
591static int rtl822x_read_mmd(struct phy_device *phydev, int devnum, u16 regnum)
592{
593 int ret = rtlgen_read_mmd(phydev, devnum, regnum);
594
595 if (ret != -EOPNOTSUPP)
596 return ret;
597
598 if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE2) {
599 rtl821x_write_page(phydev, 0xa6e);
600 ret = __phy_read(phydev, 0x16);
601 rtl821x_write_page(phydev, 0);
602 } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2) {
603 rtl821x_write_page(phydev, 0xa6d);
604 ret = __phy_read(phydev, 0x12);
605 rtl821x_write_page(phydev, 0);
606 } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE2) {
607 rtl821x_write_page(phydev, 0xa6d);
608 ret = __phy_read(phydev, 0x10);
609 rtl821x_write_page(phydev, 0);
610 }
611
612 return ret;
613}
614
615static int rtl822x_write_mmd(struct phy_device *phydev, int devnum, u16 regnum,
616 u16 val)
617{
618 int ret = rtlgen_write_mmd(phydev, devnum, regnum, val);
619
620 if (ret != -EOPNOTSUPP)
621 return ret;
622
623 if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2) {
624 rtl821x_write_page(phydev, 0xa6d);
625 ret = __phy_write(phydev, 0x12, val);
626 rtl821x_write_page(phydev, 0);
627 }
628
629 return ret;
630}
631
632static int rtl822x_get_features(struct phy_device *phydev)
633{
634 int val;
635
636 val = phy_read_paged(phydev, 0xa61, 0x13);
637 if (val < 0)
638 return val;
639
640 linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT,
641 phydev->supported, val & RTL_SUPPORTS_2500FULL);
642 linkmode_mod_bit(ETHTOOL_LINK_MODE_5000baseT_Full_BIT,
643 phydev->supported, val & RTL_SUPPORTS_5000FULL);
644 linkmode_mod_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
645 phydev->supported, val & RTL_SUPPORTS_10000FULL);
646
647 return genphy_read_abilities(phydev);
648}
649
650static int rtl822x_config_aneg(struct phy_device *phydev)
651{
652 int ret = 0;
653
654 if (phydev->autoneg == AUTONEG_ENABLE) {
655 u16 adv2500 = 0;
656
657 if (linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT,
658 phydev->advertising))
659 adv2500 = RTL_ADV_2500FULL;
660
661 ret = phy_modify_paged_changed(phydev, 0xa5d, 0x12,
662 RTL_ADV_2500FULL, adv2500);
663 if (ret < 0)
664 return ret;
665 }
666
667 return __genphy_config_aneg(phydev, ret);
668}
669
670static int rtl822x_read_status(struct phy_device *phydev)
671{
672 int ret;
673
674 if (phydev->autoneg == AUTONEG_ENABLE) {
675 int lpadv = phy_read_paged(phydev, 0xa5d, 0x13);
676
677 if (lpadv < 0)
678 return lpadv;
679
680 linkmode_mod_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
681 phydev->lp_advertising, lpadv & RTL_LPADV_10000FULL);
682 linkmode_mod_bit(ETHTOOL_LINK_MODE_5000baseT_Full_BIT,
683 phydev->lp_advertising, lpadv & RTL_LPADV_5000FULL);
684 linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT,
685 phydev->lp_advertising, lpadv & RTL_LPADV_2500FULL);
686 }
687
688 ret = genphy_read_status(phydev);
689 if (ret < 0)
690 return ret;
691
692 return rtlgen_get_speed(phydev);
693}
694
695static bool rtlgen_supports_2_5gbps(struct phy_device *phydev)
696{
697 int val;
698
699 phy_write(phydev, RTL821x_PAGE_SELECT, 0xa61);
700 val = phy_read(phydev, 0x13);
701 phy_write(phydev, RTL821x_PAGE_SELECT, 0);
702
703 return val >= 0 && val & RTL_SUPPORTS_2500FULL;
704}
705
706static int rtlgen_match_phy_device(struct phy_device *phydev)
707{
708 return phydev->phy_id == RTL_GENERIC_PHYID &&
709 !rtlgen_supports_2_5gbps(phydev);
710}
711
712static int rtl8226_match_phy_device(struct phy_device *phydev)
713{
714 return phydev->phy_id == RTL_GENERIC_PHYID &&
715 rtlgen_supports_2_5gbps(phydev);
716}
717
718static int rtlgen_resume(struct phy_device *phydev)
719{
720 int ret = genphy_resume(phydev);
721
722 /* Internal PHY's from RTL8168h up may not be instantly ready */
723 msleep(20);
724
725 return ret;
726}
727
728static int rtl9000a_config_init(struct phy_device *phydev)
729{
730 phydev->autoneg = AUTONEG_DISABLE;
731 phydev->speed = SPEED_100;
732 phydev->duplex = DUPLEX_FULL;
733
734 return 0;
735}
736
737static int rtl9000a_config_aneg(struct phy_device *phydev)
738{
739 int ret;
740 u16 ctl = 0;
741
742 switch (phydev->master_slave_set) {
743 case MASTER_SLAVE_CFG_MASTER_FORCE:
744 ctl |= CTL1000_AS_MASTER;
745 break;
746 case MASTER_SLAVE_CFG_SLAVE_FORCE:
747 break;
748 case MASTER_SLAVE_CFG_UNKNOWN:
749 case MASTER_SLAVE_CFG_UNSUPPORTED:
750 return 0;
751 default:
752 phydev_warn(phydev, "Unsupported Master/Slave mode\n");
753 return -EOPNOTSUPP;
754 }
755
756 ret = phy_modify_changed(phydev, MII_CTRL1000, CTL1000_AS_MASTER, ctl);
757 if (ret == 1)
758 ret = genphy_soft_reset(phydev);
759
760 return ret;
761}
762
763static int rtl9000a_read_status(struct phy_device *phydev)
764{
765 int ret;
766
767 phydev->master_slave_get = MASTER_SLAVE_CFG_UNKNOWN;
768 phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN;
769
770 ret = genphy_update_link(phydev);
771 if (ret)
772 return ret;
773
774 ret = phy_read(phydev, MII_CTRL1000);
775 if (ret < 0)
776 return ret;
777 if (ret & CTL1000_AS_MASTER)
778 phydev->master_slave_get = MASTER_SLAVE_CFG_MASTER_FORCE;
779 else
780 phydev->master_slave_get = MASTER_SLAVE_CFG_SLAVE_FORCE;
781
782 ret = phy_read(phydev, MII_STAT1000);
783 if (ret < 0)
784 return ret;
785 if (ret & LPA_1000MSRES)
786 phydev->master_slave_state = MASTER_SLAVE_STATE_MASTER;
787 else
788 phydev->master_slave_state = MASTER_SLAVE_STATE_SLAVE;
789
790 return 0;
791}
792
793static int rtl9000a_ack_interrupt(struct phy_device *phydev)
794{
795 int err;
796
797 err = phy_read(phydev, RTL8211F_INSR);
798
799 return (err < 0) ? err : 0;
800}
801
802static int rtl9000a_config_intr(struct phy_device *phydev)
803{
804 u16 val;
805 int err;
806
807 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
808 err = rtl9000a_ack_interrupt(phydev);
809 if (err)
810 return err;
811
812 val = (u16)~RTL9000A_GINMR_LINK_STATUS;
813 err = phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
814 } else {
815 val = ~0;
816 err = phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
817 if (err)
818 return err;
819
820 err = rtl9000a_ack_interrupt(phydev);
821 }
822
823 return phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
824}
825
826static irqreturn_t rtl9000a_handle_interrupt(struct phy_device *phydev)
827{
828 int irq_status;
829
830 irq_status = phy_read(phydev, RTL8211F_INSR);
831 if (irq_status < 0) {
832 phy_error(phydev);
833 return IRQ_NONE;
834 }
835
836 if (!(irq_status & RTL8211F_INER_LINK_STATUS))
837 return IRQ_NONE;
838
839 phy_trigger_machine(phydev);
840
841 return IRQ_HANDLED;
842}
843
844static struct phy_driver realtek_drvs[] = {
845 {
846 PHY_ID_MATCH_EXACT(0x00008201),
847 .name = "RTL8201CP Ethernet",
848 .read_page = rtl821x_read_page,
849 .write_page = rtl821x_write_page,
850 }, {
851 PHY_ID_MATCH_EXACT(0x001cc816),
852 .name = "RTL8201F Fast Ethernet",
853 .config_intr = &rtl8201_config_intr,
854 .handle_interrupt = rtl8201_handle_interrupt,
855 .suspend = genphy_suspend,
856 .resume = genphy_resume,
857 .read_page = rtl821x_read_page,
858 .write_page = rtl821x_write_page,
859 }, {
860 PHY_ID_MATCH_MODEL(0x001cc880),
861 .name = "RTL8208 Fast Ethernet",
862 .read_mmd = genphy_read_mmd_unsupported,
863 .write_mmd = genphy_write_mmd_unsupported,
864 .suspend = genphy_suspend,
865 .resume = genphy_resume,
866 .read_page = rtl821x_read_page,
867 .write_page = rtl821x_write_page,
868 }, {
869 PHY_ID_MATCH_EXACT(0x001cc910),
870 .name = "RTL8211 Gigabit Ethernet",
871 .config_aneg = rtl8211_config_aneg,
872 .read_mmd = &genphy_read_mmd_unsupported,
873 .write_mmd = &genphy_write_mmd_unsupported,
874 .read_page = rtl821x_read_page,
875 .write_page = rtl821x_write_page,
876 }, {
877 PHY_ID_MATCH_EXACT(0x001cc912),
878 .name = "RTL8211B Gigabit Ethernet",
879 .config_intr = &rtl8211b_config_intr,
880 .handle_interrupt = rtl821x_handle_interrupt,
881 .read_mmd = &genphy_read_mmd_unsupported,
882 .write_mmd = &genphy_write_mmd_unsupported,
883 .suspend = rtl8211b_suspend,
884 .resume = rtl8211b_resume,
885 .read_page = rtl821x_read_page,
886 .write_page = rtl821x_write_page,
887 }, {
888 PHY_ID_MATCH_EXACT(0x001cc913),
889 .name = "RTL8211C Gigabit Ethernet",
890 .config_init = rtl8211c_config_init,
891 .read_mmd = &genphy_read_mmd_unsupported,
892 .write_mmd = &genphy_write_mmd_unsupported,
893 .read_page = rtl821x_read_page,
894 .write_page = rtl821x_write_page,
895 }, {
896 PHY_ID_MATCH_EXACT(0x001cc914),
897 .name = "RTL8211DN Gigabit Ethernet",
898 .config_intr = rtl8211e_config_intr,
899 .handle_interrupt = rtl821x_handle_interrupt,
900 .suspend = genphy_suspend,
901 .resume = genphy_resume,
902 .read_page = rtl821x_read_page,
903 .write_page = rtl821x_write_page,
904 }, {
905 PHY_ID_MATCH_EXACT(0x001cc915),
906 .name = "RTL8211E Gigabit Ethernet",
907 .config_init = &rtl8211e_config_init,
908 .config_intr = &rtl8211e_config_intr,
909 .handle_interrupt = rtl821x_handle_interrupt,
910 .suspend = genphy_suspend,
911 .resume = genphy_resume,
912 .read_page = rtl821x_read_page,
913 .write_page = rtl821x_write_page,
914 }, {
915 PHY_ID_MATCH_EXACT(0x001cc916),
916 .name = "RTL8211F Gigabit Ethernet",
917 .probe = rtl821x_probe,
918 .config_init = &rtl8211f_config_init,
919 .read_status = rtlgen_read_status,
920 .config_intr = &rtl8211f_config_intr,
921 .handle_interrupt = rtl8211f_handle_interrupt,
922 .suspend = genphy_suspend,
923 .resume = rtl821x_resume,
924 .read_page = rtl821x_read_page,
925 .write_page = rtl821x_write_page,
926 }, {
927 .name = "Generic FE-GE Realtek PHY",
928 .match_phy_device = rtlgen_match_phy_device,
929 .read_status = rtlgen_read_status,
930 .suspend = genphy_suspend,
931 .resume = rtlgen_resume,
932 .read_page = rtl821x_read_page,
933 .write_page = rtl821x_write_page,
934 .read_mmd = rtlgen_read_mmd,
935 .write_mmd = rtlgen_write_mmd,
936 }, {
937 .name = "RTL8226 2.5Gbps PHY",
938 .match_phy_device = rtl8226_match_phy_device,
939 .get_features = rtl822x_get_features,
940 .config_aneg = rtl822x_config_aneg,
941 .read_status = rtl822x_read_status,
942 .suspend = genphy_suspend,
943 .resume = rtlgen_resume,
944 .read_page = rtl821x_read_page,
945 .write_page = rtl821x_write_page,
946 .read_mmd = rtl822x_read_mmd,
947 .write_mmd = rtl822x_write_mmd,
948 }, {
949 PHY_ID_MATCH_EXACT(0x001cc840),
950 .name = "RTL8226B_RTL8221B 2.5Gbps PHY",
951 .get_features = rtl822x_get_features,
952 .config_aneg = rtl822x_config_aneg,
953 .read_status = rtl822x_read_status,
954 .suspend = genphy_suspend,
955 .resume = rtlgen_resume,
956 .read_page = rtl821x_read_page,
957 .write_page = rtl821x_write_page,
958 .read_mmd = rtl822x_read_mmd,
959 .write_mmd = rtl822x_write_mmd,
960 }, {
961 PHY_ID_MATCH_EXACT(0x001cc838),
962 .name = "RTL8226-CG 2.5Gbps PHY",
963 .get_features = rtl822x_get_features,
964 .config_aneg = rtl822x_config_aneg,
965 .read_status = rtl822x_read_status,
966 .suspend = genphy_suspend,
967 .resume = rtlgen_resume,
968 .read_page = rtl821x_read_page,
969 .write_page = rtl821x_write_page,
970 }, {
971 PHY_ID_MATCH_EXACT(0x001cc848),
972 .name = "RTL8226B-CG_RTL8221B-CG 2.5Gbps PHY",
973 .get_features = rtl822x_get_features,
974 .config_aneg = rtl822x_config_aneg,
975 .read_status = rtl822x_read_status,
976 .suspend = genphy_suspend,
977 .resume = rtlgen_resume,
978 .read_page = rtl821x_read_page,
979 .write_page = rtl821x_write_page,
980 }, {
981 PHY_ID_MATCH_EXACT(0x001cc849),
982 .name = "RTL8221B-VB-CG 2.5Gbps PHY",
983 .get_features = rtl822x_get_features,
984 .config_aneg = rtl822x_config_aneg,
985 .read_status = rtl822x_read_status,
986 .suspend = genphy_suspend,
987 .resume = rtlgen_resume,
988 .read_page = rtl821x_read_page,
989 .write_page = rtl821x_write_page,
990 }, {
991 PHY_ID_MATCH_EXACT(0x001cc84a),
992 .name = "RTL8221B-VM-CG 2.5Gbps PHY",
993 .get_features = rtl822x_get_features,
994 .config_aneg = rtl822x_config_aneg,
995 .read_status = rtl822x_read_status,
996 .suspend = genphy_suspend,
997 .resume = rtlgen_resume,
998 .read_page = rtl821x_read_page,
999 .write_page = rtl821x_write_page,
1000 }, {
1001 PHY_ID_MATCH_EXACT(0x001cc961),
1002 .name = "RTL8366RB Gigabit Ethernet",
1003 .config_init = &rtl8366rb_config_init,
1004 /* These interrupts are handled by the irq controller
1005 * embedded inside the RTL8366RB, they get unmasked when the
1006 * irq is requested and ACKed by reading the status register,
1007 * which is done by the irqchip code.
1008 */
1009 .config_intr = genphy_no_config_intr,
1010 .handle_interrupt = genphy_handle_interrupt_no_ack,
1011 .suspend = genphy_suspend,
1012 .resume = genphy_resume,
1013 }, {
1014 PHY_ID_MATCH_EXACT(0x001ccb00),
1015 .name = "RTL9000AA_RTL9000AN Ethernet",
1016 .features = PHY_BASIC_T1_FEATURES,
1017 .config_init = rtl9000a_config_init,
1018 .config_aneg = rtl9000a_config_aneg,
1019 .read_status = rtl9000a_read_status,
1020 .config_intr = rtl9000a_config_intr,
1021 .handle_interrupt = rtl9000a_handle_interrupt,
1022 .suspend = genphy_suspend,
1023 .resume = genphy_resume,
1024 .read_page = rtl821x_read_page,
1025 .write_page = rtl821x_write_page,
1026 },
1027};
1028
1029module_phy_driver(realtek_drvs);
1030
1031static const struct mdio_device_id __maybe_unused realtek_tbl[] = {
1032 { PHY_ID_MATCH_VENDOR(0x001cc800) },
1033 { }
1034};
1035
1036MODULE_DEVICE_TABLE(mdio, realtek_tbl);