This source file includes following definitions.
- tqphymatch
- tqphyattach
- tqphy_service
- tqphy_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
76 #include <sys/param.h>
77 #include <sys/systm.h>
78 #include <sys/kernel.h>
79 #include <sys/device.h>
80 #include <sys/socket.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/tqphyreg.h>
90
91 int tqphymatch(struct device *, void *, void *);
92 void tqphyattach(struct device *, struct device *, void *);
93 int tqphydetach(struct device *, int);
94
95 struct cfattach tqphy_ca = {
96 sizeof(struct mii_softc), tqphymatch, tqphyattach, mii_phy_detach,
97 mii_phy_activate
98 };
99
100 struct cfdriver tqphy_cd = {
101 NULL, "tqphy", DV_DULL
102 };
103
104 int tqphy_service(struct mii_softc *, struct mii_data *, int);
105 void tqphy_status(struct mii_softc *);
106
107 const struct mii_phy_funcs tqphy_funcs = {
108 tqphy_service, tqphy_status, mii_phy_reset,
109 };
110
111 static const struct mii_phydesc tqphys[] = {
112 { MII_OUI_TSC, MII_MODEL_TSC_78Q2120,
113 MII_STR_TSC_78Q2120 },
114
115 { 0, 0,
116 NULL },
117 };
118
119 int
120 tqphymatch(struct device *parent, void *match, void *aux)
121 {
122 struct mii_attach_args *ma = aux;
123
124 if (mii_phy_match(ma, tqphys) != NULL)
125 return (10);
126
127 return (0);
128 }
129
130 void
131 tqphyattach(struct device *parent, struct device *self, void *aux)
132 {
133 struct mii_softc *sc = (struct mii_softc *)self;
134 struct mii_attach_args *ma = aux;
135 struct mii_data *mii = ma->mii_data;
136 const struct mii_phydesc *mpd;
137
138 mpd = mii_phy_match(ma, tqphys);
139 printf(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
140
141 sc->mii_inst = mii->mii_instance;
142 sc->mii_phy = ma->mii_phyno;
143 sc->mii_funcs = &tqphy_funcs;
144 sc->mii_pdata = mii;
145 sc->mii_flags = ma->mii_flags;
146
147
148
149
150 sc->mii_flags |= MIIF_NOLOOP;
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 tqphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
162 {
163 struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
164 int reg;
165
166 if ((sc->mii_dev.dv_flags & DVF_ACTIVE) == 0)
167 return (ENXIO);
168
169 switch (cmd) {
170 case MII_POLLSTAT:
171
172
173
174 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
175 return (0);
176 break;
177
178 case MII_MEDIACHG:
179
180
181
182
183 if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
184 reg = PHY_READ(sc, MII_BMCR);
185 PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
186 return (0);
187 }
188
189
190
191
192 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
193 break;
194
195 mii_phy_setmedia(sc);
196 break;
197
198 case MII_TICK:
199
200
201
202 if (IFM_INST(ife->ifm_media) != sc->mii_inst)
203 return (0);
204
205 if (mii_phy_tick(sc) == EJUSTRETURN)
206 return (0);
207 break;
208
209 case MII_DOWN:
210 mii_phy_down(sc);
211 return (0);
212 }
213
214
215 mii_phy_status(sc);
216
217
218 mii_phy_update(sc, cmd);
219 return (0);
220 }
221
222 void
223 tqphy_status(struct mii_softc *sc)
224 {
225 struct mii_data *mii = sc->mii_pdata;
226 struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
227 int bmsr, bmcr, diag;
228
229 mii->mii_media_status = IFM_AVALID;
230 mii->mii_media_active = IFM_ETHER;
231
232 bmsr = PHY_READ(sc, MII_BMSR) |
233 PHY_READ(sc, MII_BMSR);
234 if (bmsr & BMSR_LINK)
235 mii->mii_media_status |= IFM_ACTIVE;
236
237 bmcr = PHY_READ(sc, MII_BMCR);
238 if (bmcr & BMCR_ISO) {
239 mii->mii_media_active |= IFM_NONE;
240 mii->mii_media_status = 0;
241 return;
242 }
243
244 if (bmcr & BMCR_LOOP)
245 mii->mii_media_active |= IFM_LOOP;
246
247 if (bmcr & BMCR_AUTOEN) {
248 if ((bmsr & BMSR_ACOMP) == 0) {
249
250 mii->mii_media_active |= IFM_NONE;
251 return;
252 }
253 diag = PHY_READ(sc, MII_TQPHY_DIAG);
254 if (diag & DIAG_RATE)
255 mii->mii_media_active |= IFM_100_TX;
256 else
257 mii->mii_media_active |= IFM_10_T;
258
259 if (diag & DIAG_DPLX)
260 mii->mii_media_active |= IFM_FDX;
261 else
262 mii->mii_media_active |= IFM_HDX;
263 } else
264 mii->mii_media_active = ife->ifm_media;
265 }