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         { 0, 0 }
  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;
 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 |= IFM_100_TX|IFM_FDX;
 394 }
 395
 396 #ifdef RL_DEBUG
 397 static void
 398 rlswitch_phydump(device_t dev) {
 399         int phy, reg, val;
 400         struct mii_softc *sc;
 401
 402         sc = device_get_softc(dev);
 403         device_printf(dev, "rlswitchphydump\n");
 404         for (phy = 0; phy <= 5; phy++) {
 405                 printf("PHY%i:", phy);
 406                 for (reg = 0; reg <= 31; reg++) {
 407                         val = MIIBUS_READREG(sc->mii_dev, phy, reg);
 408                         printf(" 0x%x", val);
 409                 }
 410                 printf("\n");
 411         }
 412 }
 413 #endif