NetBSD/sys/dev/mii/mii.c

/*	$NetBSD: mii.c,v 1.5 1998/06/09 07:30:43 thorpej Exp $	*/
 
/*
 * Copyright (c) 1997 Manuel Bouyer.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *	This product includes software developed by Manuel Bouyer.
 * 4. The name of the author may not be used to endorse or promote products
 *    derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <sys/socket.h>
#include <sys/sockio.h>

#include <net/if.h>
#if defined(SIOCSIFMEDIA)
#include <net/if_media.h>
#endif

#include <dev/mii/mii_adapter.h>
#include <dev/mii/mii_phy.h>
#include <dev/mii/generic_phy.h>

#include "locators.h"

/* The mii bus private data definitions */

struct mii_softc {
	struct device sc_dev;
	mii_data_t *adapter;
	mii_phy_t *phy[32];
	mii_phy_t *current_phy;
};

static void mii_sync __P((mii_data_t *));
static void mii_sendbit __P((mii_data_t *, u_int32_t, int));

int miimatch __P((struct device *, struct cfdata *, void *));
int mii_configmatch __P((struct device *, struct cfdata *, void *));
void miiattach __P((struct device *, struct device *, void *));

int mii_print __P((void *, const char *));

struct cfattach mii_ca = {
	sizeof(struct mii_softc), miimatch, miiattach
};

int mii_adapter_print(aux, pnp)
    void *aux;
	const char *pnp;
{
	if (pnp)
		printf("mii at %s", pnp);
	return UNCONF;
}

int
mii_print(aux, pnp)
	void *aux;
	const char *pnp;
{
	mii_phy_t *phy = aux;

	if (pnp)
		printf("PHY ID 0x%x at %s", phy->phy_id, pnp);
	printf(" dev %d", phy->dev);
	return (UNCONF);
}

int
miimatch(parent, cf, aux)
	struct device *parent;
	struct cfdata *cf;
	void *aux;
{
	return 1;
}

void
miiattach(parent, self, aux)
	struct device *parent, *self;
	void *aux;
{
	int phy_id_l, phy_id_h;
	int i;
	mii_phy_t *phy;
	struct mii_softc *sc = (struct mii_softc *)self;
	mii_data_t *adapter = aux;
	/* struct cfdata *cf; */

	printf("\n");
	sc->adapter = adapter;
	sc->adapter->mii_sc = sc; 
	sc->current_phy = NULL;

	for (i = 0; i < 32; i++) {
		phy_id_h = mii_readreg(sc, i, PHY_IDH);
		phy_id_l = mii_readreg(sc, i, PHY_IDL);
#ifdef MII_DEBUG
		printf("Id of PHY 0x%x: 0x%x%x\n", i, phy_id_h, phy_id_l);
#endif
		if (phy_id_h != -1 && phy_id_l != -1) {
			phy = malloc(sizeof(mii_phy_t), M_DEVBUF, M_WAITOK);
			phy->phy_id = ((phy_id_h & 0xffff) << 16) |
			    (phy_id_l & 0xffff);
			phy->adapter_id = adapter->adapter_id;
			phy->dev = i;
			phy->mii_softc = sc;
#if 0
			if ((cf = config_search(mii_configmatch, self,
			    phy)) != NULL) {
				sc->phy[i] = phy;
				config_attach(self, cf, phy, mii_print);
			} else {
				sc->phy[i] = NULL;
				mii_print(phy, sc->sc_dev.dv_xname);
				printf(" not configured\n");
				free(phy, M_DEVBUF);
			}
#else
			if (config_found_sm(self, phy, mii_print,
			    mii_configmatch) != NULL) {
				sc->phy[i] = phy;
			} else {
				sc->phy[i] = NULL;
				free(phy, M_DEVBUF);
			}
#endif
		}
	}
}

int
mii_configmatch(parent, cf, aux)
	struct device *parent;
	struct cfdata *cf;
	void *aux;
{
	mii_phy_t *phy = aux;

	if (cf->cf_loc[MIICF_DEV] != MIICF_DEV_DEFAULT &&
	    cf->cf_loc[MIICF_DEV] != phy->dev)
		return (0);
	return ((*cf->cf_attach->ca_match)(parent, cf, aux));
}

static void
mii_sync(adapter)
	mii_data_t* adapter;
{
	int i;

	(*adapter->mii_clrbit)(adapter->adapter_softc, MII_TXEN);
	for (i = 0; i < 32; i++) {
		(*adapter->mii_clrbit)(adapter->adapter_softc, MII_CLOCK);
		(*adapter->mii_setbit)(adapter->adapter_softc, MII_CLOCK);
	}
}

static void
mii_sendbit(adapter, data, nbits)
	mii_data_t *adapter;
	u_int32_t data;
	int nbits;
{
	int i;

	(*adapter->mii_setbit)(adapter->adapter_softc, MII_TXEN);
	for (i = 1 << (nbits -1); i; i = i >>  1) {
		(*adapter->mii_clrbit)(adapter->adapter_softc, MII_CLOCK);
		(*adapter->mii_readbit)(adapter->adapter_softc, MII_CLOCK);
		if (data & i)
			(*adapter->mii_setbit)(adapter->adapter_softc,
			    MII_DATA);
		else
			(*adapter->mii_clrbit)(adapter->adapter_softc,
			    MII_DATA);
		(*adapter->mii_setbit)(adapter->adapter_softc, MII_CLOCK);
		(*adapter->mii_readbit)(adapter->adapter_softc, MII_CLOCK);
	}
}

int
mii_readreg(v, phy, reg)
	void *v;
	u_int16_t phy;
	u_int16_t reg;
{
	mii_data_t *adapter = ((struct mii_softc *)v)->adapter;
	u_int16_t val = 0;
	int err =0;
	int i;

	if (adapter->mii_readreg) /* adapter has a special way to read PHYs */
		return ((*adapter->mii_readreg)(adapter->adapter_softc,
		    phy, reg));

	/* else read using the control lines */
	mii_sync(adapter);
	mii_sendbit(adapter, MII_START, 2);
	mii_sendbit(adapter, MII_READ, 2);
	mii_sendbit(adapter, phy, 5);
	mii_sendbit(adapter, reg, 5);

	(*adapter->mii_clrbit)(adapter->adapter_softc, MII_TXEN);
	(*adapter->mii_clrbit)(adapter->adapter_softc, MII_CLOCK);
	(*adapter->mii_setbit)(adapter->adapter_softc, MII_CLOCK);
	(*adapter->mii_clrbit)(adapter->adapter_softc, MII_CLOCK);

	err = (*adapter->mii_readbit)(adapter->adapter_softc, MII_DATA);
	(*adapter->mii_setbit)(adapter->adapter_softc, MII_CLOCK);

	for (i = 0; i < 16; i++) {
		val = val << 1;
		(*adapter->mii_clrbit)(adapter->adapter_softc, MII_CLOCK);
		if (err == 0)
			if ((*adapter->mii_readbit)(adapter->adapter_softc,
			    MII_DATA))
				val |= 1;
		(*adapter->mii_setbit)(adapter->adapter_softc, MII_CLOCK);
	}
	(*adapter->mii_clrbit)(adapter->adapter_softc, MII_CLOCK);
	(*adapter->mii_setbit)(adapter->adapter_softc, MII_CLOCK);

	if (err == 0)
		return val;
	else
		return -1;
}

void
mii_writereg(v, phy, reg, data)
	void *v;
	u_int16_t phy;
	u_int16_t reg;
	u_int16_t data;
{
	mii_data_t *adapter = ((struct mii_softc *)v)->adapter;

	if (adapter->mii_writereg) {
		/* Interface has a special way of writing to the PHY. */
		(*adapter->mii_writereg)(adapter, phy, reg, data);
		return;
	}

	/* else write using the control lines */
	mii_sync(adapter);
	mii_sendbit(adapter, MII_START, 2);
	mii_sendbit(adapter, MII_WRITE, 2);
	mii_sendbit(adapter, phy, 5);
	mii_sendbit(adapter, reg, 5);
	mii_sendbit(adapter, MII_ACK, 2);
	mii_sendbit(adapter, data, 16);

	(*adapter->mii_clrbit)(adapter->adapter_softc, MII_CLOCK);
	(*adapter->mii_setbit)(adapter->adapter_softc, MII_CLOCK);
}

void
mii_media_add(ifmedia, adapter)
	struct ifmedia *ifmedia;
	mii_data_t *adapter;
{
	struct mii_softc *sc = adapter->mii_sc;
	int i;
	u_int32_t media = 0;

	for (i = 0; i < 32; i++) {
		if (sc->phy[i])
			media |= sc->phy[i]->phy_media;
	}
	if (media & PHY_BNC)
		ifmedia_add(ifmedia, IFM_ETHER | IFM_10_2, 0, NULL);
	if (media & PHY_AUI)
		ifmedia_add(ifmedia, IFM_ETHER | IFM_10_5, 0, NULL);
	if (media & PHY_10baseT)
		ifmedia_add(ifmedia, IFM_ETHER | IFM_10_T, 0, NULL);
	if (media & PHY_10baseTfd)
		ifmedia_add(ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX, 0, NULL);
	if (media & PHY_100baseTx)
		ifmedia_add(ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL);
	if (media & PHY_100baseTxfd)
		ifmedia_add(ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX, 0, NULL);
	if (media & PHY_100baseT4)
		ifmedia_add(ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL);
	ifmedia_add(ifmedia, IFM_ETHER | IFM_NONE, 0, NULL);
}

int
mii_mediachg(adapter)
	mii_data_t *adapter;
{
	struct mii_softc *sc = adapter->mii_sc;
	int i, best = -1, error = 0;
	int media = adapter->mii_media_active;

	sc->current_phy = NULL;

	for (i = 0; i < 32; i++) {
		if (sc->phy[i] == NULL)
			continue;
		switch (sc->phy[i]->phy_media_set(media,
		    sc->phy[i]->phy_softc)) {
		case -1:	/* PHY not available */
			break;
		case 0:		/* link sucessfully selected */
			sc->current_phy = sc->phy[i];
			break;
		case ENETDOWN:	/* link selected but not up */
			best = i;
			break;
		default:
			break;
		}
	}
	if (sc->current_phy == NULL) {
		/*
		 * We didn't find a valid media. Select the best one (i.e.
		 * last supported but not up). If media != autoselect,
		 * don't report any error code.
		 */
		if (best < 0)
			return (EINVAL);
		sc->current_phy = sc->phy[best];
		error = sc->phy[best]->phy_media_set(media,
		    sc->phy[best]->phy_softc);
		if (media != IFM_AUTO)
			error = 0;
	}
	/* power down all but current phy */
	for (i = 0; i < 32; i++) {
		if (sc->phy[i] != sc->current_phy) {
			if (sc->phy[i] == NULL)
				mii_writereg(sc, i, PHY_CONTROL, CTRL_ISO);
			else
				sc->phy[i]->phy_pdown(sc->phy[i]->phy_softc);
		}
	}
	return (error);
}

void
mii_pollstat(adapter)
	mii_data_t *adapter;
{
	struct mii_softc *sc = adapter->mii_sc;

	adapter->mii_media_status = IFM_AVALID;
	if (sc->current_phy == NULL)
		return;
	if ((*sc->current_phy->phy_status)(adapter->mii_media_active,
	    sc->current_phy->phy_softc) == 0)
		adapter->mii_media_status |= IFM_ACTIVE;
}