]> CyberLeo.Net >> Repos - FreeBSD/releng/8.2.git/blob - sys/dev/mii/tdkphy.c
MFC: r217415
[FreeBSD/releng/8.2.git] / sys / dev / mii / tdkphy.c
1 /*-
2  * Copyright (c) 2000,2001 Jonathan Chen.
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions, and the following disclaimer,
10  *    without modification, immediately at the beginning of the file.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in
13  *    the documentation and/or other materials provided with the
14  *    distribution.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
20  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26  * SUCH DAMAGE.
27  */
28
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31
32 /*
33  * Driver for the TDK 78Q2120 MII
34  *
35  * References:
36  *   Datasheet for the 78Q2120 - http://www.tsc.tdk.com/lan/78q2120.pdf
37  *   Most of this code stolen from ukphy.c
38  */
39
40 /*
41  * The TDK 78Q2120 is found on some Xircom X3201 based cardbus cards,
42  * also spotted on some 3C575 cards.  It's just like any other normal
43  * phy, except it does auto negotiation in a different way.
44  */
45
46 #include <sys/param.h>
47 #include <sys/systm.h>
48 #include <sys/kernel.h>
49 #include <sys/socket.h>
50 #include <sys/errno.h>
51 #include <sys/module.h>
52 #include <sys/bus.h>
53
54 #include <net/if.h>
55 #include <net/if_media.h>
56
57 #include <dev/mii/mii.h>
58 #include <dev/mii/miivar.h>
59 #include "miidevs.h"
60
61 #include <dev/mii/tdkphyreg.h>
62
63 #include "miibus_if.h"
64
65 static int tdkphy_probe(device_t);
66 static int tdkphy_attach(device_t);
67
68 static device_method_t tdkphy_methods[] = {
69         /* device interface */
70         DEVMETHOD(device_probe,         tdkphy_probe),
71         DEVMETHOD(device_attach,        tdkphy_attach),
72         DEVMETHOD(device_detach,        mii_phy_detach),
73         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
74         { 0, 0 }
75 };
76
77 static devclass_t tdkphy_devclass;
78
79 static driver_t tdkphy_driver = {
80         "tdkphy",
81         tdkphy_methods,
82         sizeof(struct mii_softc)
83 };
84
85 DRIVER_MODULE(tdkphy, miibus, tdkphy_driver, tdkphy_devclass, 0, 0);
86
87 static int tdkphy_service(struct mii_softc *, struct mii_data *, int);
88 static void tdkphy_status(struct mii_softc *);
89
90 static const struct mii_phydesc tdkphys[] = {
91         MII_PHY_DESC(TDK, 78Q2120),
92         MII_PHY_END
93 };
94
95 static int
96 tdkphy_probe(device_t dev)
97 {
98
99         return (mii_phy_dev_probe(dev, tdkphys, BUS_PROBE_DEFAULT));
100 }
101
102 static int
103 tdkphy_attach(device_t dev)
104 {
105         struct mii_softc *sc;
106         struct mii_attach_args *ma;
107         struct mii_data *mii;
108         sc = device_get_softc(dev);
109         ma = device_get_ivars(dev);
110         sc->mii_dev = device_get_parent(dev);
111         mii = ma->mii_data;
112         LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list);
113
114         if (bootverbose)
115                 device_printf(dev, "OUI 0x%06x, model 0x%04x, rev. %d\n",
116                     MII_OUI(ma->mii_id1, ma->mii_id2),
117                     MII_MODEL(ma->mii_id2), MII_REV(ma->mii_id2));
118
119         sc->mii_flags = miibus_get_flags(dev);
120         sc->mii_inst = mii->mii_instance++;
121         sc->mii_phy = ma->mii_phyno;
122         sc->mii_service = tdkphy_service;
123         sc->mii_pdata = mii;
124
125         /*
126          * Apparently, we can't do loopback on this PHY.
127          */
128         sc->mii_flags |= MIIF_NOLOOP;
129
130         mii_phy_reset(sc);
131
132         sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
133         device_printf(dev, " ");
134         mii_phy_add_media(sc);
135         printf("\n");
136
137         MIIBUS_MEDIAINIT(sc->mii_dev);
138         return (0);
139 }
140
141 static int
142 tdkphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
143 {
144
145         switch (cmd) {
146         case MII_POLLSTAT:
147                 break;
148
149         case MII_MEDIACHG:
150                 /*
151                  * If the interface is not up, don't do anything.
152                  */
153                 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
154                         break;
155
156                 mii_phy_setmedia(sc);
157                 break;
158
159         case MII_TICK:
160                 if (mii_phy_tick(sc) == EJUSTRETURN)
161                         return (0);
162                 break;
163         }
164
165         /* Update the media status. */
166         tdkphy_status(sc);
167         if (sc->mii_pdata->mii_media_active & IFM_FDX)
168                 PHY_WRITE(sc, MII_BMCR, PHY_READ(sc, MII_BMCR) | BMCR_FDX);
169         else
170                 PHY_WRITE(sc, MII_BMCR, PHY_READ(sc, MII_BMCR) & ~BMCR_FDX);
171
172         /* Callback if something changed. */
173         mii_phy_update(sc, cmd);
174         return (0);
175 }
176
177 static void
178 tdkphy_status(struct mii_softc *phy)
179 {
180         struct mii_data *mii = phy->mii_pdata;
181         struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
182         int bmsr, bmcr, anlpar, diag;
183
184         mii->mii_media_status = IFM_AVALID;
185         mii->mii_media_active = IFM_ETHER;
186
187         bmsr = PHY_READ(phy, MII_BMSR) | PHY_READ(phy, MII_BMSR);
188         if (bmsr & BMSR_LINK)
189                 mii->mii_media_status |= IFM_ACTIVE;
190
191         bmcr = PHY_READ(phy, MII_BMCR);
192         if (bmcr & BMCR_ISO) {
193                 mii->mii_media_active |= IFM_NONE;
194                 mii->mii_media_status = 0;
195                 return;
196         }
197
198         if (bmcr & BMCR_LOOP)
199                 mii->mii_media_active |= IFM_LOOP;
200
201         if (bmcr & BMCR_AUTOEN) {
202                 /*
203                  * NWay autonegotiation takes the highest-order common
204                  * bit of the ANAR and ANLPAR (i.e. best media advertised
205                  * both by us and our link partner).
206                  */
207                 if ((bmsr & BMSR_ACOMP) == 0) {
208                         /* Erg, still trying, I guess... */
209                         mii->mii_media_active |= IFM_NONE;
210                         return;
211                 }
212
213                 anlpar = PHY_READ(phy, MII_ANAR) & PHY_READ(phy, MII_ANLPAR);
214                 /*
215                  * ANLPAR doesn't get set on my card, but we check it anyway,
216                  * since it is mentioned in the 78Q2120 specs.
217                  */
218                 if (anlpar & ANLPAR_TX_FD)
219                         mii->mii_media_active |= IFM_100_TX|IFM_FDX;
220                 else if (anlpar & ANLPAR_T4)
221                         mii->mii_media_active |= IFM_100_T4|IFM_HDX;
222                 else if (anlpar & ANLPAR_TX)
223                         mii->mii_media_active |= IFM_100_TX|IFM_HDX;
224                 else if (anlpar & ANLPAR_10_FD)
225                         mii->mii_media_active |= IFM_10_T|IFM_FDX;
226                 else if (anlpar & ANLPAR_10)
227                         mii->mii_media_active |= IFM_10_T|IFM_HDX;
228                 else {
229                         /*
230                          * ANLPAR isn't set, which leaves two possibilities:
231                          * 1) Auto negotiation failed
232                          * 2) Auto negotiation completed, but the card forgot
233                          *    to set ANLPAR.
234                          * So we check the MII_DIAG(18) register...
235                          */
236                         diag = PHY_READ(phy, MII_DIAG);
237                         if (diag & DIAG_NEGFAIL) /* assume 10baseT if no neg */
238                                 mii->mii_media_active |= IFM_10_T|IFM_HDX;
239                         else {
240                                 if (diag & DIAG_DUPLEX)
241                                         mii->mii_media_active |= IFM_FDX;
242                                 else
243                                         mii->mii_media_active |= IFM_HDX;
244                                 if (diag & DIAG_RATE_100)
245                                         mii->mii_media_active |= IFM_100_TX;
246                                 else
247                                         mii->mii_media_active |= IFM_10_T;
248                         }
249                 }
250         } else
251                 mii->mii_media_active = ife->ifm_media;
252 }