hc
2025-02-14 bbb9540dc49f70f6b703d1c8d1b85fa5f602d86e
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (C) 2012 Daniel Schwierzeck <daniel.schwierzeck@googlemail.com>
 * Copyright (C) 2016 Hauke Mehrtens <hauke@hauke-m.de>
 */
 
#include <linux/mdio.h>
#include <linux/module.h>
#include <linux/phy.h>
#include <linux/of.h>
 
#define XWAY_MDIO_IMASK            0x19    /* interrupt mask */
#define XWAY_MDIO_ISTAT            0x1A    /* interrupt status */
#define XWAY_MDIO_LED            0x1B    /* led control */
 
/* bit 15:12 are reserved */
#define XWAY_MDIO_LED_LED3_EN        BIT(11)    /* Enable the integrated function of LED3 */
#define XWAY_MDIO_LED_LED2_EN        BIT(10)    /* Enable the integrated function of LED2 */
#define XWAY_MDIO_LED_LED1_EN        BIT(9)    /* Enable the integrated function of LED1 */
#define XWAY_MDIO_LED_LED0_EN        BIT(8)    /* Enable the integrated function of LED0 */
/* bit 7:4 are reserved */
#define XWAY_MDIO_LED_LED3_DA        BIT(3)    /* Direct Access to LED3 */
#define XWAY_MDIO_LED_LED2_DA        BIT(2)    /* Direct Access to LED2 */
#define XWAY_MDIO_LED_LED1_DA        BIT(1)    /* Direct Access to LED1 */
#define XWAY_MDIO_LED_LED0_DA        BIT(0)    /* Direct Access to LED0 */
 
#define XWAY_MDIO_INIT_WOL        BIT(15)    /* Wake-On-LAN */
#define XWAY_MDIO_INIT_MSRE        BIT(14)
#define XWAY_MDIO_INIT_NPRX        BIT(13)
#define XWAY_MDIO_INIT_NPTX        BIT(12)
#define XWAY_MDIO_INIT_ANE        BIT(11)    /* Auto-Neg error */
#define XWAY_MDIO_INIT_ANC        BIT(10)    /* Auto-Neg complete */
#define XWAY_MDIO_INIT_ADSC        BIT(5)    /* Link auto-downspeed detect */
#define XWAY_MDIO_INIT_MPIPC        BIT(4)
#define XWAY_MDIO_INIT_MDIXC        BIT(3)
#define XWAY_MDIO_INIT_DXMC        BIT(2)    /* Duplex mode change */
#define XWAY_MDIO_INIT_LSPC        BIT(1)    /* Link speed change */
#define XWAY_MDIO_INIT_LSTC        BIT(0)    /* Link state change */
#define XWAY_MDIO_INIT_MASK        (XWAY_MDIO_INIT_LSTC | \
                    XWAY_MDIO_INIT_ADSC)
 
#define ADVERTISED_MPD            BIT(10)    /* Multi-port device */
 
/* LED Configuration */
#define XWAY_MMD_LEDCH            0x01E0
/* Inverse of SCAN Function */
#define  XWAY_MMD_LEDCH_NACS_NONE    0x0000
#define  XWAY_MMD_LEDCH_NACS_LINK    0x0001
#define  XWAY_MMD_LEDCH_NACS_PDOWN    0x0002
#define  XWAY_MMD_LEDCH_NACS_EEE    0x0003
#define  XWAY_MMD_LEDCH_NACS_ANEG    0x0004
#define  XWAY_MMD_LEDCH_NACS_ABIST    0x0005
#define  XWAY_MMD_LEDCH_NACS_CDIAG    0x0006
#define  XWAY_MMD_LEDCH_NACS_TEST    0x0007
/* Slow Blink Frequency */
#define  XWAY_MMD_LEDCH_SBF_F02HZ    0x0000
#define  XWAY_MMD_LEDCH_SBF_F04HZ    0x0010
#define  XWAY_MMD_LEDCH_SBF_F08HZ    0x0020
#define  XWAY_MMD_LEDCH_SBF_F16HZ    0x0030
/* Fast Blink Frequency */
#define  XWAY_MMD_LEDCH_FBF_F02HZ    0x0000
#define  XWAY_MMD_LEDCH_FBF_F04HZ    0x0040
#define  XWAY_MMD_LEDCH_FBF_F08HZ    0x0080
#define  XWAY_MMD_LEDCH_FBF_F16HZ    0x00C0
/* LED Configuration */
#define XWAY_MMD_LEDCL            0x01E1
/* Complex Blinking Configuration */
#define  XWAY_MMD_LEDCH_CBLINK_NONE    0x0000
#define  XWAY_MMD_LEDCH_CBLINK_LINK    0x0001
#define  XWAY_MMD_LEDCH_CBLINK_PDOWN    0x0002
#define  XWAY_MMD_LEDCH_CBLINK_EEE    0x0003
#define  XWAY_MMD_LEDCH_CBLINK_ANEG    0x0004
#define  XWAY_MMD_LEDCH_CBLINK_ABIST    0x0005
#define  XWAY_MMD_LEDCH_CBLINK_CDIAG    0x0006
#define  XWAY_MMD_LEDCH_CBLINK_TEST    0x0007
/* Complex SCAN Configuration */
#define  XWAY_MMD_LEDCH_SCAN_NONE    0x0000
#define  XWAY_MMD_LEDCH_SCAN_LINK    0x0010
#define  XWAY_MMD_LEDCH_SCAN_PDOWN    0x0020
#define  XWAY_MMD_LEDCH_SCAN_EEE    0x0030
#define  XWAY_MMD_LEDCH_SCAN_ANEG    0x0040
#define  XWAY_MMD_LEDCH_SCAN_ABIST    0x0050
#define  XWAY_MMD_LEDCH_SCAN_CDIAG    0x0060
#define  XWAY_MMD_LEDCH_SCAN_TEST    0x0070
/* Configuration for LED Pin x */
#define XWAY_MMD_LED0H            0x01E2
/* Fast Blinking Configuration */
#define  XWAY_MMD_LEDxH_BLINKF_MASK    0x000F
#define  XWAY_MMD_LEDxH_BLINKF_NONE    0x0000
#define  XWAY_MMD_LEDxH_BLINKF_LINK10    0x0001
#define  XWAY_MMD_LEDxH_BLINKF_LINK100    0x0002
#define  XWAY_MMD_LEDxH_BLINKF_LINK10X    0x0003
#define  XWAY_MMD_LEDxH_BLINKF_LINK1000    0x0004
#define  XWAY_MMD_LEDxH_BLINKF_LINK10_0    0x0005
#define  XWAY_MMD_LEDxH_BLINKF_LINK100X    0x0006
#define  XWAY_MMD_LEDxH_BLINKF_LINK10XX    0x0007
#define  XWAY_MMD_LEDxH_BLINKF_PDOWN    0x0008
#define  XWAY_MMD_LEDxH_BLINKF_EEE    0x0009
#define  XWAY_MMD_LEDxH_BLINKF_ANEG    0x000A
#define  XWAY_MMD_LEDxH_BLINKF_ABIST    0x000B
#define  XWAY_MMD_LEDxH_BLINKF_CDIAG    0x000C
/* Constant On Configuration */
#define  XWAY_MMD_LEDxH_CON_MASK    0x00F0
#define  XWAY_MMD_LEDxH_CON_NONE    0x0000
#define  XWAY_MMD_LEDxH_CON_LINK10    0x0010
#define  XWAY_MMD_LEDxH_CON_LINK100    0x0020
#define  XWAY_MMD_LEDxH_CON_LINK10X    0x0030
#define  XWAY_MMD_LEDxH_CON_LINK1000    0x0040
#define  XWAY_MMD_LEDxH_CON_LINK10_0    0x0050
#define  XWAY_MMD_LEDxH_CON_LINK100X    0x0060
#define  XWAY_MMD_LEDxH_CON_LINK10XX    0x0070
#define  XWAY_MMD_LEDxH_CON_PDOWN    0x0080
#define  XWAY_MMD_LEDxH_CON_EEE        0x0090
#define  XWAY_MMD_LEDxH_CON_ANEG    0x00A0
#define  XWAY_MMD_LEDxH_CON_ABIST    0x00B0
#define  XWAY_MMD_LEDxH_CON_CDIAG    0x00C0
#define  XWAY_MMD_LEDxH_CON_COPPER    0x00D0
#define  XWAY_MMD_LEDxH_CON_FIBER    0x00E0
/* Configuration for LED Pin x */
#define XWAY_MMD_LED0L            0x01E3
/* Pulsing Configuration */
#define  XWAY_MMD_LEDxL_PULSE_MASK    0x000F
#define  XWAY_MMD_LEDxL_PULSE_NONE    0x0000
#define  XWAY_MMD_LEDxL_PULSE_TXACT    0x0001
#define  XWAY_MMD_LEDxL_PULSE_RXACT    0x0002
#define  XWAY_MMD_LEDxL_PULSE_COL    0x0004
/* Slow Blinking Configuration */
#define  XWAY_MMD_LEDxL_BLINKS_MASK    0x00F0
#define  XWAY_MMD_LEDxL_BLINKS_NONE    0x0000
#define  XWAY_MMD_LEDxL_BLINKS_LINK10    0x0010
#define  XWAY_MMD_LEDxL_BLINKS_LINK100    0x0020
#define  XWAY_MMD_LEDxL_BLINKS_LINK10X    0x0030
#define  XWAY_MMD_LEDxL_BLINKS_LINK1000    0x0040
#define  XWAY_MMD_LEDxL_BLINKS_LINK10_0    0x0050
#define  XWAY_MMD_LEDxL_BLINKS_LINK100X    0x0060
#define  XWAY_MMD_LEDxL_BLINKS_LINK10XX    0x0070
#define  XWAY_MMD_LEDxL_BLINKS_PDOWN    0x0080
#define  XWAY_MMD_LEDxL_BLINKS_EEE    0x0090
#define  XWAY_MMD_LEDxL_BLINKS_ANEG    0x00A0
#define  XWAY_MMD_LEDxL_BLINKS_ABIST    0x00B0
#define  XWAY_MMD_LEDxL_BLINKS_CDIAG    0x00C0
#define XWAY_MMD_LED1H            0x01E4
#define XWAY_MMD_LED1L            0x01E5
#define XWAY_MMD_LED2H            0x01E6
#define XWAY_MMD_LED2L            0x01E7
#define XWAY_MMD_LED3H            0x01E8
#define XWAY_MMD_LED3L            0x01E9
 
#define PHY_ID_PHY11G_1_3        0x030260D1
#define PHY_ID_PHY22F_1_3        0x030260E1
#define PHY_ID_PHY11G_1_4        0xD565A400
#define PHY_ID_PHY22F_1_4        0xD565A410
#define PHY_ID_PHY11G_1_5        0xD565A401
#define PHY_ID_PHY22F_1_5        0xD565A411
#define PHY_ID_PHY11G_VR9_1_1        0xD565A408
#define PHY_ID_PHY22F_VR9_1_1        0xD565A418
#define PHY_ID_PHY11G_VR9_1_2        0xD565A409
#define PHY_ID_PHY22F_VR9_1_2        0xD565A419
 
static int xway_gphy_config_init(struct phy_device *phydev)
{
   int err;
   u32 ledxh;
   u32 ledxl;
 
   /* Mask all interrupts */
   err = phy_write(phydev, XWAY_MDIO_IMASK, 0);
   if (err)
       return err;
 
   /* Clear all pending interrupts */
   phy_read(phydev, XWAY_MDIO_ISTAT);
 
   /* Ensure that integrated led function is enabled for all leds */
   err = phy_write(phydev, XWAY_MDIO_LED,
           XWAY_MDIO_LED_LED0_EN |
           XWAY_MDIO_LED_LED1_EN |
           XWAY_MDIO_LED_LED2_EN |
           XWAY_MDIO_LED_LED3_EN);
   if (err)
       return err;
 
   phy_write_mmd(phydev, MDIO_MMD_VEND2, XWAY_MMD_LEDCH,
             XWAY_MMD_LEDCH_NACS_NONE |
             XWAY_MMD_LEDCH_SBF_F02HZ |
             XWAY_MMD_LEDCH_FBF_F16HZ);
   phy_write_mmd(phydev, MDIO_MMD_VEND2, XWAY_MMD_LEDCL,
             XWAY_MMD_LEDCH_CBLINK_NONE |
             XWAY_MMD_LEDCH_SCAN_NONE);
 
   /**
    * In most cases only one LED is connected to this phy, so
    * configure them all to constant on and pulse mode. LED3 is
    * only available in some packages, leave it in its reset
    * configuration.
    */
   ledxh = XWAY_MMD_LEDxH_BLINKF_NONE | XWAY_MMD_LEDxH_CON_LINK10XX;
   ledxl = XWAY_MMD_LEDxL_PULSE_TXACT | XWAY_MMD_LEDxL_PULSE_RXACT |
       XWAY_MMD_LEDxL_BLINKS_NONE;
   phy_write_mmd(phydev, MDIO_MMD_VEND2, XWAY_MMD_LED0H, ledxh);
   phy_write_mmd(phydev, MDIO_MMD_VEND2, XWAY_MMD_LED0L, ledxl);
   phy_write_mmd(phydev, MDIO_MMD_VEND2, XWAY_MMD_LED1H, ledxh);
   phy_write_mmd(phydev, MDIO_MMD_VEND2, XWAY_MMD_LED1L, ledxl);
   phy_write_mmd(phydev, MDIO_MMD_VEND2, XWAY_MMD_LED2H, ledxh);
   phy_write_mmd(phydev, MDIO_MMD_VEND2, XWAY_MMD_LED2L, ledxl);
 
   return 0;
}
 
static int xway_gphy14_config_aneg(struct phy_device *phydev)
{
   int reg, err;
 
   /* Advertise as multi-port device, see IEEE802.3-2002 40.5.1.1 */
   /* This is a workaround for an errata in rev < 1.5 devices */
   reg = phy_read(phydev, MII_CTRL1000);
   reg |= ADVERTISED_MPD;
   err = phy_write(phydev, MII_CTRL1000, reg);
   if (err)
       return err;
 
   return genphy_config_aneg(phydev);
}
 
static int xway_gphy_ack_interrupt(struct phy_device *phydev)
{
   int reg;
 
   reg = phy_read(phydev, XWAY_MDIO_ISTAT);
   return (reg < 0) ? reg : 0;
}
 
static int xway_gphy_did_interrupt(struct phy_device *phydev)
{
   int reg;
 
   reg = phy_read(phydev, XWAY_MDIO_ISTAT);
   return reg & XWAY_MDIO_INIT_MASK;
}
 
static int xway_gphy_config_intr(struct phy_device *phydev)
{
   u16 mask = 0;
 
   if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
       mask = XWAY_MDIO_INIT_MASK;
 
   return phy_write(phydev, XWAY_MDIO_IMASK, mask);
}
 
static struct phy_driver xway_gphy[] = {
   {
       .phy_id        = PHY_ID_PHY11G_1_3,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY11G (PEF 7071/PEF 7072) v1.3",
       /* PHY_GBIT_FEATURES */
       .config_init    = xway_gphy_config_init,
       .config_aneg    = xway_gphy14_config_aneg,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY22F_1_3,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY22F (PEF 7061) v1.3",
       /* PHY_BASIC_FEATURES */
       .config_init    = xway_gphy_config_init,
       .config_aneg    = xway_gphy14_config_aneg,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY11G_1_4,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY11G (PEF 7071/PEF 7072) v1.4",
       /* PHY_GBIT_FEATURES */
       .config_init    = xway_gphy_config_init,
       .config_aneg    = xway_gphy14_config_aneg,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY22F_1_4,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY22F (PEF 7061) v1.4",
       /* PHY_BASIC_FEATURES */
       .config_init    = xway_gphy_config_init,
       .config_aneg    = xway_gphy14_config_aneg,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY11G_1_5,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY11G (PEF 7071/PEF 7072) v1.5 / v1.6",
       /* PHY_GBIT_FEATURES */
       .config_init    = xway_gphy_config_init,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY22F_1_5,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY22F (PEF 7061) v1.5 / v1.6",
       /* PHY_BASIC_FEATURES */
       .config_init    = xway_gphy_config_init,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY11G_VR9_1_1,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY11G (xRX v1.1 integrated)",
       /* PHY_GBIT_FEATURES */
       .config_init    = xway_gphy_config_init,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY22F_VR9_1_1,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY22F (xRX v1.1 integrated)",
       /* PHY_BASIC_FEATURES */
       .config_init    = xway_gphy_config_init,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY11G_VR9_1_2,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY11G (xRX v1.2 integrated)",
       /* PHY_GBIT_FEATURES */
       .config_init    = xway_gphy_config_init,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   }, {
       .phy_id        = PHY_ID_PHY22F_VR9_1_2,
       .phy_id_mask    = 0xffffffff,
       .name        = "Intel XWAY PHY22F (xRX v1.2 integrated)",
       /* PHY_BASIC_FEATURES */
       .config_init    = xway_gphy_config_init,
       .ack_interrupt    = xway_gphy_ack_interrupt,
       .did_interrupt    = xway_gphy_did_interrupt,
       .config_intr    = xway_gphy_config_intr,
       .suspend    = genphy_suspend,
       .resume        = genphy_resume,
   },
};
module_phy_driver(xway_gphy);
 
static struct mdio_device_id __maybe_unused xway_gphy_tbl[] = {
   { PHY_ID_PHY11G_1_3, 0xffffffff },
   { PHY_ID_PHY22F_1_3, 0xffffffff },
   { PHY_ID_PHY11G_1_4, 0xffffffff },
   { PHY_ID_PHY22F_1_4, 0xffffffff },
   { PHY_ID_PHY11G_1_5, 0xffffffff },
   { PHY_ID_PHY22F_1_5, 0xffffffff },
   { PHY_ID_PHY11G_VR9_1_1, 0xffffffff },
   { PHY_ID_PHY22F_VR9_1_1, 0xffffffff },
   { PHY_ID_PHY11G_VR9_1_2, 0xffffffff },
   { PHY_ID_PHY22F_VR9_1_2, 0xffffffff },
   { }
};
MODULE_DEVICE_TABLE(mdio, xway_gphy_tbl);
 
MODULE_DESCRIPTION("Intel XWAY PHY driver");
MODULE_LICENSE("GPL");