iophy.c revision 1.37 1 1.37 msaitoh /* $NetBSD: iophy.c,v 1.37 2014/06/16 16:48:16 msaitoh Exp $ */
2 1.1 soren
3 1.1 soren /*
4 1.10 thorpej * Copyright (c) 1998, 1999, 2000 The NetBSD Foundation, Inc.
5 1.1 soren * All rights reserved.
6 1.1 soren *
7 1.1 soren * This code is derived from software contributed to The NetBSD Foundation
8 1.1 soren * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
9 1.1 soren * NASA Ames Research Center.
10 1.1 soren *
11 1.1 soren * Redistribution and use in source and binary forms, with or without
12 1.1 soren * modification, are permitted provided that the following conditions
13 1.1 soren * are met:
14 1.1 soren * 1. Redistributions of source code must retain the above copyright
15 1.1 soren * notice, this list of conditions and the following disclaimer.
16 1.1 soren * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 soren * notice, this list of conditions and the following disclaimer in the
18 1.1 soren * documentation and/or other materials provided with the distribution.
19 1.1 soren *
20 1.1 soren * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
21 1.1 soren * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 1.1 soren * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 1.1 soren * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
24 1.1 soren * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25 1.1 soren * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 1.1 soren * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 1.1 soren * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28 1.1 soren * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 1.1 soren * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 1.1 soren * POSSIBILITY OF SUCH DAMAGE.
31 1.1 soren */
32 1.1 soren
33 1.1 soren /*
34 1.1 soren * Copyright (c) 1997 Manuel Bouyer. All rights reserved.
35 1.1 soren *
36 1.1 soren * Redistribution and use in source and binary forms, with or without
37 1.1 soren * modification, are permitted provided that the following conditions
38 1.1 soren * are met:
39 1.1 soren * 1. Redistributions of source code must retain the above copyright
40 1.1 soren * notice, this list of conditions and the following disclaimer.
41 1.1 soren * 2. Redistributions in binary form must reproduce the above copyright
42 1.1 soren * notice, this list of conditions and the following disclaimer in the
43 1.1 soren * documentation and/or other materials provided with the distribution.
44 1.1 soren *
45 1.1 soren * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
46 1.1 soren * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
47 1.1 soren * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
48 1.1 soren * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
49 1.1 soren * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
50 1.1 soren * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
51 1.1 soren * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
52 1.1 soren * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
53 1.1 soren * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
54 1.1 soren * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
55 1.1 soren */
56 1.1 soren
57 1.1 soren /*
58 1.1 soren * Intel 82553 PHY driver
59 1.1 soren */
60 1.15 lukem
61 1.15 lukem #include <sys/cdefs.h>
62 1.37 msaitoh __KERNEL_RCSID(0, "$NetBSD: iophy.c,v 1.37 2014/06/16 16:48:16 msaitoh Exp $");
63 1.1 soren
64 1.1 soren #include <sys/param.h>
65 1.1 soren #include <sys/systm.h>
66 1.1 soren #include <sys/kernel.h>
67 1.1 soren #include <sys/device.h>
68 1.1 soren #include <sys/socket.h>
69 1.1 soren
70 1.1 soren #include <net/if.h>
71 1.1 soren #include <net/if_media.h>
72 1.1 soren
73 1.1 soren #include <dev/mii/mii.h>
74 1.1 soren #include <dev/mii/miivar.h>
75 1.1 soren #include <dev/mii/miidevs.h>
76 1.1 soren
77 1.1 soren #include <dev/mii/iophyreg.h>
78 1.1 soren
79 1.33 xtraeme static int iophymatch(device_t, cfdata_t, void *);
80 1.33 xtraeme static void iophyattach(device_t, device_t, void *);
81 1.1 soren
82 1.33 xtraeme CFATTACH_DECL_NEW(iophy, sizeof(struct mii_softc),
83 1.20 thorpej iophymatch, iophyattach, mii_phy_detach, mii_phy_activate);
84 1.1 soren
85 1.22 thorpej static int iophy_service(struct mii_softc *, struct mii_data *, int);
86 1.22 thorpej static void iophy_status(struct mii_softc *);
87 1.1 soren
88 1.22 thorpej static const struct mii_phy_funcs iophy_funcs = {
89 1.10 thorpej iophy_service, iophy_status, mii_phy_reset,
90 1.10 thorpej };
91 1.10 thorpej
92 1.22 thorpej static const struct mii_phydesc iophys[] = {
93 1.13 thorpej { MII_OUI_xxINTEL, MII_MODEL_xxINTEL_I82553,
94 1.13 thorpej MII_STR_xxINTEL_I82553 },
95 1.13 thorpej
96 1.13 thorpej { MII_OUI_yyINTEL, MII_MODEL_yyINTEL_I82553,
97 1.13 thorpej MII_STR_yyINTEL_I82553 },
98 1.13 thorpej
99 1.13 thorpej { 0, 0,
100 1.13 thorpej NULL },
101 1.13 thorpej };
102 1.13 thorpej
103 1.22 thorpej static int
104 1.33 xtraeme iophymatch(device_t parent, cfdata_t match, void *aux)
105 1.1 soren {
106 1.1 soren struct mii_attach_args *ma = aux;
107 1.1 soren
108 1.13 thorpej if (mii_phy_match(ma, iophys) != NULL)
109 1.1 soren return (10);
110 1.1 soren
111 1.1 soren return (0);
112 1.1 soren }
113 1.1 soren
114 1.22 thorpej static void
115 1.33 xtraeme iophyattach(device_t parent, device_t self, void *aux)
116 1.1 soren {
117 1.25 thorpej struct mii_softc *sc = device_private(self);
118 1.1 soren struct mii_attach_args *ma = aux;
119 1.1 soren struct mii_data *mii = ma->mii_data;
120 1.13 thorpej const struct mii_phydesc *mpd;
121 1.1 soren
122 1.13 thorpej mpd = mii_phy_match(ma, iophys);
123 1.21 thorpej aprint_naive(": Media interface\n");
124 1.21 thorpej aprint_normal(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
125 1.1 soren
126 1.33 xtraeme sc->mii_dev = self;
127 1.1 soren sc->mii_inst = mii->mii_instance;
128 1.1 soren sc->mii_phy = ma->mii_phyno;
129 1.10 thorpej sc->mii_funcs = &iophy_funcs;
130 1.1 soren sc->mii_pdata = mii;
131 1.16 thorpej sc->mii_flags = ma->mii_flags;
132 1.28 christos sc->mii_anegticks = MII_ANEGTICKS;
133 1.1 soren
134 1.10 thorpej PHY_RESET(sc);
135 1.1 soren
136 1.1 soren sc->mii_capabilities =
137 1.1 soren PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
138 1.33 xtraeme aprint_normal_dev(self, "");
139 1.1 soren if ((sc->mii_capabilities & BMSR_MEDIAMASK) == 0)
140 1.21 thorpej aprint_error("no media present");
141 1.1 soren else
142 1.5 thorpej mii_phy_add_media(sc);
143 1.21 thorpej aprint_normal("\n");
144 1.1 soren }
145 1.1 soren
146 1.22 thorpej static int
147 1.14 thorpej iophy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
148 1.1 soren {
149 1.1 soren struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
150 1.1 soren int reg;
151 1.4 thorpej
152 1.1 soren switch (cmd) {
153 1.1 soren case MII_POLLSTAT:
154 1.1 soren /*
155 1.1 soren * If we're not polling our PHY instance, just return.
156 1.1 soren */
157 1.1 soren if (IFM_INST(ife->ifm_media) != sc->mii_inst)
158 1.1 soren return (0);
159 1.1 soren break;
160 1.1 soren
161 1.1 soren case MII_MEDIACHG:
162 1.1 soren /*
163 1.1 soren * If the media indicates a different PHY instance,
164 1.1 soren * isolate ourselves.
165 1.1 soren */
166 1.1 soren if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
167 1.1 soren reg = PHY_READ(sc, MII_BMCR);
168 1.1 soren PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
169 1.1 soren return (0);
170 1.1 soren }
171 1.1 soren
172 1.1 soren /*
173 1.1 soren * If the interface is not up, don't do anything.
174 1.1 soren */
175 1.1 soren if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
176 1.1 soren break;
177 1.1 soren
178 1.8 thorpej mii_phy_setmedia(sc);
179 1.1 soren break;
180 1.1 soren
181 1.1 soren case MII_TICK:
182 1.1 soren /*
183 1.1 soren * If we're not currently selected, just return.
184 1.1 soren */
185 1.1 soren if (IFM_INST(ife->ifm_media) != sc->mii_inst)
186 1.1 soren return (0);
187 1.1 soren
188 1.9 thorpej if (mii_phy_tick(sc) == EJUSTRETURN)
189 1.1 soren return (0);
190 1.1 soren break;
191 1.3 thorpej
192 1.3 thorpej case MII_DOWN:
193 1.3 thorpej mii_phy_down(sc);
194 1.3 thorpej return (0);
195 1.1 soren }
196 1.1 soren
197 1.1 soren /* Update the media status. */
198 1.7 thorpej mii_phy_status(sc);
199 1.1 soren
200 1.1 soren /* Callback if something changed. */
201 1.9 thorpej mii_phy_update(sc, cmd);
202 1.1 soren return (0);
203 1.1 soren }
204 1.1 soren
205 1.22 thorpej static void
206 1.14 thorpej iophy_status(struct mii_softc *sc)
207 1.1 soren {
208 1.1 soren struct mii_data *mii = sc->mii_pdata;
209 1.2 thorpej struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
210 1.1 soren int bmsr, bmcr, ext0;
211 1.1 soren
212 1.1 soren mii->mii_media_status = IFM_AVALID;
213 1.1 soren mii->mii_media_active = IFM_ETHER;
214 1.1 soren
215 1.1 soren bmsr = PHY_READ(sc, MII_BMSR) |
216 1.1 soren PHY_READ(sc, MII_BMSR);
217 1.1 soren if (bmsr & BMSR_LINK)
218 1.1 soren mii->mii_media_status |= IFM_ACTIVE;
219 1.1 soren
220 1.1 soren bmcr = PHY_READ(sc, MII_BMCR);
221 1.1 soren if (bmcr & BMCR_ISO) {
222 1.1 soren mii->mii_media_active |= IFM_NONE;
223 1.1 soren mii->mii_media_status = 0;
224 1.1 soren return;
225 1.1 soren }
226 1.1 soren
227 1.1 soren if (bmcr & BMCR_LOOP)
228 1.1 soren mii->mii_media_active |= IFM_LOOP;
229 1.1 soren
230 1.1 soren if (bmcr & BMCR_AUTOEN) {
231 1.1 soren if ((bmsr & BMSR_ACOMP) == 0) {
232 1.1 soren /* Erg, still trying, I guess... */
233 1.1 soren mii->mii_media_active |= IFM_NONE;
234 1.1 soren return;
235 1.1 soren }
236 1.1 soren ext0 = PHY_READ(sc, MII_IOPHY_EXT0);
237 1.1 soren
238 1.35 cegger if (ext0 & EXT0_SPEED) {
239 1.35 cegger if ((bmsr & BMSR_100TXFDX) || (bmsr & BMSR_100TXHDX)) {
240 1.35 cegger mii->mii_media_active |= IFM_100_TX;
241 1.35 cegger } else if (bmsr & BMSR_100T4) {
242 1.1 soren mii->mii_media_active |= IFM_100_T4;
243 1.1 soren }
244 1.35 cegger } else
245 1.1 soren mii->mii_media_active |= IFM_10_T;
246 1.1 soren
247 1.1 soren if (ext0 & EXT0_DUPLEX)
248 1.1 soren mii->mii_media_active |= IFM_FDX;
249 1.37 msaitoh else
250 1.37 msaitoh mii->mii_media_active |= IFM_HDX;
251 1.1 soren } else
252 1.2 thorpej mii->mii_media_active = ife->ifm_media;
253 1.1 soren }
254