shithub: riscv

ref: 8be7f27b758ef9ef818f68db0d8bcb7b038eae0e
dir: /sys/src/cmd/nusb/ether/asix.c/

View raw version
/*
 * Asix USB ether adapters
 * I got no documentation for it, thus the bits
 * come from other systems; it's likely this is
 * doing more than needed in some places and
 * less than required in others.
 */
#include <u.h>
#include <libc.h>
#include <thread.h>

#include "usb.h"
#include "dat.h"

/*
 * Asix common
 */
enum
{
	Mgm		= 0x0001,		/* media */
	Mfd		= 0x0002,
	Mac		= 0x0004,
	Mmhz		= 0x0008,
	Mrfc		= 0x0010,
	Mtfc		= 0x0020,
	Mjfe		= 0x0040,
	Mre		= 0x0100,
	Mps		= 0x0200,
	Munk		= 0x8000,
	Mall772		= Mfd|Mrfc|Mtfc|Mps|Mac|Mre,
	Mall178		= Mps|Mfd|Mac|Mrfc|Mtfc|Mjfe|Mre,
	Mall179		= Mgm|Mfd|Mmhz|Mrfc|Mtfc|Mjfe|Munk|Mre,

	Rxctldce	= 0x0100,		/* drop crcerr */
	Rxctlso		= 0x80,			/* start operation */
	Rxctlam		= 0x10,
	Rxctlab		= 0x08,
	Rxctlsep	= 0x04,
	Rxctlamall	= 0x02,			/* all multicast */
	Rxctlprom	= 0x01,			/* promiscuous */
	Rxall179	= Rxctldce|Rxctlso|Rxctlab|Rxctlamall,

	/* MII */
	Miibmcr			= 0x00,		/* basic mode ctrl reg. */
		Bmcrreset	= 0x8000,	/* reset */
		Bmcranena	= 0x1000,	/* auto neg. enable */
		Bmcrar		= 0x0200,	/* announce restart */

	Miibmsr			= 0x01,
		Bmsrlink	= 0x0004,

	Miiad			= 0x04,		/* advertise reg. */
		Adcsma		= 0x0001,
		Ad1000f		= 0x0200,
		Ad1000h		= 0x0100,
		Ad10h		= 0x0020,
		Ad10f		= 0x0040,
		Ad100h		= 0x0080,
		Ad100f		= 0x0100,
		Adpause		= 0x0400,
		Adall		= Ad10h|Ad10f|Ad100h|Ad100f,

	Miimctl			= 0x14,		/* marvell ctl */
		Mtxdly		= 0x02,
		Mrxdly		= 0x80,
		Mtxrxdly	= 0x82,

	Miic1000			= 0x09,
};

/*
 *	a88178 & a88772
 */
enum
{
	/* Asix commands */
	Cswmii		= 0x06,		/* set sw mii */
	Crmii		= 0x07,		/* read mii reg */
	Cwmii		= 0x08,		/* write mii reg */
	Chwmii		= 0x0a,		/* set hw mii */
	Creeprom	= 0x0b,		/* read eeprom */
	Cwdis		= 0x0e,		/* write disable */
	Cwena		= 0x0d,		/* write enable */
	Crrxctl		= 0x0f,		/* read rx ctl */
	Cwrxctl		= 0x10,		/* write rx ctl */
	Cwipg		= 0x12,		/* write ipg */
	Crmac		= 0x13,		/* read mac addr */
	Crphy		= 0x19,		/* read phy id */
	Cwmedium	= 0x1b,		/* write medium mode */
	Crgpio		= 0x1e,		/* read gpio */
	Cwgpio		= 0x1f,		/* write gpios */
	Creset		= 0x20,		/* reset */
	Cwphy		= 0x22,		/* select phy */

	/* reset codes */
	Rclear		= 0x00,
	Rprte		= 0x04,
	Rprl		= 0x08,
	Riprl		= 0x20,
	Rippd		= 0x40,

	Ipgdflt		= 0x15|0x0c|0x12,	/* default ipg0, 1, 2 */

	Gpiogpo1en	= 0x04,		/* gpio1 enable */,
	Gpiogpo1		= 0x08,		/* gpio1 value */
	Gpiogpo2en	= 0x10,		/* gpio2 enable */
	Gpiogpo2		= 0x20,		/* gpio2 value */
	Gpiorse		= 0x80,		/* gpio reload serial eeprom */

	Pmask		= 0x1F,
	Pembed		= 0x10,			/* embedded phy */	
};

static uint asixphy;

static int
asixset(Dev *d, int c, int v)
{
	int r;
	int ec;

	r = Rh2d|Rvendor|Rdev;
	ec = usbcmd(d, r, c, v, 0, nil, 0);
	if(ec < 0)
		fprint(2, "%s: asixset %x %x: %r\n", argv0, c, v);
	return ec;
}

static int
asixget(Dev *d, int c, uchar *buf, int l)
{
	int r;
	int ec;

	r = Rd2h|Rvendor|Rdev;
	ec = usbcmd(d, r, c, 0, 0, buf, l);
	if(ec < 0)
		fprint(2, "%s: asixget %x: %r\n", argv0, c);
	return ec;
}

static int
getgpio(Dev *d)
{
	uchar c;

	if(asixget(d, Crgpio, &c, 1) < 0)
		return -1;
	return c;
}

static int
getphy(Dev *d)
{
	uchar buf[2];

	if(asixget(d, Crphy, buf, sizeof(buf)) < 0)
		return -1;
	return buf[1];
}

static int
getrxctl(Dev *d)
{
	uchar buf[2];

	memset(buf, 0, sizeof(buf));
	if(asixget(d, Crrxctl, buf, sizeof(buf)) < 0)
		return -1;
	return GET2(buf);
}

static int
miiread(Dev *d, int phy, int reg)
{
	int r;
	uchar v[2];

	r = Rd2h|Rvendor|Rdev;
	if(usbcmd(d, r, Crmii, phy, reg, v, 2) < 0){
		fprint(2, "%s: miiread: %r\n", argv0);
		return -1;
	}
	r = GET2(v);
	if(r == 0xFFFF)
		return -1;
	return r;
}

static int
miiwrite(Dev *d, int phy, int reg, int val)
{
	int r;
	uchar v[2];

	if(asixset(d, Cswmii, 0) < 0)
		return -1;
	r = Rh2d|Rvendor|Rdev;
	PUT2(v, val);
	if(usbcmd(d, r, Cwmii, phy, reg, v, 2) < 0){
		fprint(2, "%s: miiwrite: %#x %#x %r\n", argv0, reg, val);
		return -1;
	}
	if(asixset(d, Chwmii, 0) < 0)
		return -1;
	return 0;
}

static int
eepromread(Dev *d, int i)
{
	int r;
	int ec;
	uchar buf[2];

	r = Rd2h|Rvendor|Rdev;
	ec = usbcmd(d, r, Creeprom, i, 0, buf, sizeof(buf));
	if(ec < 0)
		fprint(2, "%s: eepromread %d: %r\n", argv0, i);
	ec = GET2(buf);
	if(ec == 0xFFFF)
		ec = -1;
	return ec;
}

static int
asixreceive(Dev *ep)
{
	Block *b;
	uint hd;
	int n;

	b = allocb(Maxpkt+4);
	if((n = read(ep->dfd, b->wp, b->lim - b->base)) < 0){
		freeb(b);
		return -1;
	}
	b->wp += n;
	while(BLEN(b) >= 4){
		hd = GET4(b->rp);
		b->rp += 4;
		n = hd & 0xFFFF;
		hd = (hd>>16) ^ 0xFFFF;
		if((n != hd) || (n > BLEN(b)))
			break;
		if(n == BLEN(b)){
			etheriq(b);
			return 0;
		}
		etheriq(copyblock(b, n));
		b->rp += n;
	}
	freeb(b);
	return 0;
}

static void
asixtransmit(Dev *ep, Block *b)
{
	uint hd;
	int n;

	n = BLEN(b);
	hd = n | (n<<16)^0xFFFF0000;
	b->rp -= 4;
	PUT4(b->rp, hd);
	n += 4;
	if((n % ep->maxpkt) == 0){
		PUT4(b->wp, 0xFFFF0000);
		b->wp += 4;
	}
	write(ep->dfd, b->rp, BLEN(b));
	freeb(b);
}

static int
asixpromiscuous(Dev *d, int on)
{
	int rxctl;

	rxctl = getrxctl(d);
	if(on)
		rxctl |= Rxctlprom;
	else
		rxctl &= ~Rxctlprom;
	return asixset(d, Cwrxctl, rxctl);
}

static int
asixmulticast(Dev *d, uchar*, int)
{
	int rxctl;

	rxctl = getrxctl(d);
	if(nmulti != 0)
		rxctl |= Rxctlamall;
	else
		rxctl &= ~Rxctlamall;
	return asixset(d, Cwrxctl, rxctl);
}

int
a88178init(Dev *d)
{
	int bmcr;
	int gpio;
	int ee17;

	gpio = getgpio(d);
	if(gpio < 0)
		return -1;
	asixset(d, Cwena, 0);
	ee17 = eepromread(d, 0x0017);
	asixset(d, Cwdis, 0);
	asixset(d, Cwgpio, Gpiorse|Gpiogpo1|Gpiogpo1en);
	if((ee17 >> 8) != 1){
		asixset(d, Cwgpio, 0x003c);
		asixset(d, Cwgpio, 0x001c);
		asixset(d, Cwgpio, 0x003c);
	}else{
		asixset(d, Cwgpio, Gpiogpo1en);
		asixset(d, Cwgpio, Gpiogpo1|Gpiogpo1en);
	}
	asixset(d, Creset, Rclear);
	sleep(150);
	asixset(d, Creset, Rippd|Rprl);
	sleep(150);
	asixset(d, Cwrxctl, 0);
	if(asixget(d, Crmac, macaddr, Eaddrlen) < 0)
		return -1;
	asixphy = getphy(d);
	if(ee17 < 0 || (ee17 & 0x7) == 0){
		miiwrite(d, asixphy, Miimctl, Mtxrxdly);
		sleep(60);
	}
	miiwrite(d, asixphy, Miibmcr, Bmcrreset|Bmcranena);
	miiwrite(d, asixphy, Miiad, Adall|Adcsma|Adpause);
	miiwrite(d, asixphy, Miic1000, Ad1000f);
	bmcr = miiread(d, asixphy, Miibmcr);
	if((bmcr & Bmcranena) != 0){
		bmcr |= Bmcrar;
		miiwrite(d, asixphy, Miibmcr, bmcr);
	}
	asixset(d, Cwmedium, Mall178);
	asixset(d, Cwrxctl, Rxctlso|Rxctlab);

	epreceive = asixreceive;
	eptransmit = asixtransmit;
	eppromiscuous = asixpromiscuous;
	epmulticast = asixmulticast;

	return 0;
}

int
a88772init(Dev *d)
{
	int bmcr;
	int rc;

	if(asixset(d, Cwgpio, Gpiorse|Gpiogpo2|Gpiogpo2en) < 0)
		return -1;
	asixphy = getphy(d);
	if((asixphy & Pmask) == Pembed){
		/* embedded 10/100 ethernet */
		rc = asixset(d, Cwphy, 1);
	}else
		rc = asixset(d, Cwphy, 0);
	if(rc < 0)
		return -1;
	if(asixset(d, Creset, Rippd|Rprl) < 0)
		return -1;
	sleep(150);
	if((asixphy & Pmask) == Pembed)
		rc = asixset(d, Creset, Riprl);
	else
		rc = asixset(d, Creset, Rprte);
	if(rc < 0)
		return -1;
	sleep(150);
	getrxctl(d);
	if(asixset(d, Cwrxctl, 0) < 0)
		return -1;
	if(asixget(d, Crmac, macaddr, Eaddrlen) < 0)
		return -1;
	if(asixset(d, Creset, Rprl) < 0)
		return -1;
	sleep(150);
	if(asixset(d, Creset, Riprl|Rprl) < 0)
		return -1;
	sleep(150);

	miiwrite(d, asixphy, Miibmcr, Bmcrreset);
	miiwrite(d, asixphy, Miiad, Adall|Adcsma);
	bmcr = miiread(d, asixphy, Miibmcr);
	if((bmcr & Bmcranena) != 0){
		bmcr |= Bmcrar;
		miiwrite(d, asixphy, Miibmcr, bmcr);
	}
	if(asixset(d, Cwmedium, Mall772) < 0)
		return -1;
	if(asixset(d, Cwipg, Ipgdflt) < 0)
		return -1;
	if(asixset(d, Cwrxctl, Rxctlso|Rxctlab) < 0)
		return -1;

	epreceive = asixreceive;
	eptransmit = asixtransmit;
	eppromiscuous = asixpromiscuous;
	epmulticast = asixmulticast;

	return 0;
}

/*
 *	a88179 & a88178a
 */
enum
{
	/* Access */
	Amac			= 0x01,
		Nid		= 0x10,

	Aphy			= 0x02,
		Physts		= 0x02,
		Phyid		= 0x03,
		Phyfd		= 0x11,

	/* Control */
	Crxctl			= 0x0b,
	Cmed			= 0x22,		/* medium status register */
	Cmmsr			= 0x24,		/* control monitor */	
		Mrwmp		= 0x04,
		Mpmepol		= 0x20,
		Mpmetyp		= 0x40,

	Cphy			= 0x26,		/* control phy */
		Cphybz		= 0x0010,
		Cphyiprl	= 0x0020,

	Cblkinq			= 0x2e,
	Csclk			= 0x33,		/* select clock */
		Sclkbcs		= 0x01,
		Sclkacs		= 0x02,

	Cpwtrl			= 0x54,
	Cpwtrh			= 0x55,
	Capo			= 0x91,		/* auto-power off phy */

	/* USB/Link conn. */
	Usbfs		= 0x01,
	Usbhs		= 0x02,
	Usbss 		= 0x04,
	Link10		= 0x10,
	Link100		= 0x20,
	Link1000	= 0x40,

	Linkfd		= 0x2000,
};

static int
a179set(Dev *d, int c, int v, int i, uchar *b, int l)
{
	int r, ec;

	r = Rh2d|Rvendor|Rdev;
	ec = usbcmd(d, r, c, v, i, b, l);
	if(ec < 0)
		fprint(2, "%s: a179set %x %x: %r\n", argv0, c, v);
	return ec;
}

static int
a179set1(Dev *d, int v, uchar b)
{
	return a179set(d, Amac, v, 1, &b, 1);
}

static int
a179set2(Dev *d, int v, ushort b)
{
	uchar buf[2];

	memcpy(buf, &b, 2);
	return a179set(d, Amac, v, 2, buf, 2);
}

static int
a179get(Dev *d, int c, int v, int i, uchar *buf, int l)
{
	int r, ec;

	r = Rd2h|Rvendor|Rdev;
	ec = usbcmd(d, r, c, v, i, buf, l);
	if(ec < 0)
		fprint(2, "%s: a179get %x %x: %r\n", argv0, c, v);
	return ec;
}

static int
a179miiread(Dev *d, int reg)
{
	int r;
	uchar v[2];

	r = Rd2h|Rvendor|Rdev;
	if(usbcmd(d, r, Aphy, Phyid, reg, v, 2) < 0){
		fprint(2, "%s: a179miiread: %r\n", argv0);
		return -1;
	}
	r = GET2(v);
	if(r == 0xFFFF)
		return -1;
	return r;
}


static int
a179miiwrite(Dev *d, int reg, uint val)
{
	int r;
	uchar v[2];

	PUT2(v, val);
	r = Rh2d|Rvendor|Rdev;
	if(usbcmd(d, r, Aphy, Phyid, reg, v, 2) < 0){
		fprint(2, "%s: a179miiwrite: %#x %#x %r\n", argv0, reg, val);
		return -1;
	}
	return 0;
}

static int a179bufsz;

static int
a179receive(Dev *ep)
{
	Block *b;
	uchar *hdr;
	uint pktlen, npkt;
	int n;

	b = allocb(a179bufsz);
	if((n = read(ep->dfd, b->wp, b->lim - b->base)) < 0){
		freeb(b);
		return -1;
	}
	b->wp += n;
	npkt = GET2(b->wp-4);
	hdr = b->base + GET2(b->wp-2);
	b->wp -= 4;
	while(npkt-- > 0){
		pktlen = GET2(hdr+2) & 0x1FFF;
		if(pktlen < ETHERHDRSIZE || pktlen > BLEN(b))
			break;
		etheriq(copyblock(b, pktlen-4));
		b->rp += (pktlen+7) & 0xFFF8;
		hdr += 4;
	}
	freeb(b);
	return 0;
}

static void
a179transmit(Dev *ep, Block *b)
{
	uint hd[2];

	hd[0] = BLEN(b);
	hd[1] = 0;
	b->rp -= 8;
	if((BLEN(b) % ep->maxpkt) == 0)
		hd[1] |= 0x80008000;
	PUT4(b->rp, hd[0]);
	PUT4(b->rp+4, hd[1]);
	write(ep->dfd, b->rp, BLEN(b));
	freeb(b);
}

static int
a179getrxctl(Dev *d)
{
	uchar buf[2];

	memset(buf, 0, sizeof(buf));
	if(a179get(d, Amac, Crxctl, 2, buf, 2) < 0)
		return -1;
	return GET2(buf);
}

static int
a179linkup(Dev *d)
{
	int timeout;
	ushort link;

	timeout = 5000;
	do{
		link = a179miiread(d, Miibmsr);
		if(link & Bmsrlink)
			return 0;
		sleep(50);
	}while(timeout -= 50);

	fprint(2, "%s: a179linkup: no link\n", argv0);
	return -1;
}

static int
a179promiscuous(Dev *d, int on)
{
	ushort rxctl;

	rxctl = a179getrxctl(d);
	if(on)
		rxctl |= Rxctlprom;
	else
		rxctl &= ~Rxctlprom;
	return a179set2(d, Crxctl, rxctl);
}

static int
a179multicast(Dev *d, uchar*, int)
{
	int rxctl;

	rxctl = a179getrxctl(d);
	if(nmulti != 0)
		rxctl |= Rxctlamall;
	else
		rxctl &= ~Rxctlamall;
	return a179set2(d, Crxctl, rxctl);
}

static int
a179linkspeed(Dev *d)
{
	uchar link;

	a179get(d, Amac, Physts, 1, &link, 1);
	if(link & Link1000)
		return 1000;
	if(link & Link100)
		return 100;
	if(link & Link10)
		return 10;
	return 0;
}

int
a88179init(Dev *d)
{
	uchar qctrl[4][5] = {
		{0x07, 0x4f, 0x00, 0x02, 0xff},
		{0x07, 0x20, 0x03, 0x03, 0xff},
		{0x07, 0xae, 0x07, 0x04, 0xff},
		{0x07, 0xcc, 0x4c, 0x04, 0x08}
	};
	ushort mode, fd;
	uchar link;
	int spd;

	a179set2(d, Cphy, 0);
	a179set2(d, Cphy, Cphyiprl);
	sleep(200);
	a179set1(d, Csclk, Sclkacs|Sclkbcs);
	sleep(100);
	a179set1(d, Cpwtrl, 0x34);
	a179set1(d, Cpwtrh, 0x52);
	if(setmac){
		if(a179set(d, Amac, Nid, Eaddrlen, macaddr, Eaddrlen) < 0)
			return -1;
	}else if(a179get(d, Amac, Nid, Eaddrlen, macaddr, Eaddrlen) < 0)
		return -1;
	if(a179set2(d, Crxctl, Rxall179) < 0)
		return -1;
	if(a179set1(d, Cmmsr, Mpmetyp|Mpmepol|Mrwmp) < 0)
		return -1;
	if(a179set(d, Capo, 0, 0, nil, 0) < 0)
		return -1;

	if(a179linkup(d) < 0)
		return -1;

	spd = 3;	/* default bulkinq */
	mode = Mtfc | Mrfc | Mre;
	a179get(d, Amac, Physts, 1, &link, 1);
	if(link & Link1000){
		mode |= Mgm|Mmhz|Mjfe|Munk;
		if(link & Usbss)
			spd = 0;
		else if(link & Usbhs)
			spd = 1;
	}else if(link & Link100){
		mode |= Mps;
		if(link & (Usbss|Usbhs))
			spd = 2;
	} /* Link10 */
	a179set(d, Amac, Cblkinq, 5, qctrl[spd], 5);
	a179bufsz = 1024*(qctrl[spd][3]+2);
	fd = a179miiread(d, Phyfd);
	if(fd & Linkfd)
		mode |= Mfd;

	if(a179set2(d, Cmed, mode) < 0)
		return -1;

	epreceive = a179receive;
	eptransmit = a179transmit;
	eppromiscuous = a179promiscuous;
	epmulticast = a179multicast;
	eplinkspeed = a179linkspeed;

	return 0;
}