amphy.c revision 92739
150983Swpaul/* 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 * $FreeBSD: head/sys/dev/mii/amphy.c 92739 2002-03-20 02:08:01Z alfred $ 3350983Swpaul */ 3450983Swpaul 3550983Swpaul/* 3650983Swpaul * driver for AMD AM79c873 PHYs 3751428Swpaul * This driver also works for the Davicom DM9101 PHY, which appears to 3851428Swpaul * be an AM79c873 workalike. 3950983Swpaul */ 4050983Swpaul 4150983Swpaul#include <sys/param.h> 4250983Swpaul#include <sys/systm.h> 4350983Swpaul#include <sys/kernel.h> 4450983Swpaul#include <sys/socket.h> 4550983Swpaul#include <sys/bus.h> 4650983Swpaul 4750983Swpaul#include <net/if.h> 4850983Swpaul#include <net/if_media.h> 4950983Swpaul 5050983Swpaul#include <dev/mii/mii.h> 5150983Swpaul#include <dev/mii/miivar.h> 5250983Swpaul#include <dev/mii/miidevs.h> 5350983Swpaul 5450983Swpaul#include <dev/mii/amphyreg.h> 5550983Swpaul 5650983Swpaul#include "miibus_if.h" 5750983Swpaul 5850983Swpaul#if !defined(lint) 5950983Swpaulstatic const char rcsid[] = 6050983Swpaul "$FreeBSD: head/sys/dev/mii/amphy.c 92739 2002-03-20 02:08:01Z alfred $"; 6150983Swpaul#endif 6250983Swpaul 6392739Salfredstatic int amphy_probe (device_t); 6492739Salfredstatic int amphy_attach (device_t); 6592739Salfredstatic int amphy_detach (device_t); 6650983Swpaul 6750983Swpaulstatic device_method_t amphy_methods[] = { 6850983Swpaul /* device interface */ 6950983Swpaul DEVMETHOD(device_probe, amphy_probe), 7050983Swpaul DEVMETHOD(device_attach, amphy_attach), 7150983Swpaul DEVMETHOD(device_detach, amphy_detach), 7250983Swpaul DEVMETHOD(device_shutdown, bus_generic_shutdown), 7350983Swpaul { 0, 0 } 7450983Swpaul}; 7550983Swpaul 7650983Swpaulstatic devclass_t amphy_devclass; 7750983Swpaul 7850983Swpaulstatic driver_t amphy_driver = { 7950983Swpaul "amphy", 8050983Swpaul amphy_methods, 8150983Swpaul sizeof(struct mii_softc) 8250983Swpaul}; 8350983Swpaul 8450983SwpaulDRIVER_MODULE(amphy, miibus, amphy_driver, amphy_devclass, 0, 0); 8550983Swpaul 8692739Salfredstatic int amphy_service(struct mii_softc *, struct mii_data *, int); 8792739Salfredstatic void amphy_status(struct mii_softc *); 8850983Swpaul 8950983Swpaulstatic int amphy_probe(dev) 9050983Swpaul device_t dev; 9150983Swpaul{ 9250983Swpaul struct mii_attach_args *ma; 9350983Swpaul 9450983Swpaul ma = device_get_ivars(dev); 9550983Swpaul 9651428Swpaul if ((MII_OUI(ma->mii_id1, ma->mii_id2) != MII_OUI_xxAMD || 9751428Swpaul MII_MODEL(ma->mii_id2) != MII_MODEL_xxAMD_79C873) && 9851428Swpaul (MII_OUI(ma->mii_id1, ma->mii_id2) != MII_OUI_xxDAVICOM || 9951428Swpaul MII_MODEL(ma->mii_id2) != MII_MODEL_xxDAVICOM_DM9101)) 10050983Swpaul return(ENXIO); 10150983Swpaul 10251428Swpaul if (MII_OUI(ma->mii_id1, ma->mii_id2) == MII_OUI_xxAMD) 10351428Swpaul device_set_desc(dev, MII_STR_xxAMD_79C873); 10451428Swpaul else if (MII_OUI(ma->mii_id1, ma->mii_id2) == MII_OUI_xxDAVICOM) 10551428Swpaul device_set_desc(dev, MII_STR_xxDAVICOM_DM9101); 10650983Swpaul 10750983Swpaul return(0); 10850983Swpaul} 10950983Swpaul 11050983Swpaulstatic int amphy_attach(dev) 11150983Swpaul device_t dev; 11250983Swpaul{ 11350983Swpaul struct mii_softc *sc; 11450983Swpaul struct mii_attach_args *ma; 11550983Swpaul struct mii_data *mii; 11650983Swpaul 11750983Swpaul sc = device_get_softc(dev); 11850983Swpaul ma = device_get_ivars(dev); 11950983Swpaul sc->mii_dev = device_get_parent(dev); 12050983Swpaul mii = device_get_softc(sc->mii_dev); 12150983Swpaul LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 12250983Swpaul 12350983Swpaul sc->mii_inst = mii->mii_instance; 12450983Swpaul sc->mii_phy = ma->mii_phyno; 12550983Swpaul sc->mii_service = amphy_service; 12650983Swpaul sc->mii_pdata = mii; 12750983Swpaul 12850983Swpaul sc->mii_flags |= MIIF_NOISOLATE; 12950983Swpaul mii->mii_instance++; 13050983Swpaul 13150983Swpaul#define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL) 13250983Swpaul 13350983Swpaul ADD(IFM_MAKEWORD(IFM_ETHER, IFM_NONE, 0, sc->mii_inst), 13450983Swpaul BMCR_ISO); 13550983Swpaul#if 0 13650983Swpaul ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst), 13750983Swpaul BMCR_LOOP|BMCR_S100); 13850983Swpaul#endif 13950983Swpaul 14050983Swpaul mii_phy_reset(sc); 14150983Swpaul 14250983Swpaul sc->mii_capabilities = 14350983Swpaul PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 14450983Swpaul device_printf(dev, " "); 14550983Swpaul if ((sc->mii_capabilities & BMSR_MEDIAMASK) == 0) 14650983Swpaul printf("no media present"); 14750983Swpaul else 14850983Swpaul mii_add_media(mii, sc->mii_capabilities, 14950983Swpaul sc->mii_inst); 15050983Swpaul printf("\n"); 15150983Swpaul#undef ADD 15250983Swpaul MIIBUS_MEDIAINIT(sc->mii_dev); 15350983Swpaul return(0); 15450983Swpaul} 15550983Swpaul 15650983Swpaulstatic int amphy_detach(dev) 15750983Swpaul device_t dev; 15850983Swpaul{ 15950983Swpaul struct mii_softc *sc; 16050983Swpaul struct mii_data *mii; 16150983Swpaul 16250983Swpaul sc = device_get_softc(dev); 16350983Swpaul mii = device_get_softc(device_get_parent(dev)); 16469925Swpaul mii_phy_auto_stop(sc); 16550983Swpaul sc->mii_dev = NULL; 16650983Swpaul LIST_REMOVE(sc, mii_list); 16750983Swpaul 16850983Swpaul return(0); 16950983Swpaul} 17084145Sjlemon 17184145Sjlemonstatic int 17250983Swpaulamphy_service(sc, mii, cmd) 17350983Swpaul struct mii_softc *sc; 17450983Swpaul struct mii_data *mii; 17550983Swpaul int cmd; 17650983Swpaul{ 17750983Swpaul struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 17850983Swpaul int reg; 17950983Swpaul 18050983Swpaul switch (cmd) { 18150983Swpaul case MII_POLLSTAT: 18250983Swpaul /* 18350983Swpaul * If we're not polling our PHY instance, just return. 18450983Swpaul */ 18550983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) 18650983Swpaul return (0); 18750983Swpaul break; 18850983Swpaul 18950983Swpaul case MII_MEDIACHG: 19050983Swpaul /* 19150983Swpaul * If the media indicates a different PHY instance, 19250983Swpaul * isolate ourselves. 19350983Swpaul */ 19450983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) { 19550983Swpaul reg = PHY_READ(sc, MII_BMCR); 19650983Swpaul PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO); 19750983Swpaul return (0); 19850983Swpaul } 19950983Swpaul 20050983Swpaul /* 20150983Swpaul * If the interface is not up, don't do anything. 20250983Swpaul */ 20350983Swpaul if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 20450983Swpaul break; 20550983Swpaul 20650983Swpaul switch (IFM_SUBTYPE(ife->ifm_media)) { 20750983Swpaul case IFM_AUTO: 20850983Swpaul /* 20950983Swpaul * If we're already in auto mode, just return. 21050983Swpaul */ 21150983Swpaul if (PHY_READ(sc, MII_BMCR) & BMCR_AUTOEN) 21250983Swpaul return (0); 21350983Swpaul (void) mii_phy_auto(sc, 1); 21450983Swpaul break; 21550983Swpaul case IFM_100_T4: 21650983Swpaul /* 21750983Swpaul * XXX Not supported as a manual setting right now. 21850983Swpaul */ 21950983Swpaul return (EINVAL); 22050983Swpaul default: 22150983Swpaul /* 22250983Swpaul * BMCR data is stored in the ifmedia entry. 22350983Swpaul */ 22450983Swpaul PHY_WRITE(sc, MII_ANAR, 22550983Swpaul mii_anar(ife->ifm_media)); 22650983Swpaul PHY_WRITE(sc, MII_BMCR, ife->ifm_data); 22750983Swpaul } 22850983Swpaul break; 22950983Swpaul 23050983Swpaul case MII_TICK: 23150983Swpaul /* 23250983Swpaul * If we're not currently selected, just return. 23350983Swpaul */ 23450983Swpaul if (IFM_INST(ife->ifm_media) != sc->mii_inst) 23550983Swpaul return (0); 23684145Sjlemon if (mii_phy_tick(sc) == EJUSTRETURN) 23750983Swpaul return (0); 23850983Swpaul break; 23950983Swpaul } 24050983Swpaul 24150983Swpaul /* Update the media status. */ 24250983Swpaul amphy_status(sc); 24350983Swpaul 24450983Swpaul /* Callback if something changed. */ 24584145Sjlemon mii_phy_update(sc, cmd); 24650983Swpaul return (0); 24750983Swpaul} 24850983Swpaul 24984145Sjlemonstatic void 25050983Swpaulamphy_status(sc) 25150983Swpaul struct mii_softc *sc; 25250983Swpaul{ 25350983Swpaul struct mii_data *mii = sc->mii_pdata; 25450983Swpaul int bmsr, bmcr, par, anlpar; 25550983Swpaul 25650983Swpaul mii->mii_media_status = IFM_AVALID; 25750983Swpaul mii->mii_media_active = IFM_ETHER; 25850983Swpaul 25950983Swpaul bmsr = PHY_READ(sc, MII_BMSR) | 26050983Swpaul PHY_READ(sc, MII_BMSR); 26150983Swpaul if (bmsr & BMSR_LINK) 26250983Swpaul mii->mii_media_status |= IFM_ACTIVE; 26350983Swpaul 26450983Swpaul bmcr = PHY_READ(sc, MII_BMCR); 26550983Swpaul if (bmcr & BMCR_ISO) { 26650983Swpaul mii->mii_media_active |= IFM_NONE; 26750983Swpaul mii->mii_media_status = 0; 26850983Swpaul return; 26950983Swpaul } 27050983Swpaul 27150983Swpaul if (bmcr & BMCR_LOOP) 27250983Swpaul mii->mii_media_active |= IFM_LOOP; 27350983Swpaul 27450983Swpaul if (bmcr & BMCR_AUTOEN) { 27550983Swpaul /* 27650983Swpaul * The PAR status bits are only valid of autonegotiation 27750983Swpaul * has completed (or it's disabled). 27850983Swpaul */ 27950983Swpaul if ((bmsr & BMSR_ACOMP) == 0) { 28050983Swpaul /* Erg, still trying, I guess... */ 28150983Swpaul mii->mii_media_active |= IFM_NONE; 28250983Swpaul return; 28350983Swpaul } 28450983Swpaul 28550983Swpaul if (PHY_READ(sc, MII_ANER) & ANER_LPAN) { 28650983Swpaul anlpar = PHY_READ(sc, MII_ANAR) & 28750983Swpaul PHY_READ(sc, MII_ANLPAR); 28850983Swpaul if (anlpar & ANLPAR_T4) 28950983Swpaul mii->mii_media_active |= IFM_100_T4; 29050983Swpaul else if (anlpar & ANLPAR_TX_FD) 29150983Swpaul mii->mii_media_active |= IFM_100_TX|IFM_FDX; 29250983Swpaul else if (anlpar & ANLPAR_TX) 29350983Swpaul mii->mii_media_active |= IFM_100_TX; 29450983Swpaul else if (anlpar & ANLPAR_10_FD) 29550983Swpaul mii->mii_media_active |= IFM_10_T|IFM_FDX; 29650983Swpaul else if (anlpar & ANLPAR_10) 29750983Swpaul mii->mii_media_active |= IFM_10_T; 29850983Swpaul else 29950983Swpaul mii->mii_media_active |= IFM_NONE; 30050983Swpaul return; 30150983Swpaul } 30250983Swpaul 30350983Swpaul /* 30450983Swpaul * Link partner is not capable of autonegotiation. 30550983Swpaul */ 30650983Swpaul par = PHY_READ(sc, MII_AMPHY_DSCSR); 30750983Swpaul if (par & DSCSR_100FDX) 30850983Swpaul mii->mii_media_active |= IFM_100_TX|IFM_FDX; 30950983Swpaul else if (par & DSCSR_100HDX) 31050983Swpaul mii->mii_media_active |= IFM_100_TX; 31150983Swpaul else if (par & DSCSR_10FDX) 31250983Swpaul mii->mii_media_active |= IFM_10_T|IFM_HDX; 31350983Swpaul else if (par & DSCSR_10HDX) 31450983Swpaul mii->mii_media_active |= IFM_10_T; 31550983Swpaul } else 31650983Swpaul mii->mii_media_active = mii_media_from_bmcr(bmcr); 31750983Swpaul} 318