[Bug 760] Fix setting WEP key in monitor mode causes IV lost.
[linux-2.6] / drivers / net / sungem_phy.c
1 /*
2  * PHY drivers for the sungem ethernet driver.
3  * 
4  * This file could be shared with other drivers.
5  * 
6  * (c) 2002, Benjamin Herrenscmidt (benh@kernel.crashing.org)
7  *
8  * TODO:
9  *  - Implement WOL
10  *  - Add support for PHYs that provide an IRQ line
11  *  - Eventually moved the entire polling state machine in
12  *    there (out of the eth driver), so that it can easily be
13  *    skipped on PHYs that implement it in hardware.
14  *  - On LXT971 & BCM5201, Apple uses some chip specific regs
15  *    to read the link status. Figure out why and if it makes
16  *    sense to do the same (magic aneg ?)
17  *  - Apple has some additional power management code for some
18  *    Broadcom PHYs that they "hide" from the OpenSource version
19  *    of darwin, still need to reverse engineer that
20  */
21
22 #include <linux/config.h>
23
24 #include <linux/module.h>
25
26 #include <linux/kernel.h>
27 #include <linux/sched.h>
28 #include <linux/types.h>
29 #include <linux/netdevice.h>
30 #include <linux/etherdevice.h>
31 #include <linux/mii.h>
32 #include <linux/ethtool.h>
33 #include <linux/delay.h>
34
35 #ifdef CONFIG_PPC_PMAC
36 #include <asm/prom.h>
37 #endif
38
39 #include "sungem_phy.h"
40
41 /* Link modes of the BCM5400 PHY */
42 static int phy_BCM5400_link_table[8][3] = {
43         { 0, 0, 0 },    /* No link */
44         { 0, 0, 0 },    /* 10BT Half Duplex */
45         { 1, 0, 0 },    /* 10BT Full Duplex */
46         { 0, 1, 0 },    /* 100BT Half Duplex */
47         { 0, 1, 0 },    /* 100BT Half Duplex */
48         { 1, 1, 0 },    /* 100BT Full Duplex*/
49         { 1, 0, 1 },    /* 1000BT */
50         { 1, 0, 1 },    /* 1000BT */
51 };
52
53 static inline int __phy_read(struct mii_phy* phy, int id, int reg)
54 {
55         return phy->mdio_read(phy->dev, id, reg);
56 }
57
58 static inline void __phy_write(struct mii_phy* phy, int id, int reg, int val)
59 {
60         phy->mdio_write(phy->dev, id, reg, val);
61 }
62
63 static inline int phy_read(struct mii_phy* phy, int reg)
64 {
65         return phy->mdio_read(phy->dev, phy->mii_id, reg);
66 }
67
68 static inline void phy_write(struct mii_phy* phy, int reg, int val)
69 {
70         phy->mdio_write(phy->dev, phy->mii_id, reg, val);
71 }
72
73 static int reset_one_mii_phy(struct mii_phy* phy, int phy_id)
74 {
75         u16 val;
76         int limit = 10000;
77         
78         val = __phy_read(phy, phy_id, MII_BMCR);
79         val &= ~(BMCR_ISOLATE | BMCR_PDOWN);
80         val |= BMCR_RESET;
81         __phy_write(phy, phy_id, MII_BMCR, val);
82
83         udelay(100);
84
85         while (limit--) {
86                 val = __phy_read(phy, phy_id, MII_BMCR);
87                 if ((val & BMCR_RESET) == 0)
88                         break;
89                 udelay(10);
90         }
91         if ((val & BMCR_ISOLATE) && limit > 0)
92                 __phy_write(phy, phy_id, MII_BMCR, val & ~BMCR_ISOLATE);
93         
94         return (limit <= 0);
95 }
96
97 static int bcm5201_init(struct mii_phy* phy)
98 {
99         u16 data;
100
101         data = phy_read(phy, MII_BCM5201_MULTIPHY);
102         data &= ~MII_BCM5201_MULTIPHY_SUPERISOLATE;
103         phy_write(phy, MII_BCM5201_MULTIPHY, data);
104
105         phy_write(phy, MII_BCM5201_INTERRUPT, 0);
106
107         return 0;
108 }
109
110 static int bcm5201_suspend(struct mii_phy* phy)
111 {
112         phy_write(phy, MII_BCM5201_INTERRUPT, 0);
113         phy_write(phy, MII_BCM5201_MULTIPHY, MII_BCM5201_MULTIPHY_SUPERISOLATE);
114
115         return 0;
116 }
117
118 static int bcm5221_init(struct mii_phy* phy)
119 {
120         u16 data;
121
122         data = phy_read(phy, MII_BCM5221_TEST);
123         phy_write(phy, MII_BCM5221_TEST,
124                 data | MII_BCM5221_TEST_ENABLE_SHADOWS);
125
126         data = phy_read(phy, MII_BCM5221_SHDOW_AUX_STAT2);
127         phy_write(phy, MII_BCM5221_SHDOW_AUX_STAT2,
128                 data | MII_BCM5221_SHDOW_AUX_STAT2_APD);
129
130         data = phy_read(phy, MII_BCM5221_SHDOW_AUX_MODE4);
131         phy_write(phy, MII_BCM5221_SHDOW_AUX_MODE4,
132                 data | MII_BCM5221_SHDOW_AUX_MODE4_CLKLOPWR);
133
134         data = phy_read(phy, MII_BCM5221_TEST);
135         phy_write(phy, MII_BCM5221_TEST,
136                 data & ~MII_BCM5221_TEST_ENABLE_SHADOWS);
137
138         return 0;
139 }
140
141 static int bcm5221_suspend(struct mii_phy* phy)
142 {
143         u16 data;
144
145         data = phy_read(phy, MII_BCM5221_TEST);
146         phy_write(phy, MII_BCM5221_TEST,
147                 data | MII_BCM5221_TEST_ENABLE_SHADOWS);
148
149         data = phy_read(phy, MII_BCM5221_SHDOW_AUX_MODE4);
150         phy_write(phy, MII_BCM5221_SHDOW_AUX_MODE4,
151                   data | MII_BCM5221_SHDOW_AUX_MODE4_IDDQMODE);
152
153         return 0;
154 }
155
156 static int bcm5400_init(struct mii_phy* phy)
157 {
158         u16 data;
159
160         /* Configure for gigabit full duplex */
161         data = phy_read(phy, MII_BCM5400_AUXCONTROL);
162         data |= MII_BCM5400_AUXCONTROL_PWR10BASET;
163         phy_write(phy, MII_BCM5400_AUXCONTROL, data);
164         
165         data = phy_read(phy, MII_BCM5400_GB_CONTROL);
166         data |= MII_BCM5400_GB_CONTROL_FULLDUPLEXCAP;
167         phy_write(phy, MII_BCM5400_GB_CONTROL, data);
168         
169         udelay(100);
170
171         /* Reset and configure cascaded 10/100 PHY */
172         (void)reset_one_mii_phy(phy, 0x1f);
173         
174         data = __phy_read(phy, 0x1f, MII_BCM5201_MULTIPHY);
175         data |= MII_BCM5201_MULTIPHY_SERIALMODE;
176         __phy_write(phy, 0x1f, MII_BCM5201_MULTIPHY, data);
177
178         data = phy_read(phy, MII_BCM5400_AUXCONTROL);
179         data &= ~MII_BCM5400_AUXCONTROL_PWR10BASET;
180         phy_write(phy, MII_BCM5400_AUXCONTROL, data);
181
182         return 0;
183 }
184
185 static int bcm5400_suspend(struct mii_phy* phy)
186 {
187 #if 0 /* Commented out in Darwin... someone has those dawn docs ? */
188         phy_write(phy, MII_BMCR, BMCR_PDOWN);
189 #endif
190         return 0;
191 }
192
193 static int bcm5401_init(struct mii_phy* phy)
194 {
195         u16 data;
196         int rev;
197
198         rev = phy_read(phy, MII_PHYSID2) & 0x000f;
199         if (rev == 0 || rev == 3) {
200                 /* Some revisions of 5401 appear to need this
201                  * initialisation sequence to disable, according
202                  * to OF, "tap power management"
203                  * 
204                  * WARNING ! OF and Darwin don't agree on the
205                  * register addresses. OF seem to interpret the
206                  * register numbers below as decimal
207                  *
208                  * Note: This should (and does) match tg3_init_5401phy_dsp
209                  *       in the tg3.c driver. -DaveM
210                  */
211                 phy_write(phy, 0x18, 0x0c20);
212                 phy_write(phy, 0x17, 0x0012);
213                 phy_write(phy, 0x15, 0x1804);
214                 phy_write(phy, 0x17, 0x0013);
215                 phy_write(phy, 0x15, 0x1204);
216                 phy_write(phy, 0x17, 0x8006);
217                 phy_write(phy, 0x15, 0x0132);
218                 phy_write(phy, 0x17, 0x8006);
219                 phy_write(phy, 0x15, 0x0232);
220                 phy_write(phy, 0x17, 0x201f);
221                 phy_write(phy, 0x15, 0x0a20);
222         }
223         
224         /* Configure for gigabit full duplex */
225         data = phy_read(phy, MII_BCM5400_GB_CONTROL);
226         data |= MII_BCM5400_GB_CONTROL_FULLDUPLEXCAP;
227         phy_write(phy, MII_BCM5400_GB_CONTROL, data);
228
229         udelay(10);
230
231         /* Reset and configure cascaded 10/100 PHY */
232         (void)reset_one_mii_phy(phy, 0x1f);
233         
234         data = __phy_read(phy, 0x1f, MII_BCM5201_MULTIPHY);
235         data |= MII_BCM5201_MULTIPHY_SERIALMODE;
236         __phy_write(phy, 0x1f, MII_BCM5201_MULTIPHY, data);
237
238         return 0;
239 }
240
241 static int bcm5401_suspend(struct mii_phy* phy)
242 {
243 #if 0 /* Commented out in Darwin... someone has those dawn docs ? */
244         phy_write(phy, MII_BMCR, BMCR_PDOWN);
245 #endif
246         return 0;
247 }
248
249 static int bcm5411_init(struct mii_phy* phy)
250 {
251         u16 data;
252
253         /* Here's some more Apple black magic to setup
254          * some voltage stuffs.
255          */
256         phy_write(phy, 0x1c, 0x8c23);
257         phy_write(phy, 0x1c, 0x8ca3);
258         phy_write(phy, 0x1c, 0x8c23);
259
260         /* Here, Apple seems to want to reset it, do
261          * it as well
262          */
263         phy_write(phy, MII_BMCR, BMCR_RESET);
264         phy_write(phy, MII_BMCR, 0x1340);
265
266         data = phy_read(phy, MII_BCM5400_GB_CONTROL);
267         data |= MII_BCM5400_GB_CONTROL_FULLDUPLEXCAP;
268         phy_write(phy, MII_BCM5400_GB_CONTROL, data);
269
270         udelay(10);
271
272         /* Reset and configure cascaded 10/100 PHY */
273         (void)reset_one_mii_phy(phy, 0x1f);
274         
275         return 0;
276 }
277
278 static int bcm5411_suspend(struct mii_phy* phy)
279 {
280         phy_write(phy, MII_BMCR, BMCR_PDOWN);
281
282         return 0;
283 }
284
285 static int bcm5421_init(struct mii_phy* phy)
286 {
287         u16 data;
288         unsigned int id;
289
290         id = (phy_read(phy, MII_PHYSID1) << 16 | phy_read(phy, MII_PHYSID2));
291
292         /* Revision 0 of 5421 needs some fixups */
293         if (id == 0x002060e0) {
294                 /* This is borrowed from MacOS
295                  */
296                 phy_write(phy, 0x18, 0x1007);
297                 data = phy_read(phy, 0x18);
298                 phy_write(phy, 0x18, data | 0x0400);
299                 phy_write(phy, 0x18, 0x0007);
300                 data = phy_read(phy, 0x18);
301                 phy_write(phy, 0x18, data | 0x0800);
302                 phy_write(phy, 0x17, 0x000a);
303                 data = phy_read(phy, 0x15);
304                 phy_write(phy, 0x15, data | 0x0200);
305         }
306
307         /* Pick up some init code from OF for K2 version */
308         if ((id & 0xfffffff0) == 0x002062e0) {
309                 phy_write(phy, 4, 0x01e1);
310                 phy_write(phy, 9, 0x0300);
311         }
312
313         /* Check if we can enable automatic low power */
314 #ifdef CONFIG_PPC_PMAC
315         if (phy->platform_data) {
316                 struct device_node *np = of_get_parent(phy->platform_data);
317                 int can_low_power = 1;
318                 if (np == NULL || get_property(np, "no-autolowpower", NULL))
319                         can_low_power = 0;
320                 if (can_low_power) {
321                         /* Enable automatic low-power */
322                         phy_write(phy, 0x1c, 0x9002);
323                         phy_write(phy, 0x1c, 0xa821);
324                         phy_write(phy, 0x1c, 0x941d);
325                 }
326         }
327 #endif /* CONFIG_PPC_PMAC */
328
329         return 0;
330 }
331
332 static int bcm54xx_setup_aneg(struct mii_phy *phy, u32 advertise)
333 {
334         u16 ctl, adv;
335         
336         phy->autoneg = 1;
337         phy->speed = SPEED_10;
338         phy->duplex = DUPLEX_HALF;
339         phy->pause = 0;
340         phy->advertising = advertise;
341
342         /* Setup standard advertise */
343         adv = phy_read(phy, MII_ADVERTISE);
344         adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
345         if (advertise & ADVERTISED_10baseT_Half)
346                 adv |= ADVERTISE_10HALF;
347         if (advertise & ADVERTISED_10baseT_Full)
348                 adv |= ADVERTISE_10FULL;
349         if (advertise & ADVERTISED_100baseT_Half)
350                 adv |= ADVERTISE_100HALF;
351         if (advertise & ADVERTISED_100baseT_Full)
352                 adv |= ADVERTISE_100FULL;
353         phy_write(phy, MII_ADVERTISE, adv);
354
355         /* Setup 1000BT advertise */
356         adv = phy_read(phy, MII_1000BASETCONTROL);
357         adv &= ~(MII_1000BASETCONTROL_FULLDUPLEXCAP|MII_1000BASETCONTROL_HALFDUPLEXCAP);
358         if (advertise & SUPPORTED_1000baseT_Half)
359                 adv |= MII_1000BASETCONTROL_HALFDUPLEXCAP;
360         if (advertise & SUPPORTED_1000baseT_Full)
361                 adv |= MII_1000BASETCONTROL_FULLDUPLEXCAP;
362         phy_write(phy, MII_1000BASETCONTROL, adv);
363
364         /* Start/Restart aneg */
365         ctl = phy_read(phy, MII_BMCR);
366         ctl |= (BMCR_ANENABLE | BMCR_ANRESTART);
367         phy_write(phy, MII_BMCR, ctl);
368
369         return 0;
370 }
371
372 static int bcm54xx_setup_forced(struct mii_phy *phy, int speed, int fd)
373 {
374         u16 ctl;
375         
376         phy->autoneg = 0;
377         phy->speed = speed;
378         phy->duplex = fd;
379         phy->pause = 0;
380
381         ctl = phy_read(phy, MII_BMCR);
382         ctl &= ~(BMCR_FULLDPLX|BMCR_SPEED100|BMCR_SPD2|BMCR_ANENABLE);
383
384         /* First reset the PHY */
385         phy_write(phy, MII_BMCR, ctl | BMCR_RESET);
386
387         /* Select speed & duplex */
388         switch(speed) {
389         case SPEED_10:
390                 break;
391         case SPEED_100:
392                 ctl |= BMCR_SPEED100;
393                 break;
394         case SPEED_1000:
395                 ctl |= BMCR_SPD2;
396         }
397         if (fd == DUPLEX_FULL)
398                 ctl |= BMCR_FULLDPLX;
399
400         // XXX Should we set the sungem to GII now on 1000BT ?
401         
402         phy_write(phy, MII_BMCR, ctl);
403
404         return 0;
405 }
406
407 static int bcm54xx_read_link(struct mii_phy *phy)
408 {
409         int link_mode;  
410         u16 val;
411         
412         if (phy->autoneg) {
413                 val = phy_read(phy, MII_BCM5400_AUXSTATUS);
414                 link_mode = ((val & MII_BCM5400_AUXSTATUS_LINKMODE_MASK) >>
415                              MII_BCM5400_AUXSTATUS_LINKMODE_SHIFT);
416                 phy->duplex = phy_BCM5400_link_table[link_mode][0] ? DUPLEX_FULL : DUPLEX_HALF;
417                 phy->speed = phy_BCM5400_link_table[link_mode][2] ?
418                                 SPEED_1000 :
419                                 (phy_BCM5400_link_table[link_mode][1] ? SPEED_100 : SPEED_10);
420                 val = phy_read(phy, MII_LPA);
421                 phy->pause = ((val & LPA_PAUSE) != 0);
422         }
423         /* On non-aneg, we assume what we put in BMCR is the speed,
424          * though magic-aneg shouldn't prevent this case from occurring
425          */
426
427         return 0;
428 }
429
430 static int marvell_setup_aneg(struct mii_phy *phy, u32 advertise)
431 {
432         u16 ctl, adv;
433         
434         phy->autoneg = 1;
435         phy->speed = SPEED_10;
436         phy->duplex = DUPLEX_HALF;
437         phy->pause = 0;
438         phy->advertising = advertise;
439
440         /* Setup standard advertise */
441         adv = phy_read(phy, MII_ADVERTISE);
442         adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
443         if (advertise & ADVERTISED_10baseT_Half)
444                 adv |= ADVERTISE_10HALF;
445         if (advertise & ADVERTISED_10baseT_Full)
446                 adv |= ADVERTISE_10FULL;
447         if (advertise & ADVERTISED_100baseT_Half)
448                 adv |= ADVERTISE_100HALF;
449         if (advertise & ADVERTISED_100baseT_Full)
450                 adv |= ADVERTISE_100FULL;
451         phy_write(phy, MII_ADVERTISE, adv);
452
453         /* Setup 1000BT advertise & enable crossover detect
454          * XXX How do we advertise 1000BT ? Darwin source is
455          * confusing here, they read from specific control and
456          * write to control... Someone has specs for those
457          * beasts ?
458          */
459         adv = phy_read(phy, MII_M1011_PHY_SPEC_CONTROL);
460         adv |= MII_M1011_PHY_SPEC_CONTROL_AUTO_MDIX;
461         adv &= ~(MII_1000BASETCONTROL_FULLDUPLEXCAP |
462                         MII_1000BASETCONTROL_HALFDUPLEXCAP);
463         if (advertise & SUPPORTED_1000baseT_Half)
464                 adv |= MII_1000BASETCONTROL_HALFDUPLEXCAP;
465         if (advertise & SUPPORTED_1000baseT_Full)
466                 adv |= MII_1000BASETCONTROL_FULLDUPLEXCAP;
467         phy_write(phy, MII_1000BASETCONTROL, adv);
468
469         /* Start/Restart aneg */
470         ctl = phy_read(phy, MII_BMCR);
471         ctl |= (BMCR_ANENABLE | BMCR_ANRESTART);
472         phy_write(phy, MII_BMCR, ctl);
473
474         return 0;
475 }
476
477 static int marvell_setup_forced(struct mii_phy *phy, int speed, int fd)
478 {
479         u16 ctl, ctl2;
480         
481         phy->autoneg = 0;
482         phy->speed = speed;
483         phy->duplex = fd;
484         phy->pause = 0;
485
486         ctl = phy_read(phy, MII_BMCR);
487         ctl &= ~(BMCR_FULLDPLX|BMCR_SPEED100|BMCR_SPD2|BMCR_ANENABLE);
488         ctl |= BMCR_RESET;
489
490         /* Select speed & duplex */
491         switch(speed) {
492         case SPEED_10:
493                 break;
494         case SPEED_100:
495                 ctl |= BMCR_SPEED100;
496                 break;
497         /* I'm not sure about the one below, again, Darwin source is
498          * quite confusing and I lack chip specs
499          */
500         case SPEED_1000:
501                 ctl |= BMCR_SPD2;
502         }
503         if (fd == DUPLEX_FULL)
504                 ctl |= BMCR_FULLDPLX;
505
506         /* Disable crossover. Again, the way Apple does it is strange,
507          * though I don't assume they are wrong ;)
508          */
509         ctl2 = phy_read(phy, MII_M1011_PHY_SPEC_CONTROL);
510         ctl2 &= ~(MII_M1011_PHY_SPEC_CONTROL_MANUAL_MDIX |
511                 MII_M1011_PHY_SPEC_CONTROL_AUTO_MDIX |
512                 MII_1000BASETCONTROL_FULLDUPLEXCAP |
513                 MII_1000BASETCONTROL_HALFDUPLEXCAP);
514         if (speed == SPEED_1000)
515                 ctl2 |= (fd == DUPLEX_FULL) ?
516                         MII_1000BASETCONTROL_FULLDUPLEXCAP :
517                         MII_1000BASETCONTROL_HALFDUPLEXCAP;
518         phy_write(phy, MII_1000BASETCONTROL, ctl2);
519
520         // XXX Should we set the sungem to GII now on 1000BT ?
521         
522         phy_write(phy, MII_BMCR, ctl);
523
524         return 0;
525 }
526
527 static int marvell_read_link(struct mii_phy *phy)
528 {
529         u16 status;
530
531         if (phy->autoneg) {
532                 status = phy_read(phy, MII_M1011_PHY_SPEC_STATUS);
533                 if ((status & MII_M1011_PHY_SPEC_STATUS_RESOLVED) == 0)
534                         return -EAGAIN;
535                 if (status & MII_M1011_PHY_SPEC_STATUS_1000)
536                         phy->speed = SPEED_1000;
537                 else if (status & MII_M1011_PHY_SPEC_STATUS_100)
538                         phy->speed = SPEED_100;
539                 else
540                         phy->speed = SPEED_10;
541                 if (status & MII_M1011_PHY_SPEC_STATUS_FULLDUPLEX)
542                         phy->duplex = DUPLEX_FULL;
543                 else
544                         phy->duplex = DUPLEX_HALF;
545                 phy->pause = 0; /* XXX Check against spec ! */
546         }
547         /* On non-aneg, we assume what we put in BMCR is the speed,
548          * though magic-aneg shouldn't prevent this case from occurring
549          */
550
551         return 0;
552 }
553
554 static int genmii_setup_aneg(struct mii_phy *phy, u32 advertise)
555 {
556         u16 ctl, adv;
557         
558         phy->autoneg = 1;
559         phy->speed = SPEED_10;
560         phy->duplex = DUPLEX_HALF;
561         phy->pause = 0;
562         phy->advertising = advertise;
563
564         /* Setup standard advertise */
565         adv = phy_read(phy, MII_ADVERTISE);
566         adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
567         if (advertise & ADVERTISED_10baseT_Half)
568                 adv |= ADVERTISE_10HALF;
569         if (advertise & ADVERTISED_10baseT_Full)
570                 adv |= ADVERTISE_10FULL;
571         if (advertise & ADVERTISED_100baseT_Half)
572                 adv |= ADVERTISE_100HALF;
573         if (advertise & ADVERTISED_100baseT_Full)
574                 adv |= ADVERTISE_100FULL;
575         phy_write(phy, MII_ADVERTISE, adv);
576
577         /* Start/Restart aneg */
578         ctl = phy_read(phy, MII_BMCR);
579         ctl |= (BMCR_ANENABLE | BMCR_ANRESTART);
580         phy_write(phy, MII_BMCR, ctl);
581
582         return 0;
583 }
584
585 static int genmii_setup_forced(struct mii_phy *phy, int speed, int fd)
586 {
587         u16 ctl;
588         
589         phy->autoneg = 0;
590         phy->speed = speed;
591         phy->duplex = fd;
592         phy->pause = 0;
593
594         ctl = phy_read(phy, MII_BMCR);
595         ctl &= ~(BMCR_FULLDPLX|BMCR_SPEED100|BMCR_ANENABLE);
596
597         /* First reset the PHY */
598         phy_write(phy, MII_BMCR, ctl | BMCR_RESET);
599
600         /* Select speed & duplex */
601         switch(speed) {
602         case SPEED_10:
603                 break;
604         case SPEED_100:
605                 ctl |= BMCR_SPEED100;
606                 break;
607         case SPEED_1000:
608         default:
609                 return -EINVAL;
610         }
611         if (fd == DUPLEX_FULL)
612                 ctl |= BMCR_FULLDPLX;
613         phy_write(phy, MII_BMCR, ctl);
614
615         return 0;
616 }
617
618 static int genmii_poll_link(struct mii_phy *phy)
619 {
620         u16 status;
621         
622         (void)phy_read(phy, MII_BMSR);
623         status = phy_read(phy, MII_BMSR);
624         if ((status & BMSR_LSTATUS) == 0)
625                 return 0;
626         if (phy->autoneg && !(status & BMSR_ANEGCOMPLETE))
627                 return 0;
628         return 1;
629 }
630
631 static int genmii_read_link(struct mii_phy *phy)
632 {
633         u16 lpa;
634
635         if (phy->autoneg) {
636                 lpa = phy_read(phy, MII_LPA);
637
638                 if (lpa & (LPA_10FULL | LPA_100FULL))
639                         phy->duplex = DUPLEX_FULL;
640                 else
641                         phy->duplex = DUPLEX_HALF;
642                 if (lpa & (LPA_100FULL | LPA_100HALF))
643                         phy->speed = SPEED_100;
644                 else
645                         phy->speed = SPEED_10;
646                 phy->pause = 0;
647         }
648         /* On non-aneg, we assume what we put in BMCR is the speed,
649          * though magic-aneg shouldn't prevent this case from occurring
650          */
651
652          return 0;
653 }
654
655
656 #define MII_BASIC_FEATURES      (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full | \
657                                  SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | \
658                                  SUPPORTED_Autoneg | SUPPORTED_TP | SUPPORTED_MII)
659 #define MII_GBIT_FEATURES       (MII_BASIC_FEATURES | \
660                                  SUPPORTED_1000baseT_Half | SUPPORTED_1000baseT_Full)
661
662 /* Broadcom BCM 5201 */
663 static struct mii_phy_ops bcm5201_phy_ops = {
664         .init           = bcm5201_init,
665         .suspend        = bcm5201_suspend,
666         .setup_aneg     = genmii_setup_aneg,
667         .setup_forced   = genmii_setup_forced,
668         .poll_link      = genmii_poll_link,
669         .read_link      = genmii_read_link,
670 };
671
672 static struct mii_phy_def bcm5201_phy_def = {
673         .phy_id         = 0x00406210,
674         .phy_id_mask    = 0xfffffff0,
675         .name           = "BCM5201",
676         .features       = MII_BASIC_FEATURES,
677         .magic_aneg     = 1,
678         .ops            = &bcm5201_phy_ops
679 };
680
681 /* Broadcom BCM 5221 */
682 static struct mii_phy_ops bcm5221_phy_ops = {
683         .suspend        = bcm5221_suspend,
684         .init           = bcm5221_init,
685         .setup_aneg     = genmii_setup_aneg,
686         .setup_forced   = genmii_setup_forced,
687         .poll_link      = genmii_poll_link,
688         .read_link      = genmii_read_link,
689 };
690
691 static struct mii_phy_def bcm5221_phy_def = {
692         .phy_id         = 0x004061e0,
693         .phy_id_mask    = 0xfffffff0,
694         .name           = "BCM5221",
695         .features       = MII_BASIC_FEATURES,
696         .magic_aneg     = 1,
697         .ops            = &bcm5221_phy_ops
698 };
699
700 /* Broadcom BCM 5400 */
701 static struct mii_phy_ops bcm5400_phy_ops = {
702         .init           = bcm5400_init,
703         .suspend        = bcm5400_suspend,
704         .setup_aneg     = bcm54xx_setup_aneg,
705         .setup_forced   = bcm54xx_setup_forced,
706         .poll_link      = genmii_poll_link,
707         .read_link      = bcm54xx_read_link,
708 };
709
710 static struct mii_phy_def bcm5400_phy_def = {
711         .phy_id         = 0x00206040,
712         .phy_id_mask    = 0xfffffff0,
713         .name           = "BCM5400",
714         .features       = MII_GBIT_FEATURES,
715         .magic_aneg     = 1,
716         .ops            = &bcm5400_phy_ops
717 };
718
719 /* Broadcom BCM 5401 */
720 static struct mii_phy_ops bcm5401_phy_ops = {
721         .init           = bcm5401_init,
722         .suspend        = bcm5401_suspend,
723         .setup_aneg     = bcm54xx_setup_aneg,
724         .setup_forced   = bcm54xx_setup_forced,
725         .poll_link      = genmii_poll_link,
726         .read_link      = bcm54xx_read_link,
727 };
728
729 static struct mii_phy_def bcm5401_phy_def = {
730         .phy_id         = 0x00206050,
731         .phy_id_mask    = 0xfffffff0,
732         .name           = "BCM5401",
733         .features       = MII_GBIT_FEATURES,
734         .magic_aneg     = 1,
735         .ops            = &bcm5401_phy_ops
736 };
737
738 /* Broadcom BCM 5411 */
739 static struct mii_phy_ops bcm5411_phy_ops = {
740         .init           = bcm5411_init,
741         .suspend        = bcm5411_suspend,
742         .setup_aneg     = bcm54xx_setup_aneg,
743         .setup_forced   = bcm54xx_setup_forced,
744         .poll_link      = genmii_poll_link,
745         .read_link      = bcm54xx_read_link,
746 };
747
748 static struct mii_phy_def bcm5411_phy_def = {
749         .phy_id         = 0x00206070,
750         .phy_id_mask    = 0xfffffff0,
751         .name           = "BCM5411",
752         .features       = MII_GBIT_FEATURES,
753         .magic_aneg     = 1,
754         .ops            = &bcm5411_phy_ops
755 };
756
757 /* Broadcom BCM 5421 */
758 static struct mii_phy_ops bcm5421_phy_ops = {
759         .init           = bcm5421_init,
760         .suspend        = bcm5411_suspend,
761         .setup_aneg     = bcm54xx_setup_aneg,
762         .setup_forced   = bcm54xx_setup_forced,
763         .poll_link      = genmii_poll_link,
764         .read_link      = bcm54xx_read_link,
765 };
766
767 static struct mii_phy_def bcm5421_phy_def = {
768         .phy_id         = 0x002060e0,
769         .phy_id_mask    = 0xfffffff0,
770         .name           = "BCM5421",
771         .features       = MII_GBIT_FEATURES,
772         .magic_aneg     = 1,
773         .ops            = &bcm5421_phy_ops
774 };
775
776 /* Broadcom BCM 5421 built-in K2 */
777 static struct mii_phy_ops bcm5421k2_phy_ops = {
778         .init           = bcm5421_init,
779         .suspend        = bcm5411_suspend,
780         .setup_aneg     = bcm54xx_setup_aneg,
781         .setup_forced   = bcm54xx_setup_forced,
782         .poll_link      = genmii_poll_link,
783         .read_link      = bcm54xx_read_link,
784 };
785
786 static struct mii_phy_def bcm5421k2_phy_def = {
787         .phy_id         = 0x002062e0,
788         .phy_id_mask    = 0xfffffff0,
789         .name           = "BCM5421-K2",
790         .features       = MII_GBIT_FEATURES,
791         .magic_aneg     = 1,
792         .ops            = &bcm5421k2_phy_ops
793 };
794
795 /* Broadcom BCM 5462 built-in Vesta */
796 static struct mii_phy_ops bcm5462V_phy_ops = {
797         .init           = bcm5421_init,
798         .suspend        = bcm5411_suspend,
799         .setup_aneg     = bcm54xx_setup_aneg,
800         .setup_forced   = bcm54xx_setup_forced,
801         .poll_link      = genmii_poll_link,
802         .read_link      = bcm54xx_read_link,
803 };
804
805 static struct mii_phy_def bcm5462V_phy_def = {
806         .phy_id         = 0x002060d0,
807         .phy_id_mask    = 0xfffffff0,
808         .name           = "BCM5462-Vesta",
809         .features       = MII_GBIT_FEATURES,
810         .magic_aneg     = 1,
811         .ops            = &bcm5462V_phy_ops
812 };
813
814 /* Marvell 88E1101 (Apple seem to deal with 2 different revs,
815  * I masked out the 8 last bits to get both, but some specs
816  * would be useful here) --BenH.
817  */
818 static struct mii_phy_ops marvell_phy_ops = {
819         .setup_aneg     = marvell_setup_aneg,
820         .setup_forced   = marvell_setup_forced,
821         .poll_link      = genmii_poll_link,
822         .read_link      = marvell_read_link
823 };
824
825 static struct mii_phy_def marvell_phy_def = {
826         .phy_id         = 0x01410c00,
827         .phy_id_mask    = 0xffffff00,
828         .name           = "Marvell 88E1101",
829         .features       = MII_GBIT_FEATURES,
830         .magic_aneg     = 1,
831         .ops            = &marvell_phy_ops
832 };
833
834 /* Generic implementation for most 10/100 PHYs */
835 static struct mii_phy_ops generic_phy_ops = {
836         .setup_aneg     = genmii_setup_aneg,
837         .setup_forced   = genmii_setup_forced,
838         .poll_link      = genmii_poll_link,
839         .read_link      = genmii_read_link
840 };
841
842 static struct mii_phy_def genmii_phy_def = {
843         .phy_id         = 0x00000000,
844         .phy_id_mask    = 0x00000000,
845         .name           = "Generic MII",
846         .features       = MII_BASIC_FEATURES,
847         .magic_aneg     = 0,
848         .ops            = &generic_phy_ops
849 };
850
851 static struct mii_phy_def* mii_phy_table[] = {
852         &bcm5201_phy_def,
853         &bcm5221_phy_def,
854         &bcm5400_phy_def,
855         &bcm5401_phy_def,
856         &bcm5411_phy_def,
857         &bcm5421_phy_def,
858         &bcm5421k2_phy_def,
859         &bcm5462V_phy_def,
860         &marvell_phy_def,
861         &genmii_phy_def,
862         NULL
863 };
864
865 int mii_phy_probe(struct mii_phy *phy, int mii_id)
866 {
867         int rc;
868         u32 id;
869         struct mii_phy_def* def;
870         int i;
871
872         /* We do not reset the mii_phy structure as the driver
873          * may re-probe the PHY regulary
874          */
875         phy->mii_id = mii_id;
876         
877         /* Take PHY out of isloate mode and reset it. */
878         rc = reset_one_mii_phy(phy, mii_id);
879         if (rc)
880                 goto fail;
881
882         /* Read ID and find matching entry */   
883         id = (phy_read(phy, MII_PHYSID1) << 16 | phy_read(phy, MII_PHYSID2));
884         printk(KERN_DEBUG "PHY ID: %x, addr: %x\n", id, mii_id);
885         for (i=0; (def = mii_phy_table[i]) != NULL; i++)
886                 if ((id & def->phy_id_mask) == def->phy_id)
887                         break;
888         /* Should never be NULL (we have a generic entry), but... */
889         if (def == NULL)
890                 goto fail;
891
892         phy->def = def;
893         
894         return 0;
895 fail:
896         phy->speed = 0;
897         phy->duplex = 0;
898         phy->pause = 0;
899         phy->advertising = 0;
900         return -ENODEV;
901 }
902
903 EXPORT_SYMBOL(mii_phy_probe);
904 MODULE_LICENSE("GPL");
905