inphy.c revision 164827
1/*- 2 * Copyright (c) 2001 Jonathan Lemon 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the author nor the names of any co-contributors 14 * may be used to endorse or promote products derived from this software 15 * without specific prior written permission. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 * 29 */ 30 31#include <sys/cdefs.h> 32__FBSDID("$FreeBSD: head/sys/dev/mii/inphy.c 164827 2006-12-02 15:32:34Z marius $"); 33 34/* 35 * driver for Intel 82553 and 82555 PHYs 36 */ 37 38#include <sys/param.h> 39#include <sys/systm.h> 40#include <sys/kernel.h> 41#include <sys/module.h> 42#include <sys/socket.h> 43#include <sys/bus.h> 44 45#include <net/if.h> 46#include <net/if_media.h> 47 48#include <dev/mii/mii.h> 49#include <dev/mii/miivar.h> 50#include "miidevs.h" 51 52#include <dev/mii/inphyreg.h> 53 54#include "miibus_if.h" 55 56static int inphy_probe(device_t dev); 57static int inphy_attach(device_t dev); 58 59static device_method_t inphy_methods[] = { 60 /* device interface */ 61 DEVMETHOD(device_probe, inphy_probe), 62 DEVMETHOD(device_attach, inphy_attach), 63 DEVMETHOD(device_detach, mii_phy_detach), 64 DEVMETHOD(device_shutdown, bus_generic_shutdown), 65 { 0, 0 } 66}; 67 68static devclass_t inphy_devclass; 69 70static driver_t inphy_driver = { 71 "inphy", 72 inphy_methods, 73 sizeof(struct mii_softc) 74}; 75 76DRIVER_MODULE(inphy, miibus, inphy_driver, inphy_devclass, 0, 0); 77 78static int inphy_service(struct mii_softc *, struct mii_data *, int); 79static void inphy_status(struct mii_softc *); 80 81static const struct mii_phydesc inphys[] = { 82 MII_PHY_DESC(INTEL, I82553C), 83 MII_PHY_DESC(INTEL, I82555), 84 MII_PHY_DESC(INTEL, I82562EM), 85 MII_PHY_DESC(INTEL, I82562ET), 86 MII_PHY_DESC(xxINTEL, I82553AB), 87 MII_PHY_END 88}; 89 90static int 91inphy_probe(device_t dev) 92{ 93 94 return (mii_phy_dev_probe(dev, inphys, BUS_PROBE_DEFAULT)); 95} 96 97static int 98inphy_attach(device_t dev) 99{ 100 struct mii_softc *sc; 101 struct mii_attach_args *ma; 102 struct mii_data *mii; 103 104 sc = device_get_softc(dev); 105 ma = device_get_ivars(dev); 106 sc->mii_dev = device_get_parent(dev); 107 mii = device_get_softc(sc->mii_dev); 108 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 109 110 sc->mii_inst = mii->mii_instance; 111 sc->mii_phy = ma->mii_phyno; 112 sc->mii_service = inphy_service; 113 sc->mii_pdata = mii; 114 mii->mii_instance++; 115 116 ifmedia_add(&mii->mii_media, 117 IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst), 118 BMCR_LOOP|BMCR_S100, NULL); 119 120 mii_phy_reset(sc); 121 122 sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 123 device_printf(dev, " "); 124 mii_phy_add_media(sc); 125 printf("\n"); 126 127 MIIBUS_MEDIAINIT(sc->mii_dev); 128 129 return (0); 130} 131 132static int 133inphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 134{ 135 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 136 int reg; 137 138 switch (cmd) { 139 case MII_POLLSTAT: 140 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 141 return (0); 142 break; 143 144 case MII_MEDIACHG: 145 if (IFM_INST(ife->ifm_media) != sc->mii_inst) { 146 reg = PHY_READ(sc, MII_BMCR); 147 PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO); 148 return (0); 149 } 150 151 /* 152 * If the interface is not up, don't do anything. 153 */ 154 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 155 break; 156 157 mii_phy_setmedia(sc); 158 break; 159 160 case MII_TICK: 161 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 162 return (0); 163 if (mii_phy_tick(sc) == EJUSTRETURN) 164 return (0); 165 break; 166 } 167 168 /* Update the media status. */ 169 inphy_status(sc); 170 171 /* Callback if something changed. */ 172 mii_phy_update(sc, cmd); 173 return (0); 174} 175 176static void 177inphy_status(struct mii_softc *sc) 178{ 179 struct mii_data *mii = sc->mii_pdata; 180 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 181 int bmsr, bmcr, scr; 182 183 mii->mii_media_status = IFM_AVALID; 184 mii->mii_media_active = IFM_ETHER; 185 186 bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR); 187 if (bmsr & BMSR_LINK) 188 mii->mii_media_status |= IFM_ACTIVE; 189 190 bmcr = PHY_READ(sc, MII_BMCR); 191 if (bmcr & BMCR_ISO) { 192 mii->mii_media_active |= IFM_NONE; 193 mii->mii_media_status = 0; 194 return; 195 } 196 197 if (bmcr & BMCR_LOOP) 198 mii->mii_media_active |= IFM_LOOP; 199 200 if (bmcr & BMCR_AUTOEN) { 201 if ((bmsr & BMSR_ACOMP) == 0) { 202 mii->mii_media_active |= IFM_NONE; 203 return; 204 } 205 206 scr = PHY_READ(sc, MII_INPHY_SCR); 207 if (scr & SCR_S100) 208 mii->mii_media_active |= IFM_100_TX; 209 else 210 mii->mii_media_active |= IFM_10_T; 211 if (scr & SCR_FDX) 212 mii->mii_media_active |= IFM_FDX; 213 } else 214 mii->mii_media_active = ife->ifm_media; 215} 216