Home | History | Annotate | Line # | Download | only in mii
iophy.c revision 1.37
      1 /*	$NetBSD: iophy.c,v 1.37 2014/06/16 16:48:16 msaitoh Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 1998, 1999, 2000 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
      9  * NASA Ames Research Center.
     10  *
     11  * Redistribution and use in source and binary forms, with or without
     12  * modification, are permitted provided that the following conditions
     13  * are met:
     14  * 1. Redistributions of source code must retain the above copyright
     15  *    notice, this list of conditions and the following disclaimer.
     16  * 2. Redistributions in binary form must reproduce the above copyright
     17  *    notice, this list of conditions and the following disclaimer in the
     18  *    documentation and/or other materials provided with the distribution.
     19  *
     20  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     21  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     22  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     23  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     24  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     25  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     26  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     27  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     28  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     29  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     30  * POSSIBILITY OF SUCH DAMAGE.
     31  */
     32 
     33 /*
     34  * Copyright (c) 1997 Manuel Bouyer.  All rights reserved.
     35  *
     36  * Redistribution and use in source and binary forms, with or without
     37  * modification, are permitted provided that the following conditions
     38  * are met:
     39  * 1. Redistributions of source code must retain the above copyright
     40  *    notice, this list of conditions and the following disclaimer.
     41  * 2. Redistributions in binary form must reproduce the above copyright
     42  *    notice, this list of conditions and the following disclaimer in the
     43  *    documentation and/or other materials provided with the distribution.
     44  *
     45  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     46  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     47  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     48  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     49  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     50  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     51  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     52  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     53  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     54  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     55  */
     56 
     57 /*
     58  * Intel 82553 PHY driver
     59  */
     60 
     61 #include <sys/cdefs.h>
     62 __KERNEL_RCSID(0, "$NetBSD: iophy.c,v 1.37 2014/06/16 16:48:16 msaitoh Exp $");
     63 
     64 #include <sys/param.h>
     65 #include <sys/systm.h>
     66 #include <sys/kernel.h>
     67 #include <sys/device.h>
     68 #include <sys/socket.h>
     69 
     70 #include <net/if.h>
     71 #include <net/if_media.h>
     72 
     73 #include <dev/mii/mii.h>
     74 #include <dev/mii/miivar.h>
     75 #include <dev/mii/miidevs.h>
     76 
     77 #include <dev/mii/iophyreg.h>
     78 
     79 static int	iophymatch(device_t, cfdata_t, void *);
     80 static void	iophyattach(device_t, device_t, void *);
     81 
     82 CFATTACH_DECL_NEW(iophy, sizeof(struct mii_softc),
     83     iophymatch, iophyattach, mii_phy_detach, mii_phy_activate);
     84 
     85 static int	iophy_service(struct mii_softc *, struct mii_data *, int);
     86 static void	iophy_status(struct mii_softc *);
     87 
     88 static const struct mii_phy_funcs iophy_funcs = {
     89 	iophy_service, iophy_status, mii_phy_reset,
     90 };
     91 
     92 static const struct mii_phydesc iophys[] = {
     93 	{ MII_OUI_xxINTEL,		MII_MODEL_xxINTEL_I82553,
     94 	  MII_STR_xxINTEL_I82553 },
     95 
     96 	{ MII_OUI_yyINTEL,		MII_MODEL_yyINTEL_I82553,
     97 	  MII_STR_yyINTEL_I82553 },
     98 
     99 	{ 0,				0,
    100 	  NULL },
    101 };
    102 
    103 static int
    104 iophymatch(device_t parent, cfdata_t match, void *aux)
    105 {
    106 	struct mii_attach_args *ma = aux;
    107 
    108 	if (mii_phy_match(ma, iophys) != NULL)
    109 		return (10);
    110 
    111 	return (0);
    112 }
    113 
    114 static void
    115 iophyattach(device_t parent, device_t self, void *aux)
    116 {
    117 	struct mii_softc *sc = device_private(self);
    118 	struct mii_attach_args *ma = aux;
    119 	struct mii_data *mii = ma->mii_data;
    120 	const struct mii_phydesc *mpd;
    121 
    122 	mpd = mii_phy_match(ma, iophys);
    123 	aprint_naive(": Media interface\n");
    124 	aprint_normal(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
    125 
    126 	sc->mii_dev = self;
    127 	sc->mii_inst = mii->mii_instance;
    128 	sc->mii_phy = ma->mii_phyno;
    129 	sc->mii_funcs = &iophy_funcs;
    130 	sc->mii_pdata = mii;
    131 	sc->mii_flags = ma->mii_flags;
    132 	sc->mii_anegticks = MII_ANEGTICKS;
    133 
    134 	PHY_RESET(sc);
    135 
    136 	sc->mii_capabilities =
    137 	    PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
    138 	aprint_normal_dev(self, "");
    139 	if ((sc->mii_capabilities & BMSR_MEDIAMASK) == 0)
    140 		aprint_error("no media present");
    141 	else
    142 		mii_phy_add_media(sc);
    143 	aprint_normal("\n");
    144 }
    145 
    146 static int
    147 iophy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
    148 {
    149 	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    150 	int reg;
    151 
    152 	switch (cmd) {
    153 	case MII_POLLSTAT:
    154 		/*
    155 		 * If we're not polling our PHY instance, just return.
    156 		 */
    157 		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    158 			return (0);
    159 		break;
    160 
    161 	case MII_MEDIACHG:
    162 		/*
    163 		 * If the media indicates a different PHY instance,
    164 		 * isolate ourselves.
    165 		 */
    166 		if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
    167 			reg = PHY_READ(sc, MII_BMCR);
    168 			PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
    169 			return (0);
    170 		}
    171 
    172 		/*
    173 		 * If the interface is not up, don't do anything.
    174 		 */
    175 		if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
    176 			break;
    177 
    178 		mii_phy_setmedia(sc);
    179 		break;
    180 
    181 	case MII_TICK:
    182 		/*
    183 		 * If we're not currently selected, just return.
    184 		 */
    185 		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    186 			return (0);
    187 
    188 		if (mii_phy_tick(sc) == EJUSTRETURN)
    189 			return (0);
    190 		break;
    191 
    192 	case MII_DOWN:
    193 		mii_phy_down(sc);
    194 		return (0);
    195 	}
    196 
    197 	/* Update the media status. */
    198 	mii_phy_status(sc);
    199 
    200 	/* Callback if something changed. */
    201 	mii_phy_update(sc, cmd);
    202 	return (0);
    203 }
    204 
    205 static void
    206 iophy_status(struct mii_softc *sc)
    207 {
    208 	struct mii_data *mii = sc->mii_pdata;
    209 	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    210 	int bmsr, bmcr, ext0;
    211 
    212 	mii->mii_media_status = IFM_AVALID;
    213 	mii->mii_media_active = IFM_ETHER;
    214 
    215 	bmsr = PHY_READ(sc, MII_BMSR) |
    216 	    PHY_READ(sc, MII_BMSR);
    217 	if (bmsr & BMSR_LINK)
    218 		mii->mii_media_status |= IFM_ACTIVE;
    219 
    220 	bmcr = PHY_READ(sc, MII_BMCR);
    221 	if (bmcr & BMCR_ISO) {
    222 		mii->mii_media_active |= IFM_NONE;
    223 		mii->mii_media_status = 0;
    224 		return;
    225 	}
    226 
    227 	if (bmcr & BMCR_LOOP)
    228 		mii->mii_media_active |= IFM_LOOP;
    229 
    230 	if (bmcr & BMCR_AUTOEN) {
    231 		if ((bmsr & BMSR_ACOMP) == 0) {
    232 			/* Erg, still trying, I guess... */
    233 			mii->mii_media_active |= IFM_NONE;
    234 			return;
    235 		}
    236 		ext0 = PHY_READ(sc, MII_IOPHY_EXT0);
    237 
    238 		if (ext0 & EXT0_SPEED) {
    239 			if ((bmsr & BMSR_100TXFDX) || (bmsr & BMSR_100TXHDX)) {
    240 				mii->mii_media_active |= IFM_100_TX;
    241 			} else if (bmsr & BMSR_100T4) {
    242 				mii->mii_media_active |= IFM_100_T4;
    243 			}
    244 		} else
    245 			mii->mii_media_active |= IFM_10_T;
    246 
    247 		if (ext0 & EXT0_DUPLEX)
    248 			mii->mii_media_active |= IFM_FDX;
    249 		else
    250 			mii->mii_media_active |= IFM_HDX;
    251 	} else
    252 		mii->mii_media_active = ife->ifm_media;
    253 }
    254