FreeBSD/Linux Kernel Cross Reference
sys/dev/mii/rlswitch.c
1 /*-
2 * Copyright (c) 1997, 1998, 1999
3 * Bill Paul <wpaul@ctr.columbia.edu>. All rights reserved.
4 * Copyright (c) 2006 Bernd Walter. All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. All advertising materials mentioning features or use of this software
15 * must display the following acknowledgement:
16 * This product includes software developed by Bill Paul.
17 * 4. Neither the name of the author nor the names of any co-contributors
18 * may be used to endorse or promote products derived from this software
19 * without specific prior written permission.
20 *
21 * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24 * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
25 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
31 * THE POSSIBILITY OF SUCH DAMAGE.
32 */
33
34 #include <sys/cdefs.h>
35 __FBSDID("$FreeBSD$");
36
37 /*
38 * driver for RealTek 8305 pseudo PHYs
39 */
40
41 #include <sys/param.h>
42 #include <sys/systm.h>
43 #include <sys/kernel.h>
44 #include <sys/module.h>
45 #include <sys/socket.h>
46 #include <sys/bus.h>
47
48 #include <net/if.h>
49 #include <net/if_arp.h>
50 #include <net/if_media.h>
51
52 #include <dev/mii/mii.h>
53 #include <dev/mii/miivar.h>
54 #include "miidevs.h"
55
56 #include <machine/bus.h>
57 #include <pci/if_rlreg.h>
58
59 #include "miibus_if.h"
60
61 //#define RL_DEBUG
62 #define RL_VLAN
63
64 static int rlswitch_probe(device_t);
65 static int rlswitch_attach(device_t);
66
67 static device_method_t rlswitch_methods[] = {
68 /* device interface */
69 DEVMETHOD(device_probe, rlswitch_probe),
70 DEVMETHOD(device_attach, rlswitch_attach),
71 DEVMETHOD(device_detach, mii_phy_detach),
72 DEVMETHOD(device_shutdown, bus_generic_shutdown),
73 DEVMETHOD_END
74 };
75
76 static devclass_t rlswitch_devclass;
77
78 static driver_t rlswitch_driver = {
79 "rlswitch",
80 rlswitch_methods,
81 sizeof(struct mii_softc)
82 };
83
84 DRIVER_MODULE(rlswitch, miibus, rlswitch_driver, rlswitch_devclass, 0, 0);
85
86 static int rlswitch_service(struct mii_softc *, struct mii_data *, int);
87 static void rlswitch_status(struct mii_softc *);
88
89 #ifdef RL_DEBUG
90 static void rlswitch_phydump(device_t dev);
91 #endif
92
93 static const struct mii_phydesc rlswitches[] = {
94 MII_PHY_DESC(xxREALTEK, RTL8305SC),
95 MII_PHY_END
96 };
97
98 static int
99 rlswitch_probe(device_t dev)
100 {
101 int rv;
102
103 rv = mii_phy_dev_probe(dev, rlswitches, BUS_PROBE_DEFAULT);
104 if (rv <= 0)
105 return (rv);
106
107 return (ENXIO);
108 }
109
110 static int
111 rlswitch_attach(device_t dev)
112 {
113 struct mii_softc *sc;
114 struct mii_attach_args *ma;
115 struct mii_data *mii;
116
117 sc = device_get_softc(dev);
118 ma = device_get_ivars(dev);
119 sc->mii_dev = device_get_parent(dev);
120 mii = ma->mii_data;
121 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list);
122
123 sc->mii_flags = miibus_get_flags(dev);
124 sc->mii_inst = mii->mii_instance++;
125 sc->mii_phy = ma->mii_phyno;
126 sc->mii_service = rlswitch_service;
127 sc->mii_pdata = mii;
128
129 /*
130 * We handle all pseudo PHYs in a single instance.
131 */
132 sc->mii_flags |= MIIF_NOISOLATE | MIIF_NOMANPAUSE;
133
134 #define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL)
135
136 #if 0
137 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst),
138 MII_MEDIA_100_TX);
139 #endif
140
141 sc->mii_capabilities = BMSR_100TXFDX & ma->mii_capmask;
142 device_printf(dev, " ");
143 mii_phy_add_media(sc);
144 printf("\n");
145 #undef ADD
146 #ifdef RL_DEBUG
147 rlswitch_phydump(dev);
148 #endif
149
150 #ifdef RL_VLAN
151 int val;
152
153 /* Global Control 0 */
154 val = 0;
155 val |= 0 << 10; /* enable 802.1q VLAN Tag support */
156 val |= 0 << 9; /* enable VLAN ingress filtering */
157 val |= 1 << 8; /* disable VLAN tag admit control */
158 val |= 1 << 6; /* internal use */
159 val |= 1 << 5; /* internal use */
160 val |= 1 << 4; /* internal use */
161 val |= 1 << 3; /* internal use */
162 val |= 1 << 1; /* reserved */
163 MIIBUS_WRITEREG(sc->mii_dev, 0, 16, val);
164
165 /* Global Control 2 */
166 val = 0;
167 val |= 1 << 15; /* reserved */
168 val |= 0 << 14; /* enable 1552 Bytes support */
169 val |= 1 << 13; /* enable broadcast input drop */
170 val |= 1 << 12; /* forward reserved control frames */
171 val |= 1 << 11; /* disable forwarding unicast frames to other VLAN's */
172 val |= 1 << 10; /* disable forwarding ARP broadcasts to other VLAN's */
173 val |= 1 << 9; /* enable 48 pass 1 */
174 val |= 0 << 8; /* enable VLAN */
175 val |= 1 << 7; /* reserved */
176 val |= 1 << 6; /* enable defer */
177 val |= 1 << 5; /* 43ms LED blink time */
178 val |= 3 << 3; /* 16:1 queue weight */
179 val |= 1 << 2; /* disable broadcast storm control */
180 val |= 1 << 1; /* enable power-on LED blinking */
181 val |= 1 << 0; /* reserved */
182 MIIBUS_WRITEREG(sc->mii_dev, 0, 18, val);
183
184 /* Port 0 Control Register 0 */
185 val = 0;
186 val |= 1 << 15; /* reserved */
187 val |= 1 << 11; /* drop received packets with wrong VLAN tag */
188 val |= 1 << 10; /* disable 802.1p priority classification */
189 val |= 1 << 9; /* disable diffserv priority classification */
190 val |= 1 << 6; /* internal use */
191 val |= 3 << 4; /* internal use */
192 val |= 1 << 3; /* internal use */
193 val |= 1 << 2; /* internal use */
194 val |= 1 << 0; /* remove VLAN tags on output */
195 MIIBUS_WRITEREG(sc->mii_dev, 0, 22, val);
196
197 /* Port 1 Control Register 0 */
198 val = 0;
199 val |= 1 << 15; /* reserved */
200 val |= 1 << 11; /* drop received packets with wrong VLAN tag */
201 val |= 1 << 10; /* disable 802.1p priority classification */
202 val |= 1 << 9; /* disable diffserv priority classification */
203 val |= 1 << 6; /* internal use */
204 val |= 3 << 4; /* internal use */
205 val |= 1 << 3; /* internal use */
206 val |= 1 << 2; /* internal use */
207 val |= 1 << 0; /* remove VLAN tags on output */
208 MIIBUS_WRITEREG(sc->mii_dev, 1, 22, val);
209
210 /* Port 2 Control Register 0 */
211 val = 0;
212 val |= 1 << 15; /* reserved */
213 val |= 1 << 11; /* drop received packets with wrong VLAN tag */
214 val |= 1 << 10; /* disable 802.1p priority classification */
215 val |= 1 << 9; /* disable diffserv priority classification */
216 val |= 1 << 6; /* internal use */
217 val |= 3 << 4; /* internal use */
218 val |= 1 << 3; /* internal use */
219 val |= 1 << 2; /* internal use */
220 val |= 1 << 0; /* remove VLAN tags on output */
221 MIIBUS_WRITEREG(sc->mii_dev, 2, 22, val);
222
223 /* Port 3 Control Register 0 */
224 val = 0;
225 val |= 1 << 15; /* reserved */
226 val |= 1 << 11; /* drop received packets with wrong VLAN tag */
227 val |= 1 << 10; /* disable 802.1p priority classification */
228 val |= 1 << 9; /* disable diffserv priority classification */
229 val |= 1 << 6; /* internal use */
230 val |= 3 << 4; /* internal use */
231 val |= 1 << 3; /* internal use */
232 val |= 1 << 2; /* internal use */
233 val |= 1 << 0; /* remove VLAN tags on output */
234 MIIBUS_WRITEREG(sc->mii_dev, 3, 22, val);
235
236 /* Port 4 (system port) Control Register 0 */
237 val = 0;
238 val |= 1 << 15; /* reserved */
239 val |= 0 << 11; /* don't drop received packets with wrong VLAN tag */
240 val |= 1 << 10; /* disable 802.1p priority classification */
241 val |= 1 << 9; /* disable diffserv priority classification */
242 val |= 1 << 6; /* internal use */
243 val |= 3 << 4; /* internal use */
244 val |= 1 << 3; /* internal use */
245 val |= 1 << 2; /* internal use */
246 val |= 2 << 0; /* add VLAN tags for untagged packets on output */
247 MIIBUS_WRITEREG(sc->mii_dev, 4, 22, val);
248
249 /* Port 0 Control Register 1 and VLAN A */
250 val = 0;
251 val |= 0x0 << 12; /* Port 0 VLAN Index */
252 val |= 1 << 11; /* internal use */
253 val |= 1 << 10; /* internal use */
254 val |= 1 << 9; /* internal use */
255 val |= 1 << 7; /* internal use */
256 val |= 1 << 6; /* internal use */
257 val |= 0x11 << 0; /* VLAN A membership */
258 MIIBUS_WRITEREG(sc->mii_dev, 0, 24, val);
259
260 /* Port 0 Control Register 2 and VLAN A */
261 val = 0;
262 val |= 1 << 15; /* internal use */
263 val |= 1 << 14; /* internal use */
264 val |= 1 << 13; /* internal use */
265 val |= 1 << 12; /* internal use */
266 val |= 0x100 << 0; /* VLAN A ID */
267 MIIBUS_WRITEREG(sc->mii_dev, 0, 25, val);
268
269 /* Port 1 Control Register 1 and VLAN B */
270 val = 0;
271 val |= 0x1 << 12; /* Port 1 VLAN Index */
272 val |= 1 << 11; /* internal use */
273 val |= 1 << 10; /* internal use */
274 val |= 1 << 9; /* internal use */
275 val |= 1 << 7; /* internal use */
276 val |= 1 << 6; /* internal use */
277 val |= 0x12 << 0; /* VLAN B membership */
278 MIIBUS_WRITEREG(sc->mii_dev, 1, 24, val);
279
280 /* Port 1 Control Register 2 and VLAN B */
281 val = 0;
282 val |= 1 << 15; /* internal use */
283 val |= 1 << 14; /* internal use */
284 val |= 1 << 13; /* internal use */
285 val |= 1 << 12; /* internal use */
286 val |= 0x101 << 0; /* VLAN B ID */
287 MIIBUS_WRITEREG(sc->mii_dev, 1, 25, val);
288
289 /* Port 2 Control Register 1 and VLAN C */
290 val = 0;
291 val |= 0x2 << 12; /* Port 2 VLAN Index */
292 val |= 1 << 11; /* internal use */
293 val |= 1 << 10; /* internal use */
294 val |= 1 << 9; /* internal use */
295 val |= 1 << 7; /* internal use */
296 val |= 1 << 6; /* internal use */
297 val |= 0x14 << 0; /* VLAN C membership */
298 MIIBUS_WRITEREG(sc->mii_dev, 2, 24, val);
299
300 /* Port 2 Control Register 2 and VLAN C */
301 val = 0;
302 val |= 1 << 15; /* internal use */
303 val |= 1 << 14; /* internal use */
304 val |= 1 << 13; /* internal use */
305 val |= 1 << 12; /* internal use */
306 val |= 0x102 << 0; /* VLAN C ID */
307 MIIBUS_WRITEREG(sc->mii_dev, 2, 25, val);
308
309 /* Port 3 Control Register 1 and VLAN D */
310 val = 0;
311 val |= 0x3 << 12; /* Port 3 VLAN Index */
312 val |= 1 << 11; /* internal use */
313 val |= 1 << 10; /* internal use */
314 val |= 1 << 9; /* internal use */
315 val |= 1 << 7; /* internal use */
316 val |= 1 << 6; /* internal use */
317 val |= 0x18 << 0; /* VLAN D membership */
318 MIIBUS_WRITEREG(sc->mii_dev, 3, 24, val);
319
320 /* Port 3 Control Register 2 and VLAN D */
321 val = 0;
322 val |= 1 << 15; /* internal use */
323 val |= 1 << 14; /* internal use */
324 val |= 1 << 13; /* internal use */
325 val |= 1 << 12; /* internal use */
326 val |= 0x103 << 0; /* VLAN D ID */
327 MIIBUS_WRITEREG(sc->mii_dev, 3, 25, val);
328
329 /* Port 4 Control Register 1 and VLAN E */
330 val = 0;
331 val |= 0x0 << 12; /* Port 4 VLAN Index */
332 val |= 1 << 11; /* internal use */
333 val |= 1 << 10; /* internal use */
334 val |= 1 << 9; /* internal use */
335 val |= 1 << 7; /* internal use */
336 val |= 1 << 6; /* internal use */
337 val |= 0 << 0; /* VLAN E membership */
338 MIIBUS_WRITEREG(sc->mii_dev, 4, 24, val);
339
340 /* Port 4 Control Register 2 and VLAN E */
341 val = 0;
342 val |= 1 << 15; /* internal use */
343 val |= 1 << 14; /* internal use */
344 val |= 1 << 13; /* internal use */
345 val |= 1 << 12; /* internal use */
346 val |= 0x104 << 0; /* VLAN E ID */
347 MIIBUS_WRITEREG(sc->mii_dev, 4, 25, val);
348 #endif
349
350 #ifdef RL_DEBUG
351 rlswitch_phydump(dev);
352 #endif
353 MIIBUS_MEDIAINIT(sc->mii_dev);
354 return (0);
355 }
356
357 static int
358 rlswitch_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
359 {
360
361 switch (cmd) {
362 case MII_POLLSTAT:
363 break;
364
365 case MII_MEDIACHG:
366 break;
367
368 case MII_TICK:
369 /*
370 * Is the interface even up?
371 */
372 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
373 return (0);
374 break;
375 }
376
377 /* Update the media status. */
378 rlswitch_status(sc);
379
380 /* Callback if something changed. */
381 // mii_phy_update(sc, cmd);
382 return (0);
383 }
384
385 static void
386 rlswitch_status(struct mii_softc *phy)
387 {
388 struct mii_data *mii = phy->mii_pdata;
389
390 mii->mii_media_status = IFM_AVALID;
391 mii->mii_media_active = IFM_ETHER;
392 mii->mii_media_status |= IFM_ACTIVE;
393 mii->mii_media_active |=
394 IFM_100_TX | IFM_FDX | mii_phy_flowstatus(phy);
395 }
396
397 #ifdef RL_DEBUG
398 static void
399 rlswitch_phydump(device_t dev) {
400 int phy, reg, val;
401 struct mii_softc *sc;
402
403 sc = device_get_softc(dev);
404 device_printf(dev, "rlswitchphydump\n");
405 for (phy = 0; phy <= 5; phy++) {
406 printf("PHY%i:", phy);
407 for (reg = 0; reg <= 31; reg++) {
408 val = MIIBUS_READREG(sc->mii_dev, phy, reg);
409 printf(" 0x%x", val);
410 }
411 printf("\n");
412 }
413 }
414 #endif
Cache object: 42af6e9af980fc8c24f4afa5cab95d17
|