This source file includes following definitions.
- inphymatch
- inphyattach
- inphy_service
- inphy_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
75 #include <sys/param.h>
76 #include <sys/systm.h>
77 #include <sys/kernel.h>
78 #include <sys/device.h>
79 #include <sys/socket.h>
80 #include <sys/errno.h>
81
82 #include <net/if.h>
83 #include <net/if_media.h>
84
85 #include <dev/mii/mii.h>
86 #include <dev/mii/miivar.h>
87 #include <dev/mii/miidevs.h>
88
89 #include <dev/mii/inphyreg.h>
90
91 int inphymatch(struct device *, void *, void *);
92 void inphyattach(struct device *, struct device *, void *);
93
94 struct cfattach inphy_ca = {
95 sizeof(struct mii_softc), inphymatch, inphyattach, mii_phy_detach,
96 mii_phy_activate
97 };
98
99 struct cfdriver inphy_cd = {
100 NULL, "inphy", DV_DULL
101 };
102
103 int inphy_service(struct mii_softc *, struct mii_data *, int);
104 void inphy_status(struct mii_softc *);
105
106 const struct mii_phy_funcs inphy_funcs = {
107 inphy_service, inphy_status, mii_phy_reset,
108 };
109
110 static const struct mii_phydesc inphys[] = {
111 { MII_OUI_INTEL, MII_MODEL_INTEL_I82555,
112 MII_STR_INTEL_I82555 },
113 { MII_OUI_INTEL, MII_MODEL_INTEL_I82562EM,
114 MII_STR_INTEL_I82562EM },
115 { MII_OUI_INTEL, MII_MODEL_INTEL_I82562ET,
116 MII_STR_INTEL_I82562ET },
117
118 { 0, 0,
119 NULL },
120 };
121
122 int
123 inphymatch(parent, match, aux)
124 struct device *parent;
125 void *match;
126 void *aux;
127 {
128 struct mii_attach_args *ma = aux;
129
130 if (mii_phy_match(ma, inphys) != NULL)
131 return (10);
132
133 return (0);
134 }
135
136 void
137 inphyattach(parent, self, aux)
138 struct device *parent, *self;
139 void *aux;
140 {
141 struct mii_softc *sc = (struct mii_softc *)self;
142 struct mii_attach_args *ma = aux;
143 struct mii_data *mii = ma->mii_data;
144 const struct mii_phydesc *mpd;
145
146 mpd = mii_phy_match(ma, inphys);
147 printf(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
148
149 sc->mii_inst = mii->mii_instance;
150 sc->mii_phy = ma->mii_phyno;
151 sc->mii_funcs = &inphy_funcs;
152 sc->mii_pdata = mii;
153 sc->mii_flags = ma->mii_flags;
154
155 PHY_RESET(sc);
156
157 sc->mii_capabilities =
158 PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
159 if (sc->mii_capabilities & BMSR_MEDIAMASK)
160 mii_phy_add_media(sc);
161 }
162
163 int
164 inphy_service(sc, mii, cmd)
165 struct mii_softc *sc;
166 struct mii_data *mii;
167 int cmd;
168 {
169 struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
170 int reg;
171
172 if ((sc->mii_dev.dv_flags & DVF_ACTIVE) == 0)
173 return (ENXIO);
174
175 switch (cmd) {
176 case MII_POLLSTAT:
177
178
179
180 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
181 return (0);
182 break;
183
184 case MII_MEDIACHG:
185
186
187
188
189 if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
190 reg = PHY_READ(sc, MII_BMCR);
191 PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
192 return (0);
193 }
194
195
196
197
198 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
199 break;
200
201 mii_phy_setmedia(sc);
202 break;
203
204 case MII_TICK:
205
206
207
208 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
209 return (0);
210
211 if (mii_phy_tick(sc) == EJUSTRETURN)
212 return (0);
213 break;
214
215 case MII_DOWN:
216 mii_phy_down(sc);
217 return (0);
218 }
219
220
221 mii_phy_status(sc);
222
223
224 mii_phy_update(sc, cmd);
225 return (0);
226 }
227
228 void
229 inphy_status(sc)
230 struct mii_softc *sc;
231 {
232 struct mii_data *mii = sc->mii_pdata;
233 struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
234 int bmsr, bmcr, scr;
235
236 mii->mii_media_status = IFM_AVALID;
237 mii->mii_media_active = IFM_ETHER;
238
239 bmsr = PHY_READ(sc, MII_BMSR) |
240 PHY_READ(sc, MII_BMSR);
241 if (bmsr & BMSR_LINK)
242 mii->mii_media_status |= IFM_ACTIVE;
243
244 bmcr = PHY_READ(sc, MII_BMCR);
245 if (bmcr & BMCR_ISO) {
246 mii->mii_media_active |= IFM_NONE;
247 mii->mii_media_status = 0;
248 return;
249 }
250
251 if (bmcr & BMCR_LOOP)
252 mii->mii_media_active |= IFM_LOOP;
253
254 if (bmcr & BMCR_AUTOEN) {
255 if ((bmsr & BMSR_ACOMP) == 0) {
256
257 mii->mii_media_active |= IFM_NONE;
258 return;
259 }
260
261 scr = PHY_READ(sc, MII_INPHY_SCR);
262 if ((bmsr & BMSR_100T4) && (scr & SCR_T4))
263 mii->mii_media_active |= IFM_100_T4;
264 else if (scr & SCR_S100)
265 mii->mii_media_active |= IFM_100_TX;
266 else
267 mii->mii_media_active |= IFM_10_T;
268
269 if (scr & SCR_FDX)
270 mii->mii_media_active |= IFM_FDX;
271 else
272 mii->mii_media_active |= IFM_HDX;
273 } else
274 mii->mii_media_active = ife->ifm_media;
275 }