]> CyberLeo.Net >> Repos - FreeBSD/stable/8.git/blob - sys/dev/mii/smcphy.c
MFC: r213893, r213908, r214566, r214605, r214846
[FreeBSD/stable/8.git] / sys / dev / mii / smcphy.c
1 /*-
2  * Copyright (c) 2006 Benno Rice.  All rights reserved.
3  *
4  * Redistribution and use in source and binary forms, with or without
5  * modification, are permitted provided that the following conditions
6  * are met:
7  * 1. Redistributions of source code must retain the above copyright
8  *    notice, this list of conditions and the following disclaimer.
9  * 2. Redistributions in binary form must reproduce the above copyright
10  *    notice, this list of conditions and the following disclaimer in the
11  *    documentation and/or other materials provided with the distribution.
12  *
13  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
14  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
15  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
16  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
17  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
18  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
19  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
20  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
21  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
22  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
23  */
24
25 #include <sys/cdefs.h>
26 __FBSDID("$FreeBSD$");
27
28 /*
29  * Driver for the internal PHY on the SMSC LAN91C111.
30  */
31
32 #include <sys/param.h>
33 #include <sys/systm.h>
34 #include <sys/kernel.h>
35 #include <sys/socket.h>
36 #include <sys/errno.h>
37 #include <sys/module.h>
38 #include <sys/bus.h>
39 #include <sys/malloc.h>
40
41 #include <machine/bus.h>
42
43 #include <net/if.h>
44 #include <net/if_media.h>
45
46 #include <dev/mii/mii.h>
47 #include <dev/mii/miivar.h>
48 #include "miidevs.h"
49
50 #include "miibus_if.h"
51
52 static int      smcphy_probe(device_t);
53 static int      smcphy_attach(device_t);
54
55 static int      smcphy_service(struct mii_softc *, struct mii_data *, int);
56 static int      smcphy_reset(struct mii_softc *);
57 static void     smcphy_auto(struct mii_softc *);
58
59 static device_method_t smcphy_methods[] = {
60         /* device interface */
61         DEVMETHOD(device_probe,         smcphy_probe),
62         DEVMETHOD(device_attach,        smcphy_attach),
63         DEVMETHOD(device_detach,        mii_phy_detach),
64         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
65
66         { 0, 0 }
67 };
68
69 static devclass_t smcphy_devclass;
70
71 static driver_t smcphy_driver = {
72         "smcphy",
73         smcphy_methods,
74         sizeof(struct mii_softc)
75 };
76
77 DRIVER_MODULE(smcphy, miibus, smcphy_driver, smcphy_devclass, 0, 0);
78
79 static int
80 smcphy_probe(device_t dev)
81 {
82         struct  mii_attach_args *ma;
83
84         ma = device_get_ivars(dev);
85
86         if (MII_OUI(ma->mii_id1, ma->mii_id2) != MII_OUI_SMSC ||
87             MII_MODEL(ma->mii_id2) != MII_MODEL_SMSC_LAN83C183)
88                 return (ENXIO);
89
90         device_set_desc(dev, MII_STR_SMSC_LAN83C183);
91
92         return (0);
93 }
94
95 static int
96 smcphy_attach(device_t dev)
97 {
98         struct  mii_softc *sc;
99         struct  mii_attach_args *ma;
100         struct  mii_data *mii;
101
102         sc = device_get_softc(dev);
103         ma = device_get_ivars(dev);
104         sc->mii_dev = device_get_parent(dev);
105         mii = ma->mii_data;
106         LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list);
107
108         sc->mii_flags = miibus_get_flags(dev);
109         sc->mii_inst = mii->mii_instance++;
110         sc->mii_phy = ma->mii_phyno;
111         sc->mii_service = smcphy_service;
112         sc->mii_pdata = mii;
113
114         sc->mii_flags |= MIIF_NOISOLATE;
115
116         if (smcphy_reset(sc) != 0) {
117                 device_printf(dev, "reset failed\n");
118         }
119
120         /* Mask interrupts, we poll instead. */
121         PHY_WRITE(sc, 0x1e, 0xffc0);
122
123         sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
124         device_printf(dev, " ");
125         mii_add_media(sc);
126         printf("\n");
127
128         MIIBUS_MEDIAINIT(sc->mii_dev);
129         mii_phy_setmedia(sc);
130
131         return (0);
132 }
133
134 static int
135 smcphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
136 {
137         struct  ifmedia_entry *ife;
138         int     reg;
139
140         ife = mii->mii_media.ifm_cur;
141
142         switch (cmd) {
143         case MII_POLLSTAT:
144                 break;
145
146         case MII_MEDIACHG:
147                 /*
148                  * If the interface is not up, don't do anything.
149                  */
150                 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
151                         break;
152
153                 switch (IFM_SUBTYPE(ife->ifm_media)) {
154                 case IFM_AUTO:
155                         smcphy_auto(sc);
156                         break;
157
158                 default:
159                         mii_phy_setmedia(sc);
160                         break;
161                 }
162
163                 break;
164
165         case MII_TICK:
166                 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) {
167                         return (0);
168                 }
169
170                 if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) {
171                         break;
172                 }
173
174                 /* I have no idea why BMCR_ISO gets set. */
175                 reg = PHY_READ(sc, MII_BMCR);
176                 if (reg & BMCR_ISO) {
177                         PHY_WRITE(sc, MII_BMCR, reg & ~BMCR_ISO);
178                 }
179
180                 reg = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
181                 if (reg & BMSR_LINK) {
182                         sc->mii_ticks = 0;
183                         break;
184                 }
185
186                 if (++sc->mii_ticks <= MII_ANEGTICKS) {
187                         break;
188                 }
189
190                 sc->mii_ticks = 0;
191                 if (smcphy_reset(sc) != 0) {
192                         device_printf(sc->mii_dev, "reset failed\n");
193                 }
194                 smcphy_auto(sc);
195                 break;
196         }
197
198         /* Update the media status. */
199         ukphy_status(sc);
200
201         /* Callback if something changed. */
202         mii_phy_update(sc, cmd);
203         return (0);
204 }
205
206 static int
207 smcphy_reset(struct mii_softc *sc)
208 {
209         u_int   bmcr;
210         int     timeout;
211
212         PHY_WRITE(sc, MII_BMCR, BMCR_RESET);
213
214         for (timeout = 2; timeout > 0; timeout--) {
215                 DELAY(50000);
216                 bmcr = PHY_READ(sc, MII_BMCR);
217                 if ((bmcr & BMCR_RESET) == 0)
218                         break;
219         }
220
221         if (bmcr & BMCR_RESET) {
222                 return (EIO);
223         }
224
225         PHY_WRITE(sc, MII_BMCR, 0x3000);
226         return (0);
227 }
228
229 static void
230 smcphy_auto(struct mii_softc *sc)
231 {
232         uint16_t        anar;
233
234         anar = BMSR_MEDIA_TO_ANAR(sc->mii_capabilities) |
235             ANAR_CSMA;
236         if (sc->mii_flags & MIIF_DOPAUSE)
237                 anar |= ANAR_FC;
238         PHY_WRITE(sc, MII_ANAR, anar);
239         /* Apparently this helps. */
240         anar = PHY_READ(sc, MII_ANAR);
241         PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
242 }