inphy.c revision 95718
174131Sjlemon/*- 274131Sjlemon * Copyright (c) 2001 Jonathan Lemon 374131Sjlemon * All rights reserved. 474131Sjlemon * 574131Sjlemon * Redistribution and use in source and binary forms, with or without 674131Sjlemon * modification, are permitted provided that the following conditions 774131Sjlemon * are met: 874131Sjlemon * 1. Redistributions of source code must retain the above copyright 974131Sjlemon * notice, this list of conditions and the following disclaimer. 1074131Sjlemon * 2. Redistributions in binary form must reproduce the above copyright 1174131Sjlemon * notice, this list of conditions and the following disclaimer in the 1274131Sjlemon * documentation and/or other materials provided with the distribution. 1374131Sjlemon * 3. Neither the name of the author nor the names of any co-contributors 1474131Sjlemon * may be used to endorse or promote products derived from this software 1574131Sjlemon * without specific prior written permission. 1674131Sjlemon * 1774131Sjlemon * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1874131Sjlemon * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1974131Sjlemon * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2074131Sjlemon * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 2174131Sjlemon * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2274131Sjlemon * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2374131Sjlemon * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2474131Sjlemon * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2574131Sjlemon * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2674131Sjlemon * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2774131Sjlemon * SUCH DAMAGE. 2874131Sjlemon * 2974131Sjlemon * $FreeBSD: head/sys/dev/mii/inphy.c 95718 2002-04-29 11:57:30Z phk $ 3074131Sjlemon */ 3174131Sjlemon 3274131Sjlemon/* 3374131Sjlemon * driver for Intel 82553 and 82555 PHYs 3474131Sjlemon */ 3574131Sjlemon 3674131Sjlemon#include <sys/param.h> 3774131Sjlemon#include <sys/systm.h> 3874131Sjlemon#include <sys/kernel.h> 3974131Sjlemon#include <sys/malloc.h> 4074131Sjlemon#include <sys/socket.h> 4174131Sjlemon#include <sys/bus.h> 4274131Sjlemon 4374131Sjlemon#include <net/if.h> 4474131Sjlemon#include <net/if_media.h> 4574131Sjlemon 4674131Sjlemon#include <dev/mii/mii.h> 4774131Sjlemon#include <dev/mii/miivar.h> 4874131Sjlemon#include <dev/mii/miidevs.h> 4974131Sjlemon 5074131Sjlemon#include <dev/mii/inphyreg.h> 5174131Sjlemon 5274131Sjlemon#include "miibus_if.h" 5374131Sjlemon 5474131Sjlemonstatic int inphy_probe(device_t dev); 5574131Sjlemonstatic int inphy_attach(device_t dev); 5674131Sjlemonstatic int inphy_detach(device_t dev); 5774131Sjlemon 5874131Sjlemonstatic device_method_t inphy_methods[] = { 5974131Sjlemon /* device interface */ 6074131Sjlemon DEVMETHOD(device_probe, inphy_probe), 6174131Sjlemon DEVMETHOD(device_attach, inphy_attach), 6274131Sjlemon DEVMETHOD(device_detach, inphy_detach), 6374131Sjlemon DEVMETHOD(device_shutdown, bus_generic_shutdown), 6474131Sjlemon { 0, 0 } 6574131Sjlemon}; 6674131Sjlemon 6774131Sjlemonstatic devclass_t inphy_devclass; 6874131Sjlemon 6974131Sjlemonstatic driver_t inphy_driver = { 7074131Sjlemon "inphy", 7174131Sjlemon inphy_methods, 7274131Sjlemon sizeof(struct mii_softc) 7374131Sjlemon}; 7474131Sjlemon 7574131SjlemonDRIVER_MODULE(inphy, miibus, inphy_driver, inphy_devclass, 0, 0); 7674131Sjlemon 7784145Sjlemonstatic int inphy_service(struct mii_softc *, struct mii_data *, int); 7884145Sjlemonstatic void inphy_status(struct mii_softc *); 7974131Sjlemon 8074131Sjlemonstatic int 8174131Sjlemoninphy_probe(device_t dev) 8274131Sjlemon{ 8374131Sjlemon struct mii_attach_args *ma; 8474131Sjlemon device_t parent; 8574131Sjlemon 8674131Sjlemon ma = device_get_ivars(dev); 8774131Sjlemon parent = device_get_parent(device_get_parent(dev)); 8874131Sjlemon 8974131Sjlemon /* Intel 82553 A/B steppings */ 9074131Sjlemon if (MII_OUI(ma->mii_id1, ma->mii_id2) == MII_OUI_xxINTEL && 9174131Sjlemon MII_MODEL(ma->mii_id2) == MII_MODEL_xxINTEL_I82553AB) { 9274131Sjlemon device_set_desc(dev, MII_STR_xxINTEL_I82553AB); 9374131Sjlemon return (0); 9474131Sjlemon } 9574131Sjlemon 9676483Sjlemon if (MII_OUI(ma->mii_id1, ma->mii_id2) == MII_OUI_INTEL) { 9776483Sjlemon switch (MII_MODEL(ma->mii_id2)) { 9876483Sjlemon case MII_MODEL_INTEL_I82555: 9976483Sjlemon device_set_desc(dev, MII_STR_INTEL_I82555); 10076483Sjlemon return (0); 10176483Sjlemon case MII_MODEL_INTEL_I82553C: 10276483Sjlemon device_set_desc(dev, MII_STR_INTEL_I82553C); 10376483Sjlemon return (0); 10476483Sjlemon case MII_MODEL_INTEL_I82562EM: 10576483Sjlemon device_set_desc(dev, MII_STR_INTEL_I82562EM); 10676483Sjlemon return (0); 10776483Sjlemon case MII_MODEL_INTEL_I82562ET: 10876483Sjlemon device_set_desc(dev, MII_STR_INTEL_I82562ET); 10976483Sjlemon return (0); 11076483Sjlemon } 11176483Sjlemon } 11276483Sjlemon 11374131Sjlemon return (ENXIO); 11474131Sjlemon} 11574131Sjlemon 11674131Sjlemonstatic int 11774131Sjlemoninphy_attach(device_t dev) 11874131Sjlemon{ 11974131Sjlemon struct mii_softc *sc; 12074131Sjlemon struct mii_attach_args *ma; 12174131Sjlemon struct mii_data *mii; 12274131Sjlemon 12374131Sjlemon sc = device_get_softc(dev); 12474131Sjlemon ma = device_get_ivars(dev); 12574131Sjlemon sc->mii_dev = device_get_parent(dev); 12674131Sjlemon mii = device_get_softc(sc->mii_dev); 12774131Sjlemon LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 12874131Sjlemon 12974131Sjlemon sc->mii_inst = mii->mii_instance; 13074131Sjlemon sc->mii_phy = ma->mii_phyno; 13174131Sjlemon sc->mii_service = inphy_service; 13274131Sjlemon sc->mii_pdata = mii; 13374131Sjlemon mii->mii_instance++; 13474131Sjlemon 13574131Sjlemon#if 0 13674131Sjlemon sc->mii_flags |= MIIF_NOISOLATE; 13774131Sjlemon#endif 13874131Sjlemon 13974131Sjlemon ifmedia_add(&mii->mii_media, 14074131Sjlemon IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst), 14174131Sjlemon BMCR_LOOP|BMCR_S100, NULL); 14274131Sjlemon 14374131Sjlemon mii_phy_reset(sc); 14474131Sjlemon 14574131Sjlemon sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 14674377Sjlemon device_printf(dev, " "); 14795718Sphk mii_phy_add_media(sc); 14874131Sjlemon printf("\n"); 14974131Sjlemon 15074131Sjlemon MIIBUS_MEDIAINIT(sc->mii_dev); 15174131Sjlemon 15274131Sjlemon return (0); 15374131Sjlemon} 15474131Sjlemon 15574131Sjlemonstatic int 15674131Sjlemoninphy_detach(device_t dev) 15774131Sjlemon{ 15874131Sjlemon struct mii_softc *sc; 15974131Sjlemon struct mii_data *mii; 16074131Sjlemon 16174131Sjlemon sc = device_get_softc(dev); 16274131Sjlemon mii = device_get_softc(device_get_softc(dev)); 16374131Sjlemon mii_phy_auto_stop(sc); 16474131Sjlemon sc->mii_dev = NULL; 16574131Sjlemon LIST_REMOVE(sc, mii_list); 16674131Sjlemon 16774131Sjlemon return (0); 16874131Sjlemon} 16974131Sjlemon 17084145Sjlemonstatic int 17174131Sjlemoninphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 17274131Sjlemon{ 17374131Sjlemon struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 17474131Sjlemon int reg; 17574131Sjlemon 17674131Sjlemon switch (cmd) { 17774131Sjlemon case MII_POLLSTAT: 17874131Sjlemon if (IFM_INST(ife->ifm_media) != sc->mii_inst) 17974131Sjlemon return (0); 18074131Sjlemon break; 18174131Sjlemon 18274131Sjlemon case MII_MEDIACHG: 18374131Sjlemon if (IFM_INST(ife->ifm_media) != sc->mii_inst) { 18474131Sjlemon reg = PHY_READ(sc, MII_BMCR); 18574131Sjlemon PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO); 18674131Sjlemon return (0); 18774131Sjlemon } 18874131Sjlemon 18974131Sjlemon /* 19074131Sjlemon * If the interface is not up, don't do anything. 19174131Sjlemon */ 19274131Sjlemon if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 19374131Sjlemon break; 19474131Sjlemon 19595718Sphk mii_phy_setmedia(sc); 19674131Sjlemon break; 19774131Sjlemon 19874131Sjlemon case MII_TICK: 19974131Sjlemon if (IFM_INST(ife->ifm_media) != sc->mii_inst) 20074131Sjlemon return (0); 20184145Sjlemon if (mii_phy_tick(sc) == EJUSTRETURN) 20274131Sjlemon return (0); 20374131Sjlemon break; 20474131Sjlemon } 20574131Sjlemon 20674131Sjlemon /* Update the media status. */ 20774131Sjlemon inphy_status(sc); 20874131Sjlemon 20974131Sjlemon /* Callback if something changed. */ 21084145Sjlemon mii_phy_update(sc, cmd); 21174131Sjlemon return (0); 21274131Sjlemon} 21374131Sjlemon 21484145Sjlemonstatic void 21574131Sjlemoninphy_status(struct mii_softc *sc) 21674131Sjlemon{ 21774131Sjlemon struct mii_data *mii = sc->mii_pdata; 21895718Sphk struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 21974131Sjlemon int bmsr, bmcr, scr; 22074131Sjlemon 22174131Sjlemon mii->mii_media_status = IFM_AVALID; 22274131Sjlemon mii->mii_media_active = IFM_ETHER; 22374131Sjlemon 22474131Sjlemon bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR); 22574131Sjlemon if (bmsr & BMSR_LINK) 22674131Sjlemon mii->mii_media_status |= IFM_ACTIVE; 22774131Sjlemon 22874131Sjlemon bmcr = PHY_READ(sc, MII_BMCR); 22974131Sjlemon if (bmcr & BMCR_ISO) { 23074131Sjlemon mii->mii_media_active |= IFM_NONE; 23174131Sjlemon mii->mii_media_status = 0; 23274131Sjlemon return; 23374131Sjlemon } 23474131Sjlemon 23574131Sjlemon if (bmcr & BMCR_LOOP) 23674131Sjlemon mii->mii_media_active |= IFM_LOOP; 23774131Sjlemon 23874131Sjlemon if (bmcr & BMCR_AUTOEN) { 23974131Sjlemon if ((bmsr & BMSR_ACOMP) == 0) { 24074131Sjlemon mii->mii_media_active |= IFM_NONE; 24174131Sjlemon return; 24274131Sjlemon } 24374131Sjlemon 24474131Sjlemon scr = PHY_READ(sc, MII_INPHY_SCR); 24574131Sjlemon if (scr & SCR_S100) 24674131Sjlemon mii->mii_media_active |= IFM_100_TX; 24774131Sjlemon else 24874131Sjlemon mii->mii_media_active |= IFM_10_T; 24974131Sjlemon if (scr & SCR_FDX) 25074131Sjlemon mii->mii_media_active |= IFM_FDX; 25174131Sjlemon } else 25295718Sphk mii->mii_media_active = ife->ifm_media; 25374131Sjlemon} 254