amphy.c revision 175703
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 175703 2008-01-27 01:11:57Z marius $"); 35119418Sobrien 3650983Swpaul/* 3750983Swpaul * driver for AMD AM79c873 PHYs 38164835Smarius * This driver also works for Davicom DM910{1,2} PHYs, which appear 39164835Smarius * to be AM79c873 workalikes. 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[] = { 86164835Smarius MII_PHY_DESC(DAVICOM, DM9102), 87164827Smarius MII_PHY_DESC(xxAMD, 79C873), 88164827Smarius MII_PHY_DESC(xxDAVICOM, DM9101), 89164827Smarius MII_PHY_END 90164827Smarius}; 91164827Smarius 92105135Salfredstatic int 93150763Simpamphy_probe(device_t dev) 9450983Swpaul{ 9550983Swpaul 96164827Smarius return (mii_phy_dev_probe(dev, amphys, BUS_PROBE_DEFAULT)); 9750983Swpaul} 9850983Swpaul 99105135Salfredstatic int 100150763Simpamphy_attach(device_t dev) 10150983Swpaul{ 10250983Swpaul struct mii_softc *sc; 10350983Swpaul struct mii_attach_args *ma; 10450983Swpaul struct mii_data *mii; 10550983Swpaul 10650983Swpaul sc = device_get_softc(dev); 10750983Swpaul ma = device_get_ivars(dev); 10850983Swpaul sc->mii_dev = device_get_parent(dev); 10950983Swpaul mii = device_get_softc(sc->mii_dev); 11050983Swpaul LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 11150983Swpaul 11250983Swpaul sc->mii_inst = mii->mii_instance; 11350983Swpaul sc->mii_phy = ma->mii_phyno; 11450983Swpaul sc->mii_service = amphy_service; 11550983Swpaul sc->mii_pdata = mii; 11650983Swpaul 11750983Swpaul mii->mii_instance++; 11850983Swpaul 11950983Swpaul#define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL) 12050983Swpaul 12150983Swpaul#if 0 12250983Swpaul ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst), 123165985Smarius MII_MEDIA_100_TX); 12450983Swpaul#endif 12550983Swpaul 12650983Swpaul mii_phy_reset(sc); 12750983Swpaul 12850983Swpaul sc->mii_capabilities = 12950983Swpaul PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 13050983Swpaul device_printf(dev, " "); 131164835Smarius mii_phy_add_media(sc); 13250983Swpaul printf("\n"); 13350983Swpaul#undef ADD 13450983Swpaul MIIBUS_MEDIAINIT(sc->mii_dev); 135164835Smarius return (0); 13650983Swpaul} 13750983Swpaul 13884145Sjlemonstatic int 139150763Simpamphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 14050983Swpaul{ 14150983Swpaul struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 14250983Swpaul int reg; 14350983Swpaul 14450983Swpaul switch (cmd) { 14550983Swpaul case MII_POLLSTAT: 14650983Swpaul /* 14750983Swpaul * If we're not polling our PHY instance, just return. 14850983Swpaul */ 14950983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) 15050983Swpaul return (0); 15150983Swpaul break; 15250983Swpaul 15350983Swpaul case MII_MEDIACHG: 15450983Swpaul /* 15550983Swpaul * If the media indicates a different PHY instance, 15650983Swpaul * isolate ourselves. 15750983Swpaul */ 15850983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) { 15950983Swpaul reg = PHY_READ(sc, MII_BMCR); 16050983Swpaul PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO); 16150983Swpaul return (0); 16250983Swpaul } 16350983Swpaul 16450983Swpaul /* 16550983Swpaul * If the interface is not up, don't do anything. 16650983Swpaul */ 16750983Swpaul if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 16850983Swpaul break; 16950983Swpaul 170164835Smarius mii_phy_setmedia(sc); 17150983Swpaul break; 17250983Swpaul 17350983Swpaul case MII_TICK: 17450983Swpaul /* 17550983Swpaul * If we're not currently selected, just return. 17650983Swpaul */ 17750983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) 17850983Swpaul return (0); 17984145Sjlemon if (mii_phy_tick(sc) == EJUSTRETURN) 18050983Swpaul return (0); 18150983Swpaul break; 18250983Swpaul } 18350983Swpaul 18450983Swpaul /* Update the media status. */ 18550983Swpaul amphy_status(sc); 18650983Swpaul 18750983Swpaul /* Callback if something changed. */ 18884145Sjlemon mii_phy_update(sc, cmd); 18950983Swpaul return (0); 19050983Swpaul} 19150983Swpaul 19284145Sjlemonstatic void 193150763Simpamphy_status(struct mii_softc *sc) 19450983Swpaul{ 19550983Swpaul struct mii_data *mii = sc->mii_pdata; 196164835Smarius struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 19750983Swpaul int bmsr, bmcr, par, anlpar; 19850983Swpaul 19950983Swpaul mii->mii_media_status = IFM_AVALID; 20050983Swpaul mii->mii_media_active = IFM_ETHER; 20150983Swpaul 20250983Swpaul bmsr = PHY_READ(sc, MII_BMSR) | 20350983Swpaul PHY_READ(sc, MII_BMSR); 20450983Swpaul if (bmsr & BMSR_LINK) 20550983Swpaul mii->mii_media_status |= IFM_ACTIVE; 20650983Swpaul 20750983Swpaul bmcr = PHY_READ(sc, MII_BMCR); 20850983Swpaul if (bmcr & BMCR_ISO) { 20950983Swpaul mii->mii_media_active |= IFM_NONE; 21050983Swpaul mii->mii_media_status = 0; 21150983Swpaul return; 21250983Swpaul } 21350983Swpaul 21450983Swpaul if (bmcr & BMCR_LOOP) 21550983Swpaul mii->mii_media_active |= IFM_LOOP; 21650983Swpaul 21750983Swpaul if (bmcr & BMCR_AUTOEN) { 21850983Swpaul /* 219175703Smarius * The PAR status bits are only valid if autonegotiation 22050983Swpaul * has completed (or it's disabled). 22150983Swpaul */ 22250983Swpaul if ((bmsr & BMSR_ACOMP) == 0) { 22350983Swpaul /* Erg, still trying, I guess... */ 22450983Swpaul mii->mii_media_active |= IFM_NONE; 22550983Swpaul return; 22650983Swpaul } 22750983Swpaul 22850983Swpaul if (PHY_READ(sc, MII_ANER) & ANER_LPAN) { 22950983Swpaul anlpar = PHY_READ(sc, MII_ANAR) & 23050983Swpaul PHY_READ(sc, MII_ANLPAR); 231173665Syongari if (anlpar & ANLPAR_TX_FD) 232173665Syongari mii->mii_media_active |= IFM_100_TX|IFM_FDX; 233173665Syongari else if (anlpar & ANLPAR_T4) 23450983Swpaul mii->mii_media_active |= IFM_100_T4; 23550983Swpaul else if (anlpar & ANLPAR_TX) 23650983Swpaul mii->mii_media_active |= IFM_100_TX; 23750983Swpaul else if (anlpar & ANLPAR_10_FD) 23850983Swpaul mii->mii_media_active |= IFM_10_T|IFM_FDX; 23950983Swpaul else if (anlpar & ANLPAR_10) 24050983Swpaul mii->mii_media_active |= IFM_10_T; 24150983Swpaul else 24250983Swpaul mii->mii_media_active |= IFM_NONE; 24350983Swpaul return; 24450983Swpaul } 24550983Swpaul 24650983Swpaul /* 24750983Swpaul * Link partner is not capable of autonegotiation. 24850983Swpaul */ 24950983Swpaul par = PHY_READ(sc, MII_AMPHY_DSCSR); 25050983Swpaul if (par & DSCSR_100FDX) 25150983Swpaul mii->mii_media_active |= IFM_100_TX|IFM_FDX; 25250983Swpaul else if (par & DSCSR_100HDX) 25350983Swpaul mii->mii_media_active |= IFM_100_TX; 25450983Swpaul else if (par & DSCSR_10FDX) 25550983Swpaul mii->mii_media_active |= IFM_10_T|IFM_HDX; 25650983Swpaul else if (par & DSCSR_10HDX) 25750983Swpaul mii->mii_media_active |= IFM_10_T; 25850983Swpaul } else 259164835Smarius mii->mii_media_active = ife->ifm_media; 26050983Swpaul} 261