rgephy.c revision 1.13 1 1.13 tsutsui /* $NetBSD: rgephy.c,v 1.13 2006/11/28 13:36:29 tsutsui Exp $ */
2 1.1 jonathan
3 1.1 jonathan /*
4 1.1 jonathan * Copyright (c) 2003
5 1.1 jonathan * Bill Paul <wpaul (at) windriver.com>. All rights reserved.
6 1.1 jonathan *
7 1.1 jonathan * Redistribution and use in source and binary forms, with or without
8 1.1 jonathan * modification, are permitted provided that the following conditions
9 1.1 jonathan * are met:
10 1.1 jonathan * 1. Redistributions of source code must retain the above copyright
11 1.1 jonathan * notice, this list of conditions and the following disclaimer.
12 1.1 jonathan * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jonathan * notice, this list of conditions and the following disclaimer in the
14 1.1 jonathan * documentation and/or other materials provided with the distribution.
15 1.1 jonathan * 3. All advertising materials mentioning features or use of this software
16 1.1 jonathan * must display the following acknowledgement:
17 1.1 jonathan * This product includes software developed by Bill Paul.
18 1.1 jonathan * 4. Neither the name of the author nor the names of any co-contributors
19 1.1 jonathan * may be used to endorse or promote products derived from this software
20 1.1 jonathan * without specific prior written permission.
21 1.1 jonathan *
22 1.1 jonathan * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
23 1.1 jonathan * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 1.1 jonathan * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 1.1 jonathan * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
26 1.1 jonathan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27 1.1 jonathan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28 1.1 jonathan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29 1.1 jonathan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30 1.1 jonathan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31 1.1 jonathan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
32 1.1 jonathan * THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 jonathan */
34 1.1 jonathan
35 1.1 jonathan #include <sys/cdefs.h>
36 1.13 tsutsui __KERNEL_RCSID(0, "$NetBSD: rgephy.c,v 1.13 2006/11/28 13:36:29 tsutsui Exp $");
37 1.1 jonathan
38 1.1 jonathan
39 1.1 jonathan /*
40 1.1 jonathan * Driver for the RealTek 8169S/8110S internal 10/100/1000 PHY.
41 1.1 jonathan */
42 1.1 jonathan
43 1.1 jonathan #include <sys/param.h>
44 1.1 jonathan #include <sys/systm.h>
45 1.1 jonathan #include <sys/kernel.h>
46 1.10 tsutsui #include <sys/device.h>
47 1.1 jonathan #include <sys/socket.h>
48 1.1 jonathan
49 1.1 jonathan
50 1.1 jonathan #include <net/if.h>
51 1.1 jonathan #include <net/if_media.h>
52 1.1 jonathan
53 1.1 jonathan #include <dev/mii/mii.h>
54 1.1 jonathan #include <dev/mii/miivar.h>
55 1.1 jonathan #include <dev/mii/miidevs.h>
56 1.1 jonathan
57 1.1 jonathan #include <dev/mii/rgephyreg.h>
58 1.1 jonathan
59 1.1 jonathan #include <dev/ic/rtl81x9reg.h>
60 1.1 jonathan
61 1.1 jonathan static int rgephy_match(struct device *, struct cfdata *, void *);
62 1.1 jonathan static void rgephy_attach(struct device *, struct device *, void *);
63 1.1 jonathan
64 1.1 jonathan CFATTACH_DECL(rgephy, sizeof(struct mii_softc),
65 1.1 jonathan rgephy_match, rgephy_attach, mii_phy_detach, mii_phy_activate);
66 1.1 jonathan
67 1.1 jonathan
68 1.1 jonathan static int rgephy_service(struct mii_softc *, struct mii_data *, int);
69 1.1 jonathan static void rgephy_status(struct mii_softc *);
70 1.1 jonathan static int rgephy_mii_phy_auto(struct mii_softc *);
71 1.1 jonathan static void rgephy_reset(struct mii_softc *);
72 1.1 jonathan static void rgephy_loop(struct mii_softc *);
73 1.1 jonathan static void rgephy_load_dspcode(struct mii_softc *);
74 1.1 jonathan static int rgephy_mii_model;
75 1.1 jonathan
76 1.1 jonathan static const struct mii_phy_funcs rgephy_funcs = {
77 1.1 jonathan rgephy_service, rgephy_status, rgephy_reset,
78 1.1 jonathan };
79 1.1 jonathan
80 1.1 jonathan static const struct mii_phydesc rgephys[] = {
81 1.1 jonathan { MII_OUI_xxREALTEK, MII_MODEL_xxREALTEK_RTL8169S,
82 1.1 jonathan MII_STR_xxREALTEK_RTL8169S },
83 1.1 jonathan
84 1.1 jonathan { MII_OUI_REALTEK, MII_MODEL_REALTEK_RTL8169S,
85 1.1 jonathan MII_STR_REALTEK_RTL8169S },
86 1.1 jonathan
87 1.6 wiz { 0, 0,
88 1.6 wiz NULL }
89 1.1 jonathan };
90 1.1 jonathan
91 1.1 jonathan static int
92 1.11 christos rgephy_match(struct device *parent, struct cfdata *match,
93 1.9 christos void *aux)
94 1.1 jonathan {
95 1.1 jonathan struct mii_attach_args *ma = aux;
96 1.1 jonathan
97 1.1 jonathan if (mii_phy_match(ma, rgephys) != NULL)
98 1.1 jonathan return (10);
99 1.1 jonathan
100 1.1 jonathan return (0);
101 1.1 jonathan }
102 1.1 jonathan
103 1.1 jonathan static void
104 1.11 christos rgephy_attach(struct device *parent, struct device *self, void *aux)
105 1.1 jonathan {
106 1.8 thorpej struct mii_softc *sc = device_private(self);
107 1.1 jonathan struct mii_attach_args *ma = aux;
108 1.1 jonathan struct mii_data *mii = ma->mii_data;
109 1.1 jonathan const struct mii_phydesc *mpd;
110 1.1 jonathan int rev;
111 1.1 jonathan const char *sep = "";
112 1.1 jonathan
113 1.1 jonathan rev = MII_REV(ma->mii_id2);
114 1.1 jonathan mpd = mii_phy_match(ma, rgephys);
115 1.1 jonathan aprint_naive(": Media interface\n");
116 1.1 jonathan aprint_normal(": %s, rev. %d\n", mpd->mpd_name, rev);
117 1.1 jonathan
118 1.1 jonathan sc->mii_mpd_model = rev; /* XXX miivar.h comment vs usage? */
119 1.1 jonathan sc->mii_inst = mii->mii_instance;
120 1.1 jonathan sc->mii_phy = ma->mii_phyno;
121 1.1 jonathan sc->mii_pdata = mii;
122 1.1 jonathan sc->mii_flags = mii->mii_flags;
123 1.12 christos sc->mii_anegticks = MII_ANEGTICKS;
124 1.1 jonathan
125 1.1 jonathan sc->mii_funcs = &rgephy_funcs;
126 1.1 jonathan
127 1.1 jonathan /* Don't do isolate on this PHY. */
128 1.1 jonathan sc->mii_flags |= MIIF_NOISOLATE;
129 1.1 jonathan
130 1.1 jonathan #define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL)
131 1.1 jonathan #define PRINT(n) aprint_normal("%s%s", sep, (n)); sep = ", "
132 1.1 jonathan
133 1.1 jonathan #if 0
134 1.1 jonathan ADD(IFM_MAKEWORD(IFM_ETHER, IFM_NONE, 0, sc->mii_inst),
135 1.1 jonathan BMCR_ISO);
136 1.1 jonathan #endif
137 1.1 jonathan #ifdef __FreeBSD__
138 1.1 jonathan ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst),
139 1.1 jonathan BMCR_LOOP|BMCR_S100);
140 1.1 jonathan #endif
141 1.1 jonathan
142 1.1 jonathan rgephy_mii_model = MII_MODEL(ma->mii_id2);
143 1.1 jonathan
144 1.1 jonathan sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
145 1.1 jonathan sc->mii_capabilities &= ~BMSR_ANEG;
146 1.1 jonathan
147 1.1 jonathan /*
148 1.1 jonathan * FreeBSD does not check EXSTAT, but instead adds gigabit
149 1.5 perry * media explicitly. Why?
150 1.1 jonathan */
151 1.1 jonathan aprint_normal("%s: ", sc->mii_dev.dv_xname);
152 1.1 jonathan #ifdef __FreeBSD__
153 1.1 jonathan mii_phy_add_media(sc);
154 1.1 jonathan ADD(IFM_MAKEWORD(IFM_ETHER, IFM_1000_T, 0, sc->mii_inst),
155 1.1 jonathan RGEPHY_BMCR_FDX);
156 1.1 jonathan PRINT(", 1000baseTX");
157 1.1 jonathan ADD(IFM_MAKEWORD(IFM_ETHER, IFM_1000_T, IFM_FDX, sc->mii_inst), 0);
158 1.1 jonathan PRINT("1000baseTX-FDX");
159 1.1 jonathan #else
160 1.1 jonathan if (sc->mii_capabilities & BMSR_EXTSTAT) {
161 1.1 jonathan sc->mii_extcapabilities = PHY_READ(sc, MII_EXTSR);
162 1.1 jonathan }
163 1.1 jonathan mii_phy_add_media(sc);
164 1.1 jonathan #endif
165 1.1 jonathan /* rtl8169S does not report auto-sense; add manually. */
166 1.1 jonathan ADD(IFM_MAKEWORD(IFM_ETHER, IFM_AUTO, 0, sc->mii_inst), MII_NMEDIA);
167 1.1 jonathan sep =", ";
168 1.1 jonathan PRINT("auto");
169 1.1 jonathan
170 1.1 jonathan #undef ADD
171 1.1 jonathan #undef PRINT
172 1.1 jonathan
173 1.13 tsutsui PHY_RESET(sc);
174 1.1 jonathan aprint_normal("\n");
175 1.1 jonathan }
176 1.1 jonathan
177 1.1 jonathan static int
178 1.1 jonathan rgephy_service(sc, mii, cmd)
179 1.1 jonathan struct mii_softc *sc;
180 1.1 jonathan struct mii_data *mii;
181 1.1 jonathan int cmd;
182 1.1 jonathan {
183 1.1 jonathan struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
184 1.13 tsutsui int reg, speed, gig, anar;
185 1.1 jonathan
186 1.1 jonathan switch (cmd) {
187 1.1 jonathan case MII_POLLSTAT:
188 1.1 jonathan /*
189 1.1 jonathan * If we're not polling our PHY instance, just return.
190 1.1 jonathan */
191 1.1 jonathan if (IFM_INST(ife->ifm_media) != sc->mii_inst)
192 1.1 jonathan return (0);
193 1.1 jonathan break;
194 1.1 jonathan
195 1.1 jonathan case MII_MEDIACHG:
196 1.1 jonathan /*
197 1.1 jonathan * If the media indicates a different PHY instance,
198 1.1 jonathan * isolate ourselves.
199 1.1 jonathan */
200 1.1 jonathan if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
201 1.1 jonathan reg = PHY_READ(sc, MII_BMCR);
202 1.1 jonathan PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
203 1.1 jonathan return (0);
204 1.1 jonathan }
205 1.1 jonathan
206 1.1 jonathan /*
207 1.1 jonathan * If the interface is not up, don't do anything.
208 1.1 jonathan */
209 1.1 jonathan if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
210 1.1 jonathan break;
211 1.1 jonathan
212 1.1 jonathan PHY_RESET(sc); /* XXX hardware bug work-around */
213 1.1 jonathan
214 1.13 tsutsui anar = PHY_READ(sc, RGEPHY_MII_ANAR);
215 1.13 tsutsui anar &= ~(RGEPHY_ANAR_TX_FD | RGEPHY_ANAR_TX |
216 1.13 tsutsui RGEPHY_ANAR_10_FD | RGEPHY_ANAR_10);
217 1.13 tsutsui
218 1.1 jonathan switch (IFM_SUBTYPE(ife->ifm_media)) {
219 1.1 jonathan case IFM_AUTO:
220 1.1 jonathan #ifdef foo
221 1.1 jonathan /*
222 1.1 jonathan * If we're already in auto mode, just return.
223 1.1 jonathan */
224 1.1 jonathan if (PHY_READ(sc, RGEPHY_MII_BMCR) & RGEPHY_BMCR_AUTOEN)
225 1.1 jonathan return (0);
226 1.1 jonathan #endif
227 1.1 jonathan (void) rgephy_mii_phy_auto(sc);
228 1.1 jonathan break;
229 1.1 jonathan case IFM_1000_T:
230 1.1 jonathan speed = RGEPHY_S1000;
231 1.1 jonathan goto setit;
232 1.1 jonathan case IFM_100_TX:
233 1.1 jonathan speed = RGEPHY_S100;
234 1.13 tsutsui anar |= RGEPHY_ANAR_TX_FD | RGEPHY_ANAR_TX;
235 1.1 jonathan goto setit;
236 1.1 jonathan case IFM_10_T:
237 1.1 jonathan speed = RGEPHY_S10;
238 1.13 tsutsui anar |= RGEPHY_ANAR_10_FD | RGEPHY_ANAR_10;
239 1.1 jonathan setit:
240 1.1 jonathan rgephy_loop(sc);
241 1.1 jonathan if ((ife->ifm_media & IFM_GMASK) == IFM_FDX) {
242 1.1 jonathan speed |= RGEPHY_BMCR_FDX;
243 1.1 jonathan gig = RGEPHY_1000CTL_AFD;
244 1.13 tsutsui anar &= ~(RGEPHY_ANAR_TX | RGEPHY_ANAR_10);
245 1.1 jonathan } else {
246 1.1 jonathan gig = RGEPHY_1000CTL_AHD;
247 1.13 tsutsui anar &=
248 1.13 tsutsui ~(RGEPHY_ANAR_TX_FD | RGEPHY_ANAR_10_FD);
249 1.1 jonathan }
250 1.1 jonathan
251 1.13 tsutsui if (IFM_SUBTYPE(ife->ifm_media) != IFM_1000_T) {
252 1.13 tsutsui PHY_WRITE(sc, RGEPHY_MII_1000CTL, 0);
253 1.13 tsutsui PHY_WRITE(sc, RGEPHY_MII_ANAR, anar);
254 1.13 tsutsui PHY_WRITE(sc, RGEPHY_MII_BMCR, speed |
255 1.13 tsutsui RGEPHY_BMCR_AUTOEN | RGEPHY_BMCR_STARTNEG);
256 1.1 jonathan break;
257 1.13 tsutsui }
258 1.1 jonathan
259 1.1 jonathan /*
260 1.1 jonathan * When settning the link manually, one side must
261 1.1 jonathan * be the master and the other the slave. However
262 1.1 jonathan * ifmedia doesn't give us a good way to specify
263 1.1 jonathan * this, so we fake it by using one of the LINK
264 1.1 jonathan * flags. If LINK0 is set, we program the PHY to
265 1.1 jonathan * be a master, otherwise it's a slave.
266 1.1 jonathan */
267 1.1 jonathan if ((mii->mii_ifp->if_flags & IFF_LINK0)) {
268 1.1 jonathan PHY_WRITE(sc, RGEPHY_MII_1000CTL,
269 1.1 jonathan gig|RGEPHY_1000CTL_MSE|RGEPHY_1000CTL_MSC);
270 1.1 jonathan } else {
271 1.1 jonathan PHY_WRITE(sc, RGEPHY_MII_1000CTL,
272 1.1 jonathan gig|RGEPHY_1000CTL_MSE);
273 1.1 jonathan }
274 1.13 tsutsui PHY_WRITE(sc, RGEPHY_MII_BMCR, speed |
275 1.13 tsutsui RGEPHY_BMCR_AUTOEN | RGEPHY_BMCR_STARTNEG);
276 1.1 jonathan break;
277 1.1 jonathan #ifdef foo
278 1.1 jonathan case IFM_NONE:
279 1.1 jonathan PHY_WRITE(sc, MII_BMCR, BMCR_ISO|BMCR_PDOWN);
280 1.1 jonathan break;
281 1.1 jonathan #endif
282 1.1 jonathan case IFM_100_T4:
283 1.1 jonathan default:
284 1.1 jonathan return (EINVAL);
285 1.1 jonathan }
286 1.1 jonathan break;
287 1.1 jonathan
288 1.1 jonathan case MII_TICK:
289 1.1 jonathan /*
290 1.1 jonathan * If we're not currently selected, just return.
291 1.1 jonathan */
292 1.1 jonathan if (IFM_INST(ife->ifm_media) != sc->mii_inst)
293 1.1 jonathan return (0);
294 1.1 jonathan
295 1.1 jonathan /*
296 1.1 jonathan * Is the interface even up?
297 1.1 jonathan */
298 1.1 jonathan if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
299 1.1 jonathan return (0);
300 1.1 jonathan
301 1.1 jonathan /*
302 1.1 jonathan * Only used for autonegotiation.
303 1.1 jonathan */
304 1.1 jonathan if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO)
305 1.1 jonathan break;
306 1.1 jonathan
307 1.1 jonathan /*
308 1.1 jonathan * Check to see if we have link. If we do, we don't
309 1.1 jonathan * need to restart the autonegotiation process. Read
310 1.1 jonathan * the BMSR twice in case it's latched.
311 1.1 jonathan */
312 1.1 jonathan reg = PHY_READ(sc, RTK_GMEDIASTAT);
313 1.1 jonathan if (reg & RTK_GMEDIASTAT_LINK)
314 1.1 jonathan break;
315 1.1 jonathan
316 1.1 jonathan /*
317 1.1 jonathan * Only retry autonegotiation every 5 seconds.
318 1.1 jonathan */
319 1.12 christos if (++sc->mii_ticks <= MII_ANEGTICKS)
320 1.1 jonathan break;
321 1.5 perry
322 1.1 jonathan sc->mii_ticks = 0;
323 1.1 jonathan rgephy_mii_phy_auto(sc);
324 1.1 jonathan return (0);
325 1.1 jonathan }
326 1.1 jonathan
327 1.1 jonathan /* Update the media status. */
328 1.1 jonathan rgephy_status(sc);
329 1.1 jonathan
330 1.1 jonathan /*
331 1.1 jonathan * Callback if something changed. Note that we need to poke
332 1.1 jonathan * the DSP on the RealTek PHYs if the media changes.
333 1.1 jonathan *
334 1.1 jonathan */
335 1.5 perry if (sc->mii_media_active != mii->mii_media_active ||
336 1.1 jonathan sc->mii_media_status != mii->mii_media_status ||
337 1.1 jonathan cmd == MII_MEDIACHG) {
338 1.1 jonathan /* XXX only for v0/v1 phys. */
339 1.1 jonathan if (sc->mii_mpd_model < 2)
340 1.1 jonathan rgephy_load_dspcode(sc);
341 1.1 jonathan }
342 1.1 jonathan mii_phy_update(sc, cmd);
343 1.1 jonathan return (0);
344 1.1 jonathan }
345 1.1 jonathan
346 1.1 jonathan static void
347 1.1 jonathan rgephy_status(sc)
348 1.1 jonathan struct mii_softc *sc;
349 1.1 jonathan {
350 1.1 jonathan struct mii_data *mii = sc->mii_pdata;
351 1.1 jonathan int bmsr, bmcr;
352 1.1 jonathan
353 1.1 jonathan mii->mii_media_status = IFM_AVALID;
354 1.1 jonathan mii->mii_media_active = IFM_ETHER;
355 1.1 jonathan
356 1.1 jonathan bmsr = PHY_READ(sc, RTK_GMEDIASTAT);
357 1.1 jonathan
358 1.1 jonathan if (bmsr & RTK_GMEDIASTAT_LINK)
359 1.1 jonathan mii->mii_media_status |= IFM_ACTIVE;
360 1.1 jonathan bmsr = PHY_READ(sc, RGEPHY_MII_BMSR);
361 1.1 jonathan
362 1.1 jonathan bmcr = PHY_READ(sc, RGEPHY_MII_BMCR);
363 1.1 jonathan
364 1.3 kanaoka if (bmcr & RGEPHY_BMCR_ISO) {
365 1.3 kanaoka mii->mii_media_active |= IFM_NONE;
366 1.3 kanaoka mii->mii_media_status = 0;
367 1.3 kanaoka return;
368 1.3 kanaoka }
369 1.3 kanaoka
370 1.1 jonathan if (bmcr & RGEPHY_BMCR_LOOP)
371 1.1 jonathan mii->mii_media_active |= IFM_LOOP;
372 1.1 jonathan
373 1.1 jonathan if (bmcr & RGEPHY_BMCR_AUTOEN) {
374 1.1 jonathan if ((bmsr & RGEPHY_BMSR_ACOMP) == 0) {
375 1.1 jonathan /* Erg, still trying, I guess... */
376 1.1 jonathan mii->mii_media_active |= IFM_NONE;
377 1.1 jonathan return;
378 1.1 jonathan }
379 1.1 jonathan }
380 1.1 jonathan
381 1.1 jonathan bmsr = PHY_READ(sc, RTK_GMEDIASTAT);
382 1.1 jonathan if (bmsr & RTK_GMEDIASTAT_1000MBPS)
383 1.1 jonathan mii->mii_media_active |= IFM_1000_T;
384 1.13 tsutsui else if (bmsr & RTK_GMEDIASTAT_100MBPS)
385 1.13 tsutsui mii->mii_media_active |= IFM_100_TX;
386 1.13 tsutsui else if (bmsr & RTK_GMEDIASTAT_10MBPS)
387 1.13 tsutsui mii->mii_media_active |= IFM_10_T;
388 1.13 tsutsui else
389 1.13 tsutsui mii->mii_media_active |= IFM_NONE;
390 1.1 jonathan if (bmsr & RTK_GMEDIASTAT_FDX)
391 1.1 jonathan mii->mii_media_active |= IFM_FDX;
392 1.1 jonathan
393 1.1 jonathan return;
394 1.1 jonathan }
395 1.1 jonathan
396 1.1 jonathan
397 1.1 jonathan static int
398 1.1 jonathan rgephy_mii_phy_auto(mii)
399 1.1 jonathan struct mii_softc *mii;
400 1.1 jonathan {
401 1.1 jonathan rgephy_loop(mii);
402 1.1 jonathan PHY_RESET(mii);
403 1.1 jonathan
404 1.1 jonathan PHY_WRITE(mii, RGEPHY_MII_ANAR,
405 1.1 jonathan BMSR_MEDIA_TO_ANAR(mii->mii_capabilities) | ANAR_CSMA);
406 1.1 jonathan DELAY(1000);
407 1.13 tsutsui PHY_WRITE(mii, RGEPHY_MII_1000CTL,
408 1.13 tsutsui RGEPHY_1000CTL_AHD | RGEPHY_1000CTL_AFD);
409 1.1 jonathan DELAY(1000);
410 1.1 jonathan PHY_WRITE(mii, RGEPHY_MII_BMCR,
411 1.1 jonathan RGEPHY_BMCR_AUTOEN | RGEPHY_BMCR_STARTNEG);
412 1.1 jonathan DELAY(100);
413 1.1 jonathan
414 1.1 jonathan return (EJUSTRETURN);
415 1.1 jonathan }
416 1.1 jonathan
417 1.1 jonathan static void
418 1.1 jonathan rgephy_loop(struct mii_softc *sc)
419 1.1 jonathan {
420 1.1 jonathan u_int32_t bmsr;
421 1.1 jonathan int i;
422 1.1 jonathan
423 1.1 jonathan PHY_WRITE(sc, RGEPHY_MII_BMCR, RGEPHY_BMCR_PDOWN);
424 1.1 jonathan DELAY(1000);
425 1.1 jonathan
426 1.1 jonathan for (i = 0; i < 15000; i++) {
427 1.1 jonathan bmsr = PHY_READ(sc, RGEPHY_MII_BMSR);
428 1.1 jonathan if (!(bmsr & RGEPHY_BMSR_LINK)) {
429 1.1 jonathan #if 0
430 1.1 jonathan device_printf(sc->mii_dev, "looped %d\n", i);
431 1.1 jonathan #endif
432 1.1 jonathan break;
433 1.1 jonathan }
434 1.1 jonathan DELAY(10);
435 1.1 jonathan }
436 1.1 jonathan }
437 1.1 jonathan
438 1.1 jonathan #define PHY_SETBIT(x, y, z) \
439 1.1 jonathan PHY_WRITE(x, y, (PHY_READ(x, y) | (z)))
440 1.1 jonathan #define PHY_CLRBIT(x, y, z) \
441 1.1 jonathan PHY_WRITE(x, y, (PHY_READ(x, y) & ~(z)))
442 1.1 jonathan
443 1.1 jonathan /*
444 1.1 jonathan * Initialize RealTek PHY per the datasheet. The DSP in the PHYs of
445 1.1 jonathan * existing revisions of the 8169S/8110S chips need to be tuned in
446 1.13 tsutsui * order to reliably negotiate a 1000Mbps link. This is only needed
447 1.13 tsutsui * for rev 0 and rev 1 of the PHY. Later versions work without
448 1.13 tsutsui * any fixups.
449 1.1 jonathan */
450 1.1 jonathan static void
451 1.1 jonathan rgephy_load_dspcode(struct mii_softc *sc)
452 1.1 jonathan {
453 1.1 jonathan int val;
454 1.1 jonathan
455 1.1 jonathan #if 1
456 1.1 jonathan PHY_WRITE(sc, 31, 0x0001);
457 1.1 jonathan PHY_WRITE(sc, 21, 0x1000);
458 1.1 jonathan PHY_WRITE(sc, 24, 0x65C7);
459 1.1 jonathan PHY_CLRBIT(sc, 4, 0x0800);
460 1.1 jonathan val = PHY_READ(sc, 4) & 0xFFF;
461 1.1 jonathan PHY_WRITE(sc, 4, val);
462 1.1 jonathan PHY_WRITE(sc, 3, 0x00A1);
463 1.1 jonathan PHY_WRITE(sc, 2, 0x0008);
464 1.1 jonathan PHY_WRITE(sc, 1, 0x1020);
465 1.1 jonathan PHY_WRITE(sc, 0, 0x1000);
466 1.1 jonathan PHY_SETBIT(sc, 4, 0x0800);
467 1.1 jonathan PHY_CLRBIT(sc, 4, 0x0800);
468 1.1 jonathan val = (PHY_READ(sc, 4) & 0xFFF) | 0x7000;
469 1.1 jonathan PHY_WRITE(sc, 4, val);
470 1.1 jonathan PHY_WRITE(sc, 3, 0xFF41);
471 1.1 jonathan PHY_WRITE(sc, 2, 0xDE60);
472 1.1 jonathan PHY_WRITE(sc, 1, 0x0140);
473 1.1 jonathan PHY_WRITE(sc, 0, 0x0077);
474 1.1 jonathan val = (PHY_READ(sc, 4) & 0xFFF) | 0xA000;
475 1.1 jonathan PHY_WRITE(sc, 4, val);
476 1.1 jonathan PHY_WRITE(sc, 3, 0xDF01);
477 1.1 jonathan PHY_WRITE(sc, 2, 0xDF20);
478 1.1 jonathan PHY_WRITE(sc, 1, 0xFF95);
479 1.1 jonathan PHY_WRITE(sc, 0, 0xFA00);
480 1.1 jonathan val = (PHY_READ(sc, 4) & 0xFFF) | 0xB000;
481 1.1 jonathan PHY_WRITE(sc, 4, val);
482 1.1 jonathan PHY_WRITE(sc, 3, 0xFF41);
483 1.1 jonathan PHY_WRITE(sc, 2, 0xDE20);
484 1.1 jonathan PHY_WRITE(sc, 1, 0x0140);
485 1.1 jonathan PHY_WRITE(sc, 0, 0x00BB);
486 1.1 jonathan val = (PHY_READ(sc, 4) & 0xFFF) | 0xF000;
487 1.1 jonathan PHY_WRITE(sc, 4, val);
488 1.1 jonathan PHY_WRITE(sc, 3, 0xDF01);
489 1.1 jonathan PHY_WRITE(sc, 2, 0xDF20);
490 1.1 jonathan PHY_WRITE(sc, 1, 0xFF95);
491 1.1 jonathan PHY_WRITE(sc, 0, 0xBF00);
492 1.1 jonathan PHY_SETBIT(sc, 4, 0x0800);
493 1.1 jonathan PHY_CLRBIT(sc, 4, 0x0800);
494 1.1 jonathan PHY_WRITE(sc, 31, 0x0000);
495 1.1 jonathan #else
496 1.1 jonathan (void)val;
497 1.1 jonathan PHY_WRITE(sc, 0x1f, 0x0001);
498 1.1 jonathan PHY_WRITE(sc, 0x15, 0x1000);
499 1.1 jonathan PHY_WRITE(sc, 0x18, 0x65c7);
500 1.1 jonathan PHY_WRITE(sc, 0x04, 0x0000);
501 1.1 jonathan PHY_WRITE(sc, 0x03, 0x00a1);
502 1.1 jonathan PHY_WRITE(sc, 0x02, 0x0008);
503 1.1 jonathan PHY_WRITE(sc, 0x01, 0x1020);
504 1.1 jonathan PHY_WRITE(sc, 0x00, 0x1000);
505 1.1 jonathan PHY_WRITE(sc, 0x04, 0x0800);
506 1.1 jonathan PHY_WRITE(sc, 0x04, 0x0000);
507 1.1 jonathan PHY_WRITE(sc, 0x04, 0x7000);
508 1.1 jonathan PHY_WRITE(sc, 0x03, 0xff41);
509 1.1 jonathan PHY_WRITE(sc, 0x02, 0xde60);
510 1.1 jonathan PHY_WRITE(sc, 0x01, 0x0140);
511 1.1 jonathan PHY_WRITE(sc, 0x00, 0x0077);
512 1.1 jonathan PHY_WRITE(sc, 0x04, 0x7800);
513 1.1 jonathan PHY_WRITE(sc, 0x04, 0x7000);
514 1.1 jonathan PHY_WRITE(sc, 0x04, 0xa000);
515 1.1 jonathan PHY_WRITE(sc, 0x03, 0xdf01);
516 1.1 jonathan PHY_WRITE(sc, 0x02, 0xdf20);
517 1.1 jonathan PHY_WRITE(sc, 0x01, 0xff95);
518 1.1 jonathan PHY_WRITE(sc, 0x00, 0xfa00);
519 1.1 jonathan PHY_WRITE(sc, 0x04, 0xa800);
520 1.1 jonathan PHY_WRITE(sc, 0x04, 0xa000);
521 1.1 jonathan PHY_WRITE(sc, 0x04, 0xb000);
522 1.1 jonathan PHY_WRITE(sc, 0x0e, 0xff41);
523 1.1 jonathan PHY_WRITE(sc, 0x02, 0xde20);
524 1.1 jonathan PHY_WRITE(sc, 0x01, 0x0140);
525 1.1 jonathan PHY_WRITE(sc, 0x00, 0x00bb);
526 1.1 jonathan PHY_WRITE(sc, 0x04, 0xb800);
527 1.1 jonathan PHY_WRITE(sc, 0x04, 0xb000);
528 1.1 jonathan PHY_WRITE(sc, 0x04, 0xf000);
529 1.1 jonathan PHY_WRITE(sc, 0x03, 0xdf01);
530 1.1 jonathan PHY_WRITE(sc, 0x02, 0xdf20);
531 1.1 jonathan PHY_WRITE(sc, 0x01, 0xff95);
532 1.1 jonathan PHY_WRITE(sc, 0x00, 0xbf00);
533 1.1 jonathan PHY_WRITE(sc, 0x04, 0xf800);
534 1.1 jonathan PHY_WRITE(sc, 0x04, 0xf000);
535 1.1 jonathan PHY_WRITE(sc, 0x04, 0x0000);
536 1.1 jonathan PHY_WRITE(sc, 0x1f, 0x0000);
537 1.1 jonathan PHY_WRITE(sc, 0x0b, 0x0000);
538 1.1 jonathan
539 1.1 jonathan #endif
540 1.5 perry
541 1.1 jonathan DELAY(40);
542 1.1 jonathan }
543 1.1 jonathan
544 1.1 jonathan static void
545 1.1 jonathan rgephy_reset(struct mii_softc *sc)
546 1.1 jonathan {
547 1.1 jonathan mii_phy_reset(sc);
548 1.1 jonathan DELAY(1000);
549 1.1 jonathan
550 1.1 jonathan if (sc->mii_mpd_model < 2)
551 1.1 jonathan rgephy_load_dspcode(sc);
552 1.1 jonathan else {
553 1.1 jonathan PHY_WRITE(sc, 0x1F, 0x0001);
554 1.1 jonathan PHY_WRITE(sc, 0x09, 0x273a);
555 1.1 jonathan PHY_WRITE(sc, 0x0e, 0x7bfb);
556 1.1 jonathan PHY_WRITE(sc, 0x1b, 0x841e);
557 1.1 jonathan
558 1.1 jonathan PHY_WRITE(sc, 0x1F, 0x0002);
559 1.1 jonathan PHY_WRITE(sc, 0x01, 0x90D0);
560 1.1 jonathan PHY_WRITE(sc, 0x1F, 0x0000);
561 1.1 jonathan }
562 1.1 jonathan
563 1.1 jonathan /* Reset capabilities */
564 1.1 jonathan /* Step1: write our capability */
565 1.1 jonathan PHY_WRITE(sc, 0x04,0x01e1); /* 10/100 capability */
566 1.1 jonathan PHY_WRITE(sc, 0x09,0x0200); /* 1000 capability */
567 1.1 jonathan
568 1.1 jonathan #ifdef jrs_notyet
569 1.1 jonathan /* Step2: Restart NWay */
570 1.1 jonathan PHY_WRITE(sc, 0x00, 0x1200); // NWay enable and Restart NWay
571 1.1 jonathan #endif
572 1.1 jonathan }
573