Home | History | Annotate | Line # | Download | only in mii
igphy.c revision 1.20
      1  1.20   msaitoh /*	$NetBSD: igphy.c,v 1.20 2009/12/16 14:37:26 msaitoh Exp $	*/
      2   1.1      fvdl 
      3   1.1      fvdl /*
      4   1.1      fvdl  * The Intel copyright applies to the analog register setup, and the
      5   1.1      fvdl  * (currently disabled) SmartSpeed workaround code.
      6   1.1      fvdl  */
      7   1.1      fvdl 
      8   1.1      fvdl /*******************************************************************************
      9   1.1      fvdl 
     10   1.1      fvdl   Copyright (c) 2001-2003, Intel Corporation
     11   1.1      fvdl   All rights reserved.
     12   1.1      fvdl 
     13   1.1      fvdl   Redistribution and use in source and binary forms, with or without
     14   1.1      fvdl   modification, are permitted provided that the following conditions are met:
     15   1.1      fvdl 
     16   1.1      fvdl    1. Redistributions of source code must retain the above copyright notice,
     17   1.1      fvdl       this list of conditions and the following disclaimer.
     18   1.1      fvdl 
     19   1.1      fvdl    2. Redistributions in binary form must reproduce the above copyright
     20   1.1      fvdl       notice, this list of conditions and the following disclaimer in the
     21   1.1      fvdl       documentation and/or other materials provided with the distribution.
     22   1.1      fvdl 
     23   1.1      fvdl    3. Neither the name of the Intel Corporation nor the names of its
     24   1.1      fvdl       contributors may be used to endorse or promote products derived from
     25   1.1      fvdl       this software without specific prior written permission.
     26   1.1      fvdl 
     27   1.1      fvdl   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
     28   1.1      fvdl   AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     29   1.1      fvdl   IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     30   1.1      fvdl   ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
     31   1.1      fvdl   LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32   1.1      fvdl   CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33   1.1      fvdl   SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34   1.1      fvdl   INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35   1.1      fvdl   CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36   1.1      fvdl   ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37   1.1      fvdl   POSSIBILITY OF SUCH DAMAGE.
     38   1.1      fvdl 
     39   1.1      fvdl *******************************************************************************/
     40   1.1      fvdl 
     41   1.1      fvdl 
     42   1.1      fvdl /*-
     43   1.1      fvdl  * Copyright (c) 1998, 1999, 2000, 2003 The NetBSD Foundation, Inc.
     44   1.1      fvdl  * All rights reserved.
     45   1.1      fvdl  *
     46   1.1      fvdl  * This code is derived from software contributed to The NetBSD Foundation
     47   1.1      fvdl  * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
     48   1.1      fvdl  * NASA Ames Research Center, and by Frank van der Linden.
     49   1.1      fvdl  *
     50   1.1      fvdl  * Redistribution and use in source and binary forms, with or without
     51   1.1      fvdl  * modification, are permitted provided that the following conditions
     52   1.1      fvdl  * are met:
     53   1.1      fvdl  * 1. Redistributions of source code must retain the above copyright
     54   1.1      fvdl  *    notice, this list of conditions and the following disclaimer.
     55   1.1      fvdl  * 2. Redistributions in binary form must reproduce the above copyright
     56   1.1      fvdl  *    notice, this list of conditions and the following disclaimer in the
     57   1.1      fvdl  *    documentation and/or other materials provided with the distribution.
     58   1.1      fvdl  *
     59   1.1      fvdl  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     60   1.1      fvdl  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     61   1.1      fvdl  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     62   1.1      fvdl  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     63   1.1      fvdl  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     64   1.1      fvdl  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     65   1.1      fvdl  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     66   1.1      fvdl  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     67   1.1      fvdl  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     68   1.1      fvdl  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     69   1.1      fvdl  * POSSIBILITY OF SUCH DAMAGE.
     70   1.1      fvdl  */
     71   1.1      fvdl 
     72   1.1      fvdl #include <sys/cdefs.h>
     73  1.20   msaitoh __KERNEL_RCSID(0, "$NetBSD: igphy.c,v 1.20 2009/12/16 14:37:26 msaitoh Exp $");
     74   1.1      fvdl 
     75   1.1      fvdl #include "opt_mii.h"
     76   1.1      fvdl 
     77   1.1      fvdl #include <sys/param.h>
     78   1.1      fvdl #include <sys/systm.h>
     79   1.1      fvdl #include <sys/kernel.h>
     80   1.1      fvdl #include <sys/device.h>
     81   1.1      fvdl #include <sys/socket.h>
     82   1.1      fvdl #include <sys/errno.h>
     83   1.1      fvdl 
     84   1.1      fvdl #include <net/if.h>
     85   1.1      fvdl #include <net/if_media.h>
     86   1.1      fvdl 
     87   1.1      fvdl #include <dev/mii/mii.h>
     88   1.1      fvdl #include <dev/mii/miivar.h>
     89   1.1      fvdl #include <dev/mii/miidevs.h>
     90   1.1      fvdl #include <dev/mii/igphyreg.h>
     91  1.19   msaitoh #include <dev/pci/if_wmvar.h>
     92   1.1      fvdl 
     93   1.5   thorpej struct igphy_softc {
     94   1.5   thorpej 	struct mii_softc sc_mii;
     95   1.5   thorpej 	int sc_smartspeed;
     96  1.19   msaitoh 	uint32_t sc_mactype;
     97  1.20   msaitoh 	uint32_t sc_macflags;
     98   1.5   thorpej };
     99   1.5   thorpej 
    100   1.1      fvdl static void igphy_reset(struct mii_softc *);
    101   1.1      fvdl static void igphy_load_dspcode(struct mii_softc *);
    102  1.20   msaitoh static void igphy_load_dspcode_igp3(struct mii_softc *);
    103   1.1      fvdl static void igphy_smartspeed_workaround(struct mii_softc *sc);
    104   1.1      fvdl 
    105  1.16   xtraeme static int	igphymatch(device_t, cfdata_t, void *);
    106  1.16   xtraeme static void	igphyattach(device_t, device_t, void *);
    107   1.1      fvdl 
    108  1.16   xtraeme CFATTACH_DECL_NEW(igphy, sizeof(struct igphy_softc),
    109   1.1      fvdl     igphymatch, igphyattach, mii_phy_detach, mii_phy_activate);
    110   1.1      fvdl 
    111   1.4   thorpej static int	igphy_service(struct mii_softc *, struct mii_data *, int);
    112   1.4   thorpej static void	igphy_status(struct mii_softc *);
    113   1.1      fvdl 
    114   1.4   thorpej static const struct mii_phy_funcs igphy_funcs = {
    115   1.1      fvdl 	igphy_service, igphy_status, igphy_reset,
    116   1.1      fvdl };
    117   1.1      fvdl 
    118   1.4   thorpej static const struct mii_phydesc igphys[] = {
    119   1.1      fvdl 	{ MII_OUI_yyINTEL,		MII_MODEL_yyINTEL_IGP01E1000,
    120   1.1      fvdl 	  MII_STR_yyINTEL_IGP01E1000 },
    121   1.1      fvdl 
    122  1.19   msaitoh 	{ MII_OUI_yyINTEL,		MII_MODEL_yyINTEL_I82566,
    123  1.19   msaitoh 	  MII_STR_yyINTEL_I82566 },
    124  1.19   msaitoh 
    125   1.1      fvdl 	{0,				0,
    126   1.1      fvdl 	 NULL },
    127   1.1      fvdl };
    128   1.1      fvdl 
    129   1.4   thorpej static int
    130  1.16   xtraeme igphymatch(device_t parent, cfdata_t match, void *aux)
    131   1.1      fvdl {
    132   1.1      fvdl 	struct mii_attach_args *ma = aux;
    133   1.1      fvdl 
    134   1.1      fvdl 	if (mii_phy_match(ma, igphys) != NULL)
    135   1.1      fvdl 		return 10;
    136   1.1      fvdl 
    137   1.1      fvdl 	return 0;
    138   1.1      fvdl }
    139   1.1      fvdl 
    140   1.4   thorpej static void
    141  1.16   xtraeme igphyattach(device_t parent, device_t self, void *aux)
    142   1.1      fvdl {
    143   1.7   thorpej 	struct mii_softc *sc = device_private(self);
    144   1.1      fvdl 	struct mii_attach_args *ma = aux;
    145   1.1      fvdl 	struct mii_data *mii = ma->mii_data;
    146   1.1      fvdl 	const struct mii_phydesc *mpd;
    147  1.19   msaitoh 	struct igphy_softc *igsc = (struct igphy_softc *) sc;
    148  1.19   msaitoh 	prop_dictionary_t dict;
    149   1.1      fvdl 
    150   1.1      fvdl 	mpd = mii_phy_match(ma, igphys);
    151   1.1      fvdl 	aprint_naive(": Media interface\n");
    152   1.1      fvdl 	aprint_normal(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
    153   1.1      fvdl 
    154  1.19   msaitoh 	dict = device_properties(parent);
    155  1.19   msaitoh 	if (!prop_dictionary_get_uint32(dict, "mactype", &igsc->sc_mactype))
    156  1.19   msaitoh 		aprint_error("WARNING! Failed to get mactype\n");
    157  1.20   msaitoh 	if (!prop_dictionary_get_uint32(dict, "macflags", &igsc->sc_macflags))
    158  1.20   msaitoh 		aprint_error("WARNING! Failed to get macflags\n");
    159  1.19   msaitoh 
    160  1.16   xtraeme 	sc->mii_dev = self;
    161   1.1      fvdl 	sc->mii_inst = mii->mii_instance;
    162   1.1      fvdl 	sc->mii_phy = ma->mii_phyno;
    163   1.1      fvdl 	sc->mii_funcs = &igphy_funcs;
    164   1.1      fvdl 	sc->mii_pdata = mii;
    165   1.1      fvdl 	sc->mii_flags = ma->mii_flags;
    166  1.10  christos 	sc->mii_anegticks = MII_ANEGTICKS_GIGE;
    167   1.1      fvdl 
    168   1.1      fvdl 	PHY_RESET(sc);
    169   1.1      fvdl 
    170   1.1      fvdl 	sc->mii_capabilities =
    171   1.1      fvdl 	    PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
    172   1.1      fvdl 	if (sc->mii_capabilities & BMSR_EXTSTAT)
    173   1.1      fvdl 		sc->mii_extcapabilities = PHY_READ(sc, MII_EXTSR);
    174  1.16   xtraeme 	aprint_normal_dev(self, "");
    175   1.1      fvdl 	if ((sc->mii_capabilities & BMSR_MEDIAMASK) == 0 &&
    176   1.1      fvdl 	    (sc->mii_extcapabilities & EXTSR_MEDIAMASK) == 0)
    177   1.1      fvdl 		aprint_error("no media present");
    178   1.1      fvdl 	else
    179   1.1      fvdl 		mii_phy_add_media(sc);
    180   1.1      fvdl 	aprint_normal("\n");
    181   1.1      fvdl }
    182   1.1      fvdl 
    183  1.20   msaitoh typedef struct {
    184  1.20   msaitoh 	int reg;
    185  1.20   msaitoh 	uint16_t val;
    186  1.20   msaitoh } dspcode;
    187  1.20   msaitoh 
    188  1.20   msaitoh static const dspcode igp1code[] = {
    189  1.20   msaitoh 	{ 0x1f95, 0x0001 },
    190  1.20   msaitoh 	{ 0x1f71, 0xbd21 },
    191  1.20   msaitoh 	{ 0x1f79, 0x0018 },
    192  1.20   msaitoh 	{ 0x1f30, 0x1600 },
    193  1.20   msaitoh 	{ 0x1f31, 0x0014 },
    194  1.20   msaitoh 	{ 0x1f32, 0x161c },
    195  1.20   msaitoh 	{ 0x1f94, 0x0003 },
    196  1.20   msaitoh 	{ 0x1f96, 0x003f },
    197  1.20   msaitoh 	{ 0x2010, 0x0008 },
    198  1.20   msaitoh 	{ 0, 0 },
    199  1.20   msaitoh };
    200  1.20   msaitoh 
    201  1.20   msaitoh static const dspcode igp1code_r2[] = {
    202  1.20   msaitoh 	{ 0x1f73, 0x0099 },
    203  1.20   msaitoh 	{ 0, 0 },
    204  1.20   msaitoh };
    205  1.20   msaitoh 
    206  1.20   msaitoh static const dspcode igp3code[] = {
    207  1.20   msaitoh 	{ 0x2f5b, 0x9018},
    208  1.20   msaitoh 	{ 0x2f52, 0x0000},
    209  1.20   msaitoh 	{ 0x2fb1, 0x8b24},
    210  1.20   msaitoh 	{ 0x2fb2, 0xf8f0},
    211  1.20   msaitoh 	{ 0x2010, 0x10b0},
    212  1.20   msaitoh 	{ 0x2011, 0x0000},
    213  1.20   msaitoh 	{ 0x20dd, 0x249a},
    214  1.20   msaitoh 	{ 0x20de, 0x00d3},
    215  1.20   msaitoh 	{ 0x28b4, 0x04ce},
    216  1.20   msaitoh 	{ 0x2f70, 0x29e4},
    217  1.20   msaitoh 	{ 0x0000, 0x0140},
    218  1.20   msaitoh 	{ 0x1f30, 0x1606},
    219  1.20   msaitoh 	{ 0x1f31, 0xb814},
    220  1.20   msaitoh 	{ 0x1f35, 0x002a},
    221  1.20   msaitoh 	{ 0x1f3e, 0x0067},
    222  1.20   msaitoh 	{ 0x1f54, 0x0065},
    223  1.20   msaitoh 	{ 0x1f55, 0x002a},
    224  1.20   msaitoh 	{ 0x1f56, 0x002a},
    225  1.20   msaitoh 	{ 0x1f72, 0x3fb0},
    226  1.20   msaitoh 	{ 0x1f76, 0xc0ff},
    227  1.20   msaitoh 	{ 0x1f77, 0x1dec},
    228  1.20   msaitoh 	{ 0x1f78, 0xf9ef},
    229  1.20   msaitoh 	{ 0x1f79, 0x0210},
    230  1.20   msaitoh 	{ 0x1895, 0x0003},
    231  1.20   msaitoh 	{ 0x1796, 0x0008},
    232  1.20   msaitoh 	{ 0x1798, 0xd008},
    233  1.20   msaitoh 	{ 0x1898, 0xd918},
    234  1.20   msaitoh 	{ 0x187a, 0x0800},
    235  1.20   msaitoh 	{ 0x0019, 0x008d},
    236  1.20   msaitoh 	{ 0x001b, 0x2080},
    237  1.20   msaitoh 	{ 0x0014, 0x0045},
    238  1.20   msaitoh 	{ 0x0000, 0x1340},
    239  1.20   msaitoh 	{ 0, 0 },
    240  1.20   msaitoh };
    241  1.20   msaitoh 
    242  1.20   msaitoh /* DSP patch for igp1 and igp2 */
    243   1.1      fvdl static void
    244   1.1      fvdl igphy_load_dspcode(struct mii_softc *sc)
    245   1.1      fvdl {
    246  1.19   msaitoh 	struct igphy_softc *igsc = (struct igphy_softc *) sc;
    247  1.20   msaitoh 	const dspcode *code;
    248  1.20   msaitoh 	uint16_t reg;
    249   1.1      fvdl 	int i;
    250   1.1      fvdl 
    251  1.19   msaitoh 	/* This workaround is only for 82541 and 82547 */
    252  1.19   msaitoh 	switch (igsc->sc_mactype) {
    253  1.19   msaitoh 	case WM_T_82541:
    254  1.19   msaitoh 	case WM_T_82547:
    255  1.20   msaitoh 		code = igp1code;
    256  1.20   msaitoh 		break;
    257  1.19   msaitoh 	case WM_T_82541_2:
    258  1.19   msaitoh 	case WM_T_82547_2:
    259  1.20   msaitoh 		code = igp1code_r2;
    260  1.19   msaitoh 		break;
    261  1.19   msaitoh 	default:
    262  1.20   msaitoh 		return;	/* byebye */
    263  1.19   msaitoh 	}
    264  1.19   msaitoh 
    265  1.20   msaitoh 	/* Delay after phy reset to enable NVM configuration to load */
    266  1.20   msaitoh 	delay(20000);
    267  1.20   msaitoh 
    268  1.20   msaitoh 	/*
    269  1.20   msaitoh 	 * Save off the current value of register 0x2F5B to be restored at
    270  1.20   msaitoh 	 * the end of this routine.
    271  1.20   msaitoh 	 */
    272  1.20   msaitoh 	reg = IGPHY_READ(sc, 0x2f5b);
    273  1.20   msaitoh 
    274  1.20   msaitoh 	/* Disabled the PHY transmitter */
    275  1.20   msaitoh 	IGPHY_WRITE(sc, 0x2f5b, 0x0003);
    276  1.20   msaitoh 
    277  1.20   msaitoh 	delay(20000);
    278   1.1      fvdl 
    279   1.1      fvdl 	PHY_WRITE(sc, MII_IGPHY_PAGE_SELECT, 0x0000);
    280   1.1      fvdl 	PHY_WRITE(sc, 0x0000, 0x0140);
    281   1.1      fvdl 
    282  1.20   msaitoh 	delay(5000);
    283   1.1      fvdl 
    284  1.20   msaitoh 	for (i = 0; !((code[i].reg == 0) && (code[i].val == 0)); i++)
    285  1.20   msaitoh 		IGPHY_WRITE(sc, code[i].reg, code[i].val);
    286   1.1      fvdl 
    287   1.1      fvdl 	PHY_WRITE(sc, MII_IGPHY_PAGE_SELECT,0x0000);
    288   1.1      fvdl 	PHY_WRITE(sc, 0x0000, 0x3300);
    289  1.20   msaitoh 
    290  1.20   msaitoh 	delay(20000);
    291  1.20   msaitoh 
    292  1.20   msaitoh 	/* Now enable the transmitter */
    293  1.20   msaitoh 	IGPHY_WRITE(sc, 0x2f5b, reg);
    294  1.20   msaitoh }
    295  1.20   msaitoh 
    296  1.20   msaitoh static void
    297  1.20   msaitoh igphy_load_dspcode_igp3(struct mii_softc *sc)
    298  1.20   msaitoh {
    299  1.20   msaitoh 	const dspcode *code = igp3code;
    300  1.20   msaitoh 	int i;
    301  1.20   msaitoh 
    302  1.20   msaitoh 	for (i = 0; !((code[i].reg == 0) && (code[i].val == 0)); i++)
    303  1.20   msaitoh 		IGPHY_WRITE(sc, code[i].reg, code[i].val);
    304   1.1      fvdl }
    305   1.1      fvdl 
    306   1.1      fvdl static void
    307   1.1      fvdl igphy_reset(struct mii_softc *sc)
    308   1.1      fvdl {
    309  1.19   msaitoh 	struct igphy_softc *igsc = (struct igphy_softc *) sc;
    310   1.1      fvdl 	uint16_t fused, fine, coarse;
    311   1.1      fvdl 
    312   1.1      fvdl 	mii_phy_reset(sc);
    313  1.20   msaitoh 	delay(150);
    314  1.20   msaitoh 
    315  1.20   msaitoh 	switch (igsc->sc_mactype) {
    316  1.20   msaitoh 	case WM_T_82541:
    317  1.20   msaitoh 	case WM_T_82547:
    318  1.20   msaitoh 	case WM_T_82541_2:
    319  1.20   msaitoh 	case WM_T_82547_2:
    320  1.20   msaitoh 		igphy_load_dspcode(sc);
    321  1.20   msaitoh 		break;
    322  1.20   msaitoh 	case WM_T_ICH8:
    323  1.20   msaitoh 	case WM_T_ICH9:
    324  1.20   msaitoh 		if ((igsc->sc_macflags & WM_F_EEPROM_INVALID) != 0)
    325  1.20   msaitoh 			igphy_load_dspcode_igp3(sc);
    326  1.20   msaitoh 		break;
    327  1.20   msaitoh 	default:	/* Not for ICH10, PCH and 8257[12] */
    328  1.20   msaitoh 		break;
    329  1.20   msaitoh 	}
    330   1.1      fvdl 
    331  1.19   msaitoh 	if (igsc->sc_mactype == WM_T_82547) {
    332  1.19   msaitoh 		fused = IGPHY_READ(sc, MII_IGPHY_ANALOG_SPARE_FUSE_STATUS);
    333  1.19   msaitoh 		if ((fused & ANALOG_SPARE_FUSE_ENABLED) == 0) {
    334  1.19   msaitoh 			fused = IGPHY_READ(sc, MII_IGPHY_ANALOG_FUSE_STATUS);
    335  1.19   msaitoh 
    336  1.19   msaitoh 			fine = fused & ANALOG_FUSE_FINE_MASK;
    337  1.19   msaitoh 			coarse = fused & ANALOG_FUSE_COARSE_MASK;
    338  1.19   msaitoh 
    339  1.19   msaitoh 			if (coarse > ANALOG_FUSE_COARSE_THRESH) {
    340  1.19   msaitoh 				coarse -= ANALOG_FUSE_COARSE_10;
    341  1.19   msaitoh 				fine -= ANALOG_FUSE_FINE_1;
    342  1.19   msaitoh 			} else if (coarse == ANALOG_FUSE_COARSE_THRESH)
    343  1.19   msaitoh 				fine -= ANALOG_FUSE_FINE_10;
    344  1.19   msaitoh 
    345  1.19   msaitoh 			fused = (fused & ANALOG_FUSE_POLY_MASK) |
    346  1.19   msaitoh 			    (fine & ANALOG_FUSE_FINE_MASK) |
    347  1.19   msaitoh 			    (coarse & ANALOG_FUSE_COARSE_MASK);
    348  1.19   msaitoh 
    349  1.19   msaitoh 			IGPHY_WRITE(sc, MII_IGPHY_ANALOG_FUSE_CONTROL, fused);
    350  1.19   msaitoh 			IGPHY_WRITE(sc, MII_IGPHY_ANALOG_FUSE_BYPASS,
    351  1.19   msaitoh 			    ANALOG_FUSE_ENABLE_SW_CONTROL);
    352  1.19   msaitoh 		}
    353   1.1      fvdl 	}
    354  1.20   msaitoh 	PHY_WRITE(sc, MII_IGPHY_PAGE_SELECT, 0x0000);
    355   1.1      fvdl }
    356   1.1      fvdl 
    357   1.1      fvdl 
    358   1.4   thorpej static int
    359   1.1      fvdl igphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
    360   1.1      fvdl {
    361   1.1      fvdl 	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    362   1.1      fvdl 	uint16_t reg;
    363   1.1      fvdl 
    364   1.1      fvdl 	switch (cmd) {
    365   1.1      fvdl 	case MII_POLLSTAT:
    366   1.1      fvdl 		/*
    367   1.1      fvdl 		 * If we're not polling our PHY instance, just return.
    368   1.1      fvdl 		 */
    369   1.1      fvdl 		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    370   1.1      fvdl 			return (0);
    371   1.1      fvdl 		break;
    372   1.1      fvdl 
    373   1.1      fvdl 	case MII_MEDIACHG:
    374   1.1      fvdl 		/*
    375   1.1      fvdl 		 * If the media indicates a different PHY instance,
    376   1.1      fvdl 		 * isolate ourselves.
    377   1.1      fvdl 		 */
    378   1.1      fvdl 		if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
    379   1.1      fvdl 			reg = PHY_READ(sc, MII_BMCR);
    380   1.1      fvdl 			PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
    381   1.1      fvdl 			return (0);
    382   1.1      fvdl 		}
    383   1.1      fvdl 
    384   1.1      fvdl 		/*
    385   1.1      fvdl 		 * If the interface is not up, don't do anything.
    386   1.1      fvdl 		 */
    387   1.1      fvdl 		if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
    388   1.1      fvdl 			break;
    389   1.1      fvdl 
    390  1.11   msaitoh 		reg = PHY_READ(sc, MII_IGPHY_PORT_CTRL);
    391  1.11   msaitoh 		if (IFM_SUBTYPE(ife->ifm_media) == IFM_AUTO) {
    392  1.11   msaitoh 			reg |= PSCR_AUTO_MDIX;
    393  1.11   msaitoh 			reg &= ~PSCR_FORCE_MDI_MDIX;
    394  1.11   msaitoh 			PHY_WRITE(sc, MII_IGPHY_PORT_CTRL, reg);
    395  1.11   msaitoh 		} else {
    396  1.11   msaitoh 			reg &= ~(PSCR_AUTO_MDIX | PSCR_FORCE_MDI_MDIX);
    397  1.11   msaitoh 			PHY_WRITE(sc, MII_IGPHY_PORT_CTRL, reg);
    398  1.11   msaitoh 		}
    399  1.11   msaitoh 
    400   1.1      fvdl 		mii_phy_setmedia(sc);
    401   1.1      fvdl 		break;
    402   1.1      fvdl 
    403   1.1      fvdl 	case MII_TICK:
    404   1.1      fvdl 		/*
    405   1.1      fvdl 		 * If we're not currently selected, just return.
    406   1.1      fvdl 		 */
    407   1.1      fvdl 		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
    408   1.1      fvdl 			return (0);
    409   1.1      fvdl 
    410   1.1      fvdl 		igphy_smartspeed_workaround(sc);
    411   1.1      fvdl 
    412   1.1      fvdl 		if (mii_phy_tick(sc) == EJUSTRETURN)
    413   1.1      fvdl 			return (0);
    414   1.1      fvdl 		break;
    415   1.1      fvdl 
    416   1.1      fvdl 	case MII_DOWN:
    417   1.1      fvdl 		mii_phy_down(sc);
    418   1.1      fvdl 		return (0);
    419   1.1      fvdl 	}
    420   1.1      fvdl 
    421   1.1      fvdl 	/* Update the media status. */
    422   1.1      fvdl 	mii_phy_status(sc);
    423   1.1      fvdl 
    424   1.1      fvdl 	/* Callback if something changed. */
    425   1.1      fvdl 	mii_phy_update(sc, cmd);
    426   1.1      fvdl 	return (0);
    427   1.1      fvdl }
    428   1.1      fvdl 
    429   1.1      fvdl 
    430   1.4   thorpej static void
    431   1.1      fvdl igphy_status(struct mii_softc *sc)
    432   1.1      fvdl {
    433   1.1      fvdl 	struct mii_data *mii = sc->mii_pdata;
    434   1.1      fvdl 	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
    435   1.1      fvdl 	uint16_t bmcr, pssr, gtsr, bmsr;
    436   1.1      fvdl 
    437   1.1      fvdl 	mii->mii_media_status = IFM_AVALID;
    438   1.1      fvdl 	mii->mii_media_active = IFM_ETHER;
    439   1.1      fvdl 
    440   1.1      fvdl 	pssr = PHY_READ(sc, MII_IGPHY_PORT_STATUS);
    441   1.1      fvdl 
    442   1.1      fvdl 	if (pssr & PSSR_LINK_UP)
    443   1.1      fvdl 		mii->mii_media_status |= IFM_ACTIVE;
    444   1.1      fvdl 
    445   1.1      fvdl 	bmcr = PHY_READ(sc, MII_BMCR);
    446   1.1      fvdl 	if (bmcr & BMCR_ISO) {
    447   1.1      fvdl 		mii->mii_media_active |= IFM_NONE;
    448   1.1      fvdl 		mii->mii_media_status = 0;
    449   1.1      fvdl 		return;
    450   1.1      fvdl 	}
    451   1.1      fvdl 
    452   1.1      fvdl 	if (bmcr & BMCR_LOOP)
    453   1.1      fvdl 		mii->mii_media_active |= IFM_LOOP;
    454   1.1      fvdl 
    455   1.1      fvdl 	bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
    456   1.1      fvdl 
    457   1.1      fvdl 	/*
    458   1.1      fvdl 	 * XXX can't check if the info is valid, no
    459   1.1      fvdl 	 * 'negotiation done' bit?
    460   1.1      fvdl 	 */
    461   1.1      fvdl 	if (bmcr & BMCR_AUTOEN) {
    462   1.1      fvdl 		if ((bmsr & BMSR_ACOMP) == 0) {
    463   1.1      fvdl 			mii->mii_media_active |= IFM_NONE;
    464   1.1      fvdl 			return;
    465   1.1      fvdl 		}
    466   1.1      fvdl 		switch (pssr & PSSR_SPEED_MASK) {
    467   1.1      fvdl 		case PSSR_SPEED_1000MBPS:
    468   1.1      fvdl 			mii->mii_media_active |= IFM_1000_T;
    469   1.1      fvdl 			gtsr = PHY_READ(sc, MII_100T2SR);
    470   1.1      fvdl 			if (gtsr & GTSR_MS_RES)
    471   1.1      fvdl 				mii->mii_media_active |= IFM_ETH_MASTER;
    472   1.1      fvdl 			break;
    473   1.1      fvdl 
    474   1.1      fvdl 		case PSSR_SPEED_100MBPS:
    475   1.1      fvdl 			mii->mii_media_active |= IFM_100_TX;
    476   1.1      fvdl 			break;
    477   1.1      fvdl 
    478   1.1      fvdl 		case PSSR_SPEED_10MBPS:
    479   1.1      fvdl 			mii->mii_media_active |= IFM_10_T;
    480   1.1      fvdl 			break;
    481   1.1      fvdl 
    482   1.1      fvdl 		default:
    483   1.1      fvdl 			mii->mii_media_active |= IFM_NONE;
    484   1.1      fvdl 			mii->mii_media_status = 0;
    485   1.1      fvdl 			return;
    486   1.1      fvdl 		}
    487   1.1      fvdl 
    488   1.1      fvdl 		if (pssr & PSSR_FULL_DUPLEX)
    489   1.2   thorpej 			mii->mii_media_active |=
    490   1.3   thorpej 			    IFM_FDX | mii_phy_flowstatus(sc);
    491   1.1      fvdl 	} else
    492   1.1      fvdl 		mii->mii_media_active = ife->ifm_media;
    493   1.1      fvdl }
    494   1.1      fvdl 
    495   1.1      fvdl static void
    496   1.1      fvdl igphy_smartspeed_workaround(struct mii_softc *sc)
    497   1.1      fvdl {
    498   1.5   thorpej 	struct igphy_softc *igsc = (struct igphy_softc *) sc;
    499   1.5   thorpej 	uint16_t reg, gtsr, gtcr;
    500   1.5   thorpej 
    501  1.19   msaitoh 
    502  1.19   msaitoh 	/* This workaround is only for 82541 and 82547 */
    503  1.19   msaitoh 	switch (igsc->sc_mactype) {
    504  1.19   msaitoh 	case WM_T_82541:
    505  1.19   msaitoh 	case WM_T_82541_2:
    506  1.19   msaitoh 	case WM_T_82547:
    507  1.19   msaitoh 	case WM_T_82547_2:
    508  1.19   msaitoh 		break;
    509  1.19   msaitoh 	default:
    510  1.19   msaitoh 		/* byebye */
    511  1.19   msaitoh 		return;
    512  1.19   msaitoh 	}
    513  1.19   msaitoh 
    514   1.5   thorpej 	if ((PHY_READ(sc, MII_BMCR) & BMCR_AUTOEN) == 0)
    515   1.5   thorpej 		return;
    516   1.5   thorpej 
    517   1.5   thorpej 	/* XXX Assume 1000TX-FDX is advertized if doing autonegotiation. */
    518   1.1      fvdl 
    519   1.1      fvdl 	reg = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
    520   1.5   thorpej 	if ((reg & BMSR_LINK) == 0) {
    521   1.5   thorpej 		switch (igsc->sc_smartspeed) {
    522   1.1      fvdl 		case 0:
    523   1.1      fvdl 			gtsr = PHY_READ(sc, MII_100T2SR);
    524   1.1      fvdl 			if (!(gtsr & GTSR_MAN_MS_FLT))
    525   1.1      fvdl 				break;
    526   1.1      fvdl 			gtsr = PHY_READ(sc, MII_100T2SR);
    527   1.1      fvdl 			if (gtsr & GTSR_MAN_MS_FLT) {
    528   1.1      fvdl 				gtcr = PHY_READ(sc, MII_100T2CR);
    529   1.1      fvdl 				if (gtcr & GTCR_MAN_MS) {
    530   1.1      fvdl 					gtcr &= ~GTCR_MAN_MS;
    531   1.1      fvdl 					PHY_WRITE(sc, MII_100T2CR,
    532   1.1      fvdl 					    gtcr);
    533   1.1      fvdl 				}
    534   1.1      fvdl 				mii_phy_auto(sc, 0);
    535   1.1      fvdl 			}
    536   1.1      fvdl 			break;
    537   1.1      fvdl 		case IGPHY_TICK_DOWNSHIFT:
    538   1.1      fvdl 			gtcr = PHY_READ(sc, MII_100T2CR);
    539   1.1      fvdl 			gtcr |= GTCR_MAN_MS;
    540   1.1      fvdl 			PHY_WRITE(sc, MII_100T2CR, gtcr);
    541   1.1      fvdl 			mii_phy_auto(sc, 0);
    542   1.1      fvdl 			break;
    543   1.1      fvdl 		default:
    544   1.1      fvdl 			break;
    545   1.1      fvdl 		}
    546   1.5   thorpej 		if (igsc->sc_smartspeed++ == IGPHY_TICK_MAX)
    547   1.5   thorpej 			igsc->sc_smartspeed = 0;
    548   1.5   thorpej 	} else
    549   1.5   thorpej 		igsc->sc_smartspeed = 0;
    550   1.1      fvdl }
    551