amphy.c revision 164827
1139749Simp/*-
250983Swpaul * Copyright (c) 1997, 1998, 1999
350983Swpaul *	Bill Paul <wpaul@ee.columbia.edu>.  All rights reserved.
450983Swpaul *
550983Swpaul * Redistribution and use in source and binary forms, with or without
650983Swpaul * modification, are permitted provided that the following conditions
750983Swpaul * are met:
850983Swpaul * 1. Redistributions of source code must retain the above copyright
950983Swpaul *    notice, this list of conditions and the following disclaimer.
1050983Swpaul * 2. Redistributions in binary form must reproduce the above copyright
1150983Swpaul *    notice, this list of conditions and the following disclaimer in the
1250983Swpaul *    documentation and/or other materials provided with the distribution.
1350983Swpaul * 3. All advertising materials mentioning features or use of this software
1450983Swpaul *    must display the following acknowledgement:
1550983Swpaul *	This product includes software developed by Bill Paul.
1650983Swpaul * 4. Neither the name of the author nor the names of any co-contributors
1750983Swpaul *    may be used to endorse or promote products derived from this software
1850983Swpaul *    without specific prior written permission.
1950983Swpaul *
2050983Swpaul * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
2150983Swpaul * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2250983Swpaul * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2350983Swpaul * ARE DISCLAIMED.  IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
2450983Swpaul * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
2550983Swpaul * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
2650983Swpaul * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
2750983Swpaul * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
2850983Swpaul * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
2950983Swpaul * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
3050983Swpaul * THE POSSIBILITY OF SUCH DAMAGE.
3150983Swpaul */
3250983Swpaul
33119418Sobrien#include <sys/cdefs.h>
34119418Sobrien__FBSDID("$FreeBSD: head/sys/dev/mii/amphy.c 164827 2006-12-02 15:32:34Z marius $");
35119418Sobrien
3650983Swpaul/*
3750983Swpaul * driver for AMD AM79c873 PHYs
3851428Swpaul * This driver also works for the Davicom DM9101 PHY, which appears to
3951428Swpaul * be an AM79c873 workalike.
4050983Swpaul */
4150983Swpaul
4250983Swpaul#include <sys/param.h>
4350983Swpaul#include <sys/systm.h>
4450983Swpaul#include <sys/kernel.h>
45129876Sphk#include <sys/module.h>
4650983Swpaul#include <sys/socket.h>
4750983Swpaul#include <sys/bus.h>
4850983Swpaul
4950983Swpaul#include <net/if.h>
5050983Swpaul#include <net/if_media.h>
5150983Swpaul
5250983Swpaul#include <dev/mii/mii.h>
5350983Swpaul#include <dev/mii/miivar.h>
54109514Sobrien#include "miidevs.h"
5550983Swpaul
5650983Swpaul#include <dev/mii/amphyreg.h>
5750983Swpaul
5850983Swpaul#include "miibus_if.h"
5950983Swpaul
60105135Salfredstatic int amphy_probe(device_t);
61105135Salfredstatic int amphy_attach(device_t);
6250983Swpaul
6350983Swpaulstatic device_method_t amphy_methods[] = {
6450983Swpaul	/* device interface */
6550983Swpaul	DEVMETHOD(device_probe,		amphy_probe),
6650983Swpaul	DEVMETHOD(device_attach,	amphy_attach),
6795722Sphk	DEVMETHOD(device_detach,	mii_phy_detach),
6850983Swpaul	DEVMETHOD(device_shutdown,	bus_generic_shutdown),
6950983Swpaul	{ 0, 0 }
7050983Swpaul};
7150983Swpaul
7250983Swpaulstatic devclass_t amphy_devclass;
7350983Swpaul
7450983Swpaulstatic driver_t amphy_driver = {
7550983Swpaul	"amphy",
7650983Swpaul	amphy_methods,
7750983Swpaul	sizeof(struct mii_softc)
7850983Swpaul};
7950983Swpaul
8050983SwpaulDRIVER_MODULE(amphy, miibus, amphy_driver, amphy_devclass, 0, 0);
8150983Swpaul
8292739Salfredstatic int	amphy_service(struct mii_softc *, struct mii_data *, int);
8392739Salfredstatic void	amphy_status(struct mii_softc *);
8450983Swpaul
85164827Smariusstatic const struct mii_phydesc amphys[] = {
86164827Smarius	MII_PHY_DESC(xxAMD, 79C873),
87164827Smarius	MII_PHY_DESC(xxDAVICOM, DM9101),
88164827Smarius	MII_PHY_END
89164827Smarius};
90164827Smarius
91105135Salfredstatic int
92150763Simpamphy_probe(device_t dev)
9350983Swpaul{
9450983Swpaul
95164827Smarius	return (mii_phy_dev_probe(dev, amphys, BUS_PROBE_DEFAULT));
9650983Swpaul}
9750983Swpaul
98105135Salfredstatic int
99150763Simpamphy_attach(device_t dev)
10050983Swpaul{
10150983Swpaul	struct mii_softc *sc;
10250983Swpaul	struct mii_attach_args *ma;
10350983Swpaul	struct mii_data *mii;
10450983Swpaul
10550983Swpaul	sc = device_get_softc(dev);
10650983Swpaul	ma = device_get_ivars(dev);
10750983Swpaul	sc->mii_dev = device_get_parent(dev);
10850983Swpaul	mii = device_get_softc(sc->mii_dev);
10950983Swpaul	LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list);
11050983Swpaul
11150983Swpaul	sc->mii_inst = mii->mii_instance;
11250983Swpaul	sc->mii_phy = ma->mii_phyno;
11350983Swpaul	sc->mii_service = amphy_service;
11450983Swpaul	sc->mii_pdata = mii;
11550983Swpaul
11650983Swpaul	sc->mii_flags |= MIIF_NOISOLATE;
11750983Swpaul	mii->mii_instance++;
11850983Swpaul
11950983Swpaul#define	ADD(m, c)	ifmedia_add(&mii->mii_media, (m), (c), NULL)
12050983Swpaul
12150983Swpaul	ADD(IFM_MAKEWORD(IFM_ETHER, IFM_NONE, 0, sc->mii_inst),
12250983Swpaul	    BMCR_ISO);
12350983Swpaul#if 0
12450983Swpaul	ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst),
12550983Swpaul	    BMCR_LOOP|BMCR_S100);
12650983Swpaul#endif
12750983Swpaul
12850983Swpaul	mii_phy_reset(sc);
12950983Swpaul
13050983Swpaul	sc->mii_capabilities =
13150983Swpaul	    PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
13250983Swpaul	device_printf(dev, " ");
13395667Sphk	mii_add_media(sc);
13450983Swpaul	printf("\n");
13550983Swpaul#undef ADD
13650983Swpaul	MIIBUS_MEDIAINIT(sc->mii_dev);
13750983Swpaul	return(0);
13850983Swpaul}
13950983Swpaul
14084145Sjlemonstatic int
141150763Simpamphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
14250983Swpaul{
14350983Swpaul	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
14450983Swpaul	int reg;
14550983Swpaul
14650983Swpaul	switch (cmd) {
14750983Swpaul	case MII_POLLSTAT:
14850983Swpaul		/*
14950983Swpaul		 * If we're not polling our PHY instance, just return.
15050983Swpaul		 */
15150983Swpaul		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
15250983Swpaul			return (0);
15350983Swpaul		break;
15450983Swpaul
15550983Swpaul	case MII_MEDIACHG:
15650983Swpaul		/*
15750983Swpaul		 * If the media indicates a different PHY instance,
15850983Swpaul		 * isolate ourselves.
15950983Swpaul		 */
16050983Swpaul		if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
16150983Swpaul			reg = PHY_READ(sc, MII_BMCR);
16250983Swpaul			PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
16350983Swpaul			return (0);
16450983Swpaul		}
16550983Swpaul
16650983Swpaul		/*
16750983Swpaul		 * If the interface is not up, don't do anything.
16850983Swpaul		 */
16950983Swpaul		if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
17050983Swpaul			break;
17150983Swpaul
17250983Swpaul		switch (IFM_SUBTYPE(ife->ifm_media)) {
17350983Swpaul		case IFM_AUTO:
17450983Swpaul			/*
17550983Swpaul			 * If we're already in auto mode, just return.
17650983Swpaul			 */
17750983Swpaul			if (PHY_READ(sc, MII_BMCR) & BMCR_AUTOEN)
17850983Swpaul				return (0);
17996026Sphk			(void) mii_phy_auto(sc);
18050983Swpaul			break;
18150983Swpaul		case IFM_100_T4:
18250983Swpaul			/*
18350983Swpaul			 * XXX Not supported as a manual setting right now.
18450983Swpaul			 */
18550983Swpaul			return (EINVAL);
18650983Swpaul		default:
18750983Swpaul			/*
18850983Swpaul			 * BMCR data is stored in the ifmedia entry.
18950983Swpaul			 */
19050983Swpaul			PHY_WRITE(sc, MII_ANAR,
19150983Swpaul			    mii_anar(ife->ifm_media));
19250983Swpaul			PHY_WRITE(sc, MII_BMCR, ife->ifm_data);
19350983Swpaul		}
19450983Swpaul		break;
19550983Swpaul
19650983Swpaul	case MII_TICK:
19750983Swpaul		/*
19850983Swpaul		 * If we're not currently selected, just return.
19950983Swpaul		 */
20050983Swpaul		if (IFM_INST(ife->ifm_media) != sc->mii_inst)
20150983Swpaul			return (0);
20284145Sjlemon		if (mii_phy_tick(sc) == EJUSTRETURN)
20350983Swpaul			return (0);
20450983Swpaul		break;
20550983Swpaul	}
20650983Swpaul
20750983Swpaul	/* Update the media status. */
20850983Swpaul	amphy_status(sc);
20950983Swpaul
21050983Swpaul	/* Callback if something changed. */
21184145Sjlemon	mii_phy_update(sc, cmd);
21250983Swpaul	return (0);
21350983Swpaul}
21450983Swpaul
21584145Sjlemonstatic void
216150763Simpamphy_status(struct mii_softc *sc)
21750983Swpaul{
21850983Swpaul	struct mii_data *mii = sc->mii_pdata;
21950983Swpaul	int bmsr, bmcr, par, anlpar;
22050983Swpaul
22150983Swpaul	mii->mii_media_status = IFM_AVALID;
22250983Swpaul	mii->mii_media_active = IFM_ETHER;
22350983Swpaul
22450983Swpaul	bmsr = PHY_READ(sc, MII_BMSR) |
22550983Swpaul	    PHY_READ(sc, MII_BMSR);
22650983Swpaul	if (bmsr & BMSR_LINK)
22750983Swpaul		mii->mii_media_status |= IFM_ACTIVE;
22850983Swpaul
22950983Swpaul	bmcr = PHY_READ(sc, MII_BMCR);
23050983Swpaul	if (bmcr & BMCR_ISO) {
23150983Swpaul		mii->mii_media_active |= IFM_NONE;
23250983Swpaul		mii->mii_media_status = 0;
23350983Swpaul		return;
23450983Swpaul	}
23550983Swpaul
23650983Swpaul	if (bmcr & BMCR_LOOP)
23750983Swpaul		mii->mii_media_active |= IFM_LOOP;
23850983Swpaul
23950983Swpaul	if (bmcr & BMCR_AUTOEN) {
24050983Swpaul		/*
24150983Swpaul		 * The PAR status bits are only valid of autonegotiation
24250983Swpaul		 * has completed (or it's disabled).
24350983Swpaul		 */
24450983Swpaul		if ((bmsr & BMSR_ACOMP) == 0) {
24550983Swpaul			/* Erg, still trying, I guess... */
24650983Swpaul			mii->mii_media_active |= IFM_NONE;
24750983Swpaul			return;
24850983Swpaul		}
24950983Swpaul
25050983Swpaul		if (PHY_READ(sc, MII_ANER) & ANER_LPAN) {
25150983Swpaul			anlpar = PHY_READ(sc, MII_ANAR) &
25250983Swpaul			    PHY_READ(sc, MII_ANLPAR);
25350983Swpaul			if (anlpar & ANLPAR_T4)
25450983Swpaul				mii->mii_media_active |= IFM_100_T4;
25550983Swpaul			else if (anlpar & ANLPAR_TX_FD)
25650983Swpaul				mii->mii_media_active |= IFM_100_TX|IFM_FDX;
25750983Swpaul			else if (anlpar & ANLPAR_TX)
25850983Swpaul				mii->mii_media_active |= IFM_100_TX;
25950983Swpaul			else if (anlpar & ANLPAR_10_FD)
26050983Swpaul				mii->mii_media_active |= IFM_10_T|IFM_FDX;
26150983Swpaul			else if (anlpar & ANLPAR_10)
26250983Swpaul				mii->mii_media_active |= IFM_10_T;
26350983Swpaul			else
26450983Swpaul				mii->mii_media_active |= IFM_NONE;
26550983Swpaul			return;
26650983Swpaul		}
26750983Swpaul
26850983Swpaul		/*
26950983Swpaul		 * Link partner is not capable of autonegotiation.
27050983Swpaul		 */
27150983Swpaul		par = PHY_READ(sc, MII_AMPHY_DSCSR);
27250983Swpaul		if (par & DSCSR_100FDX)
27350983Swpaul			mii->mii_media_active |= IFM_100_TX|IFM_FDX;
27450983Swpaul		else if (par & DSCSR_100HDX)
27550983Swpaul			mii->mii_media_active |= IFM_100_TX;
27650983Swpaul		else if (par & DSCSR_10FDX)
27750983Swpaul			mii->mii_media_active |= IFM_10_T|IFM_HDX;
27850983Swpaul		else if (par & DSCSR_10HDX)
27950983Swpaul			mii->mii_media_active |= IFM_10_T;
28050983Swpaul	} else
28150983Swpaul		mii->mii_media_active = mii_media_from_bmcr(bmcr);
28250983Swpaul}
283