Home | History | Annotate | Line # | Download | only in mii
brgphy.c revision 1.2.2.7
      1  1.2.2.7  nathanw /*	$NetBSD: brgphy.c,v 1.2.2.7 2002/08/01 02:45:02 nathanw Exp $	*/
      2  1.2.2.2  nathanw 
      3  1.2.2.2  nathanw /*-
      4  1.2.2.2  nathanw  * Copyright (c) 1998, 1999, 2000, 2001 The NetBSD Foundation, Inc.
      5  1.2.2.2  nathanw  * All rights reserved.
      6  1.2.2.2  nathanw  *
      7  1.2.2.2  nathanw  * This code is derived from software contributed to The NetBSD Foundation
      8  1.2.2.2  nathanw  * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
      9  1.2.2.2  nathanw  * NASA Ames Research Center.
     10  1.2.2.2  nathanw  *
     11  1.2.2.2  nathanw  * Redistribution and use in source and binary forms, with or without
     12  1.2.2.2  nathanw  * modification, are permitted provided that the following conditions
     13  1.2.2.2  nathanw  * are met:
     14  1.2.2.2  nathanw  * 1. Redistributions of source code must retain the above copyright
     15  1.2.2.2  nathanw  *    notice, this list of conditions and the following disclaimer.
     16  1.2.2.2  nathanw  * 2. Redistributions in binary form must reproduce the above copyright
     17  1.2.2.2  nathanw  *    notice, this list of conditions and the following disclaimer in the
     18  1.2.2.2  nathanw  *    documentation and/or other materials provided with the distribution.
     19  1.2.2.2  nathanw  * 3. All advertising materials mentioning features or use of this software
     20  1.2.2.2  nathanw  *    must display the following acknowledgement:
     21  1.2.2.2  nathanw  *	This product includes software developed by the NetBSD
     22  1.2.2.2  nathanw  *	Foundation, Inc. and its contributors.
     23  1.2.2.2  nathanw  * 4. Neither the name of The NetBSD Foundation nor the names of its
     24  1.2.2.2  nathanw  *    contributors may be used to endorse or promote products derived
     25  1.2.2.2  nathanw  *    from this software without specific prior written permission.
     26  1.2.2.2  nathanw  *
     27  1.2.2.2  nathanw  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     28  1.2.2.2  nathanw  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     29  1.2.2.2  nathanw  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     30  1.2.2.2  nathanw  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     31  1.2.2.2  nathanw  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32  1.2.2.2  nathanw  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33  1.2.2.2  nathanw  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34  1.2.2.2  nathanw  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35  1.2.2.2  nathanw  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36  1.2.2.2  nathanw  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37  1.2.2.2  nathanw  * POSSIBILITY OF SUCH DAMAGE.
     38  1.2.2.2  nathanw  */
     39  1.2.2.2  nathanw 
     40  1.2.2.2  nathanw /*
     41  1.2.2.2  nathanw  * Copyright (c) 1997 Manuel Bouyer.  All rights reserved.
     42  1.2.2.2  nathanw  *
     43  1.2.2.2  nathanw  * Redistribution and use in source and binary forms, with or without
     44  1.2.2.2  nathanw  * modification, are permitted provided that the following conditions
     45  1.2.2.2  nathanw  * are met:
     46  1.2.2.2  nathanw  * 1. Redistributions of source code must retain the above copyright
     47  1.2.2.2  nathanw  *    notice, this list of conditions and the following disclaimer.
     48  1.2.2.2  nathanw  * 2. Redistributions in binary form must reproduce the above copyright
     49  1.2.2.2  nathanw  *    notice, this list of conditions and the following disclaimer in the
     50  1.2.2.2  nathanw  *    documentation and/or other materials provided with the distribution.
     51  1.2.2.2  nathanw  * 3. All advertising materials mentioning features or use of this software
     52  1.2.2.2  nathanw  *    must display the following acknowledgement:
     53  1.2.2.2  nathanw  *	This product includes software developed by Manuel Bouyer.
     54  1.2.2.2  nathanw  * 4. The name of the author may not be used to endorse or promote products
     55  1.2.2.2  nathanw  *    derived from this software without specific prior written permission.
     56  1.2.2.2  nathanw  *
     57  1.2.2.2  nathanw  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     58  1.2.2.2  nathanw  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     59  1.2.2.2  nathanw  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     60  1.2.2.2  nathanw  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     61  1.2.2.2  nathanw  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     62  1.2.2.2  nathanw  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     63  1.2.2.2  nathanw  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     64  1.2.2.2  nathanw  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     65  1.2.2.2  nathanw  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     66  1.2.2.2  nathanw  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     67  1.2.2.2  nathanw  */
     68  1.2.2.2  nathanw 
     69  1.2.2.2  nathanw /*
     70  1.2.2.2  nathanw  * driver for the Broadcom BCM5400 Gig-E PHY.
     71  1.2.2.2  nathanw  *
     72  1.2.2.2  nathanw  * Programming information for this PHY was gleaned from FreeBSD
     73  1.2.2.2  nathanw  * (they were apparently able to get a datasheet from Broadcom).
     74  1.2.2.2  nathanw  */
     75  1.2.2.2  nathanw 
     76  1.2.2.5  nathanw #include <sys/cdefs.h>
     77  1.2.2.7  nathanw __KERNEL_RCSID(0, "$NetBSD: brgphy.c,v 1.2.2.7 2002/08/01 02:45:02 nathanw Exp $");
     78  1.2.2.5  nathanw 
     79  1.2.2.2  nathanw #include <sys/param.h>
     80  1.2.2.2  nathanw #include <sys/systm.h>
     81  1.2.2.2  nathanw #include <sys/kernel.h>
     82  1.2.2.2  nathanw #include <sys/device.h>
     83  1.2.2.2  nathanw #include <sys/socket.h>
     84  1.2.2.2  nathanw #include <sys/errno.h>
     85  1.2.2.2  nathanw 
     86  1.2.2.2  nathanw #include <net/if.h>
     87  1.2.2.2  nathanw #include <net/if_media.h>
     88  1.2.2.2  nathanw 
     89  1.2.2.2  nathanw #include <dev/mii/mii.h>
     90  1.2.2.2  nathanw #include <dev/mii/miivar.h>
     91  1.2.2.2  nathanw #include <dev/mii/miidevs.h>
     92  1.2.2.2  nathanw 
     93  1.2.2.2  nathanw #include <dev/mii/brgphyreg.h>
     94  1.2.2.2  nathanw 
     95  1.2.2.4  nathanw int	brgphymatch(struct device *, struct cfdata *, void *);
     96  1.2.2.4  nathanw void	brgphyattach(struct device *, struct device *, void *);
     97  1.2.2.2  nathanw 
     98  1.2.2.2  nathanw struct cfattach brgphy_ca = {
     99  1.2.2.2  nathanw 	sizeof(struct mii_softc), brgphymatch, brgphyattach,
    100  1.2.2.2  nathanw 	    mii_phy_detach, mii_phy_activate
    101  1.2.2.2  nathanw };
    102  1.2.2.2  nathanw 
    103  1.2.2.4  nathanw int	brgphy_service(struct mii_softc *, struct mii_data *, int);
    104  1.2.2.4  nathanw void	brgphy_status(struct mii_softc *);
    105  1.2.2.2  nathanw 
    106  1.2.2.7  nathanw void	brgphy_5401_reset(struct mii_softc *);
    107  1.2.2.7  nathanw void	brgphy_5411_reset(struct mii_softc *);
    108  1.2.2.7  nathanw 
    109  1.2.2.2  nathanw const struct mii_phy_funcs brgphy_funcs = {
    110  1.2.2.2  nathanw 	brgphy_service, brgphy_status, mii_phy_reset,
    111  1.2.2.2  nathanw };
    112  1.2.2.2  nathanw 
    113  1.2.2.7  nathanw const struct mii_phy_funcs brgphy_5401_funcs = {
    114  1.2.2.7  nathanw 	brgphy_service, brgphy_status, brgphy_5401_reset,
    115  1.2.2.7  nathanw };
    116  1.2.2.7  nathanw 
    117  1.2.2.7  nathanw const struct mii_phy_funcs brgphy_5411_funcs = {
    118  1.2.2.7  nathanw 	brgphy_service, brgphy_status, brgphy_5411_reset,
    119  1.2.2.7  nathanw };
    120  1.2.2.7  nathanw 
    121  1.2.2.2  nathanw const struct mii_phydesc brgphys[] = {
    122  1.2.2.2  nathanw 	{ MII_OUI_BROADCOM,		MII_MODEL_BROADCOM_BCM5400,
    123  1.2.2.2  nathanw 	  MII_STR_BROADCOM_BCM5400 },
    124  1.2.2.2  nathanw 
    125  1.2.2.2  nathanw 	{ MII_OUI_BROADCOM,		MII_MODEL_BROADCOM_BCM5401,
    126  1.2.2.2  nathanw 	  MII_STR_BROADCOM_BCM5401 },
    127  1.2.2.2  nathanw 
    128  1.2.2.2  nathanw 	{ MII_OUI_BROADCOM,		MII_MODEL_BROADCOM_BCM5411,
    129  1.2.2.2  nathanw 	  MII_STR_BROADCOM_BCM5411 },
    130  1.2.2.2  nathanw 
    131  1.2.2.7  nathanw 	{ MII_OUI_BROADCOM,		MII_MODEL_BROADCOM_BCM5421,
    132  1.2.2.7  nathanw 	  MII_STR_BROADCOM_BCM5421 },
    133  1.2.2.7  nathanw 
    134  1.2.2.7  nathanw 	{ MII_OUI_BROADCOM,		MII_MODEL_BROADCOM_BCM5701,
    135  1.2.2.7  nathanw 	  MII_STR_BROADCOM_BCM5701 },
    136  1.2.2.7  nathanw 
    137  1.2.2.2  nathanw 	{ 0,				0,
    138  1.2.2.2  nathanw 	  NULL },
    139  1.2.2.2  nathanw };
    140  1.2.2.2  nathanw 
    141  1.2.2.7  nathanw static void bcm5401_load_dspcode(struct mii_softc *);
    142  1.2.2.7  nathanw static void bcm5411_load_dspcode(struct mii_softc *);
    143  1.2.2.7  nathanw 
    144  1.2.2.2  nathanw int
    145  1.2.2.4  nathanw brgphymatch(struct device *parent, struct cfdata *match, void *aux)
    146  1.2.2.2  nathanw {
    147  1.2.2.2  nathanw 	struct mii_attach_args *ma = aux;
    148  1.2.2.2  nathanw 
    149  1.2.2.2  nathanw 	if (mii_phy_match(ma, brgphys) != NULL)
    150  1.2.2.2  nathanw 		return (10);
    151  1.2.2.2  nathanw 
    152  1.2.2.2  nathanw 	return (0);
    153  1.2.2.2  nathanw }
    154  1.2.2.2  nathanw 
    155  1.2.2.2  nathanw void
    156  1.2.2.4  nathanw brgphyattach(struct device *parent, struct device *self, void *aux)
    157  1.2.2.2  nathanw {
    158  1.2.2.2  nathanw 	struct mii_softc *sc = (struct mii_softc *)self;
    159  1.2.2.2  nathanw 	struct mii_attach_args *ma = aux;
    160  1.2.2.2  nathanw 	struct mii_data *mii = ma->mii_data;
    161  1.2.2.2  nathanw 	const struct mii_phydesc *mpd;
    162  1.2.2.2  nathanw 
    163  1.2.2.2  nathanw 	mpd = mii_phy_match(ma, brgphys);
    164  1.2.2.2  nathanw 	printf(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
    165  1.2.2.2  nathanw 
    166  1.2.2.2  nathanw 	sc->mii_inst = mii->mii_instance;
    167  1.2.2.2  nathanw 	sc->mii_phy = ma->mii_phyno;
    168  1.2.2.2  nathanw 	sc->mii_pdata = mii;
    169  1.2.2.6  nathanw 	sc->mii_flags = ma->mii_flags;
    170  1.2.2.2  nathanw 	sc->mii_anegticks = 5;
    171  1.2.2.2  nathanw 
    172  1.2.2.7  nathanw 	switch (MII_MODEL(ma->mii_id2)) {
    173  1.2.2.7  nathanw 	case MII_MODEL_BROADCOM_BCM5400:
    174  1.2.2.7  nathanw 		sc->mii_funcs = &brgphy_5401_funcs;
    175  1.2.2.7  nathanw 		printf("%s: using BCM5401 DSP patch\n", sc->mii_dev.dv_xname);
    176  1.2.2.7  nathanw 		break;
    177  1.2.2.7  nathanw 
    178  1.2.2.7  nathanw 	case MII_MODEL_BROADCOM_BCM5401:
    179  1.2.2.7  nathanw 		if (MII_REV(ma->mii_id2) == 1 || MII_REV(ma->mii_id2) == 3) {
    180  1.2.2.7  nathanw 			sc->mii_funcs = &brgphy_5401_funcs;
    181  1.2.2.7  nathanw 			printf("%s: using BCM5401 DSP patch\n",
    182  1.2.2.7  nathanw 			    sc->mii_dev.dv_xname);
    183  1.2.2.7  nathanw 		} else
    184  1.2.2.7  nathanw 			sc->mii_funcs = &brgphy_funcs;
    185  1.2.2.7  nathanw 		break;
    186  1.2.2.7  nathanw 
    187  1.2.2.7  nathanw 	case MII_MODEL_BROADCOM_BCM5411:
    188  1.2.2.7  nathanw 		sc->mii_funcs = &brgphy_5411_funcs;
    189  1.2.2.7  nathanw 		printf("%s: using BCM5411 DSP patch\n", sc->mii_dev.dv_xname);
    190  1.2.2.7  nathanw 		break;
    191  1.2.2.7  nathanw 
    192  1.2.2.7  nathanw 	default:
    193  1.2.2.7  nathanw 		sc->mii_funcs = &brgphy_funcs;
    194  1.2.2.7  nathanw 		break;
    195  1.2.2.7  nathanw 	}
    196  1.2.2.7  nathanw 
    197  1.2.2.2  nathanw 	PHY_RESET(sc);
    198  1.2.2.2  nathanw 
    199  1.2.2.2  nathanw 	sc->mii_capabilities =
    200  1.2.2.2  nathanw 	    PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
    201  1.2.2.2  nathanw 	if (sc->mii_capabilities & BMSR_EXTSTAT)
    202  1.2.2.2  nathanw 		sc->mii_extcapabilities = PHY_READ(sc, MII_EXTSR);
    203  1.2.2.2  nathanw 
    204  1.2.2.2  nathanw 	printf("%s: ", sc->mii_dev.dv_xname);
    205  1.2.2.2  nathanw 	if ((sc->mii_capabilities & BMSR_MEDIAMASK) == 0 &&
    206  1.2.2.2  nathanw 	    (sc->mii_extcapabilities & EXTSR_MEDIAMASK) == 0)
    207  1.2.2.2  nathanw 		printf("no media present");
    208  1.2.2.2  nathanw 	else
    209  1.2.2.2  nathanw 		mii_phy_add_media(sc);
    210  1.2.2.2  nathanw 	printf("\n");
    211  1.2.2.2  nathanw }
    212  1.2.2.2  nathanw 
    213  1.2.2.2  nathanw int
    214  1.2.2.4  nathanw brgphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
    215  1.2.2.2  nathanw {
    216  1.2.2.2  nathanw 	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    217  1.2.2.2  nathanw 	int reg;
    218  1.2.2.2  nathanw 
    219  1.2.2.2  nathanw 	switch (cmd) {
    220  1.2.2.2  nathanw 	case MII_POLLSTAT:
    221  1.2.2.2  nathanw 		/*
    222  1.2.2.2  nathanw 		 * If we're not polling our PHY instance, just return.
    223  1.2.2.2  nathanw 		 */
    224  1.2.2.2  nathanw 		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    225  1.2.2.2  nathanw 			return (0);
    226  1.2.2.2  nathanw 		break;
    227  1.2.2.2  nathanw 
    228  1.2.2.2  nathanw 	case MII_MEDIACHG:
    229  1.2.2.2  nathanw 		/*
    230  1.2.2.2  nathanw 		 * If the media indicates a different PHY instance,
    231  1.2.2.2  nathanw 		 * isolate ourselves.
    232  1.2.2.2  nathanw 		 */
    233  1.2.2.2  nathanw 		if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
    234  1.2.2.2  nathanw 			reg = PHY_READ(sc, MII_BMCR);
    235  1.2.2.2  nathanw 			PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
    236  1.2.2.2  nathanw 			return (0);
    237  1.2.2.2  nathanw 		}
    238  1.2.2.2  nathanw 
    239  1.2.2.2  nathanw 		/*
    240  1.2.2.2  nathanw 		 * If the interface is not up, don't do anything.
    241  1.2.2.2  nathanw 		 */
    242  1.2.2.2  nathanw 		if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
    243  1.2.2.2  nathanw 			break;
    244  1.2.2.2  nathanw 
    245  1.2.2.7  nathanw 		mii_phy_reset(sc);	/* XXX hardware bug work-around */
    246  1.2.2.2  nathanw 		mii_phy_setmedia(sc);
    247  1.2.2.2  nathanw 		break;
    248  1.2.2.2  nathanw 
    249  1.2.2.2  nathanw 	case MII_TICK:
    250  1.2.2.2  nathanw 		/*
    251  1.2.2.2  nathanw 		 * If we're not currently selected, just return.
    252  1.2.2.2  nathanw 		 */
    253  1.2.2.2  nathanw 		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    254  1.2.2.2  nathanw 			return (0);
    255  1.2.2.2  nathanw 
    256  1.2.2.2  nathanw 		if (mii_phy_tick(sc) == EJUSTRETURN)
    257  1.2.2.2  nathanw 			return (0);
    258  1.2.2.2  nathanw 		break;
    259  1.2.2.2  nathanw 
    260  1.2.2.2  nathanw 	case MII_DOWN:
    261  1.2.2.2  nathanw 		mii_phy_down(sc);
    262  1.2.2.2  nathanw 		return (0);
    263  1.2.2.2  nathanw 	}
    264  1.2.2.2  nathanw 
    265  1.2.2.2  nathanw 	/* Update the media status. */
    266  1.2.2.2  nathanw 	mii_phy_status(sc);
    267  1.2.2.2  nathanw 
    268  1.2.2.7  nathanw 	/*
    269  1.2.2.7  nathanw 	 * Callback if something changed.  Note that we need to poke
    270  1.2.2.7  nathanw 	 * the DSP on the Broadcom PHYs if the media changes.
    271  1.2.2.7  nathanw 	 */
    272  1.2.2.7  nathanw 	if (sc->mii_media_active != mii->mii_media_active ||
    273  1.2.2.7  nathanw 	    sc->mii_media_status != mii->mii_media_status ||
    274  1.2.2.7  nathanw 	    cmd == MII_MEDIACHG) {
    275  1.2.2.7  nathanw 		mii_phy_update(sc, cmd);
    276  1.2.2.7  nathanw 		if (sc->mii_funcs == &brgphy_5401_funcs)
    277  1.2.2.7  nathanw 			bcm5401_load_dspcode(sc);
    278  1.2.2.7  nathanw 		else if (sc->mii_funcs == &brgphy_5411_funcs)
    279  1.2.2.7  nathanw 			bcm5411_load_dspcode(sc);
    280  1.2.2.7  nathanw 	}
    281  1.2.2.2  nathanw 	return (0);
    282  1.2.2.2  nathanw }
    283  1.2.2.2  nathanw 
    284  1.2.2.2  nathanw void
    285  1.2.2.4  nathanw brgphy_status(struct mii_softc *sc)
    286  1.2.2.2  nathanw {
    287  1.2.2.2  nathanw 	struct mii_data *mii = sc->mii_pdata;
    288  1.2.2.2  nathanw 	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    289  1.2.2.2  nathanw 	int bmcr, auxsts, gtsr;
    290  1.2.2.2  nathanw 
    291  1.2.2.2  nathanw 	mii->mii_media_status = IFM_AVALID;
    292  1.2.2.2  nathanw 	mii->mii_media_active = IFM_ETHER;
    293  1.2.2.2  nathanw 
    294  1.2.2.2  nathanw 	auxsts = PHY_READ(sc, BRGPHY_MII_AUXSTS);
    295  1.2.2.2  nathanw 
    296  1.2.2.2  nathanw 	if (auxsts & BRGPHY_AUXSTS_LINK)
    297  1.2.2.2  nathanw 		mii->mii_media_status |= IFM_ACTIVE;
    298  1.2.2.2  nathanw 
    299  1.2.2.2  nathanw 	bmcr = PHY_READ(sc, MII_BMCR);
    300  1.2.2.2  nathanw 	if (bmcr & BMCR_ISO) {
    301  1.2.2.2  nathanw 		mii->mii_media_active |= IFM_NONE;
    302  1.2.2.2  nathanw 		mii->mii_media_status = 0;
    303  1.2.2.2  nathanw 		return;
    304  1.2.2.2  nathanw 	}
    305  1.2.2.2  nathanw 
    306  1.2.2.2  nathanw 	if (bmcr & BMCR_LOOP)
    307  1.2.2.2  nathanw 		mii->mii_media_active |= IFM_LOOP;
    308  1.2.2.2  nathanw 
    309  1.2.2.2  nathanw 	if (bmcr & BMCR_AUTOEN) {
    310  1.2.2.2  nathanw 		/*
    311  1.2.2.2  nathanw 		 * The media status bits are only valid of autonegotiation
    312  1.2.2.2  nathanw 		 * has completed (or it's disabled).
    313  1.2.2.2  nathanw 		 */
    314  1.2.2.2  nathanw 		if ((auxsts & BRGPHY_AUXSTS_ACOMP) == 0) {
    315  1.2.2.2  nathanw 			/* Erg, still trying, I guess... */
    316  1.2.2.2  nathanw 			mii->mii_media_active |= IFM_NONE;
    317  1.2.2.2  nathanw 			return;
    318  1.2.2.2  nathanw 		}
    319  1.2.2.2  nathanw 
    320  1.2.2.2  nathanw 		switch (auxsts & BRGPHY_AUXSTS_AN_RES) {
    321  1.2.2.2  nathanw 		case BRGPHY_RES_1000FD:
    322  1.2.2.3  nathanw 			mii->mii_media_active |= IFM_1000_T|IFM_FDX;
    323  1.2.2.2  nathanw 			gtsr = PHY_READ(sc, MII_100T2SR);
    324  1.2.2.2  nathanw 			if (gtsr & GTSR_MS_RES)
    325  1.2.2.2  nathanw 				mii->mii_media_active |= IFM_ETH_MASTER;
    326  1.2.2.2  nathanw 			break;
    327  1.2.2.2  nathanw 
    328  1.2.2.2  nathanw 		case BRGPHY_RES_1000HD:
    329  1.2.2.3  nathanw 			mii->mii_media_active |= IFM_1000_T;
    330  1.2.2.2  nathanw 			gtsr = PHY_READ(sc, MII_100T2SR);
    331  1.2.2.2  nathanw 			if (gtsr & GTSR_MS_RES)
    332  1.2.2.2  nathanw 				mii->mii_media_active |= IFM_ETH_MASTER;
    333  1.2.2.2  nathanw 			break;
    334  1.2.2.2  nathanw 
    335  1.2.2.2  nathanw 		case BRGPHY_RES_100FD:
    336  1.2.2.2  nathanw 			mii->mii_media_active |= IFM_100_TX|IFM_FDX;
    337  1.2.2.2  nathanw 			break;
    338  1.2.2.2  nathanw 
    339  1.2.2.2  nathanw 		case BRGPHY_RES_100T4:
    340  1.2.2.2  nathanw 			mii->mii_media_active |= IFM_100_T4;
    341  1.2.2.2  nathanw 			break;
    342  1.2.2.2  nathanw 
    343  1.2.2.2  nathanw 		case BRGPHY_RES_100HD:
    344  1.2.2.2  nathanw 			mii->mii_media_active |= IFM_100_TX;
    345  1.2.2.2  nathanw 			break;
    346  1.2.2.2  nathanw 
    347  1.2.2.2  nathanw 		case BRGPHY_RES_10FD:
    348  1.2.2.2  nathanw 			mii->mii_media_active |= IFM_10_T|IFM_FDX;
    349  1.2.2.2  nathanw 			break;
    350  1.2.2.2  nathanw 
    351  1.2.2.2  nathanw 		case BRGPHY_RES_10HD:
    352  1.2.2.2  nathanw 			mii->mii_media_active |= IFM_10_T;
    353  1.2.2.2  nathanw 			break;
    354  1.2.2.2  nathanw 
    355  1.2.2.2  nathanw 		default:
    356  1.2.2.2  nathanw 			mii->mii_media_active |= IFM_NONE;
    357  1.2.2.2  nathanw 			mii->mii_media_status = 0;
    358  1.2.2.2  nathanw 		}
    359  1.2.2.2  nathanw 	} else
    360  1.2.2.2  nathanw 		mii->mii_media_active = ife->ifm_media;
    361  1.2.2.2  nathanw }
    362  1.2.2.7  nathanw 
    363  1.2.2.7  nathanw void
    364  1.2.2.7  nathanw brgphy_5401_reset(struct mii_softc *sc)
    365  1.2.2.7  nathanw {
    366  1.2.2.7  nathanw 
    367  1.2.2.7  nathanw 	mii_phy_reset(sc);
    368  1.2.2.7  nathanw 	bcm5401_load_dspcode(sc);
    369  1.2.2.7  nathanw }
    370  1.2.2.7  nathanw 
    371  1.2.2.7  nathanw void
    372  1.2.2.7  nathanw brgphy_5411_reset(struct mii_softc *sc)
    373  1.2.2.7  nathanw {
    374  1.2.2.7  nathanw 
    375  1.2.2.7  nathanw 	mii_phy_reset(sc);
    376  1.2.2.7  nathanw 	bcm5411_load_dspcode(sc);
    377  1.2.2.7  nathanw }
    378  1.2.2.7  nathanw 
    379  1.2.2.7  nathanw static void
    380  1.2.2.7  nathanw bcm5401_load_dspcode(struct mii_softc *sc)
    381  1.2.2.7  nathanw {
    382  1.2.2.7  nathanw 	static const struct {
    383  1.2.2.7  nathanw 		int		reg;
    384  1.2.2.7  nathanw 		uint16_t	val;
    385  1.2.2.7  nathanw 	} dspcode[] = {
    386  1.2.2.7  nathanw 		{ BRGPHY_MII_AUXCTL,		0x4c20 },
    387  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_ADDR_REG,	0x0012 },
    388  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_RW_PORT,	0x1804 },
    389  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_ADDR_REG,	0x0013 },
    390  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_RW_PORT,	0x1204 },
    391  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_ADDR_REG,	0x8006 },
    392  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_RW_PORT,	0x0132 },
    393  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_ADDR_REG,	0x8006 },
    394  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_RW_PORT,	0x0232 },
    395  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_ADDR_REG,	0x201f },
    396  1.2.2.7  nathanw 		{ BRGPHY_MII_DSP_RW_PORT,	0x0a20 },
    397  1.2.2.7  nathanw 		{ 0,				0 },
    398  1.2.2.7  nathanw 	};
    399  1.2.2.7  nathanw 	int i;
    400  1.2.2.7  nathanw 
    401  1.2.2.7  nathanw 	for (i = 0; dspcode[i].reg != 0; i++)
    402  1.2.2.7  nathanw 		PHY_WRITE(sc, dspcode[i].reg, dspcode[i].val);
    403  1.2.2.7  nathanw }
    404  1.2.2.7  nathanw 
    405  1.2.2.7  nathanw static void
    406  1.2.2.7  nathanw bcm5411_load_dspcode(struct mii_softc *sc)
    407  1.2.2.7  nathanw {
    408  1.2.2.7  nathanw 	static const struct {
    409  1.2.2.7  nathanw 		int		reg;
    410  1.2.2.7  nathanw 		uint16_t	val;
    411  1.2.2.7  nathanw 	} dspcode[] = {
    412  1.2.2.7  nathanw 		{ 0x1c,				0x8c23 },
    413  1.2.2.7  nathanw 		{ 0x1c,				0x8ca3 },
    414  1.2.2.7  nathanw 		{ 0x1c,				0x8c23 },
    415  1.2.2.7  nathanw 		{ 0,				0 },
    416  1.2.2.7  nathanw 	};
    417  1.2.2.7  nathanw 	int i;
    418  1.2.2.7  nathanw 
    419  1.2.2.7  nathanw 	for (i = 0; dspcode[i].reg != 0; i++)
    420  1.2.2.7  nathanw 		PHY_WRITE(sc, dspcode[i].reg, dspcode[i].val);
    421  1.2.2.7  nathanw }
    422