Loading...
1// SPDX-License-Identifier: GPL-2.0
2/* Driver for the Texas Instruments DP83822, DP83825 and DP83826 PHYs.
3 *
4 * Copyright (C) 2017 Texas Instruments Inc.
5 */
6
7#include <linux/ethtool.h>
8#include <linux/etherdevice.h>
9#include <linux/kernel.h>
10#include <linux/mii.h>
11#include <linux/module.h>
12#include <linux/of.h>
13#include <linux/phy.h>
14#include <linux/netdevice.h>
15#include <linux/bitfield.h>
16
17#define DP83822_PHY_ID 0x2000a240
18#define DP83825S_PHY_ID 0x2000a140
19#define DP83825I_PHY_ID 0x2000a150
20#define DP83825CM_PHY_ID 0x2000a160
21#define DP83825CS_PHY_ID 0x2000a170
22#define DP83826C_PHY_ID 0x2000a130
23#define DP83826NC_PHY_ID 0x2000a110
24
25#define DP83822_DEVADDR 0x1f
26
27#define MII_DP83822_CTRL_2 0x0a
28#define MII_DP83822_PHYSTS 0x10
29#define MII_DP83822_PHYSCR 0x11
30#define MII_DP83822_MISR1 0x12
31#define MII_DP83822_MISR2 0x13
32#define MII_DP83822_FCSCR 0x14
33#define MII_DP83822_RCSR 0x17
34#define MII_DP83822_RESET_CTRL 0x1f
35#define MII_DP83822_GENCFG 0x465
36#define MII_DP83822_SOR1 0x467
37
38/* DP83826 specific registers */
39#define MII_DP83826_VOD_CFG1 0x30b
40#define MII_DP83826_VOD_CFG2 0x30c
41
42/* GENCFG */
43#define DP83822_SIG_DET_LOW BIT(0)
44
45/* Control Register 2 bits */
46#define DP83822_FX_ENABLE BIT(14)
47
48#define DP83822_SW_RESET BIT(15)
49#define DP83822_DIG_RESTART BIT(14)
50
51/* PHY STS bits */
52#define DP83822_PHYSTS_DUPLEX BIT(2)
53#define DP83822_PHYSTS_10 BIT(1)
54#define DP83822_PHYSTS_LINK BIT(0)
55
56/* PHYSCR Register Fields */
57#define DP83822_PHYSCR_INT_OE BIT(0) /* Interrupt Output Enable */
58#define DP83822_PHYSCR_INTEN BIT(1) /* Interrupt Enable */
59
60/* MISR1 bits */
61#define DP83822_RX_ERR_HF_INT_EN BIT(0)
62#define DP83822_FALSE_CARRIER_HF_INT_EN BIT(1)
63#define DP83822_ANEG_COMPLETE_INT_EN BIT(2)
64#define DP83822_DUP_MODE_CHANGE_INT_EN BIT(3)
65#define DP83822_SPEED_CHANGED_INT_EN BIT(4)
66#define DP83822_LINK_STAT_INT_EN BIT(5)
67#define DP83822_ENERGY_DET_INT_EN BIT(6)
68#define DP83822_LINK_QUAL_INT_EN BIT(7)
69
70/* MISR2 bits */
71#define DP83822_JABBER_DET_INT_EN BIT(0)
72#define DP83822_WOL_PKT_INT_EN BIT(1)
73#define DP83822_SLEEP_MODE_INT_EN BIT(2)
74#define DP83822_MDI_XOVER_INT_EN BIT(3)
75#define DP83822_LB_FIFO_INT_EN BIT(4)
76#define DP83822_PAGE_RX_INT_EN BIT(5)
77#define DP83822_ANEG_ERR_INT_EN BIT(6)
78#define DP83822_EEE_ERROR_CHANGE_INT_EN BIT(7)
79
80/* INT_STAT1 bits */
81#define DP83822_WOL_INT_EN BIT(4)
82#define DP83822_WOL_INT_STAT BIT(12)
83
84#define MII_DP83822_RXSOP1 0x04a5
85#define MII_DP83822_RXSOP2 0x04a6
86#define MII_DP83822_RXSOP3 0x04a7
87
88/* WoL Registers */
89#define MII_DP83822_WOL_CFG 0x04a0
90#define MII_DP83822_WOL_STAT 0x04a1
91#define MII_DP83822_WOL_DA1 0x04a2
92#define MII_DP83822_WOL_DA2 0x04a3
93#define MII_DP83822_WOL_DA3 0x04a4
94
95/* WoL bits */
96#define DP83822_WOL_MAGIC_EN BIT(0)
97#define DP83822_WOL_SECURE_ON BIT(5)
98#define DP83822_WOL_EN BIT(7)
99#define DP83822_WOL_INDICATION_SEL BIT(8)
100#define DP83822_WOL_CLR_INDICATION BIT(11)
101
102/* RCSR bits */
103#define DP83822_RMII_MODE_EN BIT(5)
104#define DP83822_RMII_MODE_SEL BIT(7)
105#define DP83822_RGMII_MODE_EN BIT(9)
106#define DP83822_RX_CLK_SHIFT BIT(12)
107#define DP83822_TX_CLK_SHIFT BIT(11)
108
109/* SOR1 mode */
110#define DP83822_STRAP_MODE1 0
111#define DP83822_STRAP_MODE2 BIT(0)
112#define DP83822_STRAP_MODE3 BIT(1)
113#define DP83822_STRAP_MODE4 GENMASK(1, 0)
114
115#define DP83822_COL_STRAP_MASK GENMASK(11, 10)
116#define DP83822_COL_SHIFT 10
117#define DP83822_RX_ER_STR_MASK GENMASK(9, 8)
118#define DP83822_RX_ER_SHIFT 8
119
120/* DP83826: VOD_CFG1 & VOD_CFG2 */
121#define DP83826_VOD_CFG1_MINUS_MDIX_MASK GENMASK(13, 12)
122#define DP83826_VOD_CFG1_MINUS_MDI_MASK GENMASK(11, 6)
123#define DP83826_VOD_CFG2_MINUS_MDIX_MASK GENMASK(15, 12)
124#define DP83826_VOD_CFG2_PLUS_MDIX_MASK GENMASK(11, 6)
125#define DP83826_VOD_CFG2_PLUS_MDI_MASK GENMASK(5, 0)
126#define DP83826_CFG_DAC_MINUS_MDIX_5_TO_4 GENMASK(5, 4)
127#define DP83826_CFG_DAC_MINUS_MDIX_3_TO_0 GENMASK(3, 0)
128#define DP83826_CFG_DAC_PERCENT_PER_STEP 625
129#define DP83826_CFG_DAC_PERCENT_DEFAULT 10000
130#define DP83826_CFG_DAC_MINUS_DEFAULT 0x30
131#define DP83826_CFG_DAC_PLUS_DEFAULT 0x10
132
133#define MII_DP83822_FIBER_ADVERTISE (ADVERTISED_TP | ADVERTISED_MII | \
134 ADVERTISED_FIBRE | \
135 ADVERTISED_Pause | ADVERTISED_Asym_Pause)
136
137struct dp83822_private {
138 bool fx_signal_det_low;
139 int fx_enabled;
140 u16 fx_sd_enable;
141 u8 cfg_dac_minus;
142 u8 cfg_dac_plus;
143 struct ethtool_wolinfo wol;
144};
145
146static int dp83822_config_wol(struct phy_device *phydev,
147 struct ethtool_wolinfo *wol)
148{
149 struct net_device *ndev = phydev->attached_dev;
150 u16 value;
151 const u8 *mac;
152
153 if (wol->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) {
154 mac = (const u8 *)ndev->dev_addr;
155
156 if (!is_valid_ether_addr(mac))
157 return -EINVAL;
158
159 /* MAC addresses start with byte 5, but stored in mac[0].
160 * 822 PHYs store bytes 4|5, 2|3, 0|1
161 */
162 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA1,
163 (mac[1] << 8) | mac[0]);
164 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA2,
165 (mac[3] << 8) | mac[2]);
166 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA3,
167 (mac[5] << 8) | mac[4]);
168
169 value = phy_read_mmd(phydev, DP83822_DEVADDR,
170 MII_DP83822_WOL_CFG);
171 if (wol->wolopts & WAKE_MAGIC)
172 value |= DP83822_WOL_MAGIC_EN;
173 else
174 value &= ~DP83822_WOL_MAGIC_EN;
175
176 if (wol->wolopts & WAKE_MAGICSECURE) {
177 phy_write_mmd(phydev, DP83822_DEVADDR,
178 MII_DP83822_RXSOP1,
179 (wol->sopass[1] << 8) | wol->sopass[0]);
180 phy_write_mmd(phydev, DP83822_DEVADDR,
181 MII_DP83822_RXSOP2,
182 (wol->sopass[3] << 8) | wol->sopass[2]);
183 phy_write_mmd(phydev, DP83822_DEVADDR,
184 MII_DP83822_RXSOP3,
185 (wol->sopass[5] << 8) | wol->sopass[4]);
186 value |= DP83822_WOL_SECURE_ON;
187 } else {
188 value &= ~DP83822_WOL_SECURE_ON;
189 }
190
191 /* Clear any pending WoL interrupt */
192 phy_read(phydev, MII_DP83822_MISR2);
193
194 value |= DP83822_WOL_EN | DP83822_WOL_INDICATION_SEL |
195 DP83822_WOL_CLR_INDICATION;
196
197 return phy_write_mmd(phydev, DP83822_DEVADDR,
198 MII_DP83822_WOL_CFG, value);
199 } else {
200 return phy_clear_bits_mmd(phydev, DP83822_DEVADDR,
201 MII_DP83822_WOL_CFG,
202 DP83822_WOL_EN |
203 DP83822_WOL_MAGIC_EN |
204 DP83822_WOL_SECURE_ON);
205 }
206}
207
208static int dp83822_set_wol(struct phy_device *phydev,
209 struct ethtool_wolinfo *wol)
210{
211 struct dp83822_private *dp83822 = phydev->priv;
212 int ret;
213
214 ret = dp83822_config_wol(phydev, wol);
215 if (!ret)
216 memcpy(&dp83822->wol, wol, sizeof(*wol));
217 return ret;
218}
219
220static void dp83822_get_wol(struct phy_device *phydev,
221 struct ethtool_wolinfo *wol)
222{
223 int value;
224 u16 sopass_val;
225
226 wol->supported = (WAKE_MAGIC | WAKE_MAGICSECURE);
227 wol->wolopts = 0;
228
229 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
230
231 if (value & DP83822_WOL_MAGIC_EN)
232 wol->wolopts |= WAKE_MAGIC;
233
234 if (value & DP83822_WOL_SECURE_ON) {
235 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
236 MII_DP83822_RXSOP1);
237 wol->sopass[0] = (sopass_val & 0xff);
238 wol->sopass[1] = (sopass_val >> 8);
239
240 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
241 MII_DP83822_RXSOP2);
242 wol->sopass[2] = (sopass_val & 0xff);
243 wol->sopass[3] = (sopass_val >> 8);
244
245 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
246 MII_DP83822_RXSOP3);
247 wol->sopass[4] = (sopass_val & 0xff);
248 wol->sopass[5] = (sopass_val >> 8);
249
250 wol->wolopts |= WAKE_MAGICSECURE;
251 }
252
253 /* WoL is not enabled so set wolopts to 0 */
254 if (!(value & DP83822_WOL_EN))
255 wol->wolopts = 0;
256}
257
258static int dp83822_config_intr(struct phy_device *phydev)
259{
260 struct dp83822_private *dp83822 = phydev->priv;
261 int misr_status;
262 int physcr_status;
263 int err;
264
265 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
266 misr_status = phy_read(phydev, MII_DP83822_MISR1);
267 if (misr_status < 0)
268 return misr_status;
269
270 misr_status |= (DP83822_LINK_STAT_INT_EN |
271 DP83822_ENERGY_DET_INT_EN |
272 DP83822_LINK_QUAL_INT_EN);
273
274 if (!dp83822->fx_enabled)
275 misr_status |= DP83822_ANEG_COMPLETE_INT_EN |
276 DP83822_DUP_MODE_CHANGE_INT_EN |
277 DP83822_SPEED_CHANGED_INT_EN;
278
279
280 err = phy_write(phydev, MII_DP83822_MISR1, misr_status);
281 if (err < 0)
282 return err;
283
284 misr_status = phy_read(phydev, MII_DP83822_MISR2);
285 if (misr_status < 0)
286 return misr_status;
287
288 misr_status |= (DP83822_JABBER_DET_INT_EN |
289 DP83822_SLEEP_MODE_INT_EN |
290 DP83822_LB_FIFO_INT_EN |
291 DP83822_PAGE_RX_INT_EN |
292 DP83822_EEE_ERROR_CHANGE_INT_EN);
293
294 if (!dp83822->fx_enabled)
295 misr_status |= DP83822_ANEG_ERR_INT_EN |
296 DP83822_WOL_PKT_INT_EN;
297
298 err = phy_write(phydev, MII_DP83822_MISR2, misr_status);
299 if (err < 0)
300 return err;
301
302 physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
303 if (physcr_status < 0)
304 return physcr_status;
305
306 physcr_status |= DP83822_PHYSCR_INT_OE | DP83822_PHYSCR_INTEN;
307
308 } else {
309 err = phy_write(phydev, MII_DP83822_MISR1, 0);
310 if (err < 0)
311 return err;
312
313 err = phy_write(phydev, MII_DP83822_MISR2, 0);
314 if (err < 0)
315 return err;
316
317 physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
318 if (physcr_status < 0)
319 return physcr_status;
320
321 physcr_status &= ~DP83822_PHYSCR_INTEN;
322 }
323
324 return phy_write(phydev, MII_DP83822_PHYSCR, physcr_status);
325}
326
327static irqreturn_t dp83822_handle_interrupt(struct phy_device *phydev)
328{
329 bool trigger_machine = false;
330 int irq_status;
331
332 /* The MISR1 and MISR2 registers are holding the interrupt status in
333 * the upper half (15:8), while the lower half (7:0) is used for
334 * controlling the interrupt enable state of those individual interrupt
335 * sources. To determine the possible interrupt sources, just read the
336 * MISR* register and use it directly to know which interrupts have
337 * been enabled previously or not.
338 */
339 irq_status = phy_read(phydev, MII_DP83822_MISR1);
340 if (irq_status < 0) {
341 phy_error(phydev);
342 return IRQ_NONE;
343 }
344 if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
345 trigger_machine = true;
346
347 irq_status = phy_read(phydev, MII_DP83822_MISR2);
348 if (irq_status < 0) {
349 phy_error(phydev);
350 return IRQ_NONE;
351 }
352 if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
353 trigger_machine = true;
354
355 if (!trigger_machine)
356 return IRQ_NONE;
357
358 phy_trigger_machine(phydev);
359
360 return IRQ_HANDLED;
361}
362
363static int dp83822_read_status(struct phy_device *phydev)
364{
365 struct dp83822_private *dp83822 = phydev->priv;
366 int status = phy_read(phydev, MII_DP83822_PHYSTS);
367 int ctrl2;
368 int ret;
369
370 if (dp83822->fx_enabled) {
371 if (status & DP83822_PHYSTS_LINK) {
372 phydev->speed = SPEED_UNKNOWN;
373 phydev->duplex = DUPLEX_UNKNOWN;
374 } else {
375 ctrl2 = phy_read(phydev, MII_DP83822_CTRL_2);
376 if (ctrl2 < 0)
377 return ctrl2;
378
379 if (!(ctrl2 & DP83822_FX_ENABLE)) {
380 ret = phy_write(phydev, MII_DP83822_CTRL_2,
381 DP83822_FX_ENABLE | ctrl2);
382 if (ret < 0)
383 return ret;
384 }
385 }
386 }
387
388 ret = genphy_read_status(phydev);
389 if (ret)
390 return ret;
391
392 if (status < 0)
393 return status;
394
395 if (status & DP83822_PHYSTS_DUPLEX)
396 phydev->duplex = DUPLEX_FULL;
397 else
398 phydev->duplex = DUPLEX_HALF;
399
400 if (status & DP83822_PHYSTS_10)
401 phydev->speed = SPEED_10;
402 else
403 phydev->speed = SPEED_100;
404
405 return 0;
406}
407
408static int dp83822_config_init(struct phy_device *phydev)
409{
410 struct dp83822_private *dp83822 = phydev->priv;
411 struct device *dev = &phydev->mdio.dev;
412 int rgmii_delay = 0;
413 s32 rx_int_delay;
414 s32 tx_int_delay;
415 int err = 0;
416 int bmcr;
417
418 if (phy_interface_is_rgmii(phydev)) {
419 rx_int_delay = phy_get_internal_delay(phydev, dev, NULL, 0,
420 true);
421
422 /* Set DP83822_RX_CLK_SHIFT to enable rx clk internal delay */
423 if (rx_int_delay > 0)
424 rgmii_delay |= DP83822_RX_CLK_SHIFT;
425
426 tx_int_delay = phy_get_internal_delay(phydev, dev, NULL, 0,
427 false);
428
429 /* Set DP83822_TX_CLK_SHIFT to disable tx clk internal delay */
430 if (tx_int_delay <= 0)
431 rgmii_delay |= DP83822_TX_CLK_SHIFT;
432
433 err = phy_modify_mmd(phydev, DP83822_DEVADDR, MII_DP83822_RCSR,
434 DP83822_RX_CLK_SHIFT | DP83822_TX_CLK_SHIFT, rgmii_delay);
435 if (err)
436 return err;
437
438 err = phy_set_bits_mmd(phydev, DP83822_DEVADDR,
439 MII_DP83822_RCSR, DP83822_RGMII_MODE_EN);
440
441 if (err)
442 return err;
443 } else {
444 err = phy_clear_bits_mmd(phydev, DP83822_DEVADDR,
445 MII_DP83822_RCSR, DP83822_RGMII_MODE_EN);
446
447 if (err)
448 return err;
449 }
450
451 if (dp83822->fx_enabled) {
452 err = phy_modify(phydev, MII_DP83822_CTRL_2,
453 DP83822_FX_ENABLE, 1);
454 if (err < 0)
455 return err;
456
457 /* Only allow advertising what this PHY supports */
458 linkmode_and(phydev->advertising, phydev->advertising,
459 phydev->supported);
460
461 linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT,
462 phydev->supported);
463 linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT,
464 phydev->advertising);
465 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Full_BIT,
466 phydev->supported);
467 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Half_BIT,
468 phydev->supported);
469 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Full_BIT,
470 phydev->advertising);
471 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Half_BIT,
472 phydev->advertising);
473
474 /* Auto neg is not supported in fiber mode */
475 bmcr = phy_read(phydev, MII_BMCR);
476 if (bmcr < 0)
477 return bmcr;
478
479 if (bmcr & BMCR_ANENABLE) {
480 err = phy_modify(phydev, MII_BMCR, BMCR_ANENABLE, 0);
481 if (err < 0)
482 return err;
483 }
484 phydev->autoneg = AUTONEG_DISABLE;
485 linkmode_clear_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
486 phydev->supported);
487 linkmode_clear_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
488 phydev->advertising);
489
490 /* Setup fiber advertisement */
491 err = phy_modify_changed(phydev, MII_ADVERTISE,
492 MII_DP83822_FIBER_ADVERTISE,
493 MII_DP83822_FIBER_ADVERTISE);
494
495 if (err < 0)
496 return err;
497
498 if (dp83822->fx_signal_det_low) {
499 err = phy_set_bits_mmd(phydev, DP83822_DEVADDR,
500 MII_DP83822_GENCFG,
501 DP83822_SIG_DET_LOW);
502 if (err)
503 return err;
504 }
505 }
506 return dp83822_config_wol(phydev, &dp83822->wol);
507}
508
509static int dp8382x_config_rmii_mode(struct phy_device *phydev)
510{
511 struct device *dev = &phydev->mdio.dev;
512 const char *of_val;
513 int ret;
514
515 if (!device_property_read_string(dev, "ti,rmii-mode", &of_val)) {
516 if (strcmp(of_val, "master") == 0) {
517 ret = phy_clear_bits_mmd(phydev, DP83822_DEVADDR, MII_DP83822_RCSR,
518 DP83822_RMII_MODE_SEL);
519 } else if (strcmp(of_val, "slave") == 0) {
520 ret = phy_set_bits_mmd(phydev, DP83822_DEVADDR, MII_DP83822_RCSR,
521 DP83822_RMII_MODE_SEL);
522 } else {
523 phydev_err(phydev, "Invalid value for ti,rmii-mode property (%s)\n",
524 of_val);
525 ret = -EINVAL;
526 }
527
528 if (ret)
529 return ret;
530 }
531
532 return 0;
533}
534
535static int dp83826_config_init(struct phy_device *phydev)
536{
537 struct dp83822_private *dp83822 = phydev->priv;
538 u16 val, mask;
539 int ret;
540
541 if (phydev->interface == PHY_INTERFACE_MODE_RMII) {
542 ret = phy_set_bits_mmd(phydev, DP83822_DEVADDR, MII_DP83822_RCSR,
543 DP83822_RMII_MODE_EN);
544 if (ret)
545 return ret;
546
547 ret = dp8382x_config_rmii_mode(phydev);
548 if (ret)
549 return ret;
550 } else {
551 ret = phy_clear_bits_mmd(phydev, DP83822_DEVADDR, MII_DP83822_RCSR,
552 DP83822_RMII_MODE_EN);
553 if (ret)
554 return ret;
555 }
556
557 if (dp83822->cfg_dac_minus != DP83826_CFG_DAC_MINUS_DEFAULT) {
558 val = FIELD_PREP(DP83826_VOD_CFG1_MINUS_MDI_MASK, dp83822->cfg_dac_minus) |
559 FIELD_PREP(DP83826_VOD_CFG1_MINUS_MDIX_MASK,
560 FIELD_GET(DP83826_CFG_DAC_MINUS_MDIX_5_TO_4,
561 dp83822->cfg_dac_minus));
562 mask = DP83826_VOD_CFG1_MINUS_MDIX_MASK | DP83826_VOD_CFG1_MINUS_MDI_MASK;
563 ret = phy_modify_mmd(phydev, DP83822_DEVADDR, MII_DP83826_VOD_CFG1, mask, val);
564 if (ret)
565 return ret;
566
567 val = FIELD_PREP(DP83826_VOD_CFG2_MINUS_MDIX_MASK,
568 FIELD_GET(DP83826_CFG_DAC_MINUS_MDIX_3_TO_0,
569 dp83822->cfg_dac_minus));
570 mask = DP83826_VOD_CFG2_MINUS_MDIX_MASK;
571 ret = phy_modify_mmd(phydev, DP83822_DEVADDR, MII_DP83826_VOD_CFG2, mask, val);
572 if (ret)
573 return ret;
574 }
575
576 if (dp83822->cfg_dac_plus != DP83826_CFG_DAC_PLUS_DEFAULT) {
577 val = FIELD_PREP(DP83826_VOD_CFG2_PLUS_MDIX_MASK, dp83822->cfg_dac_plus) |
578 FIELD_PREP(DP83826_VOD_CFG2_PLUS_MDI_MASK, dp83822->cfg_dac_plus);
579 mask = DP83826_VOD_CFG2_PLUS_MDIX_MASK | DP83826_VOD_CFG2_PLUS_MDI_MASK;
580 ret = phy_modify_mmd(phydev, DP83822_DEVADDR, MII_DP83826_VOD_CFG2, mask, val);
581 if (ret)
582 return ret;
583 }
584
585 return dp83822_config_wol(phydev, &dp83822->wol);
586}
587
588static int dp83825_config_init(struct phy_device *phydev)
589{
590 struct dp83822_private *dp83822 = phydev->priv;
591 int ret;
592
593 ret = dp8382x_config_rmii_mode(phydev);
594 if (ret)
595 return ret;
596
597 return dp83822_config_wol(phydev, &dp83822->wol);
598}
599
600static int dp83822_phy_reset(struct phy_device *phydev)
601{
602 int err;
603
604 err = phy_write(phydev, MII_DP83822_RESET_CTRL, DP83822_SW_RESET);
605 if (err < 0)
606 return err;
607
608 return phydev->drv->config_init(phydev);
609}
610
611#ifdef CONFIG_OF_MDIO
612static int dp83822_of_init(struct phy_device *phydev)
613{
614 struct dp83822_private *dp83822 = phydev->priv;
615 struct device *dev = &phydev->mdio.dev;
616
617 /* Signal detection for the PHY is only enabled if the FX_EN and the
618 * SD_EN pins are strapped. Signal detection can only enabled if FX_EN
619 * is strapped otherwise signal detection is disabled for the PHY.
620 */
621 if (dp83822->fx_enabled && dp83822->fx_sd_enable)
622 dp83822->fx_signal_det_low = device_property_present(dev,
623 "ti,link-loss-low");
624 if (!dp83822->fx_enabled)
625 dp83822->fx_enabled = device_property_present(dev,
626 "ti,fiber-mode");
627
628 return 0;
629}
630
631static int dp83826_to_dac_minus_one_regval(int percent)
632{
633 int tmp = DP83826_CFG_DAC_PERCENT_DEFAULT - percent;
634
635 return tmp / DP83826_CFG_DAC_PERCENT_PER_STEP;
636}
637
638static int dp83826_to_dac_plus_one_regval(int percent)
639{
640 int tmp = percent - DP83826_CFG_DAC_PERCENT_DEFAULT;
641
642 return tmp / DP83826_CFG_DAC_PERCENT_PER_STEP;
643}
644
645static void dp83826_of_init(struct phy_device *phydev)
646{
647 struct dp83822_private *dp83822 = phydev->priv;
648 struct device *dev = &phydev->mdio.dev;
649 u32 val;
650
651 dp83822->cfg_dac_minus = DP83826_CFG_DAC_MINUS_DEFAULT;
652 if (!device_property_read_u32(dev, "ti,cfg-dac-minus-one-bp", &val))
653 dp83822->cfg_dac_minus += dp83826_to_dac_minus_one_regval(val);
654
655 dp83822->cfg_dac_plus = DP83826_CFG_DAC_PLUS_DEFAULT;
656 if (!device_property_read_u32(dev, "ti,cfg-dac-plus-one-bp", &val))
657 dp83822->cfg_dac_plus += dp83826_to_dac_plus_one_regval(val);
658}
659#else
660static int dp83822_of_init(struct phy_device *phydev)
661{
662 return 0;
663}
664
665static void dp83826_of_init(struct phy_device *phydev)
666{
667}
668#endif /* CONFIG_OF_MDIO */
669
670static int dp83822_read_straps(struct phy_device *phydev)
671{
672 struct dp83822_private *dp83822 = phydev->priv;
673 int fx_enabled, fx_sd_enable;
674 int val;
675
676 val = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_SOR1);
677 if (val < 0)
678 return val;
679
680 phydev_dbg(phydev, "SOR1 strap register: 0x%04x\n", val);
681
682 fx_enabled = (val & DP83822_COL_STRAP_MASK) >> DP83822_COL_SHIFT;
683 if (fx_enabled == DP83822_STRAP_MODE2 ||
684 fx_enabled == DP83822_STRAP_MODE3)
685 dp83822->fx_enabled = 1;
686
687 if (dp83822->fx_enabled) {
688 fx_sd_enable = (val & DP83822_RX_ER_STR_MASK) >> DP83822_RX_ER_SHIFT;
689 if (fx_sd_enable == DP83822_STRAP_MODE3 ||
690 fx_sd_enable == DP83822_STRAP_MODE4)
691 dp83822->fx_sd_enable = 1;
692 }
693
694 return 0;
695}
696
697static int dp8382x_probe(struct phy_device *phydev)
698{
699 struct dp83822_private *dp83822;
700
701 dp83822 = devm_kzalloc(&phydev->mdio.dev, sizeof(*dp83822),
702 GFP_KERNEL);
703 if (!dp83822)
704 return -ENOMEM;
705
706 phydev->priv = dp83822;
707
708 return 0;
709}
710
711static int dp83822_probe(struct phy_device *phydev)
712{
713 struct dp83822_private *dp83822;
714 int ret;
715
716 ret = dp8382x_probe(phydev);
717 if (ret)
718 return ret;
719
720 dp83822 = phydev->priv;
721
722 ret = dp83822_read_straps(phydev);
723 if (ret)
724 return ret;
725
726 dp83822_of_init(phydev);
727
728 if (dp83822->fx_enabled)
729 phydev->port = PORT_FIBRE;
730
731 return 0;
732}
733
734static int dp83826_probe(struct phy_device *phydev)
735{
736 int ret;
737
738 ret = dp8382x_probe(phydev);
739 if (ret)
740 return ret;
741
742 dp83826_of_init(phydev);
743
744 return 0;
745}
746
747static int dp83822_suspend(struct phy_device *phydev)
748{
749 int value;
750
751 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
752
753 if (!(value & DP83822_WOL_EN))
754 genphy_suspend(phydev);
755
756 return 0;
757}
758
759static int dp83822_resume(struct phy_device *phydev)
760{
761 int value;
762
763 genphy_resume(phydev);
764
765 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
766
767 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG, value |
768 DP83822_WOL_CLR_INDICATION);
769
770 return 0;
771}
772
773#define DP83822_PHY_DRIVER(_id, _name) \
774 { \
775 PHY_ID_MATCH_MODEL(_id), \
776 .name = (_name), \
777 /* PHY_BASIC_FEATURES */ \
778 .probe = dp83822_probe, \
779 .soft_reset = dp83822_phy_reset, \
780 .config_init = dp83822_config_init, \
781 .read_status = dp83822_read_status, \
782 .get_wol = dp83822_get_wol, \
783 .set_wol = dp83822_set_wol, \
784 .config_intr = dp83822_config_intr, \
785 .handle_interrupt = dp83822_handle_interrupt, \
786 .suspend = dp83822_suspend, \
787 .resume = dp83822_resume, \
788 }
789
790#define DP83825_PHY_DRIVER(_id, _name) \
791 { \
792 PHY_ID_MATCH_MODEL(_id), \
793 .name = (_name), \
794 /* PHY_BASIC_FEATURES */ \
795 .probe = dp8382x_probe, \
796 .soft_reset = dp83822_phy_reset, \
797 .config_init = dp83825_config_init, \
798 .get_wol = dp83822_get_wol, \
799 .set_wol = dp83822_set_wol, \
800 .config_intr = dp83822_config_intr, \
801 .handle_interrupt = dp83822_handle_interrupt, \
802 .suspend = dp83822_suspend, \
803 .resume = dp83822_resume, \
804 }
805
806#define DP83826_PHY_DRIVER(_id, _name) \
807 { \
808 PHY_ID_MATCH_MODEL(_id), \
809 .name = (_name), \
810 /* PHY_BASIC_FEATURES */ \
811 .probe = dp83826_probe, \
812 .soft_reset = dp83822_phy_reset, \
813 .config_init = dp83826_config_init, \
814 .get_wol = dp83822_get_wol, \
815 .set_wol = dp83822_set_wol, \
816 .config_intr = dp83822_config_intr, \
817 .handle_interrupt = dp83822_handle_interrupt, \
818 .suspend = dp83822_suspend, \
819 .resume = dp83822_resume, \
820 }
821
822static struct phy_driver dp83822_driver[] = {
823 DP83822_PHY_DRIVER(DP83822_PHY_ID, "TI DP83822"),
824 DP83825_PHY_DRIVER(DP83825I_PHY_ID, "TI DP83825I"),
825 DP83825_PHY_DRIVER(DP83825S_PHY_ID, "TI DP83825S"),
826 DP83825_PHY_DRIVER(DP83825CM_PHY_ID, "TI DP83825M"),
827 DP83825_PHY_DRIVER(DP83825CS_PHY_ID, "TI DP83825CS"),
828 DP83826_PHY_DRIVER(DP83826C_PHY_ID, "TI DP83826C"),
829 DP83826_PHY_DRIVER(DP83826NC_PHY_ID, "TI DP83826NC"),
830};
831module_phy_driver(dp83822_driver);
832
833static struct mdio_device_id __maybe_unused dp83822_tbl[] = {
834 { DP83822_PHY_ID, 0xfffffff0 },
835 { DP83825I_PHY_ID, 0xfffffff0 },
836 { DP83826C_PHY_ID, 0xfffffff0 },
837 { DP83826NC_PHY_ID, 0xfffffff0 },
838 { DP83825S_PHY_ID, 0xfffffff0 },
839 { DP83825CM_PHY_ID, 0xfffffff0 },
840 { DP83825CS_PHY_ID, 0xfffffff0 },
841 { },
842};
843MODULE_DEVICE_TABLE(mdio, dp83822_tbl);
844
845MODULE_DESCRIPTION("Texas Instruments DP83822 PHY driver");
846MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com");
847MODULE_LICENSE("GPL v2");
1// SPDX-License-Identifier: GPL-2.0
2/* Driver for the Texas Instruments DP83822, DP83825 and DP83826 PHYs.
3 *
4 * Copyright (C) 2017 Texas Instruments Inc.
5 */
6
7#include <linux/ethtool.h>
8#include <linux/etherdevice.h>
9#include <linux/kernel.h>
10#include <linux/mii.h>
11#include <linux/module.h>
12#include <linux/of.h>
13#include <linux/phy.h>
14#include <linux/netdevice.h>
15
16#define DP83822_PHY_ID 0x2000a240
17#define DP83825S_PHY_ID 0x2000a140
18#define DP83825I_PHY_ID 0x2000a150
19#define DP83825CM_PHY_ID 0x2000a160
20#define DP83825CS_PHY_ID 0x2000a170
21#define DP83826C_PHY_ID 0x2000a130
22#define DP83826NC_PHY_ID 0x2000a110
23
24#define DP83822_DEVADDR 0x1f
25
26#define MII_DP83822_CTRL_2 0x0a
27#define MII_DP83822_PHYSTS 0x10
28#define MII_DP83822_PHYSCR 0x11
29#define MII_DP83822_MISR1 0x12
30#define MII_DP83822_MISR2 0x13
31#define MII_DP83822_FCSCR 0x14
32#define MII_DP83822_RCSR 0x17
33#define MII_DP83822_RESET_CTRL 0x1f
34#define MII_DP83822_GENCFG 0x465
35#define MII_DP83822_SOR1 0x467
36
37/* GENCFG */
38#define DP83822_SIG_DET_LOW BIT(0)
39
40/* Control Register 2 bits */
41#define DP83822_FX_ENABLE BIT(14)
42
43#define DP83822_HW_RESET BIT(15)
44#define DP83822_SW_RESET BIT(14)
45
46/* PHY STS bits */
47#define DP83822_PHYSTS_DUPLEX BIT(2)
48#define DP83822_PHYSTS_10 BIT(1)
49#define DP83822_PHYSTS_LINK BIT(0)
50
51/* PHYSCR Register Fields */
52#define DP83822_PHYSCR_INT_OE BIT(0) /* Interrupt Output Enable */
53#define DP83822_PHYSCR_INTEN BIT(1) /* Interrupt Enable */
54
55/* MISR1 bits */
56#define DP83822_RX_ERR_HF_INT_EN BIT(0)
57#define DP83822_FALSE_CARRIER_HF_INT_EN BIT(1)
58#define DP83822_ANEG_COMPLETE_INT_EN BIT(2)
59#define DP83822_DUP_MODE_CHANGE_INT_EN BIT(3)
60#define DP83822_SPEED_CHANGED_INT_EN BIT(4)
61#define DP83822_LINK_STAT_INT_EN BIT(5)
62#define DP83822_ENERGY_DET_INT_EN BIT(6)
63#define DP83822_LINK_QUAL_INT_EN BIT(7)
64
65/* MISR2 bits */
66#define DP83822_JABBER_DET_INT_EN BIT(0)
67#define DP83822_WOL_PKT_INT_EN BIT(1)
68#define DP83822_SLEEP_MODE_INT_EN BIT(2)
69#define DP83822_MDI_XOVER_INT_EN BIT(3)
70#define DP83822_LB_FIFO_INT_EN BIT(4)
71#define DP83822_PAGE_RX_INT_EN BIT(5)
72#define DP83822_ANEG_ERR_INT_EN BIT(6)
73#define DP83822_EEE_ERROR_CHANGE_INT_EN BIT(7)
74
75/* INT_STAT1 bits */
76#define DP83822_WOL_INT_EN BIT(4)
77#define DP83822_WOL_INT_STAT BIT(12)
78
79#define MII_DP83822_RXSOP1 0x04a5
80#define MII_DP83822_RXSOP2 0x04a6
81#define MII_DP83822_RXSOP3 0x04a7
82
83/* WoL Registers */
84#define MII_DP83822_WOL_CFG 0x04a0
85#define MII_DP83822_WOL_STAT 0x04a1
86#define MII_DP83822_WOL_DA1 0x04a2
87#define MII_DP83822_WOL_DA2 0x04a3
88#define MII_DP83822_WOL_DA3 0x04a4
89
90/* WoL bits */
91#define DP83822_WOL_MAGIC_EN BIT(0)
92#define DP83822_WOL_SECURE_ON BIT(5)
93#define DP83822_WOL_EN BIT(7)
94#define DP83822_WOL_INDICATION_SEL BIT(8)
95#define DP83822_WOL_CLR_INDICATION BIT(11)
96
97/* RCSR bits */
98#define DP83822_RGMII_MODE_EN BIT(9)
99#define DP83822_RX_CLK_SHIFT BIT(12)
100#define DP83822_TX_CLK_SHIFT BIT(11)
101
102/* SOR1 mode */
103#define DP83822_STRAP_MODE1 0
104#define DP83822_STRAP_MODE2 BIT(0)
105#define DP83822_STRAP_MODE3 BIT(1)
106#define DP83822_STRAP_MODE4 GENMASK(1, 0)
107
108#define DP83822_COL_STRAP_MASK GENMASK(11, 10)
109#define DP83822_COL_SHIFT 10
110#define DP83822_RX_ER_STR_MASK GENMASK(9, 8)
111#define DP83822_RX_ER_SHIFT 8
112
113#define MII_DP83822_FIBER_ADVERTISE (ADVERTISED_TP | ADVERTISED_MII | \
114 ADVERTISED_FIBRE | \
115 ADVERTISED_Pause | ADVERTISED_Asym_Pause)
116
117struct dp83822_private {
118 bool fx_signal_det_low;
119 int fx_enabled;
120 u16 fx_sd_enable;
121};
122
123static int dp83822_set_wol(struct phy_device *phydev,
124 struct ethtool_wolinfo *wol)
125{
126 struct net_device *ndev = phydev->attached_dev;
127 u16 value;
128 const u8 *mac;
129
130 if (wol->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) {
131 mac = (const u8 *)ndev->dev_addr;
132
133 if (!is_valid_ether_addr(mac))
134 return -EINVAL;
135
136 /* MAC addresses start with byte 5, but stored in mac[0].
137 * 822 PHYs store bytes 4|5, 2|3, 0|1
138 */
139 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA1,
140 (mac[1] << 8) | mac[0]);
141 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA2,
142 (mac[3] << 8) | mac[2]);
143 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA3,
144 (mac[5] << 8) | mac[4]);
145
146 value = phy_read_mmd(phydev, DP83822_DEVADDR,
147 MII_DP83822_WOL_CFG);
148 if (wol->wolopts & WAKE_MAGIC)
149 value |= DP83822_WOL_MAGIC_EN;
150 else
151 value &= ~DP83822_WOL_MAGIC_EN;
152
153 if (wol->wolopts & WAKE_MAGICSECURE) {
154 phy_write_mmd(phydev, DP83822_DEVADDR,
155 MII_DP83822_RXSOP1,
156 (wol->sopass[1] << 8) | wol->sopass[0]);
157 phy_write_mmd(phydev, DP83822_DEVADDR,
158 MII_DP83822_RXSOP2,
159 (wol->sopass[3] << 8) | wol->sopass[2]);
160 phy_write_mmd(phydev, DP83822_DEVADDR,
161 MII_DP83822_RXSOP3,
162 (wol->sopass[5] << 8) | wol->sopass[4]);
163 value |= DP83822_WOL_SECURE_ON;
164 } else {
165 value &= ~DP83822_WOL_SECURE_ON;
166 }
167
168 /* Clear any pending WoL interrupt */
169 phy_read(phydev, MII_DP83822_MISR2);
170
171 value |= DP83822_WOL_EN | DP83822_WOL_INDICATION_SEL |
172 DP83822_WOL_CLR_INDICATION;
173
174 return phy_write_mmd(phydev, DP83822_DEVADDR,
175 MII_DP83822_WOL_CFG, value);
176 } else {
177 return phy_clear_bits_mmd(phydev, DP83822_DEVADDR,
178 MII_DP83822_WOL_CFG, DP83822_WOL_EN);
179 }
180}
181
182static void dp83822_get_wol(struct phy_device *phydev,
183 struct ethtool_wolinfo *wol)
184{
185 int value;
186 u16 sopass_val;
187
188 wol->supported = (WAKE_MAGIC | WAKE_MAGICSECURE);
189 wol->wolopts = 0;
190
191 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
192
193 if (value & DP83822_WOL_MAGIC_EN)
194 wol->wolopts |= WAKE_MAGIC;
195
196 if (value & DP83822_WOL_SECURE_ON) {
197 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
198 MII_DP83822_RXSOP1);
199 wol->sopass[0] = (sopass_val & 0xff);
200 wol->sopass[1] = (sopass_val >> 8);
201
202 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
203 MII_DP83822_RXSOP2);
204 wol->sopass[2] = (sopass_val & 0xff);
205 wol->sopass[3] = (sopass_val >> 8);
206
207 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
208 MII_DP83822_RXSOP3);
209 wol->sopass[4] = (sopass_val & 0xff);
210 wol->sopass[5] = (sopass_val >> 8);
211
212 wol->wolopts |= WAKE_MAGICSECURE;
213 }
214
215 /* WoL is not enabled so set wolopts to 0 */
216 if (!(value & DP83822_WOL_EN))
217 wol->wolopts = 0;
218}
219
220static int dp83822_config_intr(struct phy_device *phydev)
221{
222 struct dp83822_private *dp83822 = phydev->priv;
223 int misr_status;
224 int physcr_status;
225 int err;
226
227 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
228 misr_status = phy_read(phydev, MII_DP83822_MISR1);
229 if (misr_status < 0)
230 return misr_status;
231
232 misr_status |= (DP83822_LINK_STAT_INT_EN |
233 DP83822_ENERGY_DET_INT_EN |
234 DP83822_LINK_QUAL_INT_EN);
235
236 /* Private data pointer is NULL on DP83825/26 */
237 if (!dp83822 || !dp83822->fx_enabled)
238 misr_status |= DP83822_ANEG_COMPLETE_INT_EN |
239 DP83822_DUP_MODE_CHANGE_INT_EN |
240 DP83822_SPEED_CHANGED_INT_EN;
241
242
243 err = phy_write(phydev, MII_DP83822_MISR1, misr_status);
244 if (err < 0)
245 return err;
246
247 misr_status = phy_read(phydev, MII_DP83822_MISR2);
248 if (misr_status < 0)
249 return misr_status;
250
251 misr_status |= (DP83822_JABBER_DET_INT_EN |
252 DP83822_SLEEP_MODE_INT_EN |
253 DP83822_LB_FIFO_INT_EN |
254 DP83822_PAGE_RX_INT_EN |
255 DP83822_EEE_ERROR_CHANGE_INT_EN);
256
257 /* Private data pointer is NULL on DP83825/26 */
258 if (!dp83822 || !dp83822->fx_enabled)
259 misr_status |= DP83822_ANEG_ERR_INT_EN |
260 DP83822_WOL_PKT_INT_EN;
261
262 err = phy_write(phydev, MII_DP83822_MISR2, misr_status);
263 if (err < 0)
264 return err;
265
266 physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
267 if (physcr_status < 0)
268 return physcr_status;
269
270 physcr_status |= DP83822_PHYSCR_INT_OE | DP83822_PHYSCR_INTEN;
271
272 } else {
273 err = phy_write(phydev, MII_DP83822_MISR1, 0);
274 if (err < 0)
275 return err;
276
277 err = phy_write(phydev, MII_DP83822_MISR2, 0);
278 if (err < 0)
279 return err;
280
281 physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
282 if (physcr_status < 0)
283 return physcr_status;
284
285 physcr_status &= ~DP83822_PHYSCR_INTEN;
286 }
287
288 return phy_write(phydev, MII_DP83822_PHYSCR, physcr_status);
289}
290
291static irqreturn_t dp83822_handle_interrupt(struct phy_device *phydev)
292{
293 bool trigger_machine = false;
294 int irq_status;
295
296 /* The MISR1 and MISR2 registers are holding the interrupt status in
297 * the upper half (15:8), while the lower half (7:0) is used for
298 * controlling the interrupt enable state of those individual interrupt
299 * sources. To determine the possible interrupt sources, just read the
300 * MISR* register and use it directly to know which interrupts have
301 * been enabled previously or not.
302 */
303 irq_status = phy_read(phydev, MII_DP83822_MISR1);
304 if (irq_status < 0) {
305 phy_error(phydev);
306 return IRQ_NONE;
307 }
308 if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
309 trigger_machine = true;
310
311 irq_status = phy_read(phydev, MII_DP83822_MISR2);
312 if (irq_status < 0) {
313 phy_error(phydev);
314 return IRQ_NONE;
315 }
316 if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
317 trigger_machine = true;
318
319 if (!trigger_machine)
320 return IRQ_NONE;
321
322 phy_trigger_machine(phydev);
323
324 return IRQ_HANDLED;
325}
326
327static int dp8382x_disable_wol(struct phy_device *phydev)
328{
329 return phy_clear_bits_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG,
330 DP83822_WOL_EN | DP83822_WOL_MAGIC_EN |
331 DP83822_WOL_SECURE_ON);
332}
333
334static int dp83822_read_status(struct phy_device *phydev)
335{
336 struct dp83822_private *dp83822 = phydev->priv;
337 int status = phy_read(phydev, MII_DP83822_PHYSTS);
338 int ctrl2;
339 int ret;
340
341 if (dp83822->fx_enabled) {
342 if (status & DP83822_PHYSTS_LINK) {
343 phydev->speed = SPEED_UNKNOWN;
344 phydev->duplex = DUPLEX_UNKNOWN;
345 } else {
346 ctrl2 = phy_read(phydev, MII_DP83822_CTRL_2);
347 if (ctrl2 < 0)
348 return ctrl2;
349
350 if (!(ctrl2 & DP83822_FX_ENABLE)) {
351 ret = phy_write(phydev, MII_DP83822_CTRL_2,
352 DP83822_FX_ENABLE | ctrl2);
353 if (ret < 0)
354 return ret;
355 }
356 }
357 }
358
359 ret = genphy_read_status(phydev);
360 if (ret)
361 return ret;
362
363 if (status < 0)
364 return status;
365
366 if (status & DP83822_PHYSTS_DUPLEX)
367 phydev->duplex = DUPLEX_FULL;
368 else
369 phydev->duplex = DUPLEX_HALF;
370
371 if (status & DP83822_PHYSTS_10)
372 phydev->speed = SPEED_10;
373 else
374 phydev->speed = SPEED_100;
375
376 return 0;
377}
378
379static int dp83822_config_init(struct phy_device *phydev)
380{
381 struct dp83822_private *dp83822 = phydev->priv;
382 struct device *dev = &phydev->mdio.dev;
383 int rgmii_delay;
384 s32 rx_int_delay;
385 s32 tx_int_delay;
386 int err = 0;
387 int bmcr;
388
389 if (phy_interface_is_rgmii(phydev)) {
390 rx_int_delay = phy_get_internal_delay(phydev, dev, NULL, 0,
391 true);
392
393 if (rx_int_delay <= 0)
394 rgmii_delay = 0;
395 else
396 rgmii_delay = DP83822_RX_CLK_SHIFT;
397
398 tx_int_delay = phy_get_internal_delay(phydev, dev, NULL, 0,
399 false);
400 if (tx_int_delay <= 0)
401 rgmii_delay &= ~DP83822_TX_CLK_SHIFT;
402 else
403 rgmii_delay |= DP83822_TX_CLK_SHIFT;
404
405 if (rgmii_delay) {
406 err = phy_set_bits_mmd(phydev, DP83822_DEVADDR,
407 MII_DP83822_RCSR, rgmii_delay);
408 if (err)
409 return err;
410 }
411
412 phy_set_bits_mmd(phydev, DP83822_DEVADDR,
413 MII_DP83822_RCSR, DP83822_RGMII_MODE_EN);
414 } else {
415 phy_clear_bits_mmd(phydev, DP83822_DEVADDR,
416 MII_DP83822_RCSR, DP83822_RGMII_MODE_EN);
417 }
418
419 if (dp83822->fx_enabled) {
420 err = phy_modify(phydev, MII_DP83822_CTRL_2,
421 DP83822_FX_ENABLE, 1);
422 if (err < 0)
423 return err;
424
425 /* Only allow advertising what this PHY supports */
426 linkmode_and(phydev->advertising, phydev->advertising,
427 phydev->supported);
428
429 linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT,
430 phydev->supported);
431 linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT,
432 phydev->advertising);
433 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Full_BIT,
434 phydev->supported);
435 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Half_BIT,
436 phydev->supported);
437 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Full_BIT,
438 phydev->advertising);
439 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Half_BIT,
440 phydev->advertising);
441
442 /* Auto neg is not supported in fiber mode */
443 bmcr = phy_read(phydev, MII_BMCR);
444 if (bmcr < 0)
445 return bmcr;
446
447 if (bmcr & BMCR_ANENABLE) {
448 err = phy_modify(phydev, MII_BMCR, BMCR_ANENABLE, 0);
449 if (err < 0)
450 return err;
451 }
452 phydev->autoneg = AUTONEG_DISABLE;
453 linkmode_clear_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
454 phydev->supported);
455 linkmode_clear_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
456 phydev->advertising);
457
458 /* Setup fiber advertisement */
459 err = phy_modify_changed(phydev, MII_ADVERTISE,
460 MII_DP83822_FIBER_ADVERTISE,
461 MII_DP83822_FIBER_ADVERTISE);
462
463 if (err < 0)
464 return err;
465
466 if (dp83822->fx_signal_det_low) {
467 err = phy_set_bits_mmd(phydev, DP83822_DEVADDR,
468 MII_DP83822_GENCFG,
469 DP83822_SIG_DET_LOW);
470 if (err)
471 return err;
472 }
473 }
474 return dp8382x_disable_wol(phydev);
475}
476
477static int dp8382x_config_init(struct phy_device *phydev)
478{
479 return dp8382x_disable_wol(phydev);
480}
481
482static int dp83822_phy_reset(struct phy_device *phydev)
483{
484 int err;
485
486 err = phy_write(phydev, MII_DP83822_RESET_CTRL, DP83822_SW_RESET);
487 if (err < 0)
488 return err;
489
490 return phydev->drv->config_init(phydev);
491}
492
493#ifdef CONFIG_OF_MDIO
494static int dp83822_of_init(struct phy_device *phydev)
495{
496 struct dp83822_private *dp83822 = phydev->priv;
497 struct device *dev = &phydev->mdio.dev;
498
499 /* Signal detection for the PHY is only enabled if the FX_EN and the
500 * SD_EN pins are strapped. Signal detection can only enabled if FX_EN
501 * is strapped otherwise signal detection is disabled for the PHY.
502 */
503 if (dp83822->fx_enabled && dp83822->fx_sd_enable)
504 dp83822->fx_signal_det_low = device_property_present(dev,
505 "ti,link-loss-low");
506 if (!dp83822->fx_enabled)
507 dp83822->fx_enabled = device_property_present(dev,
508 "ti,fiber-mode");
509
510 return 0;
511}
512#else
513static int dp83822_of_init(struct phy_device *phydev)
514{
515 return 0;
516}
517#endif /* CONFIG_OF_MDIO */
518
519static int dp83822_read_straps(struct phy_device *phydev)
520{
521 struct dp83822_private *dp83822 = phydev->priv;
522 int fx_enabled, fx_sd_enable;
523 int val;
524
525 val = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_SOR1);
526 if (val < 0)
527 return val;
528
529 phydev_dbg(phydev, "SOR1 strap register: 0x%04x\n", val);
530
531 fx_enabled = (val & DP83822_COL_STRAP_MASK) >> DP83822_COL_SHIFT;
532 if (fx_enabled == DP83822_STRAP_MODE2 ||
533 fx_enabled == DP83822_STRAP_MODE3)
534 dp83822->fx_enabled = 1;
535
536 if (dp83822->fx_enabled) {
537 fx_sd_enable = (val & DP83822_RX_ER_STR_MASK) >> DP83822_RX_ER_SHIFT;
538 if (fx_sd_enable == DP83822_STRAP_MODE3 ||
539 fx_sd_enable == DP83822_STRAP_MODE4)
540 dp83822->fx_sd_enable = 1;
541 }
542
543 return 0;
544}
545
546static int dp83822_probe(struct phy_device *phydev)
547{
548 struct dp83822_private *dp83822;
549 int ret;
550
551 dp83822 = devm_kzalloc(&phydev->mdio.dev, sizeof(*dp83822),
552 GFP_KERNEL);
553 if (!dp83822)
554 return -ENOMEM;
555
556 phydev->priv = dp83822;
557
558 ret = dp83822_read_straps(phydev);
559 if (ret)
560 return ret;
561
562 dp83822_of_init(phydev);
563
564 if (dp83822->fx_enabled)
565 phydev->port = PORT_FIBRE;
566
567 return 0;
568}
569
570static int dp83822_suspend(struct phy_device *phydev)
571{
572 int value;
573
574 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
575
576 if (!(value & DP83822_WOL_EN))
577 genphy_suspend(phydev);
578
579 return 0;
580}
581
582static int dp83822_resume(struct phy_device *phydev)
583{
584 int value;
585
586 genphy_resume(phydev);
587
588 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
589
590 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG, value |
591 DP83822_WOL_CLR_INDICATION);
592
593 return 0;
594}
595
596#define DP83822_PHY_DRIVER(_id, _name) \
597 { \
598 PHY_ID_MATCH_MODEL(_id), \
599 .name = (_name), \
600 /* PHY_BASIC_FEATURES */ \
601 .probe = dp83822_probe, \
602 .soft_reset = dp83822_phy_reset, \
603 .config_init = dp83822_config_init, \
604 .read_status = dp83822_read_status, \
605 .get_wol = dp83822_get_wol, \
606 .set_wol = dp83822_set_wol, \
607 .config_intr = dp83822_config_intr, \
608 .handle_interrupt = dp83822_handle_interrupt, \
609 .suspend = dp83822_suspend, \
610 .resume = dp83822_resume, \
611 }
612
613#define DP8382X_PHY_DRIVER(_id, _name) \
614 { \
615 PHY_ID_MATCH_MODEL(_id), \
616 .name = (_name), \
617 /* PHY_BASIC_FEATURES */ \
618 .soft_reset = dp83822_phy_reset, \
619 .config_init = dp8382x_config_init, \
620 .get_wol = dp83822_get_wol, \
621 .set_wol = dp83822_set_wol, \
622 .config_intr = dp83822_config_intr, \
623 .handle_interrupt = dp83822_handle_interrupt, \
624 .suspend = dp83822_suspend, \
625 .resume = dp83822_resume, \
626 }
627
628static struct phy_driver dp83822_driver[] = {
629 DP83822_PHY_DRIVER(DP83822_PHY_ID, "TI DP83822"),
630 DP8382X_PHY_DRIVER(DP83825I_PHY_ID, "TI DP83825I"),
631 DP8382X_PHY_DRIVER(DP83826C_PHY_ID, "TI DP83826C"),
632 DP8382X_PHY_DRIVER(DP83826NC_PHY_ID, "TI DP83826NC"),
633 DP8382X_PHY_DRIVER(DP83825S_PHY_ID, "TI DP83825S"),
634 DP8382X_PHY_DRIVER(DP83825CM_PHY_ID, "TI DP83825M"),
635 DP8382X_PHY_DRIVER(DP83825CS_PHY_ID, "TI DP83825CS"),
636};
637module_phy_driver(dp83822_driver);
638
639static struct mdio_device_id __maybe_unused dp83822_tbl[] = {
640 { DP83822_PHY_ID, 0xfffffff0 },
641 { DP83825I_PHY_ID, 0xfffffff0 },
642 { DP83826C_PHY_ID, 0xfffffff0 },
643 { DP83826NC_PHY_ID, 0xfffffff0 },
644 { DP83825S_PHY_ID, 0xfffffff0 },
645 { DP83825CM_PHY_ID, 0xfffffff0 },
646 { DP83825CS_PHY_ID, 0xfffffff0 },
647 { },
648};
649MODULE_DEVICE_TABLE(mdio, dp83822_tbl);
650
651MODULE_DESCRIPTION("Texas Instruments DP83822 PHY driver");
652MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com");
653MODULE_LICENSE("GPL v2");