sys/dev/mii/smcphy.c

   1 /*-
   2  * Copyright (c) 2006 Benno Rice.  All rights reserved.
   3  *
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that the following conditions
   6  * are met:
   7  * 1. Redistributions of source code must retain the above copyright
   8  *    notice, this list of conditions and the following disclaimer.
   9  * 2. Redistributions in binary form must reproduce the above copyright
  10  *    notice, this list of conditions and the following disclaimer in the
  11  *    documentation and/or other materials provided with the distribution.
  12  *
  13  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  14  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  15  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  16  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  17  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  18  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  19  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  20  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  21  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  22  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  23  */
  24
  25 #include <sys/cdefs.h>
  26 __FBSDID("$FreeBSD$");
  27
  28 /*
  29  * Driver for the internal PHY on the SMSC LAN91C111.
  30  */
  31
  32 #include <sys/param.h>
  33 #include <sys/systm.h>
  34 #include <sys/kernel.h>
  35 #include <sys/socket.h>
  36 #include <sys/errno.h>
  37 #include <sys/module.h>
  38 #include <sys/bus.h>
  39 #include <sys/malloc.h>
  40
  41 #include <machine/bus.h>
  42
  43 #include <net/if.h>
  44 #include <net/if_media.h>
  45
  46 #include <dev/mii/mii.h>
  47 #include <dev/mii/miivar.h>
  48 #include "miidevs.h"
  49
  50 #include "miibus_if.h"
  51
  52 static int      smcphy_probe(device_t);
  53 static int      smcphy_attach(device_t);
  54
  55 static int      smcphy_service(struct mii_softc *, struct mii_data *, int);
  56 static void     smcphy_reset(struct mii_softc *);
  57 static void     smcphy_auto(struct mii_softc *, int);
  58
  59 static device_method_t smcphy_methods[] = {
  60         /* device interface */
  61         DEVMETHOD(device_probe,         smcphy_probe),
  62         DEVMETHOD(device_attach,        smcphy_attach),
  63         DEVMETHOD(device_detach,        mii_phy_detach),
  64         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
  65
  66         { 0, 0 }
  67 };
  68
  69 static devclass_t smcphy_devclass;
  70
  71 static driver_t smcphy_driver = {
  72         "smcphy",
  73         smcphy_methods,
  74         sizeof(struct mii_softc)
  75 };
  76
  77 DRIVER_MODULE(smcphy, miibus, smcphy_driver, smcphy_devclass, 0, 0);
  78
  79 static const struct mii_phydesc smcphys[] = {
  80         MII_PHY_DESC(SEEQ, 84220),
  81         MII_PHY_END
  82 };
  83
  84 static const struct mii_phy_funcs smcphy_funcs = {
  85         smcphy_service,
  86         ukphy_status,
  87         smcphy_reset
  88 };
  89
  90 static int
  91 smcphy_probe(device_t dev)
  92 {
  93
  94         return (mii_phy_dev_probe(dev, smcphys, BUS_PROBE_DEFAULT));
  95 }
  96
  97 static int
  98 smcphy_attach(device_t dev)
  99 {
 100         struct mii_softc *sc;
 101
 102         sc = device_get_softc(dev);
 103
 104         mii_phy_dev_attach(dev, MIIF_NOISOLATE | MIIF_NOMANPAUSE,
 105             &smcphy_funcs, 1);
 106         mii_phy_setmedia(sc);
 107
 108         return (0);
 109 }
 110
 111 static int
 112 smcphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
 113 {
 114         struct  ifmedia_entry *ife;
 115         int     reg;
 116
 117         ife = mii->mii_media.ifm_cur;
 118
 119         switch (cmd) {
 120         case MII_POLLSTAT:
 121                 break;
 122
 123         case MII_MEDIACHG:
 124                 /*
 125                  * If the interface is not up, don't do anything.
 126                  */
 127                 if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
 128                         break;
 129
 130                 switch (IFM_SUBTYPE(ife->ifm_media)) {
 131                 case IFM_AUTO:
 132                         smcphy_auto(sc, ife->ifm_media);
 133                         break;
 134
 135                 default:
 136                         mii_phy_setmedia(sc);
 137                         break;
 138                 }
 139
 140                 break;
 141
 142         case MII_TICK:
 143                 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) {
 144                         return (0);
 145                 }
 146
 147                 if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) {
 148                         break;
 149                 }
 150
 151                 /* I have no idea why BMCR_ISO gets set. */
 152                 reg = PHY_READ(sc, MII_BMCR);
 153                 if (reg & BMCR_ISO) {
 154                         PHY_WRITE(sc, MII_BMCR, reg & ~BMCR_ISO);
 155                 }
 156
 157                 reg = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
 158                 if (reg & BMSR_LINK) {
 159                         sc->mii_ticks = 0;
 160                         break;
 161                 }
 162
 163                 if (++sc->mii_ticks <= MII_ANEGTICKS) {
 164                         break;
 165                 }
 166
 167                 sc->mii_ticks = 0;
 168                 PHY_RESET(sc);
 169                 smcphy_auto(sc, ife->ifm_media);
 170                 break;
 171         }
 172
 173         /* Update the media status. */
 174         PHY_STATUS(sc);
 175
 176         /* Callback if something changed. */
 177         mii_phy_update(sc, cmd);
 178         return (0);
 179 }
 180
 181 static void
 182 smcphy_reset(struct mii_softc *sc)
 183 {
 184         u_int   bmcr;
 185         int     timeout;
 186
 187         PHY_WRITE(sc, MII_BMCR, BMCR_RESET);
 188
 189         for (timeout = 2; timeout > 0; timeout--) {
 190                 DELAY(50000);
 191                 bmcr = PHY_READ(sc, MII_BMCR);
 192                 if ((bmcr & BMCR_RESET) == 0)
 193                         break;
 194         }
 195
 196         if (bmcr & BMCR_RESET)
 197                 device_printf(sc->mii_dev, "reset failed\n");
 198
 199         PHY_WRITE(sc, MII_BMCR, 0x3000);
 200
 201         /* Mask interrupts, we poll instead. */
 202         PHY_WRITE(sc, 0x1e, 0xffc0);
 203 }
 204
 205 static void
 206 smcphy_auto(struct mii_softc *sc, int media)
 207 {
 208         uint16_t        anar;
 209
 210         anar = BMSR_MEDIA_TO_ANAR(sc->mii_capabilities) |
 211             ANAR_CSMA;
 212         if ((media & IFM_FLOW) != 0 || (sc->mii_flags & MIIF_FORCEPAUSE) != 0)
 213                 anar |= ANAR_FC;
 214         PHY_WRITE(sc, MII_ANAR, anar);
 215         /* Apparently this helps. */
 216         anar = PHY_READ(sc, MII_ANAR);
 217         PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
 218 }