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