Deleted Added
full compact
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: head/sys/dev/mii/rlswitch.c 165782 2007-01-05 01:46:26Z ticso $");
35__FBSDID("$FreeBSD: head/sys/dev/mii/rlswitch.c 213229 2010-09-27 20:31:03Z marius $");
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
64static int rlswitch_probe(device_t);
65static int rlswitch_attach(device_t);
66
67static 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 { 0, 0 }
74};
75
76static devclass_t rlswitch_devclass;
77
78static driver_t rlswitch_driver = {
79 "rlswitch",
80 rlswitch_methods,
81 sizeof(struct mii_softc)
82};
83
84DRIVER_MODULE(rlswitch, miibus, rlswitch_driver, rlswitch_devclass, 0, 0);
85
86static int rlswitch_service(struct mii_softc *, struct mii_data *, int);
87static void rlswitch_status(struct mii_softc *);
88
89#ifdef RL_DEBUG
90static void rlswitch_phydump(device_t dev);
91#endif
92
93static const struct mii_phydesc rlswitches[] = {
94 MII_PHY_DESC(xxREALTEK, RTL8305SC),
95 MII_PHY_END
96};
97
98static int
99rlswitch_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
110static int
111rlswitch_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 = device_get_softc(sc->mii_dev);
120 mii = ma->mii_data;
121
122 /*
123 * We handle all pseudo PHY in a single instance, so never allow
124 * non-zero * instances!
125 */
126 if (mii->mii_instance != 0) {
127 device_printf(dev, "ignoring this PHY, non-zero instance\n");
128 return (ENXIO);
129 }
130
131 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list);
132
133 sc->mii_inst = mii->mii_instance;
134 sc->mii_phy = ma->mii_phyno;
135 sc->mii_service = rlswitch_service;
136 sc->mii_pdata = mii;
137 mii->mii_instance++;
138
139 sc->mii_flags |= MIIF_NOISOLATE;
140
141#define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL)
142
143#if 0 /* See above. */
144 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_NONE, 0, sc->mii_inst),
145 BMCR_ISO);
146#endif
147
148#if 0
149 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst),
150 BMCR_LOOP|BMCR_S100);
151#endif
152
153 sc->mii_capabilities = BMSR_100TXFDX & ma->mii_capmask;
154 device_printf(dev, " ");
155 mii_phy_add_media(sc);
156 printf("\n");
157#undef ADD
158#ifdef RL_DEBUG
159 rlswitch_phydump(dev);
160#endif
161
162#ifdef RL_VLAN
163 int val;
164
165 /* Global Control 0 */
166 val = 0;
167 val |= 0 << 10; /* enable 802.1q VLAN Tag support */
168 val |= 0 << 9; /* enable VLAN ingress filtering */
169 val |= 1 << 8; /* disable VLAN tag admit control */
170 val |= 1 << 6; /* internal use */
171 val |= 1 << 5; /* internal use */
172 val |= 1 << 4; /* internal use */
173 val |= 1 << 3; /* internal use */
174 val |= 1 << 1; /* reserved */
175 MIIBUS_WRITEREG(sc->mii_dev, 0, 16, val);
176
177 /* Global Control 2 */
178 val = 0;
179 val |= 1 << 15; /* reserved */
180 val |= 0 << 14; /* enable 1552 Bytes support */
181 val |= 1 << 13; /* enable broadcast input drop */
182 val |= 1 << 12; /* forward reserved control frames */
183 val |= 1 << 11; /* disable forwarding unicast frames to other VLAN's */
184 val |= 1 << 10; /* disable forwarding ARP broadcasts to other VLAN's */
185 val |= 1 << 9; /* enable 48 pass 1 */
186 val |= 0 << 8; /* enable VLAN */
187 val |= 1 << 7; /* reserved */
188 val |= 1 << 6; /* enable defer */
189 val |= 1 << 5; /* 43ms LED blink time */
190 val |= 3 << 3; /* 16:1 queue weight */
191 val |= 1 << 2; /* disable broadcast storm control */
192 val |= 1 << 1; /* enable power-on LED blinking */
193 val |= 1 << 0; /* reserved */
194 MIIBUS_WRITEREG(sc->mii_dev, 0, 18, val);
195
196 /* Port 0 Control Register 0 */
197 val = 0;
198 val |= 1 << 15; /* reserved */
199 val |= 1 << 11; /* drop received packets with wrong VLAN tag */
200 val |= 1 << 10; /* disable 802.1p priority classification */
201 val |= 1 << 9; /* disable diffserv priority classification */
202 val |= 1 << 6; /* internal use */
203 val |= 3 << 4; /* internal use */
204 val |= 1 << 3; /* internal use */
205 val |= 1 << 2; /* internal use */
206 val |= 1 << 0; /* remove VLAN tags on output */
207 MIIBUS_WRITEREG(sc->mii_dev, 0, 22, val);
208
209 /* Port 1 Control Register 0 */
210 val = 0;
211 val |= 1 << 15; /* reserved */
212 val |= 1 << 11; /* drop received packets with wrong VLAN tag */
213 val |= 1 << 10; /* disable 802.1p priority classification */
214 val |= 1 << 9; /* disable diffserv priority classification */
215 val |= 1 << 6; /* internal use */
216 val |= 3 << 4; /* internal use */
217 val |= 1 << 3; /* internal use */
218 val |= 1 << 2; /* internal use */
219 val |= 1 << 0; /* remove VLAN tags on output */
220 MIIBUS_WRITEREG(sc->mii_dev, 1, 22, val);
221
222 /* Port 2 Control Register 0 */
223 val = 0;
224 val |= 1 << 15; /* reserved */
225 val |= 1 << 11; /* drop received packets with wrong VLAN tag */
226 val |= 1 << 10; /* disable 802.1p priority classification */
227 val |= 1 << 9; /* disable diffserv priority classification */
228 val |= 1 << 6; /* internal use */
229 val |= 3 << 4; /* internal use */
230 val |= 1 << 3; /* internal use */
231 val |= 1 << 2; /* internal use */
232 val |= 1 << 0; /* remove VLAN tags on output */
233 MIIBUS_WRITEREG(sc->mii_dev, 2, 22, val);
234
235 /* Port 3 Control Register 0 */
236 val = 0;
237 val |= 1 << 15; /* reserved */
238 val |= 1 << 11; /* drop received packets with wrong VLAN tag */
239 val |= 1 << 10; /* disable 802.1p priority classification */
240 val |= 1 << 9; /* disable diffserv priority classification */
241 val |= 1 << 6; /* internal use */
242 val |= 3 << 4; /* internal use */
243 val |= 1 << 3; /* internal use */
244 val |= 1 << 2; /* internal use */
245 val |= 1 << 0; /* remove VLAN tags on output */
246 MIIBUS_WRITEREG(sc->mii_dev, 3, 22, val);
247
248 /* Port 4 (system port) Control Register 0 */
249 val = 0;
250 val |= 1 << 15; /* reserved */
251 val |= 0 << 11; /* don't drop received packets with wrong VLAN tag */
252 val |= 1 << 10; /* disable 802.1p priority classification */
253 val |= 1 << 9; /* disable diffserv priority classification */
254 val |= 1 << 6; /* internal use */
255 val |= 3 << 4; /* internal use */
256 val |= 1 << 3; /* internal use */
257 val |= 1 << 2; /* internal use */
258 val |= 2 << 0; /* add VLAN tags for untagged packets on output */
259 MIIBUS_WRITEREG(sc->mii_dev, 4, 22, val);
260
261 /* Port 0 Control Register 1 and VLAN A */
262 val = 0;
263 val |= 0x0 << 12; /* Port 0 VLAN Index */
264 val |= 1 << 11; /* internal use */
265 val |= 1 << 10; /* internal use */
266 val |= 1 << 9; /* internal use */
267 val |= 1 << 7; /* internal use */
268 val |= 1 << 6; /* internal use */
269 val |= 0x11 << 0; /* VLAN A membership */
270 MIIBUS_WRITEREG(sc->mii_dev, 0, 24, val);
271
272 /* Port 0 Control Register 2 and VLAN A */
273 val = 0;
274 val |= 1 << 15; /* internal use */
275 val |= 1 << 14; /* internal use */
276 val |= 1 << 13; /* internal use */
277 val |= 1 << 12; /* internal use */
278 val |= 0x100 << 0; /* VLAN A ID */
279 MIIBUS_WRITEREG(sc->mii_dev, 0, 25, val);
280
281 /* Port 1 Control Register 1 and VLAN B */
282 val = 0;
283 val |= 0x1 << 12; /* Port 1 VLAN Index */
284 val |= 1 << 11; /* internal use */
285 val |= 1 << 10; /* internal use */
286 val |= 1 << 9; /* internal use */
287 val |= 1 << 7; /* internal use */
288 val |= 1 << 6; /* internal use */
289 val |= 0x12 << 0; /* VLAN B membership */
290 MIIBUS_WRITEREG(sc->mii_dev, 1, 24, val);
291
292 /* Port 1 Control Register 2 and VLAN B */
293 val = 0;
294 val |= 1 << 15; /* internal use */
295 val |= 1 << 14; /* internal use */
296 val |= 1 << 13; /* internal use */
297 val |= 1 << 12; /* internal use */
298 val |= 0x101 << 0; /* VLAN B ID */
299 MIIBUS_WRITEREG(sc->mii_dev, 1, 25, val);
300
301 /* Port 2 Control Register 1 and VLAN C */
302 val = 0;
303 val |= 0x2 << 12; /* Port 2 VLAN Index */
304 val |= 1 << 11; /* internal use */
305 val |= 1 << 10; /* internal use */
306 val |= 1 << 9; /* internal use */
307 val |= 1 << 7; /* internal use */
308 val |= 1 << 6; /* internal use */
309 val |= 0x14 << 0; /* VLAN C membership */
310 MIIBUS_WRITEREG(sc->mii_dev, 2, 24, val);
311
312 /* Port 2 Control Register 2 and VLAN C */
313 val = 0;
314 val |= 1 << 15; /* internal use */
315 val |= 1 << 14; /* internal use */
316 val |= 1 << 13; /* internal use */
317 val |= 1 << 12; /* internal use */
318 val |= 0x102 << 0; /* VLAN C ID */
319 MIIBUS_WRITEREG(sc->mii_dev, 2, 25, val);
320
321 /* Port 3 Control Register 1 and VLAN D */
322 val = 0;
323 val |= 0x3 << 12; /* Port 3 VLAN Index */
324 val |= 1 << 11; /* internal use */
325 val |= 1 << 10; /* internal use */
326 val |= 1 << 9; /* internal use */
327 val |= 1 << 7; /* internal use */
328 val |= 1 << 6; /* internal use */
329 val |= 0x18 << 0; /* VLAN D membership */
330 MIIBUS_WRITEREG(sc->mii_dev, 3, 24, val);
331
332 /* Port 3 Control Register 2 and VLAN D */
333 val = 0;
334 val |= 1 << 15; /* internal use */
335 val |= 1 << 14; /* internal use */
336 val |= 1 << 13; /* internal use */
337 val |= 1 << 12; /* internal use */
338 val |= 0x103 << 0; /* VLAN D ID */
339 MIIBUS_WRITEREG(sc->mii_dev, 3, 25, val);
340
341 /* Port 4 Control Register 1 and VLAN E */
342 val = 0;
343 val |= 0x0 << 12; /* Port 4 VLAN Index */
344 val |= 1 << 11; /* internal use */
345 val |= 1 << 10; /* internal use */
346 val |= 1 << 9; /* internal use */
347 val |= 1 << 7; /* internal use */
348 val |= 1 << 6; /* internal use */
349 val |= 0 << 0; /* VLAN E membership */
350 MIIBUS_WRITEREG(sc->mii_dev, 4, 24, val);
351
352 /* Port 4 Control Register 2 and VLAN E */
353 val = 0;
354 val |= 1 << 15; /* internal use */
355 val |= 1 << 14; /* internal use */
356 val |= 1 << 13; /* internal use */
357 val |= 1 << 12; /* internal use */
358 val |= 0x104 << 0; /* VLAN E ID */
359 MIIBUS_WRITEREG(sc->mii_dev, 4, 25, val);
360#endif
361
362#ifdef RL_DEBUG
363 rlswitch_phydump(dev);
364#endif
365 MIIBUS_MEDIAINIT(sc->mii_dev);
366 return (0);
367}
368
369static int
370rlswitch_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
371{
372
373 switch (cmd) {
374 case MII_POLLSTAT:
375 break;
376
377 case MII_MEDIACHG:
378 break;
379
380 case MII_TICK:
381 /*
382 * Is the interface even up?
383 */
384 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
385 return (0);
386 break;
387 }
388
389 /* Update the media status. */
390 rlswitch_status(sc);
391
392 /* Callback if something changed. */
393 // mii_phy_update(sc, cmd);
394 return (0);
395}
396
397static void
398rlswitch_status(struct mii_softc *phy)
399{
400 struct mii_data *mii = phy->mii_pdata;
401
402 mii->mii_media_status = IFM_AVALID;
403 mii->mii_media_active = IFM_ETHER;
404 mii->mii_media_status |= IFM_ACTIVE;
405 mii->mii_media_active |= IFM_100_TX|IFM_FDX;
406}
407
408#ifdef RL_DEBUG
409static void
410rlswitch_phydump(device_t dev) {
411 int phy, reg, val;
412 struct mii_softc *sc;
413
414 sc = device_get_softc(dev);
415 device_printf(dev, "rlswitchphydump\n");
416 for (phy = 0; phy <= 5; phy++) {
417 printf("PHY%i:", phy);
418 for (reg = 0; reg <= 31; reg++) {
419 val = MIIBUS_READREG(sc->mii_dev, phy, reg);
420 printf(" 0x%x", val);
421 }
422 printf("\n");
423 }
424}
425#endif