inphy.c revision 285830
1104349Sphk/*- 2104349Sphk * Copyright (c) 2001 Jonathan Lemon 3104349Sphk * All rights reserved. 4104349Sphk * 5104349Sphk * Redistribution and use in source and binary forms, with or without 6104349Sphk * modification, are permitted provided that the following conditions 7104349Sphk * are met: 8104349Sphk * 1. Redistributions of source code must retain the above copyright 9104349Sphk * notice, this list of conditions and the following disclaimer. 10104349Sphk * 2. Redistributions in binary form must reproduce the above copyright 11104349Sphk * notice, this list of conditions and the following disclaimer in the 12104349Sphk * documentation and/or other materials provided with the distribution. 13104349Sphk * 3. Neither the name of the author nor the names of any co-contributors 14104349Sphk * may be used to endorse or promote products derived from this software 15104349Sphk * without specific prior written permission. 16104349Sphk * 17104349Sphk * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18104349Sphk * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19104349Sphk * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20104349Sphk * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21104349Sphk * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22104349Sphk * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23104349Sphk * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24104349Sphk * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25104349Sphk * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26104349Sphk * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27104349Sphk * SUCH DAMAGE. 28104349Sphk * 29104349Sphk */ 30104349Sphk 31104349Sphk#include <sys/cdefs.h> 32104349Sphk__FBSDID("$FreeBSD: releng/10.2/sys/dev/fxp/inphy.c 226154 2011-10-08 12:33:10Z marius $"); 33104349Sphk 34104349Sphk/* 35104349Sphk * driver for Intel 82553 and 82555 PHYs 36104349Sphk */ 37104349Sphk 38104349Sphk#include <sys/param.h> 39104349Sphk#include <sys/systm.h> 40104349Sphk#include <sys/kernel.h> 41104349Sphk#include <sys/module.h> 42104349Sphk#include <sys/socket.h> 43104349Sphk#include <sys/bus.h> 44104349Sphk 45104349Sphk#include <net/if.h> 46104349Sphk#include <net/if_media.h> 47104349Sphk 48104349Sphk#include <dev/mii/mii.h> 49104349Sphk#include <dev/mii/miivar.h> 50104349Sphk#include "miidevs.h" 51104349Sphk 52104349Sphk#include <dev/fxp/inphyreg.h> 53104349Sphk 54104349Sphk#include "miibus_if.h" 55104349Sphk 56104349Sphkstatic int inphy_probe(device_t dev); 57104349Sphkstatic int inphy_attach(device_t dev); 58104349Sphk 59104349Sphkstatic device_method_t inphy_methods[] = { 60104349Sphk /* device interface */ 61104349Sphk DEVMETHOD(device_probe, inphy_probe), 62104349Sphk DEVMETHOD(device_attach, inphy_attach), 63104349Sphk DEVMETHOD(device_detach, mii_phy_detach), 64104349Sphk DEVMETHOD(device_shutdown, bus_generic_shutdown), 65104349Sphk { 0, 0 } 66104349Sphk}; 67104349Sphk 68104349Sphkstatic devclass_t inphy_devclass; 69104349Sphk 70104349Sphkstatic driver_t inphy_driver = { 71104349Sphk "inphy", 72104349Sphk inphy_methods, 73104349Sphk sizeof(struct mii_softc) 74104349Sphk}; 75104349Sphk 76104349SphkDRIVER_MODULE(inphy, miibus, inphy_driver, inphy_devclass, 0, 0); 77104349Sphk 78104349Sphkstatic int inphy_service(struct mii_softc *, struct mii_data *, int); 79104349Sphkstatic void inphy_status(struct mii_softc *); 80104349Sphkstatic void inphy_reset(struct mii_softc *); 81104349Sphk 82104349Sphkstatic const struct mii_phydesc inphys[] = { 83104349Sphk MII_PHY_DESC(xxINTEL, I82553), 84104349Sphk MII_PHY_DESC(yyINTEL, I82553), 85104349Sphk MII_PHY_DESC(yyINTEL, I82555), 86104349Sphk MII_PHY_DESC(yyINTEL, I82562EM), 87104349Sphk MII_PHY_DESC(yyINTEL, I82562ET), 88104349Sphk MII_PHY_END 89104349Sphk}; 90104349Sphk 91104349Sphkstatic const struct mii_phy_funcs inphy_funcs = { 92104349Sphk inphy_service, 93104349Sphk inphy_status, 94104349Sphk inphy_reset 95104349Sphk}; 96104349Sphk 97104349Sphkstatic int 98104349Sphkinphy_probe(device_t dev) 99104349Sphk{ 100104349Sphk 101104349Sphk return (mii_phy_dev_probe(dev, inphys, BUS_PROBE_DEFAULT)); 102104349Sphk} 103104349Sphk 104104349Sphkstatic int 105104349Sphkinphy_attach(device_t dev) 106104349Sphk{ 107104349Sphk 108104349Sphk mii_phy_dev_attach(dev, MIIF_NOMANPAUSE, &inphy_funcs, 1); 109104349Sphk return (0); 110104349Sphk} 111104349Sphk 112104349Sphkstatic int 113inphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 114{ 115 116 switch (cmd) { 117 case MII_POLLSTAT: 118 break; 119 120 case MII_MEDIACHG: 121 /* 122 * If the interface is not up, don't do anything. 123 */ 124 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 125 break; 126 127 mii_phy_setmedia(sc); 128 break; 129 130 case MII_TICK: 131 if (mii_phy_tick(sc) == EJUSTRETURN) 132 return (0); 133 break; 134 } 135 136 /* Update the media status. */ 137 PHY_STATUS(sc); 138 139 /* Callback if something changed. */ 140 mii_phy_update(sc, cmd); 141 return (0); 142} 143 144static void 145inphy_status(struct mii_softc *sc) 146{ 147 struct mii_data *mii = sc->mii_pdata; 148 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 149 int bmsr, bmcr, scr; 150 151 mii->mii_media_status = IFM_AVALID; 152 mii->mii_media_active = IFM_ETHER; 153 154 bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR); 155 if (bmsr & BMSR_LINK) 156 mii->mii_media_status |= IFM_ACTIVE; 157 158 bmcr = PHY_READ(sc, MII_BMCR); 159 if (bmcr & BMCR_ISO) { 160 mii->mii_media_active |= IFM_NONE; 161 mii->mii_media_status = 0; 162 return; 163 } 164 165 if (bmcr & BMCR_LOOP) 166 mii->mii_media_active |= IFM_LOOP; 167 168 if (bmcr & BMCR_AUTOEN) { 169 if ((bmsr & BMSR_ACOMP) == 0) { 170 mii->mii_media_active |= IFM_NONE; 171 return; 172 } 173 174 scr = PHY_READ(sc, MII_INPHY_SCR); 175 if (scr & SCR_S100) 176 mii->mii_media_active |= IFM_100_TX; 177 else 178 mii->mii_media_active |= IFM_10_T; 179 if (scr & SCR_FDX) 180 mii->mii_media_active |= 181 IFM_FDX | mii_phy_flowstatus(sc); 182 else 183 mii->mii_media_active |= IFM_HDX; 184 } else 185 mii->mii_media_active = ife->ifm_media; 186} 187 188static void 189inphy_reset(struct mii_softc *sc) 190{ 191 192 mii_phy_reset(sc); 193 194 /* Ensure Bay flow control is disabled. */ 195 PHY_WRITE(sc, MII_INPHY_SCR, 196 PHY_READ(sc, MII_INPHY_SCR) & ~SCR_FLOWCTL); 197} 198