Edit

IABSD.fr/src/sys/dev/mii/inphy.c

Branch :

  • Show log

    Commit

  • Author : jsg
    Date : 2015-03-14 03:38:46
    Hash : 21dab745
    Message : Remove some includes include-what-you-use claims don't have any direct symbols used. Tested for indirect use by compiling amd64/i386/sparc64 kernels. ok tedu@ deraadt@

  • sys/dev/mii/inphy.c
  • /*	$OpenBSD: inphy.c,v 1.21 2015/03/14 03:38:48 jsg Exp $	*/
    /*	$NetBSD: inphy.c,v 1.18 2000/02/02 23:34:56 thorpej Exp $	*/
    
    /*-
     * Copyright (c) 1998, 1999 The NetBSD Foundation, Inc.
     * All rights reserved.
     *
     * This code is derived from software contributed to The NetBSD Foundation
     * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
     * NASA Ames Research Center.
     *
     * Redistribution and use in source and binary forms, with or without
     * modification, are permitted provided that the following conditions
     * are met:
     * 1. Redistributions of source code must retain the above copyright
     *    notice, this list of conditions and the following disclaimer.
     * 2. Redistributions in binary form must reproduce the above copyright
     *    notice, this list of conditions and the following disclaimer in the
     *    documentation and/or other materials provided with the distribution.
     *
     * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     * POSSIBILITY OF SUCH DAMAGE.
     */
    
    /*
     * Copyright (c) 1997 Manuel Bouyer.  All rights reserved.
     *
     * Redistribution and use in source and binary forms, with or without
     * modification, are permitted provided that the following conditions
     * are met:
     * 1. Redistributions of source code must retain the above copyright
     *    notice, this list of conditions and the following disclaimer.
     * 2. Redistributions in binary form must reproduce the above copyright
     *    notice, this list of conditions and the following disclaimer in the
     *    documentation and/or other materials provided with the distribution.
     *
     * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     */
    
    /*
     * driver for Intel's i82555 ethernet 10/100 PHY
     * Data Sheet available from www.intel.com
     */
    
    #include <sys/param.h>
    #include <sys/systm.h>
    #include <sys/device.h>
    #include <sys/socket.h>
    #include <sys/errno.h>
    
    #include <net/if.h>
    #include <net/if_var.h>
    #include <net/if_media.h>
    
    #include <dev/mii/mii.h>
    #include <dev/mii/miivar.h>
    #include <dev/mii/miidevs.h>
    
    #include <dev/mii/inphyreg.h>
    
    int	inphymatch(struct device *, void *, void *);
    void	inphyattach(struct device *, struct device *, void *);
    
    struct cfattach inphy_ca = {
    	sizeof(struct mii_softc), inphymatch, inphyattach, mii_phy_detach
    };
    
    struct cfdriver inphy_cd = {
    	NULL, "inphy", DV_DULL
    };
    
    int	inphy_service(struct mii_softc *, struct mii_data *, int);
    void	inphy_status(struct mii_softc *);
    
    const struct mii_phy_funcs inphy_funcs = {
    	inphy_service, inphy_status, mii_phy_reset,
    };
    
    static const struct mii_phydesc inphys[] = {
    	{ MII_OUI_INTEL,		MII_MODEL_INTEL_I82555,
    	  MII_STR_INTEL_I82555 },
    	{ MII_OUI_INTEL,		MII_MODEL_INTEL_I82562EM,
    	  MII_STR_INTEL_I82562EM },
    	{ MII_OUI_INTEL,		MII_MODEL_INTEL_I82562ET,
    	  MII_STR_INTEL_I82562ET },
    	{ MII_OUI_INTEL,		MII_MODEL_INTEL_I82562G,
    	  MII_STR_INTEL_I82562G },
    
    	{ 0,			0,
    	  NULL },
    };
    
    int
    inphymatch(parent, match, aux)
    	struct device *parent;
    	void *match;
    	void *aux;
    {
    	struct mii_attach_args *ma = aux;
    
    	if (mii_phy_match(ma, inphys) != NULL)
    		return (10);
    
    	return (0);
    }
    
    void
    inphyattach(parent, self, aux)
    	struct device *parent, *self;
    	void *aux;
    {
    	struct mii_softc *sc = (struct mii_softc *)self;
    	struct mii_attach_args *ma = aux;
    	struct mii_data *mii = ma->mii_data;
    	const struct mii_phydesc *mpd;
    
    	mpd = mii_phy_match(ma, inphys);
    	printf(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
    
    	sc->mii_inst = mii->mii_instance;
    	sc->mii_phy = ma->mii_phyno;
    	sc->mii_funcs = &inphy_funcs;
    	sc->mii_pdata = mii;
    	sc->mii_flags = ma->mii_flags;
    
    	PHY_RESET(sc);
    
    	sc->mii_capabilities =
    	    PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
    	if (sc->mii_capabilities & BMSR_MEDIAMASK)
    		mii_phy_add_media(sc);
    }
    
    int
    inphy_service(sc, mii, cmd)
    	struct mii_softc *sc;
    	struct mii_data *mii;
    	int cmd;
    {
    	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    	int reg;
    
    	if ((sc->mii_dev.dv_flags & DVF_ACTIVE) == 0)
    		return (ENXIO);
    
    	switch (cmd) {
    	case MII_POLLSTAT:
    		/*
    		 * If we're not polling our PHY instance, just return.
    		 */
    		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    			return (0);
    		break;
    
    	case MII_MEDIACHG:
    		/*
    		 * If the media indicates a different PHY instance,
    		 * isolate ourselves.
    		 */
    		if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
    			reg = PHY_READ(sc, MII_BMCR);
    			PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
    			return (0);
    		}
    
    		/*
    		 * If the interface is not up, don't do anything.
    		 */
    		if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
    			break;
    
    		mii_phy_setmedia(sc);
    		break;
    
    	case MII_TICK:
    		/*
    		 * If we're not currently selected, just return.
    		 */
    		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    			return (0);
    
    		if (mii_phy_tick(sc) == EJUSTRETURN)
    			return (0);
    		break;
    
    	case MII_DOWN:
    		mii_phy_down(sc);
    		return (0);
    	}
    
    	/* Update the media status. */
    	mii_phy_status(sc);
    
    	/* Callback if something changed. */
    	mii_phy_update(sc, cmd);
    	return (0);
    }
    
    void
    inphy_status(sc)
    	struct mii_softc *sc;
    {
    	struct mii_data *mii = sc->mii_pdata;
    	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    	int bmsr, bmcr, scr;
    
    	mii->mii_media_status = IFM_AVALID;
    	mii->mii_media_active = IFM_ETHER;
    
    	bmsr = PHY_READ(sc, MII_BMSR) |
    	    PHY_READ(sc, MII_BMSR);
    	if (bmsr & BMSR_LINK)
    		mii->mii_media_status |= IFM_ACTIVE;
    
    	bmcr = PHY_READ(sc, MII_BMCR);
    	if (bmcr & BMCR_ISO) {
    		mii->mii_media_active |= IFM_NONE;
    		mii->mii_media_status = 0;
    		return;
    	}
    
    	if (bmcr & BMCR_LOOP)
    		mii->mii_media_active |= IFM_LOOP;
    
    	if (bmcr & BMCR_AUTOEN) {
    		if ((bmsr & BMSR_ACOMP) == 0) {
    			/* Erg, still trying, I guess... */
    			mii->mii_media_active |= IFM_NONE;
    			return;
    		}
    
    		scr = PHY_READ(sc, MII_INPHY_SCR);
    		if (scr & SCR_S100)
    			mii->mii_media_active |= IFM_100_TX;
    		else if ((bmsr & BMSR_100T4) && (scr & SCR_T4))
    			mii->mii_media_active |= IFM_100_T4;
    		else
    			mii->mii_media_active |= IFM_10_T;
    
    		if (scr & SCR_FDX)
    			mii->mii_media_active |= IFM_FDX;
    		else
    			mii->mii_media_active |= IFM_HDX;
    	} else
    		mii->mii_media_active = ife->ifm_media;
    }