Home | History | Annotate | Line # | Download | only in mii
rgephy.c revision 1.26
      1  1.26    cegger /*	$NetBSD: rgephy.c,v 1.26 2009/02/11 23:01:07 cegger Exp $	*/
      2   1.1  jonathan 
      3   1.1  jonathan /*
      4   1.1  jonathan  * Copyright (c) 2003
      5   1.1  jonathan  *	Bill Paul <wpaul (at) windriver.com>.  All rights reserved.
      6   1.1  jonathan  *
      7   1.1  jonathan  * Redistribution and use in source and binary forms, with or without
      8   1.1  jonathan  * modification, are permitted provided that the following conditions
      9   1.1  jonathan  * are met:
     10   1.1  jonathan  * 1. Redistributions of source code must retain the above copyright
     11   1.1  jonathan  *    notice, this list of conditions and the following disclaimer.
     12   1.1  jonathan  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1  jonathan  *    notice, this list of conditions and the following disclaimer in the
     14   1.1  jonathan  *    documentation and/or other materials provided with the distribution.
     15   1.1  jonathan  * 3. All advertising materials mentioning features or use of this software
     16   1.1  jonathan  *    must display the following acknowledgement:
     17   1.1  jonathan  *	This product includes software developed by Bill Paul.
     18   1.1  jonathan  * 4. Neither the name of the author nor the names of any co-contributors
     19   1.1  jonathan  *    may be used to endorse or promote products derived from this software
     20   1.1  jonathan  *    without specific prior written permission.
     21   1.1  jonathan  *
     22   1.1  jonathan  * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
     23   1.1  jonathan  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     24   1.1  jonathan  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     25   1.1  jonathan  * ARE DISCLAIMED.  IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
     26   1.1  jonathan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     27   1.1  jonathan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     28   1.1  jonathan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     29   1.1  jonathan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     30   1.1  jonathan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     31   1.1  jonathan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
     32   1.1  jonathan  * THE POSSIBILITY OF SUCH DAMAGE.
     33   1.1  jonathan  */
     34   1.1  jonathan 
     35   1.1  jonathan #include <sys/cdefs.h>
     36  1.26    cegger __KERNEL_RCSID(0, "$NetBSD: rgephy.c,v 1.26 2009/02/11 23:01:07 cegger Exp $");
     37   1.1  jonathan 
     38   1.1  jonathan 
     39   1.1  jonathan /*
     40   1.1  jonathan  * Driver for the RealTek 8169S/8110S internal 10/100/1000 PHY.
     41   1.1  jonathan  */
     42   1.1  jonathan 
     43   1.1  jonathan #include <sys/param.h>
     44   1.1  jonathan #include <sys/systm.h>
     45   1.1  jonathan #include <sys/kernel.h>
     46  1.10   tsutsui #include <sys/device.h>
     47   1.1  jonathan #include <sys/socket.h>
     48   1.1  jonathan 
     49   1.1  jonathan 
     50   1.1  jonathan #include <net/if.h>
     51   1.1  jonathan #include <net/if_media.h>
     52   1.1  jonathan 
     53   1.1  jonathan #include <dev/mii/mii.h>
     54   1.1  jonathan #include <dev/mii/miivar.h>
     55   1.1  jonathan #include <dev/mii/miidevs.h>
     56   1.1  jonathan 
     57   1.1  jonathan #include <dev/mii/rgephyreg.h>
     58   1.1  jonathan 
     59   1.1  jonathan #include <dev/ic/rtl81x9reg.h>
     60   1.1  jonathan 
     61  1.21   xtraeme static int	rgephy_match(device_t, cfdata_t, void *);
     62  1.21   xtraeme static void	rgephy_attach(device_t, device_t, void *);
     63   1.1  jonathan 
     64  1.19   tsutsui struct rgephy_softc {
     65  1.19   tsutsui 	struct mii_softc mii_sc;
     66  1.19   tsutsui 	int mii_revision;
     67  1.19   tsutsui };
     68  1.19   tsutsui 
     69  1.21   xtraeme CFATTACH_DECL_NEW(rgephy, sizeof(struct rgephy_softc),
     70   1.1  jonathan     rgephy_match, rgephy_attach, mii_phy_detach, mii_phy_activate);
     71   1.1  jonathan 
     72   1.1  jonathan 
     73   1.1  jonathan static int	rgephy_service(struct mii_softc *, struct mii_data *, int);
     74   1.1  jonathan static void	rgephy_status(struct mii_softc *);
     75   1.1  jonathan static int	rgephy_mii_phy_auto(struct mii_softc *);
     76   1.1  jonathan static void	rgephy_reset(struct mii_softc *);
     77   1.1  jonathan static void	rgephy_loop(struct mii_softc *);
     78   1.1  jonathan static void	rgephy_load_dspcode(struct mii_softc *);
     79  1.15   tsutsui 
     80   1.1  jonathan static const struct mii_phy_funcs rgephy_funcs = {
     81   1.1  jonathan 	rgephy_service, rgephy_status, rgephy_reset,
     82   1.1  jonathan };
     83   1.1  jonathan 
     84   1.1  jonathan static const struct mii_phydesc rgephys[] = {
     85   1.1  jonathan 	{ MII_OUI_xxREALTEK,		MII_MODEL_xxREALTEK_RTL8169S,
     86   1.1  jonathan 	  MII_STR_xxREALTEK_RTL8169S },
     87   1.1  jonathan 
     88   1.1  jonathan 	{ MII_OUI_REALTEK,		MII_MODEL_REALTEK_RTL8169S,
     89   1.1  jonathan 	  MII_STR_REALTEK_RTL8169S },
     90   1.1  jonathan 
     91   1.6       wiz 	{ 0,				0,
     92   1.6       wiz 	  NULL }
     93   1.1  jonathan };
     94   1.1  jonathan 
     95   1.1  jonathan static int
     96  1.21   xtraeme rgephy_match(device_t parent, cfdata_t match, void *aux)
     97   1.1  jonathan {
     98   1.1  jonathan 	struct mii_attach_args *ma = aux;
     99   1.1  jonathan 
    100   1.1  jonathan 	if (mii_phy_match(ma, rgephys) != NULL)
    101  1.15   tsutsui 		return 10;
    102   1.1  jonathan 
    103  1.15   tsutsui 	return 0;
    104   1.1  jonathan }
    105   1.1  jonathan 
    106   1.1  jonathan static void
    107  1.21   xtraeme rgephy_attach(device_t parent, device_t self, void *aux)
    108   1.1  jonathan {
    109  1.19   tsutsui 	struct rgephy_softc *rsc = device_private(self);
    110  1.19   tsutsui 	struct mii_softc *sc = &rsc->mii_sc;
    111   1.1  jonathan 	struct mii_attach_args *ma = aux;
    112   1.1  jonathan 	struct mii_data *mii = ma->mii_data;
    113   1.1  jonathan 	const struct mii_phydesc *mpd;
    114   1.1  jonathan 	int rev;
    115   1.1  jonathan 	const char *sep = "";
    116   1.1  jonathan 
    117  1.19   tsutsui 	ma = aux;
    118  1.19   tsutsui 	mii = ma->mii_data;
    119  1.19   tsutsui 
    120   1.1  jonathan 	rev = MII_REV(ma->mii_id2);
    121   1.1  jonathan 	mpd = mii_phy_match(ma, rgephys);
    122   1.1  jonathan 	aprint_naive(": Media interface\n");
    123   1.1  jonathan 	aprint_normal(": %s, rev. %d\n", mpd->mpd_name, rev);
    124   1.1  jonathan 
    125  1.19   tsutsui 	rsc->mii_revision = rev;
    126  1.19   tsutsui 
    127  1.21   xtraeme 	sc->mii_dev = self;
    128   1.1  jonathan 	sc->mii_inst = mii->mii_instance;
    129   1.1  jonathan 	sc->mii_phy = ma->mii_phyno;
    130   1.1  jonathan 	sc->mii_pdata = mii;
    131   1.1  jonathan 	sc->mii_flags = mii->mii_flags;
    132  1.24    cegger 	sc->mii_anegticks = MII_ANEGTICKS_GIGE;
    133   1.1  jonathan 
    134   1.1  jonathan 	sc->mii_funcs = &rgephy_funcs;
    135   1.1  jonathan 
    136   1.1  jonathan #define	ADD(m, c)	ifmedia_add(&mii->mii_media, (m), (c), NULL)
    137   1.1  jonathan #define	PRINT(n)	aprint_normal("%s%s", sep, (n)); sep = ", "
    138   1.1  jonathan 
    139   1.1  jonathan #ifdef __FreeBSD__
    140   1.1  jonathan 	ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst),
    141   1.1  jonathan 	    BMCR_LOOP|BMCR_S100);
    142   1.1  jonathan #endif
    143   1.1  jonathan 
    144   1.1  jonathan 	sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
    145   1.1  jonathan 	sc->mii_capabilities &= ~BMSR_ANEG;
    146   1.1  jonathan 
    147   1.1  jonathan 	/*
    148   1.1  jonathan 	 * FreeBSD does not check EXSTAT, but instead adds gigabit
    149   1.5     perry 	 * media explicitly. Why?
    150   1.1  jonathan 	 */
    151  1.21   xtraeme 	aprint_normal_dev(self, "");
    152   1.1  jonathan 	if (sc->mii_capabilities & BMSR_EXTSTAT) {
    153   1.1  jonathan 		sc->mii_extcapabilities = PHY_READ(sc, MII_EXTSR);
    154   1.1  jonathan 	}
    155   1.1  jonathan 	mii_phy_add_media(sc);
    156  1.16   tsutsui 
    157   1.1  jonathan 	/* rtl8169S does not report auto-sense; add manually.  */
    158   1.1  jonathan 	ADD(IFM_MAKEWORD(IFM_ETHER, IFM_AUTO, 0, sc->mii_inst), MII_NMEDIA);
    159   1.1  jonathan 	sep =", ";
    160   1.1  jonathan 	PRINT("auto");
    161   1.1  jonathan 
    162   1.1  jonathan #undef	ADD
    163   1.1  jonathan #undef	PRINT
    164   1.1  jonathan 
    165  1.25    cegger 	rgephy_reset(sc);
    166   1.1  jonathan 	aprint_normal("\n");
    167   1.1  jonathan }
    168   1.1  jonathan 
    169   1.1  jonathan static int
    170  1.15   tsutsui rgephy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
    171   1.1  jonathan {
    172  1.19   tsutsui 	struct rgephy_softc *rsc;
    173   1.1  jonathan 	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    174  1.13   tsutsui 	int reg, speed, gig, anar;
    175   1.1  jonathan 
    176  1.19   tsutsui 	rsc = (struct rgephy_softc *)sc;
    177  1.19   tsutsui 
    178   1.1  jonathan 	switch (cmd) {
    179   1.1  jonathan 	case MII_POLLSTAT:
    180   1.1  jonathan 		/*
    181   1.1  jonathan 		 * If we're not polling our PHY instance, just return.
    182   1.1  jonathan 		 */
    183   1.1  jonathan 		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    184  1.15   tsutsui 			return 0;
    185   1.1  jonathan 		break;
    186   1.1  jonathan 
    187   1.1  jonathan 	case MII_MEDIACHG:
    188   1.1  jonathan 		/*
    189   1.1  jonathan 		 * If the media indicates a different PHY instance,
    190   1.1  jonathan 		 * isolate ourselves.
    191   1.1  jonathan 		 */
    192   1.1  jonathan 		if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
    193   1.1  jonathan 			reg = PHY_READ(sc, MII_BMCR);
    194   1.1  jonathan 			PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
    195  1.15   tsutsui 			return 0;
    196   1.1  jonathan 		}
    197   1.1  jonathan 
    198   1.1  jonathan 		/*
    199   1.1  jonathan 		 * If the interface is not up, don't do anything.
    200   1.1  jonathan 		 */
    201   1.1  jonathan 		if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
    202   1.1  jonathan 			break;
    203   1.1  jonathan 
    204  1.25    cegger 		rgephy_reset(sc);	/* XXX hardware bug work-around */
    205   1.1  jonathan 
    206  1.13   tsutsui 		anar = PHY_READ(sc, RGEPHY_MII_ANAR);
    207  1.13   tsutsui 		anar &= ~(RGEPHY_ANAR_TX_FD | RGEPHY_ANAR_TX |
    208  1.13   tsutsui 		    RGEPHY_ANAR_10_FD | RGEPHY_ANAR_10);
    209  1.13   tsutsui 
    210   1.1  jonathan 		switch (IFM_SUBTYPE(ife->ifm_media)) {
    211   1.1  jonathan 		case IFM_AUTO:
    212   1.1  jonathan #ifdef foo
    213   1.1  jonathan 			/*
    214   1.1  jonathan 			 * If we're already in auto mode, just return.
    215   1.1  jonathan 			 */
    216   1.1  jonathan 			if (PHY_READ(sc, RGEPHY_MII_BMCR) & RGEPHY_BMCR_AUTOEN)
    217  1.15   tsutsui 				return 0;
    218   1.1  jonathan #endif
    219  1.15   tsutsui 			(void)rgephy_mii_phy_auto(sc);
    220   1.1  jonathan 			break;
    221   1.1  jonathan 		case IFM_1000_T:
    222   1.1  jonathan 			speed = RGEPHY_S1000;
    223   1.1  jonathan 			goto setit;
    224   1.1  jonathan 		case IFM_100_TX:
    225   1.1  jonathan 			speed = RGEPHY_S100;
    226  1.13   tsutsui 			anar |= RGEPHY_ANAR_TX_FD | RGEPHY_ANAR_TX;
    227   1.1  jonathan 			goto setit;
    228   1.1  jonathan 		case IFM_10_T:
    229   1.1  jonathan 			speed = RGEPHY_S10;
    230  1.13   tsutsui 			anar |= RGEPHY_ANAR_10_FD | RGEPHY_ANAR_10;
    231  1.15   tsutsui  setit:
    232   1.1  jonathan 			rgephy_loop(sc);
    233   1.1  jonathan 			if ((ife->ifm_media & IFM_GMASK) == IFM_FDX) {
    234   1.1  jonathan 				speed |= RGEPHY_BMCR_FDX;
    235   1.1  jonathan 				gig = RGEPHY_1000CTL_AFD;
    236  1.13   tsutsui 				anar &= ~(RGEPHY_ANAR_TX | RGEPHY_ANAR_10);
    237   1.1  jonathan 			} else {
    238   1.1  jonathan 				gig = RGEPHY_1000CTL_AHD;
    239  1.13   tsutsui 				anar &=
    240  1.13   tsutsui 				    ~(RGEPHY_ANAR_TX_FD | RGEPHY_ANAR_10_FD);
    241   1.1  jonathan 			}
    242   1.1  jonathan 
    243  1.13   tsutsui 			if (IFM_SUBTYPE(ife->ifm_media) != IFM_1000_T) {
    244  1.13   tsutsui 				PHY_WRITE(sc, RGEPHY_MII_1000CTL, 0);
    245  1.13   tsutsui 				PHY_WRITE(sc, RGEPHY_MII_ANAR, anar);
    246  1.13   tsutsui 				PHY_WRITE(sc, RGEPHY_MII_BMCR, speed |
    247  1.13   tsutsui 				    RGEPHY_BMCR_AUTOEN | RGEPHY_BMCR_STARTNEG);
    248   1.1  jonathan 				break;
    249  1.13   tsutsui 			}
    250   1.1  jonathan 
    251   1.1  jonathan 			/*
    252  1.16   tsutsui 			 * When setting the link manually, one side must
    253   1.1  jonathan 			 * be the master and the other the slave. However
    254   1.1  jonathan 			 * ifmedia doesn't give us a good way to specify
    255   1.1  jonathan 			 * this, so we fake it by using one of the LINK
    256   1.1  jonathan 			 * flags. If LINK0 is set, we program the PHY to
    257   1.1  jonathan 			 * be a master, otherwise it's a slave.
    258   1.1  jonathan 			 */
    259   1.1  jonathan 			if ((mii->mii_ifp->if_flags & IFF_LINK0)) {
    260   1.1  jonathan 				PHY_WRITE(sc, RGEPHY_MII_1000CTL,
    261   1.1  jonathan 				    gig|RGEPHY_1000CTL_MSE|RGEPHY_1000CTL_MSC);
    262   1.1  jonathan 			} else {
    263   1.1  jonathan 				PHY_WRITE(sc, RGEPHY_MII_1000CTL,
    264   1.1  jonathan 				    gig|RGEPHY_1000CTL_MSE);
    265   1.1  jonathan 			}
    266  1.13   tsutsui 			PHY_WRITE(sc, RGEPHY_MII_BMCR, speed |
    267  1.13   tsutsui 			    RGEPHY_BMCR_AUTOEN | RGEPHY_BMCR_STARTNEG);
    268   1.1  jonathan 			break;
    269   1.1  jonathan 		case IFM_NONE:
    270   1.1  jonathan 			PHY_WRITE(sc, MII_BMCR, BMCR_ISO|BMCR_PDOWN);
    271   1.1  jonathan 			break;
    272   1.1  jonathan 		case IFM_100_T4:
    273   1.1  jonathan 		default:
    274  1.15   tsutsui 			return EINVAL;
    275   1.1  jonathan 		}
    276   1.1  jonathan 		break;
    277   1.1  jonathan 
    278   1.1  jonathan 	case MII_TICK:
    279   1.1  jonathan 		/*
    280   1.1  jonathan 		 * If we're not currently selected, just return.
    281   1.1  jonathan 		 */
    282   1.1  jonathan 		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    283  1.15   tsutsui 			return 0;
    284   1.1  jonathan 
    285   1.1  jonathan 		/*
    286   1.1  jonathan 		 * Is the interface even up?
    287   1.1  jonathan 		 */
    288   1.1  jonathan 		if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
    289  1.15   tsutsui 			return 0;
    290   1.1  jonathan 
    291   1.1  jonathan 		/*
    292   1.1  jonathan 		 * Only used for autonegotiation.
    293   1.1  jonathan 		 */
    294   1.1  jonathan 		if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO)
    295   1.1  jonathan 			break;
    296   1.1  jonathan 
    297   1.1  jonathan 		/*
    298   1.1  jonathan 		 * Check to see if we have link.  If we do, we don't
    299   1.1  jonathan 		 * need to restart the autonegotiation process.  Read
    300   1.1  jonathan 		 * the BMSR twice in case it's latched.
    301   1.1  jonathan 		 */
    302  1.19   tsutsui 		if (rsc->mii_revision >= 2) {
    303  1.19   tsutsui 			/* RTL8211B(L) */
    304  1.19   tsutsui 			reg = PHY_READ(sc, RGEPHY_MII_SSR);
    305  1.19   tsutsui 			if (reg & RGEPHY_SSR_LINK) {
    306  1.19   tsutsui 				sc->mii_ticks = 0;
    307  1.19   tsutsui 				break;
    308  1.19   tsutsui 			}
    309  1.19   tsutsui 		} else {
    310  1.19   tsutsui 			reg = PHY_READ(sc, RTK_GMEDIASTAT);
    311  1.19   tsutsui 			if ((reg & RTK_GMEDIASTAT_LINK) != 0) {
    312  1.19   tsutsui 				sc->mii_ticks = 0;
    313  1.19   tsutsui 				break;
    314  1.19   tsutsui 			}
    315  1.19   tsutsui 		}
    316   1.1  jonathan 
    317  1.25    cegger 		/* Announce link loss right after it happens. */
    318  1.25    cegger 		if (sc->mii_ticks++ == 0)
    319   1.1  jonathan 			break;
    320   1.5     perry 
    321  1.25    cegger 		/* Only retry autonegotiation every mii_anegticks seconds. */
    322  1.25    cegger 		if (sc->mii_ticks <= sc->mii_anegticks)
    323  1.25    cegger 			return 0;
    324  1.25    cegger 
    325   1.1  jonathan 		sc->mii_ticks = 0;
    326   1.1  jonathan 		rgephy_mii_phy_auto(sc);
    327  1.25    cegger 		break;
    328   1.1  jonathan 	}
    329   1.1  jonathan 
    330   1.1  jonathan 	/* Update the media status. */
    331   1.1  jonathan 	rgephy_status(sc);
    332   1.1  jonathan 
    333   1.1  jonathan 	/*
    334   1.1  jonathan 	 * Callback if something changed. Note that we need to poke
    335   1.1  jonathan 	 * the DSP on the RealTek PHYs if the media changes.
    336   1.1  jonathan 	 *
    337   1.1  jonathan 	 */
    338   1.5     perry 	if (sc->mii_media_active != mii->mii_media_active ||
    339   1.1  jonathan 	    sc->mii_media_status != mii->mii_media_status ||
    340   1.1  jonathan 	    cmd == MII_MEDIACHG) {
    341   1.1  jonathan 		rgephy_load_dspcode(sc);
    342   1.1  jonathan 	}
    343   1.1  jonathan 	mii_phy_update(sc, cmd);
    344  1.15   tsutsui 	return 0;
    345   1.1  jonathan }
    346   1.1  jonathan 
    347   1.1  jonathan static void
    348  1.15   tsutsui rgephy_status(struct mii_softc *sc)
    349   1.1  jonathan {
    350  1.19   tsutsui 	struct rgephy_softc *rsc;
    351   1.1  jonathan 	struct mii_data *mii = sc->mii_pdata;
    352  1.19   tsutsui 	int gstat, bmsr, bmcr;
    353  1.19   tsutsui 	uint16_t ssr;
    354   1.1  jonathan 
    355   1.1  jonathan 	mii->mii_media_status = IFM_AVALID;
    356   1.1  jonathan 	mii->mii_media_active = IFM_ETHER;
    357   1.1  jonathan 
    358  1.19   tsutsui 	rsc = (struct rgephy_softc *)sc;
    359  1.19   tsutsui 	if (rsc->mii_revision >= 2) {
    360  1.19   tsutsui 		ssr = PHY_READ(sc, RGEPHY_MII_SSR);
    361  1.19   tsutsui 		if (ssr & RGEPHY_SSR_LINK)
    362  1.19   tsutsui 			mii->mii_media_status |= IFM_ACTIVE;
    363  1.19   tsutsui 	} else {
    364  1.19   tsutsui 		gstat = PHY_READ(sc, RTK_GMEDIASTAT);
    365  1.19   tsutsui 		if ((gstat & RTK_GMEDIASTAT_LINK) != 0)
    366  1.19   tsutsui 			mii->mii_media_status |= IFM_ACTIVE;
    367  1.19   tsutsui 	}
    368   1.1  jonathan 
    369   1.1  jonathan 	bmsr = PHY_READ(sc, RGEPHY_MII_BMSR);
    370  1.19   tsutsui 	bmsr = PHY_READ(sc, RGEPHY_MII_BMSR);
    371   1.1  jonathan 	bmcr = PHY_READ(sc, RGEPHY_MII_BMCR);
    372   1.1  jonathan 
    373  1.15   tsutsui 	if ((bmcr & RGEPHY_BMCR_ISO) != 0) {
    374   1.3   kanaoka 		mii->mii_media_active |= IFM_NONE;
    375   1.3   kanaoka 		mii->mii_media_status = 0;
    376   1.3   kanaoka 		return;
    377   1.3   kanaoka 	}
    378   1.3   kanaoka 
    379  1.15   tsutsui 	if ((bmcr & RGEPHY_BMCR_LOOP) != 0)
    380   1.1  jonathan 		mii->mii_media_active |= IFM_LOOP;
    381   1.1  jonathan 
    382  1.15   tsutsui 	if ((bmcr & RGEPHY_BMCR_AUTOEN) != 0) {
    383   1.1  jonathan 		if ((bmsr & RGEPHY_BMSR_ACOMP) == 0) {
    384   1.1  jonathan 			/* Erg, still trying, I guess... */
    385   1.1  jonathan 			mii->mii_media_active |= IFM_NONE;
    386   1.1  jonathan 			return;
    387   1.1  jonathan 		}
    388   1.1  jonathan 	}
    389   1.1  jonathan 
    390  1.19   tsutsui 	if (rsc->mii_revision >= 2) {
    391  1.19   tsutsui 		ssr = PHY_READ(sc, RGEPHY_MII_SSR);
    392  1.19   tsutsui 		switch (ssr & RGEPHY_SSR_SPD_MASK) {
    393  1.19   tsutsui 		case RGEPHY_SSR_S1000:
    394  1.19   tsutsui 			mii->mii_media_active |= IFM_1000_T;
    395  1.19   tsutsui 			break;
    396  1.19   tsutsui 		case RGEPHY_SSR_S100:
    397  1.19   tsutsui 			mii->mii_media_active |= IFM_100_TX;
    398  1.19   tsutsui 			break;
    399  1.19   tsutsui 		case RGEPHY_SSR_S10:
    400  1.19   tsutsui 			mii->mii_media_active |= IFM_10_T;
    401  1.19   tsutsui 			break;
    402  1.19   tsutsui 		default:
    403  1.19   tsutsui 			mii->mii_media_active |= IFM_NONE;
    404  1.19   tsutsui 			break;
    405  1.19   tsutsui 		}
    406  1.19   tsutsui 		if (ssr & RGEPHY_SSR_FDX)
    407  1.24    cegger 			mii->mii_media_active |= mii_phy_flowstatus(sc) |
    408  1.24    cegger 			    IFM_FDX;
    409  1.19   tsutsui 		else
    410  1.19   tsutsui 			mii->mii_media_active |= IFM_HDX;
    411  1.19   tsutsui 	} else {
    412  1.19   tsutsui 		gstat = PHY_READ(sc, RTK_GMEDIASTAT);
    413  1.19   tsutsui 		if ((gstat & RTK_GMEDIASTAT_1000MBPS) != 0)
    414  1.19   tsutsui 			mii->mii_media_active |= IFM_1000_T;
    415  1.19   tsutsui 		else if ((gstat & RTK_GMEDIASTAT_100MBPS) != 0)
    416  1.19   tsutsui 			mii->mii_media_active |= IFM_100_TX;
    417  1.19   tsutsui 		else if ((gstat & RTK_GMEDIASTAT_10MBPS) != 0)
    418  1.19   tsutsui 			mii->mii_media_active |= IFM_10_T;
    419  1.19   tsutsui 		else
    420  1.19   tsutsui 			mii->mii_media_active |= IFM_NONE;
    421  1.19   tsutsui 		if ((gstat & RTK_GMEDIASTAT_FDX) != 0)
    422  1.24    cegger 			mii->mii_media_active |= mii_phy_flowstatus(sc) |
    423  1.24    cegger 			    IFM_FDX;
    424  1.24    cegger 		else
    425  1.24    cegger 			mii->mii_media_active |= IFM_HDX;
    426  1.19   tsutsui 	}
    427   1.1  jonathan }
    428   1.1  jonathan 
    429   1.1  jonathan 
    430   1.1  jonathan static int
    431  1.15   tsutsui rgephy_mii_phy_auto(struct mii_softc *mii)
    432   1.1  jonathan {
    433  1.24    cegger 	int anar;
    434  1.15   tsutsui 
    435   1.1  jonathan 	rgephy_loop(mii);
    436  1.25    cegger 	rgephy_reset(mii);
    437   1.1  jonathan 
    438  1.24    cegger 	anar = BMSR_MEDIA_TO_ANAR(mii->mii_capabilities) | ANAR_CSMA;
    439  1.24    cegger 	if (mii->mii_flags & MIIF_DOPAUSE)
    440  1.24    cegger 		anar |= RGEPHY_ANAR_PC | RGEPHY_ANAR_ASP;
    441  1.24    cegger 
    442  1.24    cegger 	PHY_WRITE(mii, RGEPHY_MII_ANAR, anar);
    443   1.1  jonathan 	DELAY(1000);
    444  1.13   tsutsui 	PHY_WRITE(mii, RGEPHY_MII_1000CTL,
    445  1.13   tsutsui 	    RGEPHY_1000CTL_AHD | RGEPHY_1000CTL_AFD);
    446   1.1  jonathan 	DELAY(1000);
    447   1.1  jonathan 	PHY_WRITE(mii, RGEPHY_MII_BMCR,
    448   1.1  jonathan 	    RGEPHY_BMCR_AUTOEN | RGEPHY_BMCR_STARTNEG);
    449   1.1  jonathan 	DELAY(100);
    450   1.1  jonathan 
    451  1.15   tsutsui 	return EJUSTRETURN;
    452   1.1  jonathan }
    453   1.1  jonathan 
    454   1.1  jonathan static void
    455   1.1  jonathan rgephy_loop(struct mii_softc *sc)
    456   1.1  jonathan {
    457  1.19   tsutsui 	struct rgephy_softc *rsc;
    458  1.15   tsutsui 	uint32_t bmsr;
    459   1.1  jonathan 	int i;
    460   1.1  jonathan 
    461  1.19   tsutsui 	rsc = (struct rgephy_softc *)sc;
    462  1.19   tsutsui 	if (rsc->mii_revision < 2) {
    463  1.19   tsutsui 		PHY_WRITE(sc, RGEPHY_MII_BMCR, RGEPHY_BMCR_PDOWN);
    464  1.19   tsutsui 		DELAY(1000);
    465  1.19   tsutsui 	}
    466   1.1  jonathan 
    467   1.1  jonathan 	for (i = 0; i < 15000; i++) {
    468   1.1  jonathan 		bmsr = PHY_READ(sc, RGEPHY_MII_BMSR);
    469  1.15   tsutsui 		if ((bmsr & RGEPHY_BMSR_LINK) == 0) {
    470   1.1  jonathan #if 0
    471   1.1  jonathan 			device_printf(sc->mii_dev, "looped %d\n", i);
    472   1.1  jonathan #endif
    473   1.1  jonathan 			break;
    474   1.1  jonathan 		}
    475   1.1  jonathan 		DELAY(10);
    476   1.1  jonathan 	}
    477   1.1  jonathan }
    478   1.1  jonathan 
    479   1.1  jonathan #define PHY_SETBIT(x, y, z) \
    480   1.1  jonathan 	PHY_WRITE(x, y, (PHY_READ(x, y) | (z)))
    481   1.1  jonathan #define PHY_CLRBIT(x, y, z) \
    482   1.1  jonathan 	PHY_WRITE(x, y, (PHY_READ(x, y) & ~(z)))
    483   1.1  jonathan 
    484   1.1  jonathan /*
    485   1.1  jonathan  * Initialize RealTek PHY per the datasheet. The DSP in the PHYs of
    486   1.1  jonathan  * existing revisions of the 8169S/8110S chips need to be tuned in
    487  1.13   tsutsui  * order to reliably negotiate a 1000Mbps link. This is only needed
    488  1.13   tsutsui  * for rev 0 and rev 1 of the PHY. Later versions work without
    489  1.13   tsutsui  * any fixups.
    490   1.1  jonathan  */
    491   1.1  jonathan static void
    492   1.1  jonathan rgephy_load_dspcode(struct mii_softc *sc)
    493   1.1  jonathan {
    494  1.23    cegger 	struct rgephy_softc *rsc;
    495   1.1  jonathan 	int val;
    496   1.1  jonathan 
    497  1.23    cegger 	rsc = (struct rgephy_softc *)sc;
    498  1.23    cegger 	if (rsc->mii_revision >= 2)
    499  1.23    cegger 		return;
    500  1.23    cegger 
    501   1.1  jonathan #if 1
    502   1.1  jonathan 	PHY_WRITE(sc, 31, 0x0001);
    503   1.1  jonathan 	PHY_WRITE(sc, 21, 0x1000);
    504   1.1  jonathan 	PHY_WRITE(sc, 24, 0x65C7);
    505   1.1  jonathan 	PHY_CLRBIT(sc, 4, 0x0800);
    506   1.1  jonathan 	val = PHY_READ(sc, 4) & 0xFFF;
    507   1.1  jonathan 	PHY_WRITE(sc, 4, val);
    508   1.1  jonathan 	PHY_WRITE(sc, 3, 0x00A1);
    509   1.1  jonathan 	PHY_WRITE(sc, 2, 0x0008);
    510   1.1  jonathan 	PHY_WRITE(sc, 1, 0x1020);
    511   1.1  jonathan 	PHY_WRITE(sc, 0, 0x1000);
    512   1.1  jonathan 	PHY_SETBIT(sc, 4, 0x0800);
    513   1.1  jonathan 	PHY_CLRBIT(sc, 4, 0x0800);
    514   1.1  jonathan 	val = (PHY_READ(sc, 4) & 0xFFF) | 0x7000;
    515   1.1  jonathan 	PHY_WRITE(sc, 4, val);
    516   1.1  jonathan 	PHY_WRITE(sc, 3, 0xFF41);
    517   1.1  jonathan 	PHY_WRITE(sc, 2, 0xDE60);
    518   1.1  jonathan 	PHY_WRITE(sc, 1, 0x0140);
    519   1.1  jonathan 	PHY_WRITE(sc, 0, 0x0077);
    520   1.1  jonathan 	val = (PHY_READ(sc, 4) & 0xFFF) | 0xA000;
    521   1.1  jonathan 	PHY_WRITE(sc, 4, val);
    522   1.1  jonathan 	PHY_WRITE(sc, 3, 0xDF01);
    523   1.1  jonathan 	PHY_WRITE(sc, 2, 0xDF20);
    524   1.1  jonathan 	PHY_WRITE(sc, 1, 0xFF95);
    525   1.1  jonathan 	PHY_WRITE(sc, 0, 0xFA00);
    526   1.1  jonathan 	val = (PHY_READ(sc, 4) & 0xFFF) | 0xB000;
    527   1.1  jonathan 	PHY_WRITE(sc, 4, val);
    528   1.1  jonathan 	PHY_WRITE(sc, 3, 0xFF41);
    529   1.1  jonathan 	PHY_WRITE(sc, 2, 0xDE20);
    530   1.1  jonathan 	PHY_WRITE(sc, 1, 0x0140);
    531   1.1  jonathan 	PHY_WRITE(sc, 0, 0x00BB);
    532   1.1  jonathan 	val = (PHY_READ(sc, 4) & 0xFFF) | 0xF000;
    533   1.1  jonathan 	PHY_WRITE(sc, 4, val);
    534   1.1  jonathan 	PHY_WRITE(sc, 3, 0xDF01);
    535   1.1  jonathan 	PHY_WRITE(sc, 2, 0xDF20);
    536   1.1  jonathan 	PHY_WRITE(sc, 1, 0xFF95);
    537   1.1  jonathan 	PHY_WRITE(sc, 0, 0xBF00);
    538   1.1  jonathan 	PHY_SETBIT(sc, 4, 0x0800);
    539   1.1  jonathan 	PHY_CLRBIT(sc, 4, 0x0800);
    540   1.1  jonathan 	PHY_WRITE(sc, 31, 0x0000);
    541   1.1  jonathan #else
    542   1.1  jonathan 	(void)val;
    543   1.1  jonathan 	PHY_WRITE(sc, 0x1f, 0x0001);
    544   1.1  jonathan 	PHY_WRITE(sc, 0x15, 0x1000);
    545   1.1  jonathan 	PHY_WRITE(sc, 0x18, 0x65c7);
    546   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0x0000);
    547   1.1  jonathan 	PHY_WRITE(sc, 0x03, 0x00a1);
    548   1.1  jonathan 	PHY_WRITE(sc, 0x02, 0x0008);
    549   1.1  jonathan 	PHY_WRITE(sc, 0x01, 0x1020);
    550   1.1  jonathan 	PHY_WRITE(sc, 0x00, 0x1000);
    551   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0x0800);
    552   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0x0000);
    553   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0x7000);
    554   1.1  jonathan 	PHY_WRITE(sc, 0x03, 0xff41);
    555   1.1  jonathan 	PHY_WRITE(sc, 0x02, 0xde60);
    556   1.1  jonathan 	PHY_WRITE(sc, 0x01, 0x0140);
    557   1.1  jonathan 	PHY_WRITE(sc, 0x00, 0x0077);
    558   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0x7800);
    559   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0x7000);
    560   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xa000);
    561   1.1  jonathan 	PHY_WRITE(sc, 0x03, 0xdf01);
    562   1.1  jonathan 	PHY_WRITE(sc, 0x02, 0xdf20);
    563   1.1  jonathan 	PHY_WRITE(sc, 0x01, 0xff95);
    564   1.1  jonathan 	PHY_WRITE(sc, 0x00, 0xfa00);
    565   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xa800);
    566   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xa000);
    567   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xb000);
    568   1.1  jonathan 	PHY_WRITE(sc, 0x0e, 0xff41);
    569   1.1  jonathan 	PHY_WRITE(sc, 0x02, 0xde20);
    570   1.1  jonathan 	PHY_WRITE(sc, 0x01, 0x0140);
    571   1.1  jonathan 	PHY_WRITE(sc, 0x00, 0x00bb);
    572   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xb800);
    573   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xb000);
    574   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xf000);
    575   1.1  jonathan 	PHY_WRITE(sc, 0x03, 0xdf01);
    576   1.1  jonathan 	PHY_WRITE(sc, 0x02, 0xdf20);
    577   1.1  jonathan 	PHY_WRITE(sc, 0x01, 0xff95);
    578   1.1  jonathan 	PHY_WRITE(sc, 0x00, 0xbf00);
    579   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xf800);
    580   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0xf000);
    581   1.1  jonathan 	PHY_WRITE(sc, 0x04, 0x0000);
    582   1.1  jonathan 	PHY_WRITE(sc, 0x1f, 0x0000);
    583   1.1  jonathan 	PHY_WRITE(sc, 0x0b, 0x0000);
    584   1.1  jonathan 
    585   1.1  jonathan #endif
    586   1.5     perry 
    587   1.1  jonathan 	DELAY(40);
    588   1.1  jonathan }
    589   1.1  jonathan 
    590   1.1  jonathan static void
    591   1.1  jonathan rgephy_reset(struct mii_softc *sc)
    592   1.1  jonathan {
    593  1.19   tsutsui 	struct rgephy_softc *rsc;
    594  1.23    cegger 	uint16_t ssr;
    595  1.15   tsutsui 
    596  1.26    cegger 	mii_phy_reset(sc);
    597  1.26    cegger 	DELAY(1000);
    598  1.26    cegger 
    599  1.19   tsutsui 	rsc = (struct rgephy_softc *)sc;
    600  1.26    cegger 	if (rsc->mii_revision < 2) {
    601  1.26    cegger 		rgephy_load_dspcode(sc);
    602  1.26    cegger 	} else if (rsc->mii_revision == 3) {
    603  1.23    cegger 		/* RTL8211C(L) */
    604  1.23    cegger 		ssr = PHY_READ(sc, RGEPHY_MII_SSR);
    605  1.23    cegger 		if ((ssr & RGEPHY_SSR_ALDPS) != 0) {
    606  1.23    cegger 			ssr &= ~RGEPHY_SSR_ALDPS;
    607  1.23    cegger 			PHY_WRITE(sc, RGEPHY_MII_SSR, ssr);
    608  1.23    cegger 		}
    609  1.26    cegger 	} else {
    610   1.1  jonathan 		PHY_WRITE(sc, 0x1F, 0x0001);
    611   1.1  jonathan 		PHY_WRITE(sc, 0x09, 0x273a);
    612   1.1  jonathan 		PHY_WRITE(sc, 0x0e, 0x7bfb);
    613   1.1  jonathan 		PHY_WRITE(sc, 0x1b, 0x841e);
    614   1.1  jonathan 
    615   1.1  jonathan 		PHY_WRITE(sc, 0x1F, 0x0002);
    616   1.1  jonathan 		PHY_WRITE(sc, 0x01, 0x90D0);
    617   1.1  jonathan 		PHY_WRITE(sc, 0x1F, 0x0000);
    618  1.18   tsutsui 		PHY_WRITE(sc, 0x0e, 0x0000);
    619   1.1  jonathan 	}
    620   1.1  jonathan 
    621   1.1  jonathan 	/* Reset capabilities */
    622   1.1  jonathan 	/* Step1: write our capability */
    623  1.14   tsutsui 	/* 10/100 capability */
    624  1.14   tsutsui 	PHY_WRITE(sc, RGEPHY_MII_ANAR,
    625  1.14   tsutsui 	    RGEPHY_ANAR_TX_FD | RGEPHY_ANAR_TX |
    626  1.14   tsutsui 	    RGEPHY_ANAR_10_FD | RGEPHY_ANAR_10 | ANAR_CSMA);
    627  1.14   tsutsui 	/* 1000 capability */
    628  1.14   tsutsui 	PHY_WRITE(sc, RGEPHY_MII_1000CTL,
    629  1.14   tsutsui 	    RGEPHY_1000CTL_AFD | RGEPHY_1000CTL_AHD);
    630   1.1  jonathan 
    631   1.1  jonathan 	/* Step2: Restart NWay */
    632  1.14   tsutsui 	/* NWay enable and Restart NWay */
    633  1.14   tsutsui 	PHY_WRITE(sc, RGEPHY_MII_BMCR,
    634  1.14   tsutsui 	    RGEPHY_BMCR_RESET | RGEPHY_BMCR_AUTOEN | RGEPHY_BMCR_STARTNEG);
    635   1.1  jonathan }
    636