This source file includes following definitions.
- iophymatch
- iophyattach
- iophy_service
- iophy_status
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74 #include <sys/param.h>
75 #include <sys/systm.h>
76 #include <sys/kernel.h>
77 #include <sys/device.h>
78 #include <sys/socket.h>
79
80 #include <net/if.h>
81 #include <net/if_media.h>
82
83 #include <dev/mii/mii.h>
84 #include <dev/mii/miivar.h>
85 #include <dev/mii/miidevs.h>
86
87 #include <dev/mii/iophyreg.h>
88
89 int iophymatch(struct device *, void *, void *);
90 void iophyattach(struct device *, struct device *, void *);
91
92 struct cfattach iophy_ca = {
93 sizeof(struct mii_softc), iophymatch, iophyattach, mii_phy_detach,
94 mii_phy_activate
95 };
96
97 struct cfdriver iophy_cd = {
98 NULL, "iophy", DV_DULL
99 };
100
101 int iophy_service(struct mii_softc *, struct mii_data *, int);
102 void iophy_status(struct mii_softc *);
103
104 const struct mii_phy_funcs iophy_funcs = {
105 iophy_service, iophy_status, mii_phy_reset,
106 };
107
108 static const struct mii_phydesc iophys[] = {
109 { MII_OUI_xxINTEL, MII_MODEL_xxINTEL_I82553,
110 MII_STR_xxINTEL_I82553 },
111 { MII_OUI_INTEL, MII_MODEL_INTEL_I82553,
112 MII_STR_INTEL_I82553 },
113
114 { 0, 0,
115 NULL },
116
117 };
118
119 int
120 iophymatch(parent, match, aux)
121 struct device *parent;
122 void *match;
123 void *aux;
124 {
125 struct mii_attach_args *ma = aux;
126
127 if (mii_phy_match(ma, iophys) != NULL)
128 return (10);
129
130 return (0);
131 }
132
133 void
134 iophyattach(parent, self, aux)
135 struct device *parent, *self;
136 void *aux;
137 {
138 struct mii_softc *sc = (struct mii_softc *)self;
139 struct mii_attach_args *ma = aux;
140 struct mii_data *mii = ma->mii_data;
141 const struct mii_phydesc *mpd;
142
143 mpd = mii_phy_match(ma, iophys);
144 printf(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
145
146 sc->mii_inst = mii->mii_instance;
147 sc->mii_phy = ma->mii_phyno;
148 sc->mii_funcs = &iophy_funcs;
149 sc->mii_pdata = mii;
150 sc->mii_flags = ma->mii_flags;
151
152 PHY_RESET(sc);
153
154 sc->mii_capabilities =
155 PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
156 if (sc->mii_capabilities & BMSR_MEDIAMASK)
157 mii_phy_add_media(sc);
158 }
159
160 int
161 iophy_service(sc, mii, cmd)
162 struct mii_softc *sc;
163 struct mii_data *mii;
164 int cmd;
165 {
166 struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
167 int reg;
168
169 if ((sc->mii_dev.dv_flags & DVF_ACTIVE) == 0)
170 return (ENXIO);
171
172 switch (cmd) {
173 case MII_POLLSTAT:
174
175
176
177 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
178 return (0);
179 break;
180
181 case MII_MEDIACHG:
182
183
184
185
186 if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
187 reg = PHY_READ(sc, MII_BMCR);
188 PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
189 return (0);
190 }
191
192
193
194
195 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
196 break;
197
198 mii_phy_setmedia(sc);
199 break;
200
201 case MII_TICK:
202
203
204
205 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
206 return (0);
207
208 if (mii_phy_tick(sc) == EJUSTRETURN)
209 return (0);
210 break;
211
212 case MII_DOWN:
213 mii_phy_down(sc);
214 return (0);
215 }
216
217
218 mii_phy_status(sc);
219
220
221 mii_phy_update(sc, cmd);
222 return (0);
223 }
224
225 void
226 iophy_status(sc)
227 struct mii_softc *sc;
228 {
229 struct mii_data *mii = sc->mii_pdata;
230 struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
231 int bmsr, bmcr, ext0;
232
233 mii->mii_media_status = IFM_AVALID;
234 mii->mii_media_active = IFM_ETHER;
235
236 bmsr = PHY_READ(sc, MII_BMSR) |
237 PHY_READ(sc, MII_BMSR);
238 if (bmsr & BMSR_LINK)
239 mii->mii_media_status |= IFM_ACTIVE;
240
241 bmcr = PHY_READ(sc, MII_BMCR);
242 if (bmcr & BMCR_ISO) {
243 mii->mii_media_active |= IFM_NONE;
244 mii->mii_media_status = 0;
245 return;
246 }
247
248 if (bmcr & BMCR_LOOP)
249 mii->mii_media_active |= IFM_LOOP;
250
251 if (bmcr & BMCR_AUTOEN) {
252 if ((bmsr & BMSR_ACOMP) == 0) {
253
254 mii->mii_media_active |= IFM_NONE;
255 return;
256 }
257
258 ext0 = PHY_READ(sc, MII_IOPHY_EXT0);
259 if (ext0 & EXT0_SPEED) {
260 if (bmsr & BMSR_100T4) {
261 mii->mii_media_active |= IFM_100_T4;
262 return;
263 } else
264 mii->mii_media_active |= IFM_100_TX;
265 } else
266 mii->mii_media_active |= IFM_10_T;
267
268 if (ext0 & EXT0_DUPLEX)
269 mii->mii_media_active |= IFM_FDX;
270 else
271 mii->mii_media_active |= IFM_HDX;
272 } else
273 mii->mii_media_active = ife->ifm_media;
274 }