Loading...
1/*
2
3 mii.c: MII interface library
4
5 Maintained by Jeff Garzik <jgarzik@pobox.com>
6 Copyright 2001,2002 Jeff Garzik
7
8 Various code came from myson803.c and other files by
9 Donald Becker. Copyright:
10
11 Written 1998-2002 by Donald Becker.
12
13 This software may be used and distributed according
14 to the terms of the GNU General Public License (GPL),
15 incorporated herein by reference. Drivers based on
16 or derived from this code fall under the GPL and must
17 retain the authorship, copyright and license notice.
18 This file is not a complete program and may only be
19 used when the entire operating system is licensed
20 under the GPL.
21
22 The author may be reached as becker@scyld.com, or C/O
23 Scyld Computing Corporation
24 410 Severn Ave., Suite 210
25 Annapolis MD 21403
26
27
28 */
29
30#include <linux/kernel.h>
31#include <linux/module.h>
32#include <linux/netdevice.h>
33#include <linux/ethtool.h>
34#include <linux/mii.h>
35
36static u32 mii_get_an(struct mii_if_info *mii, u16 addr)
37{
38 int advert;
39
40 advert = mii->mdio_read(mii->dev, mii->phy_id, addr);
41
42 return mii_lpa_to_ethtool_lpa_t(advert);
43}
44
45/**
46 * mii_ethtool_gset - get settings that are specified in @ecmd
47 * @mii: MII interface
48 * @ecmd: requested ethtool_cmd
49 *
50 * The @ecmd parameter is expected to have been cleared before calling
51 * mii_ethtool_gset().
52 *
53 * Returns 0 for success, negative on error.
54 */
55int mii_ethtool_gset(struct mii_if_info *mii, struct ethtool_cmd *ecmd)
56{
57 struct net_device *dev = mii->dev;
58 u16 bmcr, bmsr, ctrl1000 = 0, stat1000 = 0;
59 u32 nego;
60
61 ecmd->supported =
62 (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full |
63 SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
64 SUPPORTED_Autoneg | SUPPORTED_TP | SUPPORTED_MII);
65 if (mii->supports_gmii)
66 ecmd->supported |= SUPPORTED_1000baseT_Half |
67 SUPPORTED_1000baseT_Full;
68
69 /* only supports twisted-pair */
70 ecmd->port = PORT_MII;
71
72 /* only supports internal transceiver */
73 ecmd->transceiver = XCVR_INTERNAL;
74
75 /* this isn't fully supported at higher layers */
76 ecmd->phy_address = mii->phy_id;
77 ecmd->mdio_support = ETH_MDIO_SUPPORTS_C22;
78
79 ecmd->advertising = ADVERTISED_TP | ADVERTISED_MII;
80
81 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
82 bmsr = mii->mdio_read(dev, mii->phy_id, MII_BMSR);
83 if (mii->supports_gmii) {
84 ctrl1000 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
85 stat1000 = mii->mdio_read(dev, mii->phy_id, MII_STAT1000);
86 }
87 if (bmcr & BMCR_ANENABLE) {
88 ecmd->advertising |= ADVERTISED_Autoneg;
89 ecmd->autoneg = AUTONEG_ENABLE;
90
91 ecmd->advertising |= mii_get_an(mii, MII_ADVERTISE);
92 if (mii->supports_gmii)
93 ecmd->advertising |=
94 mii_ctrl1000_to_ethtool_adv_t(ctrl1000);
95
96 if (bmsr & BMSR_ANEGCOMPLETE) {
97 ecmd->lp_advertising = mii_get_an(mii, MII_LPA);
98 ecmd->lp_advertising |=
99 mii_stat1000_to_ethtool_lpa_t(stat1000);
100 } else {
101 ecmd->lp_advertising = 0;
102 }
103
104 nego = ecmd->advertising & ecmd->lp_advertising;
105
106 if (nego & (ADVERTISED_1000baseT_Full |
107 ADVERTISED_1000baseT_Half)) {
108 ethtool_cmd_speed_set(ecmd, SPEED_1000);
109 ecmd->duplex = !!(nego & ADVERTISED_1000baseT_Full);
110 } else if (nego & (ADVERTISED_100baseT_Full |
111 ADVERTISED_100baseT_Half)) {
112 ethtool_cmd_speed_set(ecmd, SPEED_100);
113 ecmd->duplex = !!(nego & ADVERTISED_100baseT_Full);
114 } else {
115 ethtool_cmd_speed_set(ecmd, SPEED_10);
116 ecmd->duplex = !!(nego & ADVERTISED_10baseT_Full);
117 }
118 } else {
119 ecmd->autoneg = AUTONEG_DISABLE;
120
121 ethtool_cmd_speed_set(ecmd,
122 ((bmcr & BMCR_SPEED1000 &&
123 (bmcr & BMCR_SPEED100) == 0) ?
124 SPEED_1000 :
125 ((bmcr & BMCR_SPEED100) ?
126 SPEED_100 : SPEED_10)));
127 ecmd->duplex = (bmcr & BMCR_FULLDPLX) ? DUPLEX_FULL : DUPLEX_HALF;
128 }
129
130 mii->full_duplex = ecmd->duplex;
131
132 /* ignore maxtxpkt, maxrxpkt for now */
133
134 return 0;
135}
136
137/**
138 * mii_ethtool_get_link_ksettings - get settings that are specified in @cmd
139 * @mii: MII interface
140 * @cmd: requested ethtool_link_ksettings
141 *
142 * The @cmd parameter is expected to have been cleared before calling
143 * mii_ethtool_get_link_ksettings().
144 */
145void mii_ethtool_get_link_ksettings(struct mii_if_info *mii,
146 struct ethtool_link_ksettings *cmd)
147{
148 struct net_device *dev = mii->dev;
149 u16 bmcr, bmsr, ctrl1000 = 0, stat1000 = 0;
150 u32 nego, supported, advertising, lp_advertising;
151
152 supported = (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full |
153 SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
154 SUPPORTED_Autoneg | SUPPORTED_TP | SUPPORTED_MII);
155 if (mii->supports_gmii)
156 supported |= SUPPORTED_1000baseT_Half |
157 SUPPORTED_1000baseT_Full;
158
159 /* only supports twisted-pair */
160 cmd->base.port = PORT_MII;
161
162 /* this isn't fully supported at higher layers */
163 cmd->base.phy_address = mii->phy_id;
164 cmd->base.mdio_support = ETH_MDIO_SUPPORTS_C22;
165
166 advertising = ADVERTISED_TP | ADVERTISED_MII;
167
168 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
169 bmsr = mii->mdio_read(dev, mii->phy_id, MII_BMSR);
170 if (mii->supports_gmii) {
171 ctrl1000 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
172 stat1000 = mii->mdio_read(dev, mii->phy_id, MII_STAT1000);
173 }
174 if (bmcr & BMCR_ANENABLE) {
175 advertising |= ADVERTISED_Autoneg;
176 cmd->base.autoneg = AUTONEG_ENABLE;
177
178 advertising |= mii_get_an(mii, MII_ADVERTISE);
179 if (mii->supports_gmii)
180 advertising |= mii_ctrl1000_to_ethtool_adv_t(ctrl1000);
181
182 if (bmsr & BMSR_ANEGCOMPLETE) {
183 lp_advertising = mii_get_an(mii, MII_LPA);
184 lp_advertising |=
185 mii_stat1000_to_ethtool_lpa_t(stat1000);
186 } else {
187 lp_advertising = 0;
188 }
189
190 nego = advertising & lp_advertising;
191
192 if (nego & (ADVERTISED_1000baseT_Full |
193 ADVERTISED_1000baseT_Half)) {
194 cmd->base.speed = SPEED_1000;
195 cmd->base.duplex = !!(nego & ADVERTISED_1000baseT_Full);
196 } else if (nego & (ADVERTISED_100baseT_Full |
197 ADVERTISED_100baseT_Half)) {
198 cmd->base.speed = SPEED_100;
199 cmd->base.duplex = !!(nego & ADVERTISED_100baseT_Full);
200 } else {
201 cmd->base.speed = SPEED_10;
202 cmd->base.duplex = !!(nego & ADVERTISED_10baseT_Full);
203 }
204 } else {
205 cmd->base.autoneg = AUTONEG_DISABLE;
206
207 cmd->base.speed = ((bmcr & BMCR_SPEED1000 &&
208 (bmcr & BMCR_SPEED100) == 0) ?
209 SPEED_1000 :
210 ((bmcr & BMCR_SPEED100) ?
211 SPEED_100 : SPEED_10));
212 cmd->base.duplex = (bmcr & BMCR_FULLDPLX) ?
213 DUPLEX_FULL : DUPLEX_HALF;
214
215 lp_advertising = 0;
216 }
217
218 mii->full_duplex = cmd->base.duplex;
219
220 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
221 supported);
222 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising,
223 advertising);
224 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.lp_advertising,
225 lp_advertising);
226
227 /* ignore maxtxpkt, maxrxpkt for now */
228}
229
230/**
231 * mii_ethtool_sset - set settings that are specified in @ecmd
232 * @mii: MII interface
233 * @ecmd: requested ethtool_cmd
234 *
235 * Returns 0 for success, negative on error.
236 */
237int mii_ethtool_sset(struct mii_if_info *mii, struct ethtool_cmd *ecmd)
238{
239 struct net_device *dev = mii->dev;
240 u32 speed = ethtool_cmd_speed(ecmd);
241
242 if (speed != SPEED_10 &&
243 speed != SPEED_100 &&
244 speed != SPEED_1000)
245 return -EINVAL;
246 if (ecmd->duplex != DUPLEX_HALF && ecmd->duplex != DUPLEX_FULL)
247 return -EINVAL;
248 if (ecmd->port != PORT_MII)
249 return -EINVAL;
250 if (ecmd->transceiver != XCVR_INTERNAL)
251 return -EINVAL;
252 if (ecmd->phy_address != mii->phy_id)
253 return -EINVAL;
254 if (ecmd->autoneg != AUTONEG_DISABLE && ecmd->autoneg != AUTONEG_ENABLE)
255 return -EINVAL;
256 if ((speed == SPEED_1000) && (!mii->supports_gmii))
257 return -EINVAL;
258
259 /* ignore supported, maxtxpkt, maxrxpkt */
260
261 if (ecmd->autoneg == AUTONEG_ENABLE) {
262 u32 bmcr, advert, tmp;
263 u32 advert2 = 0, tmp2 = 0;
264
265 if ((ecmd->advertising & (ADVERTISED_10baseT_Half |
266 ADVERTISED_10baseT_Full |
267 ADVERTISED_100baseT_Half |
268 ADVERTISED_100baseT_Full |
269 ADVERTISED_1000baseT_Half |
270 ADVERTISED_1000baseT_Full)) == 0)
271 return -EINVAL;
272
273 /* advertise only what has been requested */
274 advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE);
275 tmp = advert & ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
276 if (mii->supports_gmii) {
277 advert2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
278 tmp2 = advert2 & ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL);
279 }
280 tmp |= ethtool_adv_to_mii_adv_t(ecmd->advertising);
281
282 if (mii->supports_gmii)
283 tmp2 |=
284 ethtool_adv_to_mii_ctrl1000_t(ecmd->advertising);
285 if (advert != tmp) {
286 mii->mdio_write(dev, mii->phy_id, MII_ADVERTISE, tmp);
287 mii->advertising = tmp;
288 }
289 if ((mii->supports_gmii) && (advert2 != tmp2))
290 mii->mdio_write(dev, mii->phy_id, MII_CTRL1000, tmp2);
291
292 /* turn on autonegotiation, and force a renegotiate */
293 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
294 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
295 mii->mdio_write(dev, mii->phy_id, MII_BMCR, bmcr);
296
297 mii->force_media = 0;
298 } else {
299 u32 bmcr, tmp;
300
301 /* turn off auto negotiation, set speed and duplexity */
302 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
303 tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 |
304 BMCR_SPEED1000 | BMCR_FULLDPLX);
305 if (speed == SPEED_1000)
306 tmp |= BMCR_SPEED1000;
307 else if (speed == SPEED_100)
308 tmp |= BMCR_SPEED100;
309 if (ecmd->duplex == DUPLEX_FULL) {
310 tmp |= BMCR_FULLDPLX;
311 mii->full_duplex = 1;
312 } else
313 mii->full_duplex = 0;
314 if (bmcr != tmp)
315 mii->mdio_write(dev, mii->phy_id, MII_BMCR, tmp);
316
317 mii->force_media = 1;
318 }
319 return 0;
320}
321
322/**
323 * mii_ethtool_set_link_ksettings - set settings that are specified in @cmd
324 * @mii: MII interfaces
325 * @cmd: requested ethtool_link_ksettings
326 *
327 * Returns 0 for success, negative on error.
328 */
329int mii_ethtool_set_link_ksettings(struct mii_if_info *mii,
330 const struct ethtool_link_ksettings *cmd)
331{
332 struct net_device *dev = mii->dev;
333 u32 speed = cmd->base.speed;
334
335 if (speed != SPEED_10 &&
336 speed != SPEED_100 &&
337 speed != SPEED_1000)
338 return -EINVAL;
339 if (cmd->base.duplex != DUPLEX_HALF && cmd->base.duplex != DUPLEX_FULL)
340 return -EINVAL;
341 if (cmd->base.port != PORT_MII)
342 return -EINVAL;
343 if (cmd->base.phy_address != mii->phy_id)
344 return -EINVAL;
345 if (cmd->base.autoneg != AUTONEG_DISABLE &&
346 cmd->base.autoneg != AUTONEG_ENABLE)
347 return -EINVAL;
348 if ((speed == SPEED_1000) && (!mii->supports_gmii))
349 return -EINVAL;
350
351 /* ignore supported, maxtxpkt, maxrxpkt */
352
353 if (cmd->base.autoneg == AUTONEG_ENABLE) {
354 u32 bmcr, advert, tmp;
355 u32 advert2 = 0, tmp2 = 0;
356 u32 advertising;
357
358 ethtool_convert_link_mode_to_legacy_u32(
359 &advertising, cmd->link_modes.advertising);
360
361 if ((advertising & (ADVERTISED_10baseT_Half |
362 ADVERTISED_10baseT_Full |
363 ADVERTISED_100baseT_Half |
364 ADVERTISED_100baseT_Full |
365 ADVERTISED_1000baseT_Half |
366 ADVERTISED_1000baseT_Full)) == 0)
367 return -EINVAL;
368
369 /* advertise only what has been requested */
370 advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE);
371 tmp = advert & ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
372 if (mii->supports_gmii) {
373 advert2 = mii->mdio_read(dev, mii->phy_id,
374 MII_CTRL1000);
375 tmp2 = advert2 &
376 ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL);
377 }
378 tmp |= ethtool_adv_to_mii_adv_t(advertising);
379
380 if (mii->supports_gmii)
381 tmp2 |= ethtool_adv_to_mii_ctrl1000_t(advertising);
382 if (advert != tmp) {
383 mii->mdio_write(dev, mii->phy_id, MII_ADVERTISE, tmp);
384 mii->advertising = tmp;
385 }
386 if ((mii->supports_gmii) && (advert2 != tmp2))
387 mii->mdio_write(dev, mii->phy_id, MII_CTRL1000, tmp2);
388
389 /* turn on autonegotiation, and force a renegotiate */
390 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
391 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
392 mii->mdio_write(dev, mii->phy_id, MII_BMCR, bmcr);
393
394 mii->force_media = 0;
395 } else {
396 u32 bmcr, tmp;
397
398 /* turn off auto negotiation, set speed and duplexity */
399 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
400 tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 |
401 BMCR_SPEED1000 | BMCR_FULLDPLX);
402 if (speed == SPEED_1000)
403 tmp |= BMCR_SPEED1000;
404 else if (speed == SPEED_100)
405 tmp |= BMCR_SPEED100;
406 if (cmd->base.duplex == DUPLEX_FULL) {
407 tmp |= BMCR_FULLDPLX;
408 mii->full_duplex = 1;
409 } else {
410 mii->full_duplex = 0;
411 }
412 if (bmcr != tmp)
413 mii->mdio_write(dev, mii->phy_id, MII_BMCR, tmp);
414
415 mii->force_media = 1;
416 }
417 return 0;
418}
419
420/**
421 * mii_check_gmii_support - check if the MII supports Gb interfaces
422 * @mii: the MII interface
423 */
424int mii_check_gmii_support(struct mii_if_info *mii)
425{
426 int reg;
427
428 reg = mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR);
429 if (reg & BMSR_ESTATEN) {
430 reg = mii->mdio_read(mii->dev, mii->phy_id, MII_ESTATUS);
431 if (reg & (ESTATUS_1000_TFULL | ESTATUS_1000_THALF))
432 return 1;
433 }
434
435 return 0;
436}
437
438/**
439 * mii_link_ok - is link status up/ok
440 * @mii: the MII interface
441 *
442 * Returns 1 if the MII reports link status up/ok, 0 otherwise.
443 */
444int mii_link_ok (struct mii_if_info *mii)
445{
446 /* first, a dummy read, needed to latch some MII phys */
447 mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR);
448 if (mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR) & BMSR_LSTATUS)
449 return 1;
450 return 0;
451}
452
453/**
454 * mii_nway_restart - restart NWay (autonegotiation) for this interface
455 * @mii: the MII interface
456 *
457 * Returns 0 on success, negative on error.
458 */
459int mii_nway_restart (struct mii_if_info *mii)
460{
461 int bmcr;
462 int r = -EINVAL;
463
464 /* if autoneg is off, it's an error */
465 bmcr = mii->mdio_read(mii->dev, mii->phy_id, MII_BMCR);
466
467 if (bmcr & BMCR_ANENABLE) {
468 bmcr |= BMCR_ANRESTART;
469 mii->mdio_write(mii->dev, mii->phy_id, MII_BMCR, bmcr);
470 r = 0;
471 }
472
473 return r;
474}
475
476/**
477 * mii_check_link - check MII link status
478 * @mii: MII interface
479 *
480 * If the link status changed (previous != current), call
481 * netif_carrier_on() if current link status is Up or call
482 * netif_carrier_off() if current link status is Down.
483 */
484void mii_check_link (struct mii_if_info *mii)
485{
486 int cur_link = mii_link_ok(mii);
487 int prev_link = netif_carrier_ok(mii->dev);
488
489 if (cur_link && !prev_link)
490 netif_carrier_on(mii->dev);
491 else if (prev_link && !cur_link)
492 netif_carrier_off(mii->dev);
493}
494
495/**
496 * mii_check_media - check the MII interface for a carrier/speed/duplex change
497 * @mii: the MII interface
498 * @ok_to_print: OK to print link up/down messages
499 * @init_media: OK to save duplex mode in @mii
500 *
501 * Returns 1 if the duplex mode changed, 0 if not.
502 * If the media type is forced, always returns 0.
503 */
504unsigned int mii_check_media (struct mii_if_info *mii,
505 unsigned int ok_to_print,
506 unsigned int init_media)
507{
508 unsigned int old_carrier, new_carrier;
509 int advertise, lpa, media, duplex;
510 int lpa2 = 0;
511
512 /* check current and old link status */
513 old_carrier = netif_carrier_ok(mii->dev) ? 1 : 0;
514 new_carrier = (unsigned int) mii_link_ok(mii);
515
516 /* if carrier state did not change, this is a "bounce",
517 * just exit as everything is already set correctly
518 */
519 if ((!init_media) && (old_carrier == new_carrier))
520 return 0; /* duplex did not change */
521
522 /* no carrier, nothing much to do */
523 if (!new_carrier) {
524 netif_carrier_off(mii->dev);
525 if (ok_to_print)
526 netdev_info(mii->dev, "link down\n");
527 return 0; /* duplex did not change */
528 }
529
530 /*
531 * we have carrier, see who's on the other end
532 */
533 netif_carrier_on(mii->dev);
534
535 if (mii->force_media) {
536 if (ok_to_print)
537 netdev_info(mii->dev, "link up\n");
538 return 0; /* duplex did not change */
539 }
540
541 /* get MII advertise and LPA values */
542 if ((!init_media) && (mii->advertising))
543 advertise = mii->advertising;
544 else {
545 advertise = mii->mdio_read(mii->dev, mii->phy_id, MII_ADVERTISE);
546 mii->advertising = advertise;
547 }
548 lpa = mii->mdio_read(mii->dev, mii->phy_id, MII_LPA);
549 if (mii->supports_gmii)
550 lpa2 = mii->mdio_read(mii->dev, mii->phy_id, MII_STAT1000);
551
552 /* figure out media and duplex from advertise and LPA values */
553 media = mii_nway_result(lpa & advertise);
554 duplex = (media & ADVERTISE_FULL) ? 1 : 0;
555 if (lpa2 & LPA_1000FULL)
556 duplex = 1;
557
558 if (ok_to_print)
559 netdev_info(mii->dev, "link up, %uMbps, %s-duplex, lpa 0x%04X\n",
560 lpa2 & (LPA_1000FULL | LPA_1000HALF) ? 1000 :
561 media & (ADVERTISE_100FULL | ADVERTISE_100HALF) ?
562 100 : 10,
563 duplex ? "full" : "half",
564 lpa);
565
566 if ((init_media) || (mii->full_duplex != duplex)) {
567 mii->full_duplex = duplex;
568 return 1; /* duplex changed */
569 }
570
571 return 0; /* duplex did not change */
572}
573
574/**
575 * generic_mii_ioctl - main MII ioctl interface
576 * @mii_if: the MII interface
577 * @mii_data: MII ioctl data structure
578 * @cmd: MII ioctl command
579 * @duplex_chg_out: pointer to @duplex_changed status if there was no
580 * ioctl error
581 *
582 * Returns 0 on success, negative on error.
583 */
584int generic_mii_ioctl(struct mii_if_info *mii_if,
585 struct mii_ioctl_data *mii_data, int cmd,
586 unsigned int *duplex_chg_out)
587{
588 int rc = 0;
589 unsigned int duplex_changed = 0;
590
591 if (duplex_chg_out)
592 *duplex_chg_out = 0;
593
594 mii_data->phy_id &= mii_if->phy_id_mask;
595 mii_data->reg_num &= mii_if->reg_num_mask;
596
597 switch(cmd) {
598 case SIOCGMIIPHY:
599 mii_data->phy_id = mii_if->phy_id;
600 /* fall through */
601
602 case SIOCGMIIREG:
603 mii_data->val_out =
604 mii_if->mdio_read(mii_if->dev, mii_data->phy_id,
605 mii_data->reg_num);
606 break;
607
608 case SIOCSMIIREG: {
609 u16 val = mii_data->val_in;
610
611 if (mii_data->phy_id == mii_if->phy_id) {
612 switch(mii_data->reg_num) {
613 case MII_BMCR: {
614 unsigned int new_duplex = 0;
615 if (val & (BMCR_RESET|BMCR_ANENABLE))
616 mii_if->force_media = 0;
617 else
618 mii_if->force_media = 1;
619 if (mii_if->force_media &&
620 (val & BMCR_FULLDPLX))
621 new_duplex = 1;
622 if (mii_if->full_duplex != new_duplex) {
623 duplex_changed = 1;
624 mii_if->full_duplex = new_duplex;
625 }
626 break;
627 }
628 case MII_ADVERTISE:
629 mii_if->advertising = val;
630 break;
631 default:
632 /* do nothing */
633 break;
634 }
635 }
636
637 mii_if->mdio_write(mii_if->dev, mii_data->phy_id,
638 mii_data->reg_num, val);
639 break;
640 }
641
642 default:
643 rc = -EOPNOTSUPP;
644 break;
645 }
646
647 if ((rc == 0) && (duplex_chg_out) && (duplex_changed))
648 *duplex_chg_out = 1;
649
650 return rc;
651}
652
653MODULE_AUTHOR ("Jeff Garzik <jgarzik@pobox.com>");
654MODULE_DESCRIPTION ("MII hardware support library");
655MODULE_LICENSE("GPL");
656
657EXPORT_SYMBOL(mii_link_ok);
658EXPORT_SYMBOL(mii_nway_restart);
659EXPORT_SYMBOL(mii_ethtool_gset);
660EXPORT_SYMBOL(mii_ethtool_get_link_ksettings);
661EXPORT_SYMBOL(mii_ethtool_sset);
662EXPORT_SYMBOL(mii_ethtool_set_link_ksettings);
663EXPORT_SYMBOL(mii_check_link);
664EXPORT_SYMBOL(mii_check_media);
665EXPORT_SYMBOL(mii_check_gmii_support);
666EXPORT_SYMBOL(generic_mii_ioctl);
667
1/*
2
3 mii.c: MII interface library
4
5 Maintained by Jeff Garzik <jgarzik@pobox.com>
6 Copyright 2001,2002 Jeff Garzik
7
8 Various code came from myson803.c and other files by
9 Donald Becker. Copyright:
10
11 Written 1998-2002 by Donald Becker.
12
13 This software may be used and distributed according
14 to the terms of the GNU General Public License (GPL),
15 incorporated herein by reference. Drivers based on
16 or derived from this code fall under the GPL and must
17 retain the authorship, copyright and license notice.
18 This file is not a complete program and may only be
19 used when the entire operating system is licensed
20 under the GPL.
21
22 The author may be reached as becker@scyld.com, or C/O
23 Scyld Computing Corporation
24 410 Severn Ave., Suite 210
25 Annapolis MD 21403
26
27
28 */
29
30#include <linux/kernel.h>
31#include <linux/module.h>
32#include <linux/netdevice.h>
33#include <linux/ethtool.h>
34#include <linux/mdio.h>
35
36static u32 mii_get_an(struct mii_if_info *mii, u16 addr)
37{
38 u32 result = 0;
39 int advert;
40
41 advert = mii->mdio_read(mii->dev, mii->phy_id, addr);
42 if (advert & LPA_LPACK)
43 result |= ADVERTISED_Autoneg;
44 if (advert & ADVERTISE_10HALF)
45 result |= ADVERTISED_10baseT_Half;
46 if (advert & ADVERTISE_10FULL)
47 result |= ADVERTISED_10baseT_Full;
48 if (advert & ADVERTISE_100HALF)
49 result |= ADVERTISED_100baseT_Half;
50 if (advert & ADVERTISE_100FULL)
51 result |= ADVERTISED_100baseT_Full;
52 if (advert & ADVERTISE_PAUSE_CAP)
53 result |= ADVERTISED_Pause;
54 if (advert & ADVERTISE_PAUSE_ASYM)
55 result |= ADVERTISED_Asym_Pause;
56
57 return result;
58}
59
60/**
61 * mii_ethtool_gset - get settings that are specified in @ecmd
62 * @mii: MII interface
63 * @ecmd: requested ethtool_cmd
64 *
65 * The @ecmd parameter is expected to have been cleared before calling
66 * mii_ethtool_gset().
67 *
68 * Returns 0 for success, negative on error.
69 */
70int mii_ethtool_gset(struct mii_if_info *mii, struct ethtool_cmd *ecmd)
71{
72 struct net_device *dev = mii->dev;
73 u16 bmcr, bmsr, ctrl1000 = 0, stat1000 = 0;
74 u32 nego;
75
76 ecmd->supported =
77 (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full |
78 SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
79 SUPPORTED_Autoneg | SUPPORTED_TP | SUPPORTED_MII);
80 if (mii->supports_gmii)
81 ecmd->supported |= SUPPORTED_1000baseT_Half |
82 SUPPORTED_1000baseT_Full;
83
84 /* only supports twisted-pair */
85 ecmd->port = PORT_MII;
86
87 /* only supports internal transceiver */
88 ecmd->transceiver = XCVR_INTERNAL;
89
90 /* this isn't fully supported at higher layers */
91 ecmd->phy_address = mii->phy_id;
92 ecmd->mdio_support = MDIO_SUPPORTS_C22;
93
94 ecmd->advertising = ADVERTISED_TP | ADVERTISED_MII;
95
96 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
97 bmsr = mii->mdio_read(dev, mii->phy_id, MII_BMSR);
98 if (mii->supports_gmii) {
99 ctrl1000 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
100 stat1000 = mii->mdio_read(dev, mii->phy_id, MII_STAT1000);
101 }
102 if (bmcr & BMCR_ANENABLE) {
103 ecmd->advertising |= ADVERTISED_Autoneg;
104 ecmd->autoneg = AUTONEG_ENABLE;
105
106 ecmd->advertising |= mii_get_an(mii, MII_ADVERTISE);
107 if (ctrl1000 & ADVERTISE_1000HALF)
108 ecmd->advertising |= ADVERTISED_1000baseT_Half;
109 if (ctrl1000 & ADVERTISE_1000FULL)
110 ecmd->advertising |= ADVERTISED_1000baseT_Full;
111
112 if (bmsr & BMSR_ANEGCOMPLETE) {
113 ecmd->lp_advertising = mii_get_an(mii, MII_LPA);
114 if (stat1000 & LPA_1000HALF)
115 ecmd->lp_advertising |=
116 ADVERTISED_1000baseT_Half;
117 if (stat1000 & LPA_1000FULL)
118 ecmd->lp_advertising |=
119 ADVERTISED_1000baseT_Full;
120 } else {
121 ecmd->lp_advertising = 0;
122 }
123
124 nego = ecmd->advertising & ecmd->lp_advertising;
125
126 if (nego & (ADVERTISED_1000baseT_Full |
127 ADVERTISED_1000baseT_Half)) {
128 ethtool_cmd_speed_set(ecmd, SPEED_1000);
129 ecmd->duplex = !!(nego & ADVERTISED_1000baseT_Full);
130 } else if (nego & (ADVERTISED_100baseT_Full |
131 ADVERTISED_100baseT_Half)) {
132 ethtool_cmd_speed_set(ecmd, SPEED_100);
133 ecmd->duplex = !!(nego & ADVERTISED_100baseT_Full);
134 } else {
135 ethtool_cmd_speed_set(ecmd, SPEED_10);
136 ecmd->duplex = !!(nego & ADVERTISED_10baseT_Full);
137 }
138 } else {
139 ecmd->autoneg = AUTONEG_DISABLE;
140
141 ethtool_cmd_speed_set(ecmd,
142 ((bmcr & BMCR_SPEED1000 &&
143 (bmcr & BMCR_SPEED100) == 0) ?
144 SPEED_1000 :
145 ((bmcr & BMCR_SPEED100) ?
146 SPEED_100 : SPEED_10)));
147 ecmd->duplex = (bmcr & BMCR_FULLDPLX) ? DUPLEX_FULL : DUPLEX_HALF;
148 }
149
150 mii->full_duplex = ecmd->duplex;
151
152 /* ignore maxtxpkt, maxrxpkt for now */
153
154 return 0;
155}
156
157/**
158 * mii_ethtool_sset - set settings that are specified in @ecmd
159 * @mii: MII interface
160 * @ecmd: requested ethtool_cmd
161 *
162 * Returns 0 for success, negative on error.
163 */
164int mii_ethtool_sset(struct mii_if_info *mii, struct ethtool_cmd *ecmd)
165{
166 struct net_device *dev = mii->dev;
167 u32 speed = ethtool_cmd_speed(ecmd);
168
169 if (speed != SPEED_10 &&
170 speed != SPEED_100 &&
171 speed != SPEED_1000)
172 return -EINVAL;
173 if (ecmd->duplex != DUPLEX_HALF && ecmd->duplex != DUPLEX_FULL)
174 return -EINVAL;
175 if (ecmd->port != PORT_MII)
176 return -EINVAL;
177 if (ecmd->transceiver != XCVR_INTERNAL)
178 return -EINVAL;
179 if (ecmd->phy_address != mii->phy_id)
180 return -EINVAL;
181 if (ecmd->autoneg != AUTONEG_DISABLE && ecmd->autoneg != AUTONEG_ENABLE)
182 return -EINVAL;
183 if ((speed == SPEED_1000) && (!mii->supports_gmii))
184 return -EINVAL;
185
186 /* ignore supported, maxtxpkt, maxrxpkt */
187
188 if (ecmd->autoneg == AUTONEG_ENABLE) {
189 u32 bmcr, advert, tmp;
190 u32 advert2 = 0, tmp2 = 0;
191
192 if ((ecmd->advertising & (ADVERTISED_10baseT_Half |
193 ADVERTISED_10baseT_Full |
194 ADVERTISED_100baseT_Half |
195 ADVERTISED_100baseT_Full |
196 ADVERTISED_1000baseT_Half |
197 ADVERTISED_1000baseT_Full)) == 0)
198 return -EINVAL;
199
200 /* advertise only what has been requested */
201 advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE);
202 tmp = advert & ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
203 if (mii->supports_gmii) {
204 advert2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
205 tmp2 = advert2 & ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL);
206 }
207 if (ecmd->advertising & ADVERTISED_10baseT_Half)
208 tmp |= ADVERTISE_10HALF;
209 if (ecmd->advertising & ADVERTISED_10baseT_Full)
210 tmp |= ADVERTISE_10FULL;
211 if (ecmd->advertising & ADVERTISED_100baseT_Half)
212 tmp |= ADVERTISE_100HALF;
213 if (ecmd->advertising & ADVERTISED_100baseT_Full)
214 tmp |= ADVERTISE_100FULL;
215 if (mii->supports_gmii) {
216 if (ecmd->advertising & ADVERTISED_1000baseT_Half)
217 tmp2 |= ADVERTISE_1000HALF;
218 if (ecmd->advertising & ADVERTISED_1000baseT_Full)
219 tmp2 |= ADVERTISE_1000FULL;
220 }
221 if (advert != tmp) {
222 mii->mdio_write(dev, mii->phy_id, MII_ADVERTISE, tmp);
223 mii->advertising = tmp;
224 }
225 if ((mii->supports_gmii) && (advert2 != tmp2))
226 mii->mdio_write(dev, mii->phy_id, MII_CTRL1000, tmp2);
227
228 /* turn on autonegotiation, and force a renegotiate */
229 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
230 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
231 mii->mdio_write(dev, mii->phy_id, MII_BMCR, bmcr);
232
233 mii->force_media = 0;
234 } else {
235 u32 bmcr, tmp;
236
237 /* turn off auto negotiation, set speed and duplexity */
238 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
239 tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 |
240 BMCR_SPEED1000 | BMCR_FULLDPLX);
241 if (speed == SPEED_1000)
242 tmp |= BMCR_SPEED1000;
243 else if (speed == SPEED_100)
244 tmp |= BMCR_SPEED100;
245 if (ecmd->duplex == DUPLEX_FULL) {
246 tmp |= BMCR_FULLDPLX;
247 mii->full_duplex = 1;
248 } else
249 mii->full_duplex = 0;
250 if (bmcr != tmp)
251 mii->mdio_write(dev, mii->phy_id, MII_BMCR, tmp);
252
253 mii->force_media = 1;
254 }
255 return 0;
256}
257
258/**
259 * mii_check_gmii_support - check if the MII supports Gb interfaces
260 * @mii: the MII interface
261 */
262int mii_check_gmii_support(struct mii_if_info *mii)
263{
264 int reg;
265
266 reg = mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR);
267 if (reg & BMSR_ESTATEN) {
268 reg = mii->mdio_read(mii->dev, mii->phy_id, MII_ESTATUS);
269 if (reg & (ESTATUS_1000_TFULL | ESTATUS_1000_THALF))
270 return 1;
271 }
272
273 return 0;
274}
275
276/**
277 * mii_link_ok - is link status up/ok
278 * @mii: the MII interface
279 *
280 * Returns 1 if the MII reports link status up/ok, 0 otherwise.
281 */
282int mii_link_ok (struct mii_if_info *mii)
283{
284 /* first, a dummy read, needed to latch some MII phys */
285 mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR);
286 if (mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR) & BMSR_LSTATUS)
287 return 1;
288 return 0;
289}
290
291/**
292 * mii_nway_restart - restart NWay (autonegotiation) for this interface
293 * @mii: the MII interface
294 *
295 * Returns 0 on success, negative on error.
296 */
297int mii_nway_restart (struct mii_if_info *mii)
298{
299 int bmcr;
300 int r = -EINVAL;
301
302 /* if autoneg is off, it's an error */
303 bmcr = mii->mdio_read(mii->dev, mii->phy_id, MII_BMCR);
304
305 if (bmcr & BMCR_ANENABLE) {
306 bmcr |= BMCR_ANRESTART;
307 mii->mdio_write(mii->dev, mii->phy_id, MII_BMCR, bmcr);
308 r = 0;
309 }
310
311 return r;
312}
313
314/**
315 * mii_check_link - check MII link status
316 * @mii: MII interface
317 *
318 * If the link status changed (previous != current), call
319 * netif_carrier_on() if current link status is Up or call
320 * netif_carrier_off() if current link status is Down.
321 */
322void mii_check_link (struct mii_if_info *mii)
323{
324 int cur_link = mii_link_ok(mii);
325 int prev_link = netif_carrier_ok(mii->dev);
326
327 if (cur_link && !prev_link)
328 netif_carrier_on(mii->dev);
329 else if (prev_link && !cur_link)
330 netif_carrier_off(mii->dev);
331}
332
333/**
334 * mii_check_media - check the MII interface for a duplex change
335 * @mii: the MII interface
336 * @ok_to_print: OK to print link up/down messages
337 * @init_media: OK to save duplex mode in @mii
338 *
339 * Returns 1 if the duplex mode changed, 0 if not.
340 * If the media type is forced, always returns 0.
341 */
342unsigned int mii_check_media (struct mii_if_info *mii,
343 unsigned int ok_to_print,
344 unsigned int init_media)
345{
346 unsigned int old_carrier, new_carrier;
347 int advertise, lpa, media, duplex;
348 int lpa2 = 0;
349
350 /* if forced media, go no further */
351 if (mii->force_media)
352 return 0; /* duplex did not change */
353
354 /* check current and old link status */
355 old_carrier = netif_carrier_ok(mii->dev) ? 1 : 0;
356 new_carrier = (unsigned int) mii_link_ok(mii);
357
358 /* if carrier state did not change, this is a "bounce",
359 * just exit as everything is already set correctly
360 */
361 if ((!init_media) && (old_carrier == new_carrier))
362 return 0; /* duplex did not change */
363
364 /* no carrier, nothing much to do */
365 if (!new_carrier) {
366 netif_carrier_off(mii->dev);
367 if (ok_to_print)
368 netdev_info(mii->dev, "link down\n");
369 return 0; /* duplex did not change */
370 }
371
372 /*
373 * we have carrier, see who's on the other end
374 */
375 netif_carrier_on(mii->dev);
376
377 /* get MII advertise and LPA values */
378 if ((!init_media) && (mii->advertising))
379 advertise = mii->advertising;
380 else {
381 advertise = mii->mdio_read(mii->dev, mii->phy_id, MII_ADVERTISE);
382 mii->advertising = advertise;
383 }
384 lpa = mii->mdio_read(mii->dev, mii->phy_id, MII_LPA);
385 if (mii->supports_gmii)
386 lpa2 = mii->mdio_read(mii->dev, mii->phy_id, MII_STAT1000);
387
388 /* figure out media and duplex from advertise and LPA values */
389 media = mii_nway_result(lpa & advertise);
390 duplex = (media & ADVERTISE_FULL) ? 1 : 0;
391 if (lpa2 & LPA_1000FULL)
392 duplex = 1;
393
394 if (ok_to_print)
395 netdev_info(mii->dev, "link up, %uMbps, %s-duplex, lpa 0x%04X\n",
396 lpa2 & (LPA_1000FULL | LPA_1000HALF) ? 1000 :
397 media & (ADVERTISE_100FULL | ADVERTISE_100HALF) ?
398 100 : 10,
399 duplex ? "full" : "half",
400 lpa);
401
402 if ((init_media) || (mii->full_duplex != duplex)) {
403 mii->full_duplex = duplex;
404 return 1; /* duplex changed */
405 }
406
407 return 0; /* duplex did not change */
408}
409
410/**
411 * generic_mii_ioctl - main MII ioctl interface
412 * @mii_if: the MII interface
413 * @mii_data: MII ioctl data structure
414 * @cmd: MII ioctl command
415 * @duplex_chg_out: pointer to @duplex_changed status if there was no
416 * ioctl error
417 *
418 * Returns 0 on success, negative on error.
419 */
420int generic_mii_ioctl(struct mii_if_info *mii_if,
421 struct mii_ioctl_data *mii_data, int cmd,
422 unsigned int *duplex_chg_out)
423{
424 int rc = 0;
425 unsigned int duplex_changed = 0;
426
427 if (duplex_chg_out)
428 *duplex_chg_out = 0;
429
430 mii_data->phy_id &= mii_if->phy_id_mask;
431 mii_data->reg_num &= mii_if->reg_num_mask;
432
433 switch(cmd) {
434 case SIOCGMIIPHY:
435 mii_data->phy_id = mii_if->phy_id;
436 /* fall through */
437
438 case SIOCGMIIREG:
439 mii_data->val_out =
440 mii_if->mdio_read(mii_if->dev, mii_data->phy_id,
441 mii_data->reg_num);
442 break;
443
444 case SIOCSMIIREG: {
445 u16 val = mii_data->val_in;
446
447 if (mii_data->phy_id == mii_if->phy_id) {
448 switch(mii_data->reg_num) {
449 case MII_BMCR: {
450 unsigned int new_duplex = 0;
451 if (val & (BMCR_RESET|BMCR_ANENABLE))
452 mii_if->force_media = 0;
453 else
454 mii_if->force_media = 1;
455 if (mii_if->force_media &&
456 (val & BMCR_FULLDPLX))
457 new_duplex = 1;
458 if (mii_if->full_duplex != new_duplex) {
459 duplex_changed = 1;
460 mii_if->full_duplex = new_duplex;
461 }
462 break;
463 }
464 case MII_ADVERTISE:
465 mii_if->advertising = val;
466 break;
467 default:
468 /* do nothing */
469 break;
470 }
471 }
472
473 mii_if->mdio_write(mii_if->dev, mii_data->phy_id,
474 mii_data->reg_num, val);
475 break;
476 }
477
478 default:
479 rc = -EOPNOTSUPP;
480 break;
481 }
482
483 if ((rc == 0) && (duplex_chg_out) && (duplex_changed))
484 *duplex_chg_out = 1;
485
486 return rc;
487}
488
489MODULE_AUTHOR ("Jeff Garzik <jgarzik@pobox.com>");
490MODULE_DESCRIPTION ("MII hardware support library");
491MODULE_LICENSE("GPL");
492
493EXPORT_SYMBOL(mii_link_ok);
494EXPORT_SYMBOL(mii_nway_restart);
495EXPORT_SYMBOL(mii_ethtool_gset);
496EXPORT_SYMBOL(mii_ethtool_sset);
497EXPORT_SYMBOL(mii_check_link);
498EXPORT_SYMBOL(mii_check_media);
499EXPORT_SYMBOL(mii_check_gmii_support);
500EXPORT_SYMBOL(generic_mii_ioctl);
501