amphy.c revision 164827
1139749Simp/*- 250983Swpaul * Copyright (c) 1997, 1998, 1999 350983Swpaul * Bill Paul <wpaul@ee.columbia.edu>. All rights reserved. 450983Swpaul * 550983Swpaul * Redistribution and use in source and binary forms, with or without 650983Swpaul * modification, are permitted provided that the following conditions 750983Swpaul * are met: 850983Swpaul * 1. Redistributions of source code must retain the above copyright 950983Swpaul * notice, this list of conditions and the following disclaimer. 1050983Swpaul * 2. Redistributions in binary form must reproduce the above copyright 1150983Swpaul * notice, this list of conditions and the following disclaimer in the 1250983Swpaul * documentation and/or other materials provided with the distribution. 1350983Swpaul * 3. All advertising materials mentioning features or use of this software 1450983Swpaul * must display the following acknowledgement: 1550983Swpaul * This product includes software developed by Bill Paul. 1650983Swpaul * 4. Neither the name of the author nor the names of any co-contributors 1750983Swpaul * may be used to endorse or promote products derived from this software 1850983Swpaul * without specific prior written permission. 1950983Swpaul * 2050983Swpaul * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND 2150983Swpaul * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 2250983Swpaul * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2350983Swpaul * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD 2450983Swpaul * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 2550983Swpaul * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 2650983Swpaul * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 2750983Swpaul * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 2850983Swpaul * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 2950983Swpaul * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 3050983Swpaul * THE POSSIBILITY OF SUCH DAMAGE. 3150983Swpaul */ 3250983Swpaul 33119418Sobrien#include <sys/cdefs.h> 34119418Sobrien__FBSDID("$FreeBSD: head/sys/dev/mii/amphy.c 164827 2006-12-02 15:32:34Z marius $"); 35119418Sobrien 3650983Swpaul/* 3750983Swpaul * driver for AMD AM79c873 PHYs 3851428Swpaul * This driver also works for the Davicom DM9101 PHY, which appears to 3951428Swpaul * be an AM79c873 workalike. 4050983Swpaul */ 4150983Swpaul 4250983Swpaul#include <sys/param.h> 4350983Swpaul#include <sys/systm.h> 4450983Swpaul#include <sys/kernel.h> 45129876Sphk#include <sys/module.h> 4650983Swpaul#include <sys/socket.h> 4750983Swpaul#include <sys/bus.h> 4850983Swpaul 4950983Swpaul#include <net/if.h> 5050983Swpaul#include <net/if_media.h> 5150983Swpaul 5250983Swpaul#include <dev/mii/mii.h> 5350983Swpaul#include <dev/mii/miivar.h> 54109514Sobrien#include "miidevs.h" 5550983Swpaul 5650983Swpaul#include <dev/mii/amphyreg.h> 5750983Swpaul 5850983Swpaul#include "miibus_if.h" 5950983Swpaul 60105135Salfredstatic int amphy_probe(device_t); 61105135Salfredstatic int amphy_attach(device_t); 6250983Swpaul 6350983Swpaulstatic device_method_t amphy_methods[] = { 6450983Swpaul /* device interface */ 6550983Swpaul DEVMETHOD(device_probe, amphy_probe), 6650983Swpaul DEVMETHOD(device_attach, amphy_attach), 6795722Sphk DEVMETHOD(device_detach, mii_phy_detach), 6850983Swpaul DEVMETHOD(device_shutdown, bus_generic_shutdown), 6950983Swpaul { 0, 0 } 7050983Swpaul}; 7150983Swpaul 7250983Swpaulstatic devclass_t amphy_devclass; 7350983Swpaul 7450983Swpaulstatic driver_t amphy_driver = { 7550983Swpaul "amphy", 7650983Swpaul amphy_methods, 7750983Swpaul sizeof(struct mii_softc) 7850983Swpaul}; 7950983Swpaul 8050983SwpaulDRIVER_MODULE(amphy, miibus, amphy_driver, amphy_devclass, 0, 0); 8150983Swpaul 8292739Salfredstatic int amphy_service(struct mii_softc *, struct mii_data *, int); 8392739Salfredstatic void amphy_status(struct mii_softc *); 8450983Swpaul 85164827Smariusstatic const struct mii_phydesc amphys[] = { 86164827Smarius MII_PHY_DESC(xxAMD, 79C873), 87164827Smarius MII_PHY_DESC(xxDAVICOM, DM9101), 88164827Smarius MII_PHY_END 89164827Smarius}; 90164827Smarius 91105135Salfredstatic int 92150763Simpamphy_probe(device_t dev) 9350983Swpaul{ 9450983Swpaul 95164827Smarius return (mii_phy_dev_probe(dev, amphys, BUS_PROBE_DEFAULT)); 9650983Swpaul} 9750983Swpaul 98105135Salfredstatic int 99150763Simpamphy_attach(device_t dev) 10050983Swpaul{ 10150983Swpaul struct mii_softc *sc; 10250983Swpaul struct mii_attach_args *ma; 10350983Swpaul struct mii_data *mii; 10450983Swpaul 10550983Swpaul sc = device_get_softc(dev); 10650983Swpaul ma = device_get_ivars(dev); 10750983Swpaul sc->mii_dev = device_get_parent(dev); 10850983Swpaul mii = device_get_softc(sc->mii_dev); 10950983Swpaul LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 11050983Swpaul 11150983Swpaul sc->mii_inst = mii->mii_instance; 11250983Swpaul sc->mii_phy = ma->mii_phyno; 11350983Swpaul sc->mii_service = amphy_service; 11450983Swpaul sc->mii_pdata = mii; 11550983Swpaul 11650983Swpaul sc->mii_flags |= MIIF_NOISOLATE; 11750983Swpaul mii->mii_instance++; 11850983Swpaul 11950983Swpaul#define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL) 12050983Swpaul 12150983Swpaul ADD(IFM_MAKEWORD(IFM_ETHER, IFM_NONE, 0, sc->mii_inst), 12250983Swpaul BMCR_ISO); 12350983Swpaul#if 0 12450983Swpaul ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst), 12550983Swpaul BMCR_LOOP|BMCR_S100); 12650983Swpaul#endif 12750983Swpaul 12850983Swpaul mii_phy_reset(sc); 12950983Swpaul 13050983Swpaul sc->mii_capabilities = 13150983Swpaul PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 13250983Swpaul device_printf(dev, " "); 13395667Sphk mii_add_media(sc); 13450983Swpaul printf("\n"); 13550983Swpaul#undef ADD 13650983Swpaul MIIBUS_MEDIAINIT(sc->mii_dev); 13750983Swpaul return(0); 13850983Swpaul} 13950983Swpaul 14084145Sjlemonstatic int 141150763Simpamphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 14250983Swpaul{ 14350983Swpaul struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 14450983Swpaul int reg; 14550983Swpaul 14650983Swpaul switch (cmd) { 14750983Swpaul case MII_POLLSTAT: 14850983Swpaul /* 14950983Swpaul * If we're not polling our PHY instance, just return. 15050983Swpaul */ 15150983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) 15250983Swpaul return (0); 15350983Swpaul break; 15450983Swpaul 15550983Swpaul case MII_MEDIACHG: 15650983Swpaul /* 15750983Swpaul * If the media indicates a different PHY instance, 15850983Swpaul * isolate ourselves. 15950983Swpaul */ 16050983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) { 16150983Swpaul reg = PHY_READ(sc, MII_BMCR); 16250983Swpaul PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO); 16350983Swpaul return (0); 16450983Swpaul } 16550983Swpaul 16650983Swpaul /* 16750983Swpaul * If the interface is not up, don't do anything. 16850983Swpaul */ 16950983Swpaul if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 17050983Swpaul break; 17150983Swpaul 17250983Swpaul switch (IFM_SUBTYPE(ife->ifm_media)) { 17350983Swpaul case IFM_AUTO: 17450983Swpaul /* 17550983Swpaul * If we're already in auto mode, just return. 17650983Swpaul */ 17750983Swpaul if (PHY_READ(sc, MII_BMCR) & BMCR_AUTOEN) 17850983Swpaul return (0); 17996026Sphk (void) mii_phy_auto(sc); 18050983Swpaul break; 18150983Swpaul case IFM_100_T4: 18250983Swpaul /* 18350983Swpaul * XXX Not supported as a manual setting right now. 18450983Swpaul */ 18550983Swpaul return (EINVAL); 18650983Swpaul default: 18750983Swpaul /* 18850983Swpaul * BMCR data is stored in the ifmedia entry. 18950983Swpaul */ 19050983Swpaul PHY_WRITE(sc, MII_ANAR, 19150983Swpaul mii_anar(ife->ifm_media)); 19250983Swpaul PHY_WRITE(sc, MII_BMCR, ife->ifm_data); 19350983Swpaul } 19450983Swpaul break; 19550983Swpaul 19650983Swpaul case MII_TICK: 19750983Swpaul /* 19850983Swpaul * If we're not currently selected, just return. 19950983Swpaul */ 20050983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) 20150983Swpaul return (0); 20284145Sjlemon if (mii_phy_tick(sc) == EJUSTRETURN) 20350983Swpaul return (0); 20450983Swpaul break; 20550983Swpaul } 20650983Swpaul 20750983Swpaul /* Update the media status. */ 20850983Swpaul amphy_status(sc); 20950983Swpaul 21050983Swpaul /* Callback if something changed. */ 21184145Sjlemon mii_phy_update(sc, cmd); 21250983Swpaul return (0); 21350983Swpaul} 21450983Swpaul 21584145Sjlemonstatic void 216150763Simpamphy_status(struct mii_softc *sc) 21750983Swpaul{ 21850983Swpaul struct mii_data *mii = sc->mii_pdata; 21950983Swpaul int bmsr, bmcr, par, anlpar; 22050983Swpaul 22150983Swpaul mii->mii_media_status = IFM_AVALID; 22250983Swpaul mii->mii_media_active = IFM_ETHER; 22350983Swpaul 22450983Swpaul bmsr = PHY_READ(sc, MII_BMSR) | 22550983Swpaul PHY_READ(sc, MII_BMSR); 22650983Swpaul if (bmsr & BMSR_LINK) 22750983Swpaul mii->mii_media_status |= IFM_ACTIVE; 22850983Swpaul 22950983Swpaul bmcr = PHY_READ(sc, MII_BMCR); 23050983Swpaul if (bmcr & BMCR_ISO) { 23150983Swpaul mii->mii_media_active |= IFM_NONE; 23250983Swpaul mii->mii_media_status = 0; 23350983Swpaul return; 23450983Swpaul } 23550983Swpaul 23650983Swpaul if (bmcr & BMCR_LOOP) 23750983Swpaul mii->mii_media_active |= IFM_LOOP; 23850983Swpaul 23950983Swpaul if (bmcr & BMCR_AUTOEN) { 24050983Swpaul /* 24150983Swpaul * The PAR status bits are only valid of autonegotiation 24250983Swpaul * has completed (or it's disabled). 24350983Swpaul */ 24450983Swpaul if ((bmsr & BMSR_ACOMP) == 0) { 24550983Swpaul /* Erg, still trying, I guess... */ 24650983Swpaul mii->mii_media_active |= IFM_NONE; 24750983Swpaul return; 24850983Swpaul } 24950983Swpaul 25050983Swpaul if (PHY_READ(sc, MII_ANER) & ANER_LPAN) { 25150983Swpaul anlpar = PHY_READ(sc, MII_ANAR) & 25250983Swpaul PHY_READ(sc, MII_ANLPAR); 25350983Swpaul if (anlpar & ANLPAR_T4) 25450983Swpaul mii->mii_media_active |= IFM_100_T4; 25550983Swpaul else if (anlpar & ANLPAR_TX_FD) 25650983Swpaul mii->mii_media_active |= IFM_100_TX|IFM_FDX; 25750983Swpaul else if (anlpar & ANLPAR_TX) 25850983Swpaul mii->mii_media_active |= IFM_100_TX; 25950983Swpaul else if (anlpar & ANLPAR_10_FD) 26050983Swpaul mii->mii_media_active |= IFM_10_T|IFM_FDX; 26150983Swpaul else if (anlpar & ANLPAR_10) 26250983Swpaul mii->mii_media_active |= IFM_10_T; 26350983Swpaul else 26450983Swpaul mii->mii_media_active |= IFM_NONE; 26550983Swpaul return; 26650983Swpaul } 26750983Swpaul 26850983Swpaul /* 26950983Swpaul * Link partner is not capable of autonegotiation. 27050983Swpaul */ 27150983Swpaul par = PHY_READ(sc, MII_AMPHY_DSCSR); 27250983Swpaul if (par & DSCSR_100FDX) 27350983Swpaul mii->mii_media_active |= IFM_100_TX|IFM_FDX; 27450983Swpaul else if (par & DSCSR_100HDX) 27550983Swpaul mii->mii_media_active |= IFM_100_TX; 27650983Swpaul else if (par & DSCSR_10FDX) 27750983Swpaul mii->mii_media_active |= IFM_10_T|IFM_HDX; 27850983Swpaul else if (par & DSCSR_10HDX) 27950983Swpaul mii->mii_media_active |= IFM_10_T; 28050983Swpaul } else 28150983Swpaul mii->mii_media_active = mii_media_from_bmcr(bmcr); 28250983Swpaul} 283