libertas: improve function init/shutdown handling for SD8688
[linux-2.6] / drivers / net / ibm_newemac / phy.c
1 /*
2  * drivers/net/ibm_newemac/phy.c
3  *
4  * Driver for PowerPC 4xx on-chip ethernet controller, PHY support.
5  * Borrowed from sungem_phy.c, though I only kept the generic MII
6  * driver for now.
7  *
8  * This file should be shared with other drivers or eventually
9  * merged as the "low level" part of miilib
10  *
11  * Copyright 2007 Benjamin Herrenschmidt, IBM Corp.
12  *                <benh@kernel.crashing.org>
13  *
14  * Based on the arch/ppc version of the driver:
15  *
16  * (c) 2003, Benjamin Herrenscmidt (benh@kernel.crashing.org)
17  * (c) 2004-2005, Eugene Surovegin <ebs@ebshome.net>
18  *
19  */
20 #include <linux/module.h>
21 #include <linux/kernel.h>
22 #include <linux/types.h>
23 #include <linux/netdevice.h>
24 #include <linux/mii.h>
25 #include <linux/ethtool.h>
26 #include <linux/delay.h>
27
28 #include "emac.h"
29 #include "phy.h"
30
31 static inline int phy_read(struct mii_phy *phy, int reg)
32 {
33         return phy->mdio_read(phy->dev, phy->address, reg);
34 }
35
36 static inline void phy_write(struct mii_phy *phy, int reg, int val)
37 {
38         phy->mdio_write(phy->dev, phy->address, reg, val);
39 }
40
41 static inline int gpcs_phy_read(struct mii_phy *phy, int reg)
42 {
43         return phy->mdio_read(phy->dev, phy->gpcs_address, reg);
44 }
45
46 static inline void gpcs_phy_write(struct mii_phy *phy, int reg, int val)
47 {
48         phy->mdio_write(phy->dev, phy->gpcs_address, reg, val);
49 }
50
51 int emac_mii_reset_phy(struct mii_phy *phy)
52 {
53         int val;
54         int limit = 10000;
55
56         val = phy_read(phy, MII_BMCR);
57         val &= ~(BMCR_ISOLATE | BMCR_ANENABLE);
58         val |= BMCR_RESET;
59         phy_write(phy, MII_BMCR, val);
60
61         udelay(300);
62
63         while (--limit) {
64                 val = phy_read(phy, MII_BMCR);
65                 if (val >= 0 && (val & BMCR_RESET) == 0)
66                         break;
67                 udelay(10);
68         }
69         if ((val & BMCR_ISOLATE) && limit > 0)
70                 phy_write(phy, MII_BMCR, val & ~BMCR_ISOLATE);
71
72         return limit <= 0;
73 }
74
75 int emac_mii_reset_gpcs(struct mii_phy *phy)
76 {
77         int val;
78         int limit = 10000;
79
80         val = gpcs_phy_read(phy, MII_BMCR);
81         val &= ~(BMCR_ISOLATE | BMCR_ANENABLE);
82         val |= BMCR_RESET;
83         gpcs_phy_write(phy, MII_BMCR, val);
84
85         udelay(300);
86
87         while (--limit) {
88                 val = gpcs_phy_read(phy, MII_BMCR);
89                 if (val >= 0 && (val & BMCR_RESET) == 0)
90                         break;
91                 udelay(10);
92         }
93         if ((val & BMCR_ISOLATE) && limit > 0)
94                 gpcs_phy_write(phy, MII_BMCR, val & ~BMCR_ISOLATE);
95
96         if (limit > 0 && phy->mode == PHY_MODE_SGMII) {
97                 /* Configure GPCS interface to recommended setting for SGMII */
98                 gpcs_phy_write(phy, 0x04, 0x8120); /* AsymPause, FDX */
99                 gpcs_phy_write(phy, 0x07, 0x2801); /* msg_pg, toggle */
100                 gpcs_phy_write(phy, 0x00, 0x0140); /* 1Gbps, FDX     */
101         }
102
103         return limit <= 0;
104 }
105
106 static int genmii_setup_aneg(struct mii_phy *phy, u32 advertise)
107 {
108         int ctl, adv;
109
110         phy->autoneg = AUTONEG_ENABLE;
111         phy->speed = SPEED_10;
112         phy->duplex = DUPLEX_HALF;
113         phy->pause = phy->asym_pause = 0;
114         phy->advertising = advertise;
115
116         ctl = phy_read(phy, MII_BMCR);
117         if (ctl < 0)
118                 return ctl;
119         ctl &= ~(BMCR_FULLDPLX | BMCR_SPEED100 | BMCR_SPEED1000 | BMCR_ANENABLE);
120
121         /* First clear the PHY */
122         phy_write(phy, MII_BMCR, ctl);
123
124         /* Setup standard advertise */
125         adv = phy_read(phy, MII_ADVERTISE);
126         if (adv < 0)
127                 return adv;
128         adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP |
129                  ADVERTISE_PAUSE_ASYM);
130         if (advertise & ADVERTISED_10baseT_Half)
131                 adv |= ADVERTISE_10HALF;
132         if (advertise & ADVERTISED_10baseT_Full)
133                 adv |= ADVERTISE_10FULL;
134         if (advertise & ADVERTISED_100baseT_Half)
135                 adv |= ADVERTISE_100HALF;
136         if (advertise & ADVERTISED_100baseT_Full)
137                 adv |= ADVERTISE_100FULL;
138         if (advertise & ADVERTISED_Pause)
139                 adv |= ADVERTISE_PAUSE_CAP;
140         if (advertise & ADVERTISED_Asym_Pause)
141                 adv |= ADVERTISE_PAUSE_ASYM;
142         phy_write(phy, MII_ADVERTISE, adv);
143
144         if (phy->features &
145             (SUPPORTED_1000baseT_Full | SUPPORTED_1000baseT_Half)) {
146                 adv = phy_read(phy, MII_CTRL1000);
147                 if (adv < 0)
148                         return adv;
149                 adv &= ~(ADVERTISE_1000FULL | ADVERTISE_1000HALF);
150                 if (advertise & ADVERTISED_1000baseT_Full)
151                         adv |= ADVERTISE_1000FULL;
152                 if (advertise & ADVERTISED_1000baseT_Half)
153                         adv |= ADVERTISE_1000HALF;
154                 phy_write(phy, MII_CTRL1000, adv);
155         }
156
157         /* Start/Restart aneg */
158         ctl = phy_read(phy, MII_BMCR);
159         ctl |= (BMCR_ANENABLE | BMCR_ANRESTART);
160         phy_write(phy, MII_BMCR, ctl);
161
162         return 0;
163 }
164
165 static int genmii_setup_forced(struct mii_phy *phy, int speed, int fd)
166 {
167         int ctl;
168
169         phy->autoneg = AUTONEG_DISABLE;
170         phy->speed = speed;
171         phy->duplex = fd;
172         phy->pause = phy->asym_pause = 0;
173
174         ctl = phy_read(phy, MII_BMCR);
175         if (ctl < 0)
176                 return ctl;
177         ctl &= ~(BMCR_FULLDPLX | BMCR_SPEED100 | BMCR_SPEED1000 | BMCR_ANENABLE);
178
179         /* First clear the PHY */
180         phy_write(phy, MII_BMCR, ctl | BMCR_RESET);
181
182         /* Select speed & duplex */
183         switch (speed) {
184         case SPEED_10:
185                 break;
186         case SPEED_100:
187                 ctl |= BMCR_SPEED100;
188                 break;
189         case SPEED_1000:
190                 ctl |= BMCR_SPEED1000;
191                 break;
192         default:
193                 return -EINVAL;
194         }
195         if (fd == DUPLEX_FULL)
196                 ctl |= BMCR_FULLDPLX;
197         phy_write(phy, MII_BMCR, ctl);
198
199         return 0;
200 }
201
202 static int genmii_poll_link(struct mii_phy *phy)
203 {
204         int status;
205
206         /* Clear latched value with dummy read */
207         phy_read(phy, MII_BMSR);
208         status = phy_read(phy, MII_BMSR);
209         if (status < 0 || (status & BMSR_LSTATUS) == 0)
210                 return 0;
211         if (phy->autoneg == AUTONEG_ENABLE && !(status & BMSR_ANEGCOMPLETE))
212                 return 0;
213         return 1;
214 }
215
216 static int genmii_read_link(struct mii_phy *phy)
217 {
218         if (phy->autoneg == AUTONEG_ENABLE) {
219                 int glpa = 0;
220                 int lpa = phy_read(phy, MII_LPA) & phy_read(phy, MII_ADVERTISE);
221                 if (lpa < 0)
222                         return lpa;
223
224                 if (phy->features &
225                     (SUPPORTED_1000baseT_Full | SUPPORTED_1000baseT_Half)) {
226                         int adv = phy_read(phy, MII_CTRL1000);
227                         glpa = phy_read(phy, MII_STAT1000);
228
229                         if (glpa < 0 || adv < 0)
230                                 return adv;
231
232                         glpa &= adv << 2;
233                 }
234
235                 phy->speed = SPEED_10;
236                 phy->duplex = DUPLEX_HALF;
237                 phy->pause = phy->asym_pause = 0;
238
239                 if (glpa & (LPA_1000FULL | LPA_1000HALF)) {
240                         phy->speed = SPEED_1000;
241                         if (glpa & LPA_1000FULL)
242                                 phy->duplex = DUPLEX_FULL;
243                 } else if (lpa & (LPA_100FULL | LPA_100HALF)) {
244                         phy->speed = SPEED_100;
245                         if (lpa & LPA_100FULL)
246                                 phy->duplex = DUPLEX_FULL;
247                 } else if (lpa & LPA_10FULL)
248                         phy->duplex = DUPLEX_FULL;
249
250                 if (phy->duplex == DUPLEX_FULL) {
251                         phy->pause = lpa & LPA_PAUSE_CAP ? 1 : 0;
252                         phy->asym_pause = lpa & LPA_PAUSE_ASYM ? 1 : 0;
253                 }
254         } else {
255                 int bmcr = phy_read(phy, MII_BMCR);
256                 if (bmcr < 0)
257                         return bmcr;
258
259                 if (bmcr & BMCR_FULLDPLX)
260                         phy->duplex = DUPLEX_FULL;
261                 else
262                         phy->duplex = DUPLEX_HALF;
263                 if (bmcr & BMCR_SPEED1000)
264                         phy->speed = SPEED_1000;
265                 else if (bmcr & BMCR_SPEED100)
266                         phy->speed = SPEED_100;
267                 else
268                         phy->speed = SPEED_10;
269
270                 phy->pause = phy->asym_pause = 0;
271         }
272         return 0;
273 }
274
275 /* Generic implementation for most 10/100/1000 PHYs */
276 static struct mii_phy_ops generic_phy_ops = {
277         .setup_aneg     = genmii_setup_aneg,
278         .setup_forced   = genmii_setup_forced,
279         .poll_link      = genmii_poll_link,
280         .read_link      = genmii_read_link
281 };
282
283 static struct mii_phy_def genmii_phy_def = {
284         .phy_id         = 0x00000000,
285         .phy_id_mask    = 0x00000000,
286         .name           = "Generic MII",
287         .ops            = &generic_phy_ops
288 };
289
290 /* CIS8201 */
291 #define MII_CIS8201_10BTCSR     0x16
292 #define  TENBTCSR_ECHO_DISABLE  0x2000
293 #define MII_CIS8201_EPCR        0x17
294 #define  EPCR_MODE_MASK         0x3000
295 #define  EPCR_GMII_MODE         0x0000
296 #define  EPCR_RGMII_MODE        0x1000
297 #define  EPCR_TBI_MODE          0x2000
298 #define  EPCR_RTBI_MODE         0x3000
299 #define MII_CIS8201_ACSR        0x1c
300 #define  ACSR_PIN_PRIO_SELECT   0x0004
301
302 static int cis8201_init(struct mii_phy *phy)
303 {
304         int epcr;
305
306         epcr = phy_read(phy, MII_CIS8201_EPCR);
307         if (epcr < 0)
308                 return epcr;
309
310         epcr &= ~EPCR_MODE_MASK;
311
312         switch (phy->mode) {
313         case PHY_MODE_TBI:
314                 epcr |= EPCR_TBI_MODE;
315                 break;
316         case PHY_MODE_RTBI:
317                 epcr |= EPCR_RTBI_MODE;
318                 break;
319         case PHY_MODE_GMII:
320                 epcr |= EPCR_GMII_MODE;
321                 break;
322         case PHY_MODE_RGMII:
323         default:
324                 epcr |= EPCR_RGMII_MODE;
325         }
326
327         phy_write(phy, MII_CIS8201_EPCR, epcr);
328
329         /* MII regs override strap pins */
330         phy_write(phy, MII_CIS8201_ACSR,
331                   phy_read(phy, MII_CIS8201_ACSR) | ACSR_PIN_PRIO_SELECT);
332
333         /* Disable TX_EN -> CRS echo mode, otherwise 10/HDX doesn't work */
334         phy_write(phy, MII_CIS8201_10BTCSR,
335                   phy_read(phy, MII_CIS8201_10BTCSR) | TENBTCSR_ECHO_DISABLE);
336
337         return 0;
338 }
339
340 static struct mii_phy_ops cis8201_phy_ops = {
341         .init           = cis8201_init,
342         .setup_aneg     = genmii_setup_aneg,
343         .setup_forced   = genmii_setup_forced,
344         .poll_link      = genmii_poll_link,
345         .read_link      = genmii_read_link
346 };
347
348 static struct mii_phy_def cis8201_phy_def = {
349         .phy_id         = 0x000fc410,
350         .phy_id_mask    = 0x000ffff0,
351         .name           = "CIS8201 Gigabit Ethernet",
352         .ops            = &cis8201_phy_ops
353 };
354
355 static struct mii_phy_def bcm5248_phy_def = {
356
357         .phy_id         = 0x0143bc00,
358         .phy_id_mask    = 0x0ffffff0,
359         .name           = "BCM5248 10/100 SMII Ethernet",
360         .ops            = &generic_phy_ops
361 };
362
363 static int m88e1111_init(struct mii_phy *phy)
364 {
365         pr_debug("%s: Marvell 88E1111 Ethernet\n", __func__);
366         phy_write(phy, 0x14, 0x0ce3);
367         phy_write(phy, 0x18, 0x4101);
368         phy_write(phy, 0x09, 0x0e00);
369         phy_write(phy, 0x04, 0x01e1);
370         phy_write(phy, 0x00, 0x9140);
371         phy_write(phy, 0x00, 0x1140);
372
373         return  0;
374 }
375
376 static int m88e1112_init(struct mii_phy *phy)
377 {
378         /*
379          * Marvell 88E1112 PHY needs to have the SGMII MAC
380          * interace (page 2) properly configured to
381          * communicate with the 460EX/GT GPCS interface.
382          */
383
384         u16 reg_short;
385
386         pr_debug("%s: Marvell 88E1112 Ethernet\n", __func__);
387
388         /* Set access to Page 2 */
389         phy_write(phy, 0x16, 0x0002);
390
391         phy_write(phy, 0x00, 0x0040); /* 1Gbps */
392         reg_short = (u16)(phy_read(phy, 0x1a));
393         reg_short |= 0x8000; /* bypass Auto-Negotiation */
394         phy_write(phy, 0x1a, reg_short);
395         emac_mii_reset_phy(phy); /* reset MAC interface */
396
397         /* Reset access to Page 0 */
398         phy_write(phy, 0x16, 0x0000);
399
400         return  0;
401 }
402
403 static int et1011c_init(struct mii_phy *phy)
404 {
405         u16 reg_short;
406
407         reg_short = (u16)(phy_read(phy, 0x16));
408         reg_short &= ~(0x7);
409         reg_short |= 0x6;       /* RGMII Trace Delay*/
410         phy_write(phy, 0x16, reg_short);
411
412         reg_short = (u16)(phy_read(phy, 0x17));
413         reg_short &= ~(0x40);
414         phy_write(phy, 0x17, reg_short);
415
416         phy_write(phy, 0x1c, 0x74f0);
417         return 0;
418 }
419
420 static struct mii_phy_ops et1011c_phy_ops = {
421         .init           = et1011c_init,
422         .setup_aneg     = genmii_setup_aneg,
423         .setup_forced   = genmii_setup_forced,
424         .poll_link      = genmii_poll_link,
425         .read_link      = genmii_read_link
426 };
427
428 static struct mii_phy_def et1011c_phy_def = {
429         .phy_id         = 0x0282f000,
430         .phy_id_mask    = 0x0fffff00,
431         .name           = "ET1011C Gigabit Ethernet",
432         .ops            = &et1011c_phy_ops
433 };
434
435
436
437
438
439 static struct mii_phy_ops m88e1111_phy_ops = {
440         .init           = m88e1111_init,
441         .setup_aneg     = genmii_setup_aneg,
442         .setup_forced   = genmii_setup_forced,
443         .poll_link      = genmii_poll_link,
444         .read_link      = genmii_read_link
445 };
446
447 static struct mii_phy_def m88e1111_phy_def = {
448
449         .phy_id         = 0x01410CC0,
450         .phy_id_mask    = 0x0ffffff0,
451         .name           = "Marvell 88E1111 Ethernet",
452         .ops            = &m88e1111_phy_ops,
453 };
454
455 static struct mii_phy_ops m88e1112_phy_ops = {
456         .init           = m88e1112_init,
457         .setup_aneg     = genmii_setup_aneg,
458         .setup_forced   = genmii_setup_forced,
459         .poll_link      = genmii_poll_link,
460         .read_link      = genmii_read_link
461 };
462
463 static struct mii_phy_def m88e1112_phy_def = {
464         .phy_id         = 0x01410C90,
465         .phy_id_mask    = 0x0ffffff0,
466         .name           = "Marvell 88E1112 Ethernet",
467         .ops            = &m88e1112_phy_ops,
468 };
469
470 static struct mii_phy_def *mii_phy_table[] = {
471         &et1011c_phy_def,
472         &cis8201_phy_def,
473         &bcm5248_phy_def,
474         &m88e1111_phy_def,
475         &m88e1112_phy_def,
476         &genmii_phy_def,
477         NULL
478 };
479
480 int emac_mii_phy_probe(struct mii_phy *phy, int address)
481 {
482         struct mii_phy_def *def;
483         int i;
484         u32 id;
485
486         phy->autoneg = AUTONEG_DISABLE;
487         phy->advertising = 0;
488         phy->address = address;
489         phy->speed = SPEED_10;
490         phy->duplex = DUPLEX_HALF;
491         phy->pause = phy->asym_pause = 0;
492
493         /* Take PHY out of isolate mode and reset it. */
494         if (emac_mii_reset_phy(phy))
495                 return -ENODEV;
496
497         /* Read ID and find matching entry */
498         id = (phy_read(phy, MII_PHYSID1) << 16) | phy_read(phy, MII_PHYSID2);
499         for (i = 0; (def = mii_phy_table[i]) != NULL; i++)
500                 if ((id & def->phy_id_mask) == def->phy_id)
501                         break;
502         /* Should never be NULL (we have a generic entry), but... */
503         if (!def)
504                 return -ENODEV;
505
506         phy->def = def;
507
508         /* Determine PHY features if needed */
509         phy->features = def->features;
510         if (!phy->features) {
511                 u16 bmsr = phy_read(phy, MII_BMSR);
512                 if (bmsr & BMSR_ANEGCAPABLE)
513                         phy->features |= SUPPORTED_Autoneg;
514                 if (bmsr & BMSR_10HALF)
515                         phy->features |= SUPPORTED_10baseT_Half;
516                 if (bmsr & BMSR_10FULL)
517                         phy->features |= SUPPORTED_10baseT_Full;
518                 if (bmsr & BMSR_100HALF)
519                         phy->features |= SUPPORTED_100baseT_Half;
520                 if (bmsr & BMSR_100FULL)
521                         phy->features |= SUPPORTED_100baseT_Full;
522                 if (bmsr & BMSR_ESTATEN) {
523                         u16 esr = phy_read(phy, MII_ESTATUS);
524                         if (esr & ESTATUS_1000_TFULL)
525                                 phy->features |= SUPPORTED_1000baseT_Full;
526                         if (esr & ESTATUS_1000_THALF)
527                                 phy->features |= SUPPORTED_1000baseT_Half;
528                 }
529                 phy->features |= SUPPORTED_MII;
530         }
531
532         /* Setup default advertising */
533         phy->advertising = phy->features;
534
535         return 0;
536 }
537
538 MODULE_LICENSE("GPL");