Loading...
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Driver for Vitesse PHYs
4 *
5 * Author: Kriston Carson
6 */
7
8#include <linux/kernel.h>
9#include <linux/module.h>
10#include <linux/mii.h>
11#include <linux/ethtool.h>
12#include <linux/phy.h>
13#include <linux/bitfield.h>
14
15/* Vitesse Extended Page Magic Register(s) */
16#define MII_VSC73XX_EXT_PAGE_1E 0x01
17#define MII_VSC82X4_EXT_PAGE_16E 0x10
18#define MII_VSC82X4_EXT_PAGE_17E 0x11
19#define MII_VSC82X4_EXT_PAGE_18E 0x12
20
21/* Vitesse Extended Control Register 1 */
22#define MII_VSC8244_EXT_CON1 0x17
23#define MII_VSC8244_EXTCON1_INIT 0x0000
24#define MII_VSC8244_EXTCON1_TX_SKEW_MASK 0x0c00
25#define MII_VSC8244_EXTCON1_RX_SKEW_MASK 0x0300
26#define MII_VSC8244_EXTCON1_TX_SKEW 0x0800
27#define MII_VSC8244_EXTCON1_RX_SKEW 0x0200
28
29/* Vitesse Interrupt Mask Register */
30#define MII_VSC8244_IMASK 0x19
31#define MII_VSC8244_IMASK_IEN 0x8000
32#define MII_VSC8244_IMASK_SPEED 0x4000
33#define MII_VSC8244_IMASK_LINK 0x2000
34#define MII_VSC8244_IMASK_DUPLEX 0x1000
35#define MII_VSC8244_IMASK_MASK 0xf000
36
37#define MII_VSC8221_IMASK_MASK 0xa000
38
39/* Vitesse Interrupt Status Register */
40#define MII_VSC8244_ISTAT 0x1a
41#define MII_VSC8244_ISTAT_STATUS 0x8000
42#define MII_VSC8244_ISTAT_SPEED 0x4000
43#define MII_VSC8244_ISTAT_LINK 0x2000
44#define MII_VSC8244_ISTAT_DUPLEX 0x1000
45#define MII_VSC8244_ISTAT_MASK (MII_VSC8244_ISTAT_SPEED | \
46 MII_VSC8244_ISTAT_LINK | \
47 MII_VSC8244_ISTAT_DUPLEX)
48
49#define MII_VSC8221_ISTAT_MASK MII_VSC8244_ISTAT_LINK
50
51/* Vitesse Auxiliary Control/Status Register */
52#define MII_VSC8244_AUX_CONSTAT 0x1c
53#define MII_VSC8244_AUXCONSTAT_INIT 0x0000
54#define MII_VSC8244_AUXCONSTAT_DUPLEX 0x0020
55#define MII_VSC8244_AUXCONSTAT_SPEED 0x0018
56#define MII_VSC8244_AUXCONSTAT_GBIT 0x0010
57#define MII_VSC8244_AUXCONSTAT_100 0x0008
58
59#define MII_VSC8221_AUXCONSTAT_INIT 0x0004 /* need to set this bit? */
60#define MII_VSC8221_AUXCONSTAT_RESERVED 0x0004
61
62/* Vitesse Extended Page Access Register */
63#define MII_VSC82X4_EXT_PAGE_ACCESS 0x1f
64
65/* Vitesse VSC73XX Extended Control Register */
66#define MII_VSC73XX_PHY_CTRL_EXT3 0x14
67
68#define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN BIT(4)
69#define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT GENMASK(3, 2)
70#define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_STA BIT(1)
71#define MII_VSC73XX_DOWNSHIFT_MAX 5
72#define MII_VSC73XX_DOWNSHIFT_INVAL 1
73
74/* VSC73XX PHY_BYPASS_CTRL register*/
75#define MII_VSC73XX_PHY_BYPASS_CTRL MII_DCOUNTER
76#define MII_VSC73XX_PBC_TX_DIS BIT(15)
77#define MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS BIT(7)
78#define MII_VSC73XX_PBC_PAIR_SWAP_DIS BIT(5)
79#define MII_VSC73XX_PBC_POL_INV_DIS BIT(4)
80#define MII_VSC73XX_PBC_PARALLEL_DET_DIS BIT(3)
81#define MII_VSC73XX_PBC_AUTO_NP_EXCHANGE_DIS BIT(1)
82
83/* VSC73XX PHY_AUX_CTRL_STAT register */
84#define MII_VSC73XX_PHY_AUX_CTRL_STAT MII_NCONFIG
85#define MII_VSC73XX_PACS_NO_MDI_X_IND BIT(13)
86
87/* Vitesse VSC8601 Extended PHY Control Register 1 */
88#define MII_VSC8601_EPHY_CTL 0x17
89#define MII_VSC8601_EPHY_CTL_RGMII_SKEW (1 << 8)
90
91#define PHY_ID_VSC8234 0x000fc620
92#define PHY_ID_VSC8244 0x000fc6c0
93#define PHY_ID_VSC8572 0x000704d0
94#define PHY_ID_VSC8601 0x00070420
95#define PHY_ID_VSC7385 0x00070450
96#define PHY_ID_VSC7388 0x00070480
97#define PHY_ID_VSC7395 0x00070550
98#define PHY_ID_VSC7398 0x00070580
99#define PHY_ID_VSC8662 0x00070660
100#define PHY_ID_VSC8221 0x000fc550
101#define PHY_ID_VSC8211 0x000fc4b0
102
103MODULE_DESCRIPTION("Vitesse PHY driver");
104MODULE_AUTHOR("Kriston Carson");
105MODULE_LICENSE("GPL");
106
107static int vsc824x_add_skew(struct phy_device *phydev)
108{
109 int err;
110 int extcon;
111
112 extcon = phy_read(phydev, MII_VSC8244_EXT_CON1);
113
114 if (extcon < 0)
115 return extcon;
116
117 extcon &= ~(MII_VSC8244_EXTCON1_TX_SKEW_MASK |
118 MII_VSC8244_EXTCON1_RX_SKEW_MASK);
119
120 extcon |= (MII_VSC8244_EXTCON1_TX_SKEW |
121 MII_VSC8244_EXTCON1_RX_SKEW);
122
123 err = phy_write(phydev, MII_VSC8244_EXT_CON1, extcon);
124
125 return err;
126}
127
128static int vsc824x_config_init(struct phy_device *phydev)
129{
130 int err;
131
132 err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
133 MII_VSC8244_AUXCONSTAT_INIT);
134 if (err < 0)
135 return err;
136
137 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
138 err = vsc824x_add_skew(phydev);
139
140 return err;
141}
142
143#define VSC73XX_EXT_PAGE_ACCESS 0x1f
144
145static int vsc73xx_read_page(struct phy_device *phydev)
146{
147 return __phy_read(phydev, VSC73XX_EXT_PAGE_ACCESS);
148}
149
150static int vsc73xx_write_page(struct phy_device *phydev, int page)
151{
152 return __phy_write(phydev, VSC73XX_EXT_PAGE_ACCESS, page);
153}
154
155static int vsc73xx_get_downshift(struct phy_device *phydev, u8 *data)
156{
157 int val, enable, cnt;
158
159 val = phy_read_paged(phydev, MII_VSC73XX_EXT_PAGE_1E,
160 MII_VSC73XX_PHY_CTRL_EXT3);
161 if (val < 0)
162 return val;
163
164 enable = FIELD_GET(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN, val);
165 cnt = FIELD_GET(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT, val) + 2;
166
167 *data = enable ? cnt : DOWNSHIFT_DEV_DISABLE;
168
169 return 0;
170}
171
172static int vsc73xx_set_downshift(struct phy_device *phydev, u8 cnt)
173{
174 u16 mask, val;
175 int ret;
176
177 if (cnt > MII_VSC73XX_DOWNSHIFT_MAX)
178 return -E2BIG;
179 else if (cnt == MII_VSC73XX_DOWNSHIFT_INVAL)
180 return -EINVAL;
181
182 mask = MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN;
183
184 if (!cnt) {
185 val = 0;
186 } else {
187 mask |= MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT;
188 val = MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN |
189 FIELD_PREP(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT,
190 cnt - 2);
191 }
192
193 ret = phy_modify_paged(phydev, MII_VSC73XX_EXT_PAGE_1E,
194 MII_VSC73XX_PHY_CTRL_EXT3, mask, val);
195 if (ret < 0)
196 return ret;
197
198 return genphy_soft_reset(phydev);
199}
200
201static int vsc73xx_get_tunable(struct phy_device *phydev,
202 struct ethtool_tunable *tuna, void *data)
203{
204 switch (tuna->id) {
205 case ETHTOOL_PHY_DOWNSHIFT:
206 return vsc73xx_get_downshift(phydev, data);
207 default:
208 return -EOPNOTSUPP;
209 }
210}
211
212static int vsc73xx_set_tunable(struct phy_device *phydev,
213 struct ethtool_tunable *tuna, const void *data)
214{
215 switch (tuna->id) {
216 case ETHTOOL_PHY_DOWNSHIFT:
217 return vsc73xx_set_downshift(phydev, *(const u8 *)data);
218 default:
219 return -EOPNOTSUPP;
220 }
221}
222
223static void vsc73xx_config_init(struct phy_device *phydev)
224{
225 /* Receiver init */
226 phy_write(phydev, 0x1f, 0x2a30);
227 phy_modify(phydev, 0x0c, 0x0300, 0x0200);
228 phy_write(phydev, 0x1f, 0x0000);
229
230 /* Config LEDs 0x61 */
231 phy_modify(phydev, MII_TPISTATUS, 0xff00, 0x0061);
232
233 /* Enable downshift by default */
234 vsc73xx_set_downshift(phydev, MII_VSC73XX_DOWNSHIFT_MAX);
235
236 /* Set Auto MDI-X by default */
237 phydev->mdix_ctrl = ETH_TP_MDI_AUTO;
238}
239
240static int vsc738x_config_init(struct phy_device *phydev)
241{
242 u16 rev;
243 /* This magic sequence appear in the application note
244 * "VSC7385/7388 PHY Configuration".
245 *
246 * Maybe one day we will get to know what it all means.
247 */
248 phy_write(phydev, 0x1f, 0x2a30);
249 phy_modify(phydev, 0x08, 0x0200, 0x0200);
250 phy_write(phydev, 0x1f, 0x52b5);
251 phy_write(phydev, 0x10, 0xb68a);
252 phy_modify(phydev, 0x12, 0xff07, 0x0003);
253 phy_modify(phydev, 0x11, 0x00ff, 0x00a2);
254 phy_write(phydev, 0x10, 0x968a);
255 phy_write(phydev, 0x1f, 0x2a30);
256 phy_modify(phydev, 0x08, 0x0200, 0x0000);
257 phy_write(phydev, 0x1f, 0x0000);
258
259 /* Read revision */
260 rev = phy_read(phydev, MII_PHYSID2);
261 rev &= 0x0f;
262
263 /* Special quirk for revision 0 */
264 if (rev == 0) {
265 phy_write(phydev, 0x1f, 0x2a30);
266 phy_modify(phydev, 0x08, 0x0200, 0x0200);
267 phy_write(phydev, 0x1f, 0x52b5);
268 phy_write(phydev, 0x12, 0x0000);
269 phy_write(phydev, 0x11, 0x0689);
270 phy_write(phydev, 0x10, 0x8f92);
271 phy_write(phydev, 0x1f, 0x52b5);
272 phy_write(phydev, 0x12, 0x0000);
273 phy_write(phydev, 0x11, 0x0e35);
274 phy_write(phydev, 0x10, 0x9786);
275 phy_write(phydev, 0x1f, 0x2a30);
276 phy_modify(phydev, 0x08, 0x0200, 0x0000);
277 phy_write(phydev, 0x17, 0xff80);
278 phy_write(phydev, 0x17, 0x0000);
279 }
280
281 phy_write(phydev, 0x1f, 0x0000);
282 phy_write(phydev, 0x12, 0x0048);
283
284 if (rev == 0) {
285 phy_write(phydev, 0x1f, 0x2a30);
286 phy_write(phydev, 0x14, 0x6600);
287 phy_write(phydev, 0x1f, 0x0000);
288 phy_write(phydev, 0x18, 0xa24e);
289 } else {
290 phy_write(phydev, 0x1f, 0x2a30);
291 phy_modify(phydev, 0x16, 0x0fc0, 0x0240);
292 phy_modify(phydev, 0x14, 0x6000, 0x4000);
293 /* bits 14-15 in extended register 0x14 controls DACG amplitude
294 * 6 = -8%, 2 is hardware default
295 */
296 phy_write(phydev, 0x1f, 0x0001);
297 phy_modify(phydev, 0x14, 0xe000, 0x6000);
298 phy_write(phydev, 0x1f, 0x0000);
299 }
300
301 vsc73xx_config_init(phydev);
302
303 return 0;
304}
305
306static int vsc739x_config_init(struct phy_device *phydev)
307{
308 /* This magic sequence appears in the VSC7395 SparX-G5e application
309 * note "VSC7395/VSC7398 PHY Configuration"
310 *
311 * Maybe one day we will get to know what it all means.
312 */
313 phy_write(phydev, 0x1f, 0x2a30);
314 phy_modify(phydev, 0x08, 0x0200, 0x0200);
315 phy_write(phydev, 0x1f, 0x52b5);
316 phy_write(phydev, 0x10, 0xb68a);
317 phy_modify(phydev, 0x12, 0xff07, 0x0003);
318 phy_modify(phydev, 0x11, 0x00ff, 0x00a2);
319 phy_write(phydev, 0x10, 0x968a);
320 phy_write(phydev, 0x1f, 0x2a30);
321 phy_modify(phydev, 0x08, 0x0200, 0x0000);
322 phy_write(phydev, 0x1f, 0x0000);
323
324 phy_write(phydev, 0x1f, 0x0000);
325 phy_write(phydev, 0x12, 0x0048);
326 phy_write(phydev, 0x1f, 0x2a30);
327 phy_modify(phydev, 0x16, 0x0fc0, 0x0240);
328 phy_modify(phydev, 0x14, 0x6000, 0x4000);
329 phy_write(phydev, 0x1f, 0x0001);
330 phy_modify(phydev, 0x14, 0xe000, 0x6000);
331 phy_write(phydev, 0x1f, 0x0000);
332
333 vsc73xx_config_init(phydev);
334
335 return 0;
336}
337
338static int vsc73xx_mdix_set(struct phy_device *phydev, u8 mdix)
339{
340 int ret;
341 u16 val;
342
343 val = phy_read(phydev, MII_VSC73XX_PHY_BYPASS_CTRL);
344
345 switch (mdix) {
346 case ETH_TP_MDI:
347 val |= MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS |
348 MII_VSC73XX_PBC_PAIR_SWAP_DIS |
349 MII_VSC73XX_PBC_POL_INV_DIS;
350 break;
351 case ETH_TP_MDI_X:
352 /* When MDI-X auto configuration is disabled, is possible
353 * to force only MDI mode. Let's use autoconfig for forced
354 * MDIX mode.
355 */
356 case ETH_TP_MDI_AUTO:
357 val &= ~(MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS |
358 MII_VSC73XX_PBC_PAIR_SWAP_DIS |
359 MII_VSC73XX_PBC_POL_INV_DIS);
360 break;
361 default:
362 return -EINVAL;
363 }
364
365 ret = phy_write(phydev, MII_VSC73XX_PHY_BYPASS_CTRL, val);
366 if (ret)
367 return ret;
368
369 return genphy_restart_aneg(phydev);
370}
371
372static int vsc73xx_config_aneg(struct phy_device *phydev)
373{
374 int ret;
375
376 ret = vsc73xx_mdix_set(phydev, phydev->mdix_ctrl);
377 if (ret)
378 return ret;
379
380 return genphy_config_aneg(phydev);
381}
382
383static int vsc73xx_mdix_get(struct phy_device *phydev, u8 *mdix)
384{
385 u16 reg_val;
386
387 reg_val = phy_read(phydev, MII_VSC73XX_PHY_AUX_CTRL_STAT);
388 if (reg_val & MII_VSC73XX_PACS_NO_MDI_X_IND)
389 *mdix = ETH_TP_MDI;
390 else
391 *mdix = ETH_TP_MDI_X;
392
393 return 0;
394}
395
396static int vsc73xx_read_status(struct phy_device *phydev)
397{
398 int ret;
399
400 ret = vsc73xx_mdix_get(phydev, &phydev->mdix);
401 if (ret < 0)
402 return ret;
403
404 return genphy_read_status(phydev);
405}
406
407/* This adds a skew for both TX and RX clocks, so the skew should only be
408 * applied to "rgmii-id" interfaces. It may not work as expected
409 * on "rgmii-txid", "rgmii-rxid" or "rgmii" interfaces.
410 */
411static int vsc8601_add_skew(struct phy_device *phydev)
412{
413 int ret;
414
415 ret = phy_read(phydev, MII_VSC8601_EPHY_CTL);
416 if (ret < 0)
417 return ret;
418
419 ret |= MII_VSC8601_EPHY_CTL_RGMII_SKEW;
420 return phy_write(phydev, MII_VSC8601_EPHY_CTL, ret);
421}
422
423static int vsc8601_config_init(struct phy_device *phydev)
424{
425 int ret = 0;
426
427 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
428 ret = vsc8601_add_skew(phydev);
429
430 if (ret < 0)
431 return ret;
432
433 return 0;
434}
435
436static int vsc82xx_config_intr(struct phy_device *phydev)
437{
438 int err;
439
440 if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
441 /* Don't bother to ACK the interrupts since the 824x cannot
442 * clear the interrupts if they are disabled.
443 */
444 err = phy_write(phydev, MII_VSC8244_IMASK,
445 (phydev->drv->phy_id == PHY_ID_VSC8234 ||
446 phydev->drv->phy_id == PHY_ID_VSC8244 ||
447 phydev->drv->phy_id == PHY_ID_VSC8572 ||
448 phydev->drv->phy_id == PHY_ID_VSC8601) ?
449 MII_VSC8244_IMASK_MASK :
450 MII_VSC8221_IMASK_MASK);
451 else {
452 /* The Vitesse PHY cannot clear the interrupt
453 * once it has disabled them, so we clear them first
454 */
455 err = phy_read(phydev, MII_VSC8244_ISTAT);
456
457 if (err < 0)
458 return err;
459
460 err = phy_write(phydev, MII_VSC8244_IMASK, 0);
461 }
462
463 return err;
464}
465
466static irqreturn_t vsc82xx_handle_interrupt(struct phy_device *phydev)
467{
468 int irq_status, irq_mask;
469
470 if (phydev->drv->phy_id == PHY_ID_VSC8244 ||
471 phydev->drv->phy_id == PHY_ID_VSC8572 ||
472 phydev->drv->phy_id == PHY_ID_VSC8601)
473 irq_mask = MII_VSC8244_ISTAT_MASK;
474 else
475 irq_mask = MII_VSC8221_ISTAT_MASK;
476
477 irq_status = phy_read(phydev, MII_VSC8244_ISTAT);
478 if (irq_status < 0) {
479 phy_error(phydev);
480 return IRQ_NONE;
481 }
482
483 if (!(irq_status & irq_mask))
484 return IRQ_NONE;
485
486 phy_trigger_machine(phydev);
487
488 return IRQ_HANDLED;
489}
490
491static int vsc8221_config_init(struct phy_device *phydev)
492{
493 int err;
494
495 err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
496 MII_VSC8221_AUXCONSTAT_INIT);
497 return err;
498
499 /* Perhaps we should set EXT_CON1 based on the interface?
500 * Options are 802.3Z SerDes or SGMII
501 */
502}
503
504/* vsc82x4_config_autocross_enable - Enable auto MDI/MDI-X for forced links
505 * @phydev: target phy_device struct
506 *
507 * Enable auto MDI/MDI-X when in 10/100 forced link speeds by writing
508 * special values in the VSC8234/VSC8244 extended reserved registers
509 */
510static int vsc82x4_config_autocross_enable(struct phy_device *phydev)
511{
512 int ret;
513
514 if (phydev->autoneg == AUTONEG_ENABLE || phydev->speed > SPEED_100)
515 return 0;
516
517 /* map extended registers set 0x10 - 0x1e */
518 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x52b5);
519 if (ret >= 0)
520 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_18E, 0x0012);
521 if (ret >= 0)
522 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_17E, 0x2803);
523 if (ret >= 0)
524 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_16E, 0x87fa);
525 /* map standard registers set 0x10 - 0x1e */
526 if (ret >= 0)
527 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
528 else
529 phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
530
531 return ret;
532}
533
534/* vsc82x4_config_aneg - restart auto-negotiation or write BMCR
535 * @phydev: target phy_device struct
536 *
537 * Description: If auto-negotiation is enabled, we configure the
538 * advertising, and then restart auto-negotiation. If it is not
539 * enabled, then we write the BMCR and also start the auto
540 * MDI/MDI-X feature
541 */
542static int vsc82x4_config_aneg(struct phy_device *phydev)
543{
544 int ret;
545
546 /* Enable auto MDI/MDI-X when in 10/100 forced link speeds by
547 * writing special values in the VSC8234 extended reserved registers
548 */
549 if (phydev->autoneg != AUTONEG_ENABLE && phydev->speed <= SPEED_100) {
550 ret = genphy_setup_forced(phydev);
551
552 if (ret < 0) /* error */
553 return ret;
554
555 return vsc82x4_config_autocross_enable(phydev);
556 }
557
558 return genphy_config_aneg(phydev);
559}
560
561/* Vitesse 82xx */
562static struct phy_driver vsc82xx_driver[] = {
563{
564 .phy_id = PHY_ID_VSC8234,
565 .name = "Vitesse VSC8234",
566 .phy_id_mask = 0x000ffff0,
567 /* PHY_GBIT_FEATURES */
568 .config_init = &vsc824x_config_init,
569 .config_aneg = &vsc82x4_config_aneg,
570 .config_intr = &vsc82xx_config_intr,
571 .handle_interrupt = &vsc82xx_handle_interrupt,
572}, {
573 .phy_id = PHY_ID_VSC8244,
574 .name = "Vitesse VSC8244",
575 .phy_id_mask = 0x000fffc0,
576 /* PHY_GBIT_FEATURES */
577 .config_init = &vsc824x_config_init,
578 .config_aneg = &vsc82x4_config_aneg,
579 .config_intr = &vsc82xx_config_intr,
580 .handle_interrupt = &vsc82xx_handle_interrupt,
581}, {
582 .phy_id = PHY_ID_VSC8572,
583 .name = "Vitesse VSC8572",
584 .phy_id_mask = 0x000ffff0,
585 /* PHY_GBIT_FEATURES */
586 .config_init = &vsc824x_config_init,
587 .config_aneg = &vsc82x4_config_aneg,
588 .config_intr = &vsc82xx_config_intr,
589 .handle_interrupt = &vsc82xx_handle_interrupt,
590}, {
591 .phy_id = PHY_ID_VSC8601,
592 .name = "Vitesse VSC8601",
593 .phy_id_mask = 0x000ffff0,
594 /* PHY_GBIT_FEATURES */
595 .config_init = &vsc8601_config_init,
596 .config_intr = &vsc82xx_config_intr,
597 .handle_interrupt = &vsc82xx_handle_interrupt,
598}, {
599 .phy_id = PHY_ID_VSC7385,
600 .name = "Vitesse VSC7385",
601 .phy_id_mask = 0x000ffff0,
602 /* PHY_GBIT_FEATURES */
603 .config_init = vsc738x_config_init,
604 .config_aneg = vsc73xx_config_aneg,
605 .read_status = vsc73xx_read_status,
606 .read_page = vsc73xx_read_page,
607 .write_page = vsc73xx_write_page,
608 .get_tunable = vsc73xx_get_tunable,
609 .set_tunable = vsc73xx_set_tunable,
610}, {
611 .phy_id = PHY_ID_VSC7388,
612 .name = "Vitesse VSC7388",
613 .phy_id_mask = 0x000ffff0,
614 /* PHY_GBIT_FEATURES */
615 .config_init = vsc738x_config_init,
616 .config_aneg = vsc73xx_config_aneg,
617 .read_status = vsc73xx_read_status,
618 .read_page = vsc73xx_read_page,
619 .write_page = vsc73xx_write_page,
620 .get_tunable = vsc73xx_get_tunable,
621 .set_tunable = vsc73xx_set_tunable,
622}, {
623 .phy_id = PHY_ID_VSC7395,
624 .name = "Vitesse VSC7395",
625 .phy_id_mask = 0x000ffff0,
626 /* PHY_GBIT_FEATURES */
627 .config_init = vsc739x_config_init,
628 .config_aneg = vsc73xx_config_aneg,
629 .read_status = vsc73xx_read_status,
630 .read_page = vsc73xx_read_page,
631 .write_page = vsc73xx_write_page,
632 .get_tunable = vsc73xx_get_tunable,
633 .set_tunable = vsc73xx_set_tunable,
634}, {
635 .phy_id = PHY_ID_VSC7398,
636 .name = "Vitesse VSC7398",
637 .phy_id_mask = 0x000ffff0,
638 /* PHY_GBIT_FEATURES */
639 .config_init = vsc739x_config_init,
640 .config_aneg = vsc73xx_config_aneg,
641 .read_status = vsc73xx_read_status,
642 .read_page = vsc73xx_read_page,
643 .write_page = vsc73xx_write_page,
644 .get_tunable = vsc73xx_get_tunable,
645 .set_tunable = vsc73xx_set_tunable,
646}, {
647 .phy_id = PHY_ID_VSC8662,
648 .name = "Vitesse VSC8662",
649 .phy_id_mask = 0x000ffff0,
650 /* PHY_GBIT_FEATURES */
651 .config_init = &vsc824x_config_init,
652 .config_aneg = &vsc82x4_config_aneg,
653 .config_intr = &vsc82xx_config_intr,
654 .handle_interrupt = &vsc82xx_handle_interrupt,
655}, {
656 /* Vitesse 8221 */
657 .phy_id = PHY_ID_VSC8221,
658 .phy_id_mask = 0x000ffff0,
659 .name = "Vitesse VSC8221",
660 /* PHY_GBIT_FEATURES */
661 .config_init = &vsc8221_config_init,
662 .config_intr = &vsc82xx_config_intr,
663 .handle_interrupt = &vsc82xx_handle_interrupt,
664}, {
665 /* Vitesse 8211 */
666 .phy_id = PHY_ID_VSC8211,
667 .phy_id_mask = 0x000ffff0,
668 .name = "Vitesse VSC8211",
669 /* PHY_GBIT_FEATURES */
670 .config_init = &vsc8221_config_init,
671 .config_intr = &vsc82xx_config_intr,
672 .handle_interrupt = &vsc82xx_handle_interrupt,
673} };
674
675module_phy_driver(vsc82xx_driver);
676
677static struct mdio_device_id __maybe_unused vitesse_tbl[] = {
678 { PHY_ID_VSC8234, 0x000ffff0 },
679 { PHY_ID_VSC8244, 0x000fffc0 },
680 { PHY_ID_VSC8572, 0x000ffff0 },
681 { PHY_ID_VSC7385, 0x000ffff0 },
682 { PHY_ID_VSC7388, 0x000ffff0 },
683 { PHY_ID_VSC7395, 0x000ffff0 },
684 { PHY_ID_VSC7398, 0x000ffff0 },
685 { PHY_ID_VSC8662, 0x000ffff0 },
686 { PHY_ID_VSC8221, 0x000ffff0 },
687 { PHY_ID_VSC8211, 0x000ffff0 },
688 { }
689};
690
691MODULE_DEVICE_TABLE(mdio, vitesse_tbl);
1/*
2 * Driver for Vitesse PHYs
3 *
4 * Author: Kriston Carson
5 *
6 * Copyright (c) 2005, 2009, 2011 Freescale Semiconductor, Inc.
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
12 *
13 */
14
15#include <linux/kernel.h>
16#include <linux/module.h>
17#include <linux/mii.h>
18#include <linux/ethtool.h>
19#include <linux/phy.h>
20
21/* Vitesse Extended Page Magic Register(s) */
22#define MII_VSC82X4_EXT_PAGE_16E 0x10
23#define MII_VSC82X4_EXT_PAGE_17E 0x11
24#define MII_VSC82X4_EXT_PAGE_18E 0x12
25
26/* Vitesse Extended Control Register 1 */
27#define MII_VSC8244_EXT_CON1 0x17
28#define MII_VSC8244_EXTCON1_INIT 0x0000
29#define MII_VSC8244_EXTCON1_TX_SKEW_MASK 0x0c00
30#define MII_VSC8244_EXTCON1_RX_SKEW_MASK 0x0300
31#define MII_VSC8244_EXTCON1_TX_SKEW 0x0800
32#define MII_VSC8244_EXTCON1_RX_SKEW 0x0200
33
34/* Vitesse Interrupt Mask Register */
35#define MII_VSC8244_IMASK 0x19
36#define MII_VSC8244_IMASK_IEN 0x8000
37#define MII_VSC8244_IMASK_SPEED 0x4000
38#define MII_VSC8244_IMASK_LINK 0x2000
39#define MII_VSC8244_IMASK_DUPLEX 0x1000
40#define MII_VSC8244_IMASK_MASK 0xf000
41
42#define MII_VSC8221_IMASK_MASK 0xa000
43
44/* Vitesse Interrupt Status Register */
45#define MII_VSC8244_ISTAT 0x1a
46#define MII_VSC8244_ISTAT_STATUS 0x8000
47#define MII_VSC8244_ISTAT_SPEED 0x4000
48#define MII_VSC8244_ISTAT_LINK 0x2000
49#define MII_VSC8244_ISTAT_DUPLEX 0x1000
50
51/* Vitesse Auxiliary Control/Status Register */
52#define MII_VSC8244_AUX_CONSTAT 0x1c
53#define MII_VSC8244_AUXCONSTAT_INIT 0x0000
54#define MII_VSC8244_AUXCONSTAT_DUPLEX 0x0020
55#define MII_VSC8244_AUXCONSTAT_SPEED 0x0018
56#define MII_VSC8244_AUXCONSTAT_GBIT 0x0010
57#define MII_VSC8244_AUXCONSTAT_100 0x0008
58
59#define MII_VSC8221_AUXCONSTAT_INIT 0x0004 /* need to set this bit? */
60#define MII_VSC8221_AUXCONSTAT_RESERVED 0x0004
61
62/* Vitesse Extended Page Access Register */
63#define MII_VSC82X4_EXT_PAGE_ACCESS 0x1f
64
65/* Vitesse VSC8601 Extended PHY Control Register 1 */
66#define MII_VSC8601_EPHY_CTL 0x17
67#define MII_VSC8601_EPHY_CTL_RGMII_SKEW (1 << 8)
68
69#define PHY_ID_VSC8234 0x000fc620
70#define PHY_ID_VSC8244 0x000fc6c0
71#define PHY_ID_VSC8514 0x00070670
72#define PHY_ID_VSC8572 0x000704d0
73#define PHY_ID_VSC8574 0x000704a0
74#define PHY_ID_VSC8601 0x00070420
75#define PHY_ID_VSC8662 0x00070660
76#define PHY_ID_VSC8221 0x000fc550
77#define PHY_ID_VSC8211 0x000fc4b0
78
79MODULE_DESCRIPTION("Vitesse PHY driver");
80MODULE_AUTHOR("Kriston Carson");
81MODULE_LICENSE("GPL");
82
83static int vsc824x_add_skew(struct phy_device *phydev)
84{
85 int err;
86 int extcon;
87
88 extcon = phy_read(phydev, MII_VSC8244_EXT_CON1);
89
90 if (extcon < 0)
91 return extcon;
92
93 extcon &= ~(MII_VSC8244_EXTCON1_TX_SKEW_MASK |
94 MII_VSC8244_EXTCON1_RX_SKEW_MASK);
95
96 extcon |= (MII_VSC8244_EXTCON1_TX_SKEW |
97 MII_VSC8244_EXTCON1_RX_SKEW);
98
99 err = phy_write(phydev, MII_VSC8244_EXT_CON1, extcon);
100
101 return err;
102}
103
104static int vsc824x_config_init(struct phy_device *phydev)
105{
106 int err;
107
108 err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
109 MII_VSC8244_AUXCONSTAT_INIT);
110 if (err < 0)
111 return err;
112
113 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
114 err = vsc824x_add_skew(phydev);
115
116 return err;
117}
118
119/* This adds a skew for both TX and RX clocks, so the skew should only be
120 * applied to "rgmii-id" interfaces. It may not work as expected
121 * on "rgmii-txid", "rgmii-rxid" or "rgmii" interfaces. */
122static int vsc8601_add_skew(struct phy_device *phydev)
123{
124 int ret;
125
126 ret = phy_read(phydev, MII_VSC8601_EPHY_CTL);
127 if (ret < 0)
128 return ret;
129
130 ret |= MII_VSC8601_EPHY_CTL_RGMII_SKEW;
131 return phy_write(phydev, MII_VSC8601_EPHY_CTL, ret);
132}
133
134static int vsc8601_config_init(struct phy_device *phydev)
135{
136 int ret = 0;
137
138 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
139 ret = vsc8601_add_skew(phydev);
140
141 if (ret < 0)
142 return ret;
143
144 return genphy_config_init(phydev);
145}
146
147static int vsc824x_ack_interrupt(struct phy_device *phydev)
148{
149 int err = 0;
150
151 /* Don't bother to ACK the interrupts if interrupts
152 * are disabled. The 824x cannot clear the interrupts
153 * if they are disabled.
154 */
155 if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
156 err = phy_read(phydev, MII_VSC8244_ISTAT);
157
158 return (err < 0) ? err : 0;
159}
160
161static int vsc82xx_config_intr(struct phy_device *phydev)
162{
163 int err;
164
165 if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
166 err = phy_write(phydev, MII_VSC8244_IMASK,
167 (phydev->drv->phy_id == PHY_ID_VSC8234 ||
168 phydev->drv->phy_id == PHY_ID_VSC8244 ||
169 phydev->drv->phy_id == PHY_ID_VSC8514 ||
170 phydev->drv->phy_id == PHY_ID_VSC8572 ||
171 phydev->drv->phy_id == PHY_ID_VSC8574 ||
172 phydev->drv->phy_id == PHY_ID_VSC8601) ?
173 MII_VSC8244_IMASK_MASK :
174 MII_VSC8221_IMASK_MASK);
175 else {
176 /* The Vitesse PHY cannot clear the interrupt
177 * once it has disabled them, so we clear them first
178 */
179 err = phy_read(phydev, MII_VSC8244_ISTAT);
180
181 if (err < 0)
182 return err;
183
184 err = phy_write(phydev, MII_VSC8244_IMASK, 0);
185 }
186
187 return err;
188}
189
190static int vsc8221_config_init(struct phy_device *phydev)
191{
192 int err;
193
194 err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
195 MII_VSC8221_AUXCONSTAT_INIT);
196 return err;
197
198 /* Perhaps we should set EXT_CON1 based on the interface?
199 * Options are 802.3Z SerDes or SGMII
200 */
201}
202
203/* vsc82x4_config_autocross_enable - Enable auto MDI/MDI-X for forced links
204 * @phydev: target phy_device struct
205 *
206 * Enable auto MDI/MDI-X when in 10/100 forced link speeds by writing
207 * special values in the VSC8234/VSC8244 extended reserved registers
208 */
209static int vsc82x4_config_autocross_enable(struct phy_device *phydev)
210{
211 int ret;
212
213 if (phydev->autoneg == AUTONEG_ENABLE || phydev->speed > SPEED_100)
214 return 0;
215
216 /* map extended registers set 0x10 - 0x1e */
217 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x52b5);
218 if (ret >= 0)
219 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_18E, 0x0012);
220 if (ret >= 0)
221 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_17E, 0x2803);
222 if (ret >= 0)
223 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_16E, 0x87fa);
224 /* map standard registers set 0x10 - 0x1e */
225 if (ret >= 0)
226 ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
227 else
228 phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
229
230 return ret;
231}
232
233/* vsc82x4_config_aneg - restart auto-negotiation or write BMCR
234 * @phydev: target phy_device struct
235 *
236 * Description: If auto-negotiation is enabled, we configure the
237 * advertising, and then restart auto-negotiation. If it is not
238 * enabled, then we write the BMCR and also start the auto
239 * MDI/MDI-X feature
240 */
241static int vsc82x4_config_aneg(struct phy_device *phydev)
242{
243 int ret;
244
245 /* Enable auto MDI/MDI-X when in 10/100 forced link speeds by
246 * writing special values in the VSC8234 extended reserved registers
247 */
248 if (phydev->autoneg != AUTONEG_ENABLE && phydev->speed <= SPEED_100) {
249 ret = genphy_setup_forced(phydev);
250
251 if (ret < 0) /* error */
252 return ret;
253
254 return vsc82x4_config_autocross_enable(phydev);
255 }
256
257 return genphy_config_aneg(phydev);
258}
259
260/* Vitesse 82xx */
261static struct phy_driver vsc82xx_driver[] = {
262{
263 .phy_id = PHY_ID_VSC8234,
264 .name = "Vitesse VSC8234",
265 .phy_id_mask = 0x000ffff0,
266 .features = PHY_GBIT_FEATURES,
267 .flags = PHY_HAS_INTERRUPT,
268 .config_init = &vsc824x_config_init,
269 .config_aneg = &vsc82x4_config_aneg,
270 .read_status = &genphy_read_status,
271 .ack_interrupt = &vsc824x_ack_interrupt,
272 .config_intr = &vsc82xx_config_intr,
273}, {
274 .phy_id = PHY_ID_VSC8244,
275 .name = "Vitesse VSC8244",
276 .phy_id_mask = 0x000fffc0,
277 .features = PHY_GBIT_FEATURES,
278 .flags = PHY_HAS_INTERRUPT,
279 .config_init = &vsc824x_config_init,
280 .config_aneg = &vsc82x4_config_aneg,
281 .read_status = &genphy_read_status,
282 .ack_interrupt = &vsc824x_ack_interrupt,
283 .config_intr = &vsc82xx_config_intr,
284}, {
285 .phy_id = PHY_ID_VSC8514,
286 .name = "Vitesse VSC8514",
287 .phy_id_mask = 0x000ffff0,
288 .features = PHY_GBIT_FEATURES,
289 .flags = PHY_HAS_INTERRUPT,
290 .config_init = &vsc824x_config_init,
291 .config_aneg = &vsc82x4_config_aneg,
292 .read_status = &genphy_read_status,
293 .ack_interrupt = &vsc824x_ack_interrupt,
294 .config_intr = &vsc82xx_config_intr,
295}, {
296 .phy_id = PHY_ID_VSC8572,
297 .name = "Vitesse VSC8572",
298 .phy_id_mask = 0x000ffff0,
299 .features = PHY_GBIT_FEATURES,
300 .flags = PHY_HAS_INTERRUPT,
301 .config_init = &vsc824x_config_init,
302 .config_aneg = &vsc82x4_config_aneg,
303 .read_status = &genphy_read_status,
304 .ack_interrupt = &vsc824x_ack_interrupt,
305 .config_intr = &vsc82xx_config_intr,
306}, {
307 .phy_id = PHY_ID_VSC8574,
308 .name = "Vitesse VSC8574",
309 .phy_id_mask = 0x000ffff0,
310 .features = PHY_GBIT_FEATURES,
311 .flags = PHY_HAS_INTERRUPT,
312 .config_init = &vsc824x_config_init,
313 .config_aneg = &vsc82x4_config_aneg,
314 .read_status = &genphy_read_status,
315 .ack_interrupt = &vsc824x_ack_interrupt,
316 .config_intr = &vsc82xx_config_intr,
317}, {
318 .phy_id = PHY_ID_VSC8601,
319 .name = "Vitesse VSC8601",
320 .phy_id_mask = 0x000ffff0,
321 .features = PHY_GBIT_FEATURES,
322 .flags = PHY_HAS_INTERRUPT,
323 .config_init = &vsc8601_config_init,
324 .config_aneg = &genphy_config_aneg,
325 .read_status = &genphy_read_status,
326 .ack_interrupt = &vsc824x_ack_interrupt,
327 .config_intr = &vsc82xx_config_intr,
328}, {
329 .phy_id = PHY_ID_VSC8662,
330 .name = "Vitesse VSC8662",
331 .phy_id_mask = 0x000ffff0,
332 .features = PHY_GBIT_FEATURES,
333 .flags = PHY_HAS_INTERRUPT,
334 .config_init = &vsc824x_config_init,
335 .config_aneg = &vsc82x4_config_aneg,
336 .read_status = &genphy_read_status,
337 .ack_interrupt = &vsc824x_ack_interrupt,
338 .config_intr = &vsc82xx_config_intr,
339}, {
340 /* Vitesse 8221 */
341 .phy_id = PHY_ID_VSC8221,
342 .phy_id_mask = 0x000ffff0,
343 .name = "Vitesse VSC8221",
344 .features = PHY_GBIT_FEATURES,
345 .flags = PHY_HAS_INTERRUPT,
346 .config_init = &vsc8221_config_init,
347 .config_aneg = &genphy_config_aneg,
348 .read_status = &genphy_read_status,
349 .ack_interrupt = &vsc824x_ack_interrupt,
350 .config_intr = &vsc82xx_config_intr,
351}, {
352 /* Vitesse 8211 */
353 .phy_id = PHY_ID_VSC8211,
354 .phy_id_mask = 0x000ffff0,
355 .name = "Vitesse VSC8211",
356 .features = PHY_GBIT_FEATURES,
357 .flags = PHY_HAS_INTERRUPT,
358 .config_init = &vsc8221_config_init,
359 .config_aneg = &genphy_config_aneg,
360 .read_status = &genphy_read_status,
361 .ack_interrupt = &vsc824x_ack_interrupt,
362 .config_intr = &vsc82xx_config_intr,
363} };
364
365module_phy_driver(vsc82xx_driver);
366
367static struct mdio_device_id __maybe_unused vitesse_tbl[] = {
368 { PHY_ID_VSC8234, 0x000ffff0 },
369 { PHY_ID_VSC8244, 0x000fffc0 },
370 { PHY_ID_VSC8514, 0x000ffff0 },
371 { PHY_ID_VSC8572, 0x000ffff0 },
372 { PHY_ID_VSC8574, 0x000ffff0 },
373 { PHY_ID_VSC8662, 0x000ffff0 },
374 { PHY_ID_VSC8221, 0x000ffff0 },
375 { PHY_ID_VSC8211, 0x000ffff0 },
376 { }
377};
378
379MODULE_DEVICE_TABLE(mdio, vitesse_tbl);