rlswitch.c revision 227908
1275970Scy/*- 2275970Scy * Copyright (c) 1997, 1998, 1999 3275970Scy * Bill Paul <wpaul@ctr.columbia.edu>. All rights reserved. 4275970Scy * Copyright (c) 2006 Bernd Walter. All rights reserved. 5275970Scy * 6275970Scy * Redistribution and use in source and binary forms, with or without 7275970Scy * modification, are permitted provided that the following conditions 8275970Scy * are met: 9275970Scy * 1. Redistributions of source code must retain the above copyright 10275970Scy * notice, this list of conditions and the following disclaimer. 11275970Scy * 2. Redistributions in binary form must reproduce the above copyright 12275970Scy * notice, this list of conditions and the following disclaimer in the 13275970Scy * documentation and/or other materials provided with the distribution. 14275970Scy * 3. All advertising materials mentioning features or use of this software 15275970Scy * must display the following acknowledgement: 16275970Scy * This product includes software developed by Bill Paul. 17275970Scy * 4. Neither the name of the author nor the names of any co-contributors 18275970Scy * may be used to endorse or promote products derived from this software 19275970Scy * without specific prior written permission. 20275970Scy * 21275970Scy * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND 22275970Scy * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 23275970Scy * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 24275970Scy * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD 25275970Scy * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 26275970Scy * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 27275970Scy * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 28275970Scy * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 29275970Scy * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 30275970Scy * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 31275970Scy * THE POSSIBILITY OF SUCH DAMAGE. 32275970Scy */ 33275970Scy 34275970Scy#include <sys/cdefs.h> 35275970Scy__FBSDID("$FreeBSD: head/sys/dev/mii/rlswitch.c 227908 2011-11-23 20:27:26Z marius $"); 36275970Scy 37275970Scy/* 38275970Scy * driver for RealTek 8305 pseudo PHYs 39275970Scy */ 40275970Scy 41275970Scy#include <sys/param.h> 42275970Scy#include <sys/systm.h> 43275970Scy#include <sys/kernel.h> 44275970Scy#include <sys/module.h> 45275970Scy#include <sys/socket.h> 46275970Scy#include <sys/bus.h> 47275970Scy 48275970Scy#include <net/if.h> 49275970Scy#include <net/if_arp.h> 50275970Scy#include <net/if_media.h> 51275970Scy 52275970Scy#include <dev/mii/mii.h> 53275970Scy#include <dev/mii/miivar.h> 54275970Scy#include "miidevs.h" 55275970Scy 56275970Scy#include <machine/bus.h> 57275970Scy#include <pci/if_rlreg.h> 58275970Scy 59275970Scy#include "miibus_if.h" 60275970Scy 61275970Scy//#define RL_DEBUG 62275970Scy#define RL_VLAN 63275970Scy 64275970Scystatic int rlswitch_probe(device_t); 65275970Scystatic int rlswitch_attach(device_t); 66275970Scy 67275970Scystatic device_method_t rlswitch_methods[] = { 68275970Scy /* device interface */ 69275970Scy DEVMETHOD(device_probe, rlswitch_probe), 70275970Scy DEVMETHOD(device_attach, rlswitch_attach), 71275970Scy DEVMETHOD(device_detach, mii_phy_detach), 72275970Scy DEVMETHOD(device_shutdown, bus_generic_shutdown), 73275970Scy DEVMETHOD_END 74275970Scy}; 75275970Scy 76275970Scystatic devclass_t rlswitch_devclass; 77275970Scy 78275970Scystatic driver_t rlswitch_driver = { 79275970Scy "rlswitch", 80275970Scy rlswitch_methods, 81275970Scy sizeof(struct mii_softc) 82275970Scy}; 83275970Scy 84275970ScyDRIVER_MODULE(rlswitch, miibus, rlswitch_driver, rlswitch_devclass, 0, 0); 85275970Scy 86275970Scystatic int rlswitch_service(struct mii_softc *, struct mii_data *, int); 87275970Scystatic void rlswitch_status(struct mii_softc *); 88275970Scy 89275970Scy#ifdef RL_DEBUG 90275970Scystatic void rlswitch_phydump(device_t dev); 91275970Scy#endif 92275970Scy 93275970Scystatic const struct mii_phydesc rlswitches[] = { 94275970Scy MII_PHY_DESC(REALTEK, RTL8305SC), 95275970Scy MII_PHY_END 96275970Scy}; 97275970Scy 98275970Scystatic const struct mii_phy_funcs rlswitch_funcs = { 99275970Scy rlswitch_service, 100275970Scy rlswitch_status, 101275970Scy mii_phy_reset 102275970Scy}; 103275970Scy 104275970Scystatic int 105275970Scyrlswitch_probe(device_t dev) 106275970Scy{ 107275970Scy int rv; 108275970Scy 109275970Scy rv = mii_phy_dev_probe(dev, rlswitches, BUS_PROBE_DEFAULT); 110275970Scy if (rv <= 0) 111275970Scy return (rv); 112275970Scy 113275970Scy return (ENXIO); 114275970Scy} 115275970Scy 116275970Scystatic int 117275970Scyrlswitch_attach(device_t dev) 118275970Scy{ 119275970Scy struct mii_softc *sc; 120275970Scy 121275970Scy sc = device_get_softc(dev); 122275970Scy 123275970Scy /* 124275970Scy * We handle all pseudo PHYs in a single instance. 125275970Scy */ 126275970Scy mii_phy_dev_attach(dev, MIIF_NOISOLATE | MIIF_NOMANPAUSE, 127275970Scy &rlswitch_funcs, 0); 128275970Scy 129275970Scy sc->mii_capabilities = BMSR_100TXFDX & sc->mii_capmask; 130275970Scy device_printf(dev, " "); 131275970Scy mii_phy_add_media(sc); 132275970Scy printf("\n"); 133275970Scy#ifdef RL_DEBUG 134275970Scy rlswitch_phydump(dev); 135275970Scy#endif 136275970Scy 137275970Scy#ifdef RL_VLAN 138275970Scy int val; 139275970Scy 140275970Scy /* Global Control 0 */ 141275970Scy val = 0; 142275970Scy val |= 0 << 10; /* enable 802.1q VLAN Tag support */ 143275970Scy val |= 0 << 9; /* enable VLAN ingress filtering */ 144275970Scy val |= 1 << 8; /* disable VLAN tag admit control */ 145275970Scy val |= 1 << 6; /* internal use */ 146275970Scy val |= 1 << 5; /* internal use */ 147275970Scy val |= 1 << 4; /* internal use */ 148275970Scy val |= 1 << 3; /* internal use */ 149275970Scy val |= 1 << 1; /* reserved */ 150275970Scy MIIBUS_WRITEREG(sc->mii_dev, 0, 16, val); 151275970Scy 152275970Scy /* Global Control 2 */ 153275970Scy val = 0; 154275970Scy val |= 1 << 15; /* reserved */ 155275970Scy val |= 0 << 14; /* enable 1552 Bytes support */ 156275970Scy val |= 1 << 13; /* enable broadcast input drop */ 157275970Scy val |= 1 << 12; /* forward reserved control frames */ 158275970Scy val |= 1 << 11; /* disable forwarding unicast frames to other VLAN's */ 159275970Scy val |= 1 << 10; /* disable forwarding ARP broadcasts to other VLAN's */ 160275970Scy val |= 1 << 9; /* enable 48 pass 1 */ 161275970Scy val |= 0 << 8; /* enable VLAN */ 162275970Scy val |= 1 << 7; /* reserved */ 163275970Scy val |= 1 << 6; /* enable defer */ 164275970Scy val |= 1 << 5; /* 43ms LED blink time */ 165275970Scy val |= 3 << 3; /* 16:1 queue weight */ 166275970Scy val |= 1 << 2; /* disable broadcast storm control */ 167275970Scy val |= 1 << 1; /* enable power-on LED blinking */ 168275970Scy val |= 1 << 0; /* reserved */ 169275970Scy MIIBUS_WRITEREG(sc->mii_dev, 0, 18, val); 170275970Scy 171275970Scy /* Port 0 Control Register 0 */ 172275970Scy val = 0; 173275970Scy val |= 1 << 15; /* reserved */ 174275970Scy val |= 1 << 11; /* drop received packets with wrong VLAN tag */ 175275970Scy val |= 1 << 10; /* disable 802.1p priority classification */ 176275970Scy val |= 1 << 9; /* disable diffserv priority classification */ 177275970Scy val |= 1 << 6; /* internal use */ 178275970Scy val |= 3 << 4; /* internal use */ 179275970Scy val |= 1 << 3; /* internal use */ 180275970Scy val |= 1 << 2; /* internal use */ 181275970Scy val |= 1 << 0; /* remove VLAN tags on output */ 182275970Scy MIIBUS_WRITEREG(sc->mii_dev, 0, 22, val); 183275970Scy 184275970Scy /* Port 1 Control Register 0 */ 185275970Scy val = 0; 186275970Scy val |= 1 << 15; /* reserved */ 187275970Scy val |= 1 << 11; /* drop received packets with wrong VLAN tag */ 188275970Scy val |= 1 << 10; /* disable 802.1p priority classification */ 189275970Scy val |= 1 << 9; /* disable diffserv priority classification */ 190275970Scy val |= 1 << 6; /* internal use */ 191275970Scy val |= 3 << 4; /* internal use */ 192275970Scy val |= 1 << 3; /* internal use */ 193275970Scy val |= 1 << 2; /* internal use */ 194275970Scy val |= 1 << 0; /* remove VLAN tags on output */ 195275970Scy MIIBUS_WRITEREG(sc->mii_dev, 1, 22, val); 196275970Scy 197275970Scy /* Port 2 Control Register 0 */ 198275970Scy val = 0; 199275970Scy val |= 1 << 15; /* reserved */ 200275970Scy val |= 1 << 11; /* drop received packets with wrong VLAN tag */ 201275970Scy val |= 1 << 10; /* disable 802.1p priority classification */ 202275970Scy val |= 1 << 9; /* disable diffserv priority classification */ 203275970Scy val |= 1 << 6; /* internal use */ 204275970Scy val |= 3 << 4; /* internal use */ 205275970Scy val |= 1 << 3; /* internal use */ 206275970Scy val |= 1 << 2; /* internal use */ 207 val |= 1 << 0; /* remove VLAN tags on output */ 208 MIIBUS_WRITEREG(sc->mii_dev, 2, 22, val); 209 210 /* Port 3 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, 3, 22, val); 222 223 /* Port 4 (system port) Control Register 0 */ 224 val = 0; 225 val |= 1 << 15; /* reserved */ 226 val |= 0 << 11; /* don't 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 |= 2 << 0; /* add VLAN tags for untagged packets on output */ 234 MIIBUS_WRITEREG(sc->mii_dev, 4, 22, val); 235 236 /* Port 0 Control Register 1 and VLAN A */ 237 val = 0; 238 val |= 0x0 << 12; /* Port 0 VLAN Index */ 239 val |= 1 << 11; /* internal use */ 240 val |= 1 << 10; /* internal use */ 241 val |= 1 << 9; /* internal use */ 242 val |= 1 << 7; /* internal use */ 243 val |= 1 << 6; /* internal use */ 244 val |= 0x11 << 0; /* VLAN A membership */ 245 MIIBUS_WRITEREG(sc->mii_dev, 0, 24, val); 246 247 /* Port 0 Control Register 2 and VLAN A */ 248 val = 0; 249 val |= 1 << 15; /* internal use */ 250 val |= 1 << 14; /* internal use */ 251 val |= 1 << 13; /* internal use */ 252 val |= 1 << 12; /* internal use */ 253 val |= 0x100 << 0; /* VLAN A ID */ 254 MIIBUS_WRITEREG(sc->mii_dev, 0, 25, val); 255 256 /* Port 1 Control Register 1 and VLAN B */ 257 val = 0; 258 val |= 0x1 << 12; /* Port 1 VLAN Index */ 259 val |= 1 << 11; /* internal use */ 260 val |= 1 << 10; /* internal use */ 261 val |= 1 << 9; /* internal use */ 262 val |= 1 << 7; /* internal use */ 263 val |= 1 << 6; /* internal use */ 264 val |= 0x12 << 0; /* VLAN B membership */ 265 MIIBUS_WRITEREG(sc->mii_dev, 1, 24, val); 266 267 /* Port 1 Control Register 2 and VLAN B */ 268 val = 0; 269 val |= 1 << 15; /* internal use */ 270 val |= 1 << 14; /* internal use */ 271 val |= 1 << 13; /* internal use */ 272 val |= 1 << 12; /* internal use */ 273 val |= 0x101 << 0; /* VLAN B ID */ 274 MIIBUS_WRITEREG(sc->mii_dev, 1, 25, val); 275 276 /* Port 2 Control Register 1 and VLAN C */ 277 val = 0; 278 val |= 0x2 << 12; /* Port 2 VLAN Index */ 279 val |= 1 << 11; /* internal use */ 280 val |= 1 << 10; /* internal use */ 281 val |= 1 << 9; /* internal use */ 282 val |= 1 << 7; /* internal use */ 283 val |= 1 << 6; /* internal use */ 284 val |= 0x14 << 0; /* VLAN C membership */ 285 MIIBUS_WRITEREG(sc->mii_dev, 2, 24, val); 286 287 /* Port 2 Control Register 2 and VLAN C */ 288 val = 0; 289 val |= 1 << 15; /* internal use */ 290 val |= 1 << 14; /* internal use */ 291 val |= 1 << 13; /* internal use */ 292 val |= 1 << 12; /* internal use */ 293 val |= 0x102 << 0; /* VLAN C ID */ 294 MIIBUS_WRITEREG(sc->mii_dev, 2, 25, val); 295 296 /* Port 3 Control Register 1 and VLAN D */ 297 val = 0; 298 val |= 0x3 << 12; /* Port 3 VLAN Index */ 299 val |= 1 << 11; /* internal use */ 300 val |= 1 << 10; /* internal use */ 301 val |= 1 << 9; /* internal use */ 302 val |= 1 << 7; /* internal use */ 303 val |= 1 << 6; /* internal use */ 304 val |= 0x18 << 0; /* VLAN D membership */ 305 MIIBUS_WRITEREG(sc->mii_dev, 3, 24, val); 306 307 /* Port 3 Control Register 2 and VLAN D */ 308 val = 0; 309 val |= 1 << 15; /* internal use */ 310 val |= 1 << 14; /* internal use */ 311 val |= 1 << 13; /* internal use */ 312 val |= 1 << 12; /* internal use */ 313 val |= 0x103 << 0; /* VLAN D ID */ 314 MIIBUS_WRITEREG(sc->mii_dev, 3, 25, val); 315 316 /* Port 4 Control Register 1 and VLAN E */ 317 val = 0; 318 val |= 0x0 << 12; /* Port 4 VLAN Index */ 319 val |= 1 << 11; /* internal use */ 320 val |= 1 << 10; /* internal use */ 321 val |= 1 << 9; /* internal use */ 322 val |= 1 << 7; /* internal use */ 323 val |= 1 << 6; /* internal use */ 324 val |= 0 << 0; /* VLAN E membership */ 325 MIIBUS_WRITEREG(sc->mii_dev, 4, 24, val); 326 327 /* Port 4 Control Register 2 and VLAN E */ 328 val = 0; 329 val |= 1 << 15; /* internal use */ 330 val |= 1 << 14; /* internal use */ 331 val |= 1 << 13; /* internal use */ 332 val |= 1 << 12; /* internal use */ 333 val |= 0x104 << 0; /* VLAN E ID */ 334 MIIBUS_WRITEREG(sc->mii_dev, 4, 25, val); 335#endif 336 337#ifdef RL_DEBUG 338 rlswitch_phydump(dev); 339#endif 340 MIIBUS_MEDIAINIT(sc->mii_dev); 341 return (0); 342} 343 344static int 345rlswitch_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 346{ 347 348 switch (cmd) { 349 case MII_POLLSTAT: 350 break; 351 352 case MII_MEDIACHG: 353 break; 354 355 case MII_TICK: 356 /* 357 * Is the interface even up? 358 */ 359 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 360 return (0); 361 break; 362 } 363 364 /* Update the media status. */ 365 PHY_STATUS(sc); 366 367 /* Callback if something changed. */ 368 // mii_phy_update(sc, cmd); 369 return (0); 370} 371 372static void 373rlswitch_status(struct mii_softc *phy) 374{ 375 struct mii_data *mii = phy->mii_pdata; 376 377 mii->mii_media_status = IFM_AVALID; 378 mii->mii_media_active = IFM_ETHER; 379 mii->mii_media_status |= IFM_ACTIVE; 380 mii->mii_media_active |= 381 IFM_100_TX | IFM_FDX | mii_phy_flowstatus(phy); 382} 383 384#ifdef RL_DEBUG 385static void 386rlswitch_phydump(device_t dev) { 387 int phy, reg, val; 388 struct mii_softc *sc; 389 390 sc = device_get_softc(dev); 391 device_printf(dev, "rlswitchphydump\n"); 392 for (phy = 0; phy <= 5; phy++) { 393 printf("PHY%i:", phy); 394 for (reg = 0; reg <= 31; reg++) { 395 val = MIIBUS_READREG(sc->mii_dev, phy, reg); 396 printf(" 0x%x", val); 397 } 398 printf("\n"); 399 } 400} 401#endif 402