1
2
3
4
5
6
7
8#ifndef __LINUX_MII_H__
9#define __LINUX_MII_H__
10
11
12#include <linux/if.h>
13#include <linux/linkmode.h>
14#include <uapi/linux/mii.h>
15
16struct ethtool_cmd;
17
18struct mii_if_info {
19 int phy_id;
20 int advertising;
21 int phy_id_mask;
22 int reg_num_mask;
23
24 unsigned int full_duplex : 1;
25 unsigned int force_media : 1;
26 unsigned int supports_gmii : 1;
27
28 struct net_device *dev;
29 int (*mdio_read) (struct net_device *dev, int phy_id, int location);
30 void (*mdio_write) (struct net_device *dev, int phy_id, int location, int val);
31};
32
33extern int mii_link_ok (struct mii_if_info *mii);
34extern int mii_nway_restart (struct mii_if_info *mii);
35extern void mii_ethtool_gset(struct mii_if_info *mii, struct ethtool_cmd *ecmd);
36extern void mii_ethtool_get_link_ksettings(
37 struct mii_if_info *mii, struct ethtool_link_ksettings *cmd);
38extern int mii_ethtool_sset(struct mii_if_info *mii, struct ethtool_cmd *ecmd);
39extern int mii_ethtool_set_link_ksettings(
40 struct mii_if_info *mii, const struct ethtool_link_ksettings *cmd);
41extern int mii_check_gmii_support(struct mii_if_info *mii);
42extern void mii_check_link (struct mii_if_info *mii);
43extern unsigned int mii_check_media (struct mii_if_info *mii,
44 unsigned int ok_to_print,
45 unsigned int init_media);
46extern int generic_mii_ioctl(struct mii_if_info *mii_if,
47 struct mii_ioctl_data *mii_data, int cmd,
48 unsigned int *duplex_changed);
49
50
51static inline struct mii_ioctl_data *if_mii(struct ifreq *rq)
52{
53 return (struct mii_ioctl_data *) &rq->ifr_ifru;
54}
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70static inline unsigned int mii_nway_result (unsigned int negotiated)
71{
72 unsigned int ret;
73
74 if (negotiated & LPA_100FULL)
75 ret = LPA_100FULL;
76 else if (negotiated & LPA_100BASE4)
77 ret = LPA_100BASE4;
78 else if (negotiated & LPA_100HALF)
79 ret = LPA_100HALF;
80 else if (negotiated & LPA_10FULL)
81 ret = LPA_10FULL;
82 else
83 ret = LPA_10HALF;
84
85 return ret;
86}
87
88
89
90
91
92
93
94
95
96
97static inline unsigned int mii_duplex (unsigned int duplex_lock,
98 unsigned int negotiated)
99{
100 if (duplex_lock)
101 return 1;
102 if (mii_nway_result(negotiated) & LPA_DUPLEX)
103 return 1;
104 return 0;
105}
106
107
108
109
110
111
112
113
114
115static inline u32 ethtool_adv_to_mii_adv_t(u32 ethadv)
116{
117 u32 result = 0;
118
119 if (ethadv & ADVERTISED_10baseT_Half)
120 result |= ADVERTISE_10HALF;
121 if (ethadv & ADVERTISED_10baseT_Full)
122 result |= ADVERTISE_10FULL;
123 if (ethadv & ADVERTISED_100baseT_Half)
124 result |= ADVERTISE_100HALF;
125 if (ethadv & ADVERTISED_100baseT_Full)
126 result |= ADVERTISE_100FULL;
127 if (ethadv & ADVERTISED_Pause)
128 result |= ADVERTISE_PAUSE_CAP;
129 if (ethadv & ADVERTISED_Asym_Pause)
130 result |= ADVERTISE_PAUSE_ASYM;
131
132 return result;
133}
134
135
136
137
138
139
140
141
142
143static inline u32 linkmode_adv_to_mii_adv_t(unsigned long *advertising)
144{
145 u32 result = 0;
146
147 if (linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, advertising))
148 result |= ADVERTISE_10HALF;
149 if (linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, advertising))
150 result |= ADVERTISE_10FULL;
151 if (linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, advertising))
152 result |= ADVERTISE_100HALF;
153 if (linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, advertising))
154 result |= ADVERTISE_100FULL;
155 if (linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, advertising))
156 result |= ADVERTISE_PAUSE_CAP;
157 if (linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, advertising))
158 result |= ADVERTISE_PAUSE_ASYM;
159
160 return result;
161}
162
163
164
165
166
167
168
169
170static inline u32 mii_adv_to_ethtool_adv_t(u32 adv)
171{
172 u32 result = 0;
173
174 if (adv & ADVERTISE_10HALF)
175 result |= ADVERTISED_10baseT_Half;
176 if (adv & ADVERTISE_10FULL)
177 result |= ADVERTISED_10baseT_Full;
178 if (adv & ADVERTISE_100HALF)
179 result |= ADVERTISED_100baseT_Half;
180 if (adv & ADVERTISE_100FULL)
181 result |= ADVERTISED_100baseT_Full;
182 if (adv & ADVERTISE_PAUSE_CAP)
183 result |= ADVERTISED_Pause;
184 if (adv & ADVERTISE_PAUSE_ASYM)
185 result |= ADVERTISED_Asym_Pause;
186
187 return result;
188}
189
190
191
192
193
194
195
196
197
198static inline u32 ethtool_adv_to_mii_ctrl1000_t(u32 ethadv)
199{
200 u32 result = 0;
201
202 if (ethadv & ADVERTISED_1000baseT_Half)
203 result |= ADVERTISE_1000HALF;
204 if (ethadv & ADVERTISED_1000baseT_Full)
205 result |= ADVERTISE_1000FULL;
206
207 return result;
208}
209
210
211
212
213
214
215
216
217
218static inline u32 linkmode_adv_to_mii_ctrl1000_t(unsigned long *advertising)
219{
220 u32 result = 0;
221
222 if (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT,
223 advertising))
224 result |= ADVERTISE_1000HALF;
225 if (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
226 advertising))
227 result |= ADVERTISE_1000FULL;
228
229 return result;
230}
231
232
233
234
235
236
237
238
239
240static inline u32 mii_ctrl1000_to_ethtool_adv_t(u32 adv)
241{
242 u32 result = 0;
243
244 if (adv & ADVERTISE_1000HALF)
245 result |= ADVERTISED_1000baseT_Half;
246 if (adv & ADVERTISE_1000FULL)
247 result |= ADVERTISED_1000baseT_Full;
248
249 return result;
250}
251
252
253
254
255
256
257
258
259
260static inline u32 mii_lpa_to_ethtool_lpa_t(u32 lpa)
261{
262 u32 result = 0;
263
264 if (lpa & LPA_LPACK)
265 result |= ADVERTISED_Autoneg;
266
267 return result | mii_adv_to_ethtool_adv_t(lpa);
268}
269
270
271
272
273
274
275
276
277
278static inline u32 mii_stat1000_to_ethtool_lpa_t(u32 lpa)
279{
280 u32 result = 0;
281
282 if (lpa & LPA_1000HALF)
283 result |= ADVERTISED_1000baseT_Half;
284 if (lpa & LPA_1000FULL)
285 result |= ADVERTISED_1000baseT_Full;
286
287 return result;
288}
289
290
291
292
293
294
295
296
297
298
299static inline void mii_stat1000_mod_linkmode_lpa_t(unsigned long *advertising,
300 u32 lpa)
301{
302 linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT,
303 advertising, lpa & LPA_1000HALF);
304
305 linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
306 advertising, lpa & LPA_1000FULL);
307}
308
309
310
311
312
313
314
315
316
317static inline u32 ethtool_adv_to_mii_adv_x(u32 ethadv)
318{
319 u32 result = 0;
320
321 if (ethadv & ADVERTISED_1000baseT_Half)
322 result |= ADVERTISE_1000XHALF;
323 if (ethadv & ADVERTISED_1000baseT_Full)
324 result |= ADVERTISE_1000XFULL;
325 if (ethadv & ADVERTISED_Pause)
326 result |= ADVERTISE_1000XPAUSE;
327 if (ethadv & ADVERTISED_Asym_Pause)
328 result |= ADVERTISE_1000XPSE_ASYM;
329
330 return result;
331}
332
333
334
335
336
337
338
339
340
341static inline u32 mii_adv_to_ethtool_adv_x(u32 adv)
342{
343 u32 result = 0;
344
345 if (adv & ADVERTISE_1000XHALF)
346 result |= ADVERTISED_1000baseT_Half;
347 if (adv & ADVERTISE_1000XFULL)
348 result |= ADVERTISED_1000baseT_Full;
349 if (adv & ADVERTISE_1000XPAUSE)
350 result |= ADVERTISED_Pause;
351 if (adv & ADVERTISE_1000XPSE_ASYM)
352 result |= ADVERTISED_Asym_Pause;
353
354 return result;
355}
356
357
358
359
360
361
362
363
364
365
366static inline void
367mii_lpa_mod_linkmode_lpa_sgmii(unsigned long *lp_advertising, u32 lpa)
368{
369 u32 speed_duplex = lpa & LPA_SGMII_DPX_SPD_MASK;
370
371 linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT, lp_advertising,
372 speed_duplex == LPA_SGMII_1000HALF);
373
374 linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, lp_advertising,
375 speed_duplex == LPA_SGMII_1000FULL);
376
377 linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, lp_advertising,
378 speed_duplex == LPA_SGMII_100HALF);
379
380 linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, lp_advertising,
381 speed_duplex == LPA_SGMII_100FULL);
382
383 linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, lp_advertising,
384 speed_duplex == LPA_SGMII_10HALF);
385
386 linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, lp_advertising,
387 speed_duplex == LPA_SGMII_10FULL);
388}
389
390
391
392
393
394
395
396
397
398
399static inline void mii_lpa_to_linkmode_lpa_sgmii(unsigned long *lp_advertising,
400 u32 lpa)
401{
402 linkmode_zero(lp_advertising);
403
404 mii_lpa_mod_linkmode_lpa_sgmii(lp_advertising, lpa);
405}
406
407
408
409
410
411
412
413
414
415static inline void mii_adv_mod_linkmode_adv_t(unsigned long *advertising,
416 u32 adv)
417{
418 linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT,
419 advertising, adv & ADVERTISE_10HALF);
420
421 linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT,
422 advertising, adv & ADVERTISE_10FULL);
423
424 linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT,
425 advertising, adv & ADVERTISE_100HALF);
426
427 linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
428 advertising, adv & ADVERTISE_100FULL);
429
430 linkmode_mod_bit(ETHTOOL_LINK_MODE_Pause_BIT, advertising,
431 adv & ADVERTISE_PAUSE_CAP);
432
433 linkmode_mod_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT,
434 advertising, adv & ADVERTISE_PAUSE_ASYM);
435}
436
437
438
439
440
441
442
443
444
445
446static inline void mii_adv_to_linkmode_adv_t(unsigned long *advertising,
447 u32 adv)
448{
449 linkmode_zero(advertising);
450
451 mii_adv_mod_linkmode_adv_t(advertising, adv);
452}
453
454
455
456
457
458
459
460
461
462static inline void mii_lpa_to_linkmode_lpa_t(unsigned long *lp_advertising,
463 u32 lpa)
464{
465 mii_adv_to_linkmode_adv_t(lp_advertising, lpa);
466
467 if (lpa & LPA_LPACK)
468 linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
469 lp_advertising);
470
471}
472
473
474
475
476
477
478
479
480
481static inline void mii_lpa_mod_linkmode_lpa_t(unsigned long *lp_advertising,
482 u32 lpa)
483{
484 mii_adv_mod_linkmode_adv_t(lp_advertising, lpa);
485
486 linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
487 lp_advertising, lpa & LPA_LPACK);
488}
489
490static inline void mii_ctrl1000_mod_linkmode_adv_t(unsigned long *advertising,
491 u32 ctrl1000)
492{
493 linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT, advertising,
494 ctrl1000 & ADVERTISE_1000HALF);
495 linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, advertising,
496 ctrl1000 & ADVERTISE_1000FULL);
497}
498
499
500
501
502
503
504
505
506static inline u32 linkmode_adv_to_lcl_adv_t(unsigned long *advertising)
507{
508 u32 lcl_adv = 0;
509
510 if (linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT,
511 advertising))
512 lcl_adv |= ADVERTISE_PAUSE_CAP;
513 if (linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT,
514 advertising))
515 lcl_adv |= ADVERTISE_PAUSE_ASYM;
516
517 return lcl_adv;
518}
519
520
521
522
523
524
525
526static inline void mii_lpa_mod_linkmode_x(unsigned long *linkmodes, u16 lpa,
527 int fd_bit)
528{
529 linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, linkmodes,
530 lpa & LPA_LPACK);
531 linkmode_mod_bit(ETHTOOL_LINK_MODE_Pause_BIT, linkmodes,
532 lpa & LPA_1000XPAUSE);
533 linkmode_mod_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, linkmodes,
534 lpa & LPA_1000XPAUSE_ASYM);
535 linkmode_mod_bit(fd_bit, linkmodes,
536 lpa & LPA_1000XFULL);
537}
538
539
540
541
542
543
544static inline u16 linkmode_adv_to_mii_adv_x(const unsigned long *linkmodes,
545 int fd_bit)
546{
547 u16 adv = 0;
548
549 if (linkmode_test_bit(fd_bit, linkmodes))
550 adv |= ADVERTISE_1000XFULL;
551 if (linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, linkmodes))
552 adv |= ADVERTISE_1000XPAUSE;
553 if (linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, linkmodes))
554 adv |= ADVERTISE_1000XPSE_ASYM;
555
556 return adv;
557}
558
559
560
561
562
563static inline u16 mii_advertise_flowctrl(int cap)
564{
565 u16 adv = 0;
566
567 if (cap & FLOW_CTRL_RX)
568 adv = ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
569 if (cap & FLOW_CTRL_TX)
570 adv ^= ADVERTISE_PAUSE_ASYM;
571
572 return adv;
573}
574
575
576
577
578
579
580
581
582static inline u8 mii_resolve_flowctrl_fdx(u16 lcladv, u16 rmtadv)
583{
584 u8 cap = 0;
585
586 if (lcladv & rmtadv & ADVERTISE_PAUSE_CAP) {
587 cap = FLOW_CTRL_TX | FLOW_CTRL_RX;
588 } else if (lcladv & rmtadv & ADVERTISE_PAUSE_ASYM) {
589 if (lcladv & ADVERTISE_PAUSE_CAP)
590 cap = FLOW_CTRL_RX;
591 else if (rmtadv & ADVERTISE_PAUSE_CAP)
592 cap = FLOW_CTRL_TX;
593 }
594
595 return cap;
596}
597
598#endif
599