micphy.c revision 1.13 1 1.13 thorpej /* $NetBSD: micphy.c,v 1.13 2020/03/15 23:04:50 thorpej Exp $ */
2 1.1 ozaki
3 1.1 ozaki /*-
4 1.1 ozaki * Copyright (c) 1998, 1999, 2000 The NetBSD Foundation, Inc.
5 1.1 ozaki * All rights reserved.
6 1.1 ozaki *
7 1.1 ozaki * This code is derived from software contributed to The NetBSD Foundation
8 1.1 ozaki * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
9 1.1 ozaki * NASA Ames Research Center, and by Frank van der Linden.
10 1.1 ozaki *
11 1.1 ozaki * Redistribution and use in source and binary forms, with or without
12 1.1 ozaki * modification, are permitted provided that the following conditions
13 1.1 ozaki * are met:
14 1.1 ozaki * 1. Redistributions of source code must retain the above copyright
15 1.1 ozaki * notice, this list of conditions and the following disclaimer.
16 1.1 ozaki * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 ozaki * notice, this list of conditions and the following disclaimer in the
18 1.1 ozaki * documentation and/or other materials provided with the distribution.
19 1.1 ozaki *
20 1.1 ozaki * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
21 1.1 ozaki * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 1.1 ozaki * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 1.1 ozaki * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
24 1.1 ozaki * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25 1.1 ozaki * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 1.1 ozaki * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 1.1 ozaki * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28 1.1 ozaki * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 1.1 ozaki * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 1.1 ozaki * POSSIBILITY OF SUCH DAMAGE.
31 1.1 ozaki */
32 1.1 ozaki
33 1.1 ozaki /*
34 1.1 ozaki * Copyright (c) 1997 Manuel Bouyer. All rights reserved.
35 1.1 ozaki *
36 1.1 ozaki * Redistribution and use in source and binary forms, with or without
37 1.1 ozaki * modification, are permitted provided that the following conditions
38 1.1 ozaki * are met:
39 1.1 ozaki * 1. Redistributions of source code must retain the above copyright
40 1.1 ozaki * notice, this list of conditions and the following disclaimer.
41 1.1 ozaki * 2. Redistributions in binary form must reproduce the above copyright
42 1.1 ozaki * notice, this list of conditions and the following disclaimer in the
43 1.1 ozaki * documentation and/or other materials provided with the distribution.
44 1.1 ozaki *
45 1.1 ozaki * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
46 1.1 ozaki * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
47 1.1 ozaki * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
48 1.1 ozaki * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
49 1.1 ozaki * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
50 1.1 ozaki * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
51 1.1 ozaki * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
52 1.1 ozaki * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
53 1.1 ozaki * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
54 1.1 ozaki * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
55 1.1 ozaki */
56 1.1 ozaki
57 1.1 ozaki /*
58 1.9 msaitoh * Driver for Micrel KSZ8xxx 10/100 and KSZ9xxx 10/100/1000 PHY.
59 1.1 ozaki */
60 1.1 ozaki
61 1.1 ozaki #include <sys/cdefs.h>
62 1.13 thorpej __KERNEL_RCSID(0, "$NetBSD: micphy.c,v 1.13 2020/03/15 23:04:50 thorpej Exp $");
63 1.1 ozaki
64 1.1 ozaki #include "opt_mii.h"
65 1.1 ozaki
66 1.1 ozaki #include <sys/param.h>
67 1.1 ozaki #include <sys/systm.h>
68 1.1 ozaki #include <sys/kernel.h>
69 1.1 ozaki #include <sys/device.h>
70 1.1 ozaki #include <sys/socket.h>
71 1.1 ozaki #include <sys/errno.h>
72 1.1 ozaki
73 1.1 ozaki #include <net/if.h>
74 1.1 ozaki #include <net/if_media.h>
75 1.1 ozaki
76 1.1 ozaki #include <dev/mii/mii.h>
77 1.1 ozaki #include <dev/mii/miivar.h>
78 1.1 ozaki #include <dev/mii/miidevs.h>
79 1.1 ozaki
80 1.1 ozaki static int micphymatch(device_t, cfdata_t, void *);
81 1.1 ozaki static void micphyattach(device_t, device_t, void *);
82 1.6 msaitoh static void micphy_reset(struct mii_softc *);
83 1.6 msaitoh static int micphy_service(struct mii_softc *, struct mii_data *, int);
84 1.1 ozaki
85 1.1 ozaki CFATTACH_DECL3_NEW(micphy, sizeof(struct mii_softc),
86 1.1 ozaki micphymatch, micphyattach, mii_phy_detach, mii_phy_activate, NULL, NULL,
87 1.1 ozaki DVF_DETACH_SHUTDOWN);
88 1.1 ozaki
89 1.1 ozaki static int micphy_service(struct mii_softc *, struct mii_data *, int);
90 1.9 msaitoh static void micphy_status(struct mii_softc *);
91 1.1 ozaki static void micphy_fixup(struct mii_softc *, int, int, device_t);
92 1.1 ozaki
93 1.1 ozaki static const struct mii_phy_funcs micphy_funcs = {
94 1.9 msaitoh micphy_service, micphy_status, micphy_reset,
95 1.9 msaitoh };
96 1.9 msaitoh
97 1.9 msaitoh struct micphy_softc {
98 1.9 msaitoh struct mii_softc sc_mii;
99 1.9 msaitoh uint32_t sc_lstype; /* Type of link status register */
100 1.1 ozaki };
101 1.1 ozaki
102 1.1 ozaki static const struct mii_phydesc micphys[] = {
103 1.9 msaitoh MII_PHY_DESC(MICREL, KSZ8041),
104 1.9 msaitoh MII_PHY_DESC(MICREL, KSZ8051), /* +8021,8031 */
105 1.9 msaitoh MII_PHY_DESC(MICREL, KSZ8061),
106 1.9 msaitoh MII_PHY_DESC(MICREL, KSZ8081), /* +8051,8091 */
107 1.9 msaitoh MII_PHY_DESC(MICREL, KS8737),
108 1.9 msaitoh MII_PHY_DESC(MICREL, KSZ9021_8001_8721),
109 1.9 msaitoh MII_PHY_DESC(MICREL, KSZ9031),
110 1.9 msaitoh MII_PHY_DESC(MICREL, KSZ9131),
111 1.9 msaitoh MII_PHY_DESC(MICREL, KSZ9477), /* +LAN7430internal */
112 1.7 christos MII_PHY_END,
113 1.1 ozaki };
114 1.1 ozaki
115 1.9 msaitoh /*
116 1.11 msaitoh * Model Rev. Media LSTYPE Devices
117 1.9 msaitoh *
118 1.9 msaitoh * 0x11 100 1F_42 KSZ8041
119 1.9 msaitoh * 0x13 100 1F_42? KSZ8041RNLI
120 1.9 msaitoh * 0x15 ? 100 1E_20 KSZ8051
121 1.9 msaitoh * 0x5 100 1E_20 KSZ8021
122 1.9 msaitoh * 0x6 100 1E_20 KSZ8031
123 1.9 msaitoh * 0x16 ? 100 1E_20 KSZ8081
124 1.9 msaitoh * ? 100 1E_20 KSZ8091
125 1.9 msaitoh * 0x17 100 1E_20 KSZ8061
126 1.9 msaitoh * 0x21 0x0 giga GIGA KSZ9021
127 1.9 msaitoh * 0x1 giga GIGA KSZ9021RLRN
128 1.9 msaitoh * 0x9 100 1F_42 KSZ8721BL/SL
129 1.9 msaitoh * 0x9 100 none? KSZ8721CL
130 1.9 msaitoh * 0xa 100 1F_42 KSZ8001
131 1.9 msaitoh * 0x22 giga GIGA KSZ9031
132 1.11 msaitoh * 0x23 1? gigasw GIGA KSZ9477 (No master/slave bit)
133 1.9 msaitoh * 5? giga GIGA LAN7430internal
134 1.11 msaitoh * 0x24 giga GIGA KSZ9131
135 1.11 msaitoh * 0x32 100 1F_42 KS8737
136 1.9 msaitoh */
137 1.9 msaitoh
138 1.9 msaitoh /* Type of link status register */
139 1.9 msaitoh #define MICPHYF_LSTYPE_DEFAULT 0
140 1.9 msaitoh #define MICPHYF_LSTYPE_1F_42 1
141 1.9 msaitoh #define MICPHYF_LSTYPE_1E_20 2
142 1.9 msaitoh #define MICPHYF_LSTYPE_GIGA 3
143 1.9 msaitoh
144 1.9 msaitoh /* Return if the device is Gigabit (KSZ9021) */
145 1.9 msaitoh #define KSZ_MODEL21H_GIGA(rev) \
146 1.9 msaitoh ((((rev) & 0x0e) == 0) ? true : false)
147 1.9 msaitoh
148 1.9 msaitoh #define KSZ_XREG_CONTROL 0x0b
149 1.9 msaitoh #define KSZ_XREG_WRITE 0x0c
150 1.9 msaitoh #define KSZ_XREG_READ 0x0d
151 1.9 msaitoh #define KSZ_XREG_CTL_SEL_READ 0x0000
152 1.9 msaitoh #define KSZ_XREG_CTL_SEL_WRITE 0x8000
153 1.9 msaitoh
154 1.9 msaitoh #define REG_RGMII_CLOCK_AND_CONTROL 0x104
155 1.9 msaitoh #define REG_RGMII_RX_DATA 0x105
156 1.9 msaitoh
157 1.9 msaitoh /* PHY control 1 register for 10/100 PHYs (KSZ80[235689]1) */
158 1.9 msaitoh #define KSZ8051_PHYCTL1 0x1e
159 1.9 msaitoh #define KSZ8051_PHY_LINK 0x0100
160 1.9 msaitoh #define KSZ8051_PHY_MDIX 0x0020
161 1.9 msaitoh #define KSZ8051_PHY_FDX 0x0004
162 1.9 msaitoh #define KSZ8051_PHY_SPD_MASK 0x0003
163 1.9 msaitoh #define KSZ8051_PHY_SPD_10T 0x0001
164 1.9 msaitoh #define KSZ8051_PHY_SPD_100TX 0x0002
165 1.9 msaitoh
166 1.9 msaitoh /* PHY control 2 register for 10/100 PHYs (KSZ8041, KSZ8721 and KSZ8001) */
167 1.9 msaitoh #define KSZ8041_PHYCTL2 0x1f
168 1.9 msaitoh #define KSZ8041_PHY_ACOMP 0x0080
169 1.9 msaitoh #define KSZ8041_PHY_SPD_MASK 0x001c
170 1.9 msaitoh #define KSZ8041_PHY_SPD_10T 0x0004
171 1.9 msaitoh #define KSZ8041_PHY_SPD_100TX 0x0008
172 1.9 msaitoh #define KSZ8041_PHY_FDX 0x0010
173 1.9 msaitoh #define KSZ8051_PHYCTL2 0x1f
174 1.9 msaitoh
175 1.9 msaitoh /* PHY control register for Gigabit PHYs */
176 1.9 msaitoh #define KSZ_GPHYCTL 0x1f
177 1.9 msaitoh #define KSZ_GPHY_SPD_1000T 0x0040
178 1.9 msaitoh #define KSZ_GPHY_SPD_100TX 0x0020
179 1.9 msaitoh #define KSZ_GPHY_SPD_10T 0x0010
180 1.9 msaitoh #define KSZ_GPHY_FDX 0x0008
181 1.9 msaitoh #define KSZ_GPHY_1000T_MS 0x0004
182 1.6 msaitoh
183 1.1 ozaki static int
184 1.1 ozaki micphymatch(device_t parent, cfdata_t match, void *aux)
185 1.1 ozaki {
186 1.1 ozaki struct mii_attach_args *ma = aux;
187 1.1 ozaki
188 1.1 ozaki if (mii_phy_match(ma, micphys) != NULL)
189 1.1 ozaki return 10;
190 1.1 ozaki
191 1.1 ozaki return 1;
192 1.1 ozaki }
193 1.1 ozaki
194 1.1 ozaki static void
195 1.1 ozaki micphyattach(device_t parent, device_t self, void *aux)
196 1.1 ozaki {
197 1.9 msaitoh struct micphy_softc *msc = device_private(self);
198 1.9 msaitoh struct mii_softc *sc = &msc->sc_mii;
199 1.1 ozaki struct mii_attach_args *ma = aux;
200 1.1 ozaki struct mii_data *mii = ma->mii_data;
201 1.1 ozaki int model = MII_MODEL(ma->mii_id2);
202 1.1 ozaki int rev = MII_REV(ma->mii_id2);
203 1.1 ozaki const struct mii_phydesc *mpd;
204 1.1 ozaki
205 1.1 ozaki mpd = mii_phy_match(ma, micphys);
206 1.1 ozaki aprint_naive(": Media interface\n");
207 1.1 ozaki aprint_normal(": %s, rev. %d\n", mpd->mpd_name, rev);
208 1.1 ozaki
209 1.1 ozaki sc->mii_dev = self;
210 1.1 ozaki sc->mii_inst = mii->mii_instance;
211 1.1 ozaki sc->mii_phy = ma->mii_phyno;
212 1.1 ozaki sc->mii_funcs = &micphy_funcs;
213 1.1 ozaki sc->mii_pdata = mii;
214 1.1 ozaki sc->mii_flags = ma->mii_flags;
215 1.1 ozaki
216 1.9 msaitoh if ((sc->mii_mpd_model == MII_MODEL_MICREL_KSZ8041)
217 1.9 msaitoh || (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ8041RNLI)
218 1.9 msaitoh || (sc->mii_mpd_model == MII_MODEL_MICREL_KS8737)
219 1.9 msaitoh || ((sc->mii_mpd_model == MII_MODEL_MICREL_KSZ9021_8001_8721)
220 1.9 msaitoh && !KSZ_MODEL21H_GIGA(sc->mii_mpd_rev))) {
221 1.9 msaitoh msc->sc_lstype = MICPHYF_LSTYPE_1F_42;
222 1.9 msaitoh } else if ((sc->mii_mpd_model == MII_MODEL_MICREL_KSZ8051)
223 1.9 msaitoh || (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ8081)
224 1.9 msaitoh || (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ8061)) {
225 1.9 msaitoh msc->sc_lstype = MICPHYF_LSTYPE_1E_20;
226 1.9 msaitoh } else if (((sc->mii_mpd_model == MII_MODEL_MICREL_KSZ9021_8001_8721)
227 1.9 msaitoh && KSZ_MODEL21H_GIGA(sc->mii_mpd_rev))
228 1.9 msaitoh || (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ9031)
229 1.9 msaitoh || (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ9477)
230 1.9 msaitoh || (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ9131)) {
231 1.9 msaitoh msc->sc_lstype = MICPHYF_LSTYPE_GIGA;
232 1.9 msaitoh } else
233 1.9 msaitoh msc->sc_lstype = MICPHYF_LSTYPE_DEFAULT;
234 1.9 msaitoh
235 1.13 thorpej mii_lock(mii);
236 1.13 thorpej
237 1.1 ozaki PHY_RESET(sc);
238 1.1 ozaki
239 1.1 ozaki micphy_fixup(sc, model, rev, parent);
240 1.1 ozaki
241 1.5 skrll PHY_READ(sc, MII_BMSR, &sc->mii_capabilities);
242 1.5 skrll sc->mii_capabilities &= ma->mii_capmask;
243 1.1 ozaki if (sc->mii_capabilities & BMSR_EXTSTAT)
244 1.5 skrll PHY_READ(sc, MII_EXTSR, &sc->mii_extcapabilities);
245 1.10 msaitoh
246 1.13 thorpej mii_unlock(mii);
247 1.13 thorpej
248 1.12 nisimura aprint_normal_dev(self, "");
249 1.10 msaitoh mii_phy_add_media(sc);
250 1.12 nisimura aprint_normal("\n");
251 1.1 ozaki }
252 1.1 ozaki
253 1.6 msaitoh static void
254 1.6 msaitoh micphy_reset(struct mii_softc *sc)
255 1.6 msaitoh {
256 1.6 msaitoh uint16_t reg;
257 1.6 msaitoh
258 1.13 thorpej KASSERT(mii_locked(sc->mii_pdata));
259 1.13 thorpej
260 1.6 msaitoh /*
261 1.8 msaitoh * The 8081 has no "sticky bits" that survive a soft reset; several
262 1.8 msaitoh * bits in the Phy Control Register 2 must be preserved across the
263 1.8 msaitoh * reset. These bits are set up by the bootloader; they control how the
264 1.8 msaitoh * phy interfaces to the board (such as clock frequency and LED
265 1.8 msaitoh * behavior).
266 1.6 msaitoh */
267 1.6 msaitoh if (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ8081)
268 1.9 msaitoh PHY_READ(sc, KSZ8051_PHYCTL2, ®);
269 1.6 msaitoh mii_phy_reset(sc);
270 1.6 msaitoh if (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ8081)
271 1.9 msaitoh PHY_WRITE(sc, KSZ8051_PHYCTL2, reg);
272 1.6 msaitoh }
273 1.6 msaitoh
274 1.1 ozaki static int
275 1.1 ozaki micphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
276 1.1 ozaki {
277 1.1 ozaki struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
278 1.5 skrll uint16_t reg;
279 1.1 ozaki
280 1.13 thorpej KASSERT(mii_locked(mii));
281 1.13 thorpej
282 1.1 ozaki switch (cmd) {
283 1.1 ozaki case MII_POLLSTAT:
284 1.8 msaitoh /* If we're not polling our PHY instance, just return. */
285 1.1 ozaki if (IFM_INST(ife->ifm_media) != sc->mii_inst)
286 1.1 ozaki return 0;
287 1.1 ozaki break;
288 1.1 ozaki
289 1.1 ozaki case MII_MEDIACHG:
290 1.1 ozaki /*
291 1.1 ozaki * If the media indicates a different PHY instance,
292 1.1 ozaki * isolate ourselves.
293 1.1 ozaki */
294 1.1 ozaki if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
295 1.5 skrll PHY_READ(sc, MII_BMCR, ®);
296 1.1 ozaki PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
297 1.1 ozaki return 0;
298 1.1 ozaki }
299 1.1 ozaki
300 1.8 msaitoh /* If the interface is not up, don't do anything. */
301 1.1 ozaki if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
302 1.1 ozaki break;
303 1.1 ozaki
304 1.1 ozaki mii_phy_setmedia(sc);
305 1.1 ozaki break;
306 1.1 ozaki
307 1.1 ozaki case MII_TICK:
308 1.8 msaitoh /* If we're not currently selected, just return. */
309 1.1 ozaki if (IFM_INST(ife->ifm_media) != sc->mii_inst)
310 1.1 ozaki return 0;
311 1.1 ozaki
312 1.1 ozaki if (mii_phy_tick(sc) == EJUSTRETURN)
313 1.1 ozaki return 0;
314 1.1 ozaki break;
315 1.1 ozaki
316 1.1 ozaki case MII_DOWN:
317 1.1 ozaki mii_phy_down(sc);
318 1.1 ozaki return 0;
319 1.1 ozaki }
320 1.1 ozaki
321 1.1 ozaki /* Update the media status. */
322 1.1 ozaki mii_phy_status(sc);
323 1.1 ozaki
324 1.1 ozaki /* Callback if something changed. */
325 1.1 ozaki mii_phy_update(sc, cmd);
326 1.1 ozaki return 0;
327 1.1 ozaki }
328 1.1 ozaki
329 1.8 msaitoh static void
330 1.8 msaitoh micphy_writexreg(struct mii_softc *sc, uint32_t reg, uint32_t wval)
331 1.1 ozaki {
332 1.5 skrll uint16_t rval __debugused;
333 1.1 ozaki
334 1.9 msaitoh PHY_WRITE(sc, KSZ_XREG_CONTROL, KSZ_XREG_CTL_SEL_WRITE | reg);
335 1.9 msaitoh PHY_WRITE(sc, KSZ_XREG_WRITE, wval);
336 1.9 msaitoh PHY_WRITE(sc, KSZ_XREG_CONTROL, KSZ_XREG_CTL_SEL_READ | reg);
337 1.9 msaitoh PHY_READ(sc, KSZ_XREG_READ, &rval);
338 1.1 ozaki KDASSERT(wval == rval);
339 1.1 ozaki }
340 1.1 ozaki
341 1.1 ozaki static void
342 1.1 ozaki micphy_fixup(struct mii_softc *sc, int model, int rev, device_t parent)
343 1.1 ozaki {
344 1.13 thorpej
345 1.13 thorpej KASSERT(mii_locked(sc->mii_pdata));
346 1.13 thorpej
347 1.1 ozaki switch (model) {
348 1.9 msaitoh case MII_MODEL_MICREL_KSZ9021_8001_8721:
349 1.1 ozaki if (!device_is_a(parent, "cpsw"))
350 1.1 ozaki break;
351 1.1 ozaki
352 1.8 msaitoh aprint_normal_dev(sc->mii_dev,
353 1.8 msaitoh "adjusting RGMII signal timing for cpsw\n");
354 1.1 ozaki
355 1.1 ozaki // RGMII RX Data Pad Skew
356 1.1 ozaki micphy_writexreg(sc, REG_RGMII_RX_DATA, 0x0000);
357 1.1 ozaki
358 1.1 ozaki // RGMII Clock and Control Pad Skew
359 1.1 ozaki micphy_writexreg(sc, REG_RGMII_CLOCK_AND_CONTROL, 0x9090);
360 1.1 ozaki
361 1.1 ozaki break;
362 1.8 msaitoh default:
363 1.8 msaitoh break;
364 1.1 ozaki }
365 1.1 ozaki
366 1.1 ozaki return;
367 1.1 ozaki }
368 1.9 msaitoh
369 1.9 msaitoh static void
370 1.9 msaitoh micphy_status(struct mii_softc *sc)
371 1.9 msaitoh {
372 1.9 msaitoh struct micphy_softc *msc = device_private(sc->mii_dev);
373 1.9 msaitoh struct mii_data *mii = sc->mii_pdata;
374 1.9 msaitoh uint16_t bmsr, bmcr, sr;
375 1.9 msaitoh
376 1.13 thorpej KASSERT(mii_locked(mii));
377 1.13 thorpej
378 1.9 msaitoh /* For unknown devices */
379 1.9 msaitoh if (msc->sc_lstype == MICPHYF_LSTYPE_DEFAULT) {
380 1.9 msaitoh ukphy_status(sc);
381 1.9 msaitoh return;
382 1.9 msaitoh }
383 1.9 msaitoh
384 1.9 msaitoh mii->mii_media_status = IFM_AVALID;
385 1.9 msaitoh mii->mii_media_active = IFM_ETHER;
386 1.9 msaitoh
387 1.9 msaitoh PHY_READ(sc, MII_BMCR, &bmcr);
388 1.9 msaitoh
389 1.9 msaitoh PHY_READ(sc, MII_BMSR, &bmsr);
390 1.9 msaitoh PHY_READ(sc, MII_BMSR, &bmsr);
391 1.9 msaitoh if (bmsr & BMSR_LINK)
392 1.9 msaitoh mii->mii_media_status |= IFM_ACTIVE;
393 1.9 msaitoh
394 1.9 msaitoh if (bmcr & BMCR_AUTOEN) {
395 1.9 msaitoh if ((bmsr & BMSR_ACOMP) == 0) {
396 1.9 msaitoh mii->mii_media_active |= IFM_NONE;
397 1.9 msaitoh return;
398 1.9 msaitoh }
399 1.9 msaitoh }
400 1.9 msaitoh
401 1.9 msaitoh if (msc->sc_lstype == MICPHYF_LSTYPE_1F_42) {
402 1.9 msaitoh PHY_READ(sc, KSZ8041_PHYCTL2, &sr);
403 1.9 msaitoh if ((sr & KSZ8041_PHY_SPD_MASK) == 0)
404 1.9 msaitoh mii->mii_media_active |= IFM_NONE;
405 1.9 msaitoh else if (sr & KSZ8041_PHY_SPD_100TX)
406 1.9 msaitoh mii->mii_media_active |= IFM_100_TX;
407 1.9 msaitoh else if (sr & KSZ8041_PHY_SPD_10T)
408 1.9 msaitoh mii->mii_media_active |= IFM_10_T;
409 1.9 msaitoh if (sr & KSZ8041_PHY_FDX)
410 1.9 msaitoh mii->mii_media_active |= IFM_FDX
411 1.9 msaitoh | mii_phy_flowstatus(sc);
412 1.9 msaitoh } else if (msc->sc_lstype == MICPHYF_LSTYPE_1E_20) {
413 1.9 msaitoh PHY_READ(sc, KSZ8051_PHYCTL1, &sr);
414 1.9 msaitoh if ((sr & KSZ8051_PHY_SPD_MASK) == 0)
415 1.9 msaitoh mii->mii_media_active |= IFM_NONE;
416 1.9 msaitoh else if (sr & KSZ8051_PHY_SPD_100TX)
417 1.9 msaitoh mii->mii_media_active |= IFM_100_TX;
418 1.9 msaitoh else if (sr & KSZ8051_PHY_SPD_10T)
419 1.9 msaitoh mii->mii_media_active |= IFM_10_T;
420 1.9 msaitoh if (sr & KSZ8051_PHY_FDX)
421 1.9 msaitoh mii->mii_media_active |= IFM_FDX
422 1.9 msaitoh | mii_phy_flowstatus(sc);
423 1.9 msaitoh } else if (msc->sc_lstype == MICPHYF_LSTYPE_GIGA) {
424 1.9 msaitoh /* 9021/9031/7430/9131 gphy */
425 1.9 msaitoh PHY_READ(sc, KSZ_GPHYCTL, &sr);
426 1.9 msaitoh if (sr & KSZ_GPHY_SPD_1000T)
427 1.9 msaitoh mii->mii_media_active |= IFM_1000_T;
428 1.9 msaitoh else if (sr & KSZ_GPHY_SPD_100TX)
429 1.9 msaitoh mii->mii_media_active |= IFM_100_TX;
430 1.9 msaitoh else if (sr & KSZ_GPHY_SPD_10T)
431 1.9 msaitoh mii->mii_media_active |= IFM_10_T;
432 1.9 msaitoh else
433 1.9 msaitoh mii->mii_media_active |= IFM_NONE;
434 1.9 msaitoh if ((mii->mii_media_active & IFM_1000_T)
435 1.9 msaitoh && (sr & KSZ_GPHY_1000T_MS))
436 1.9 msaitoh mii->mii_media_active |= IFM_ETH_MASTER;
437 1.9 msaitoh if (sr & KSZ_GPHY_FDX)
438 1.9 msaitoh mii->mii_media_active |= IFM_FDX
439 1.9 msaitoh | mii_phy_flowstatus(sc);
440 1.9 msaitoh else
441 1.9 msaitoh mii->mii_media_active |= IFM_HDX;
442 1.9 msaitoh }
443 1.9 msaitoh }
444