#include <sys/param.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <lib/libsa/stand.h>
#include <lib/libsa/net.h>
#define NCR 0x00
#define NCR_FDX (1<<3)
#define NCR_RST (1<<0)
#define NSR 0x01
#define NSR_SPEED (1<<7)
#define NSR_LINKST (1<<6)
#define NSR_TX2END (1<<3)
#define NSR_TX1END (1<<2)
#define NSR_RXOV (1<<1)
#define TCR 0x02
#define TCR_TXREQ 0x01
#define TCR2 0x2d
#define TCR2_ONEPM 0x10
#define RCR 0x05
#define RCR_WTDIS 0x40
#define RCR_DIS_LONG 0x20
#define RCR_DIS_CRC 0x10
#define RCR_ALL 0x08
#define RCR_RUNT 0x04
#define RCR_PRMSC 0x02
#define RCR_RXEN 0x01
#define RSR 0x06
#define RSR_MF (1<<6)
#define FCR 0x0a
#define FCR_FLCE 0x01
#define EPCR 0x0b
#define EP_EPOS (1<<3)
#define EP_ERPRR (1<<2)
#define EP_ERPRW (1<<1)
#define EP_ERRE (1<<0)
#define EPAR 0x0c
#define EPDRL 0x0d
#define EPDRH 0x0e
#define PAR 0x10
#define MAR 0x16
#define GPR 0x1f
#define GPR_PHYPWROFF 0x01
#define VID0 0x28
#define VID1 0x29
#define PID0 0x2a
#define PID1 0x2b
#define CHIPR 0x2c
#define MRCMDX 0xf0
#define MRCMD 0xf2
#define MWCMD 0xf8
#define TXPLL 0xfc
#define TXPLH 0xfd
#define ISR 0xfe
#define ISR_LNKCHG 0x20
#define ISR_UDRUN 0x10
#define ISR_PTM (1<<1)
#define ISR_PRS (1<<0)
#define IMR 0xff
#define IMR_PAR (1<<7)
#define IMR_PRM (1<<0)
#ifndef DM9000MAC
#define DM9000MAC 0x08,0x08,0x11,0x18,0x12,0x27
#endif
struct local {
unsigned int csr;
unsigned int phy, bmsr, anlpar;
uint8_t en[6];
};
static struct local dm9000local;
int dm9k_match(unsigned int, void *);
void *dm9k_init(unsigned int, void *);
int dm9k_send(void *, char *, unsigned int);
int dm9k_recv(void *, char *, unsigned int, unsigned int);
static unsigned mii_read(struct local *, int, int);
static void mii_write(struct local *, int, int, int);
static void mii_dealan(struct local *, unsigned int);
extern void usleep(int);
static inline int
CSR_READ_1(struct local *l, int reg)
{
*(volatile uint8_t *)(l->csr) = reg;
return *(volatile uint8_t*)(l->csr + 4);
}
static inline int
CSR_READ_2(struct local *l, int reg)
{
*(volatile uint8_t *)(l->csr) = reg;
return *(volatile uint16_t *)(l->csr + 4);
}
static inline void
CSR_WRITE_1(struct local *l, int reg, int data)
{
*(volatile uint8_t *)(l->csr) = reg;
*(volatile uint8_t *)(l->csr + 4) = data;
}
static inline void
CSR_WRITE_2(struct local *l, int reg, int data)
{
*(volatile uint8_t *)(l->csr) = reg;
*(volatile uint16_t *)(l->csr + 4) = data;
}
int
dm9k_match(unsigned int tag, void *aux)
{
struct local *l = &dm9000local;
uint8_t *en = aux;
uint8_t std[6] = { DM9000MAC };
int val;
l->csr = 0x20000000;
val = CSR_READ_1(l, PID0);
val |= CSR_READ_1(l, PID1) << 8;
val |= CSR_READ_1(l, VID0) << 16;
val |= CSR_READ_1(l, VID1) << 24;
if (val != 0x0a469000) {
printf("DM9000 not found at 0x%x\n", l->csr);
return 0;
}
if (en != NULL
&& en[0] && en[1] && en[2] && en[3] && en[4] && en[5])
memcpy(l->en, en, 6);
else if (en != NULL) {
memcpy(en, std, 6);
memcpy(l->en, std, 6);
}
return 1;
}
void *
dm9k_init(unsigned int tag, void *aux)
{
struct local *l = &dm9000local;
uint8_t *en = l->en;
unsigned int val, fdx;
val = CSR_READ_1(l, CHIPR);
printf("DM9000 rev. %#x", val);
val = CSR_READ_1(l, ISR);
printf(", %d bit mode\n", (val & 1<<7) ? 8 : 16);
CSR_WRITE_1(l, NCR, 0);
l->phy = 1;
CSR_WRITE_1(l, GPR, GPR_PHYPWROFF);
CSR_WRITE_1(l, IMR, 0);
CSR_WRITE_1(l, TCR, 0);
CSR_WRITE_1(l, RCR, 0);
CSR_WRITE_1(l, NCR, NCR_RST);
do {
usleep(1);
} while (NCR_RST & CSR_READ_1(l, NCR));
CSR_WRITE_1(l, GPR, 0);
CSR_WRITE_1(l, NCR, NCR_RST);
do {
usleep(1);
} while (NCR_RST & CSR_READ_1(l, NCR));
(void) CSR_READ_1(l, NSR);
printf("MAC address %02x:%02x:%02x:%02x:%02x:%02x\n",
en[0], en[1], en[2], en[3], en[4], en[5]);
CSR_WRITE_1(l, PAR + 0, en[0]);
CSR_WRITE_1(l, PAR + 1, en[1]);
CSR_WRITE_1(l, PAR + 2, en[2]);
CSR_WRITE_1(l, PAR + 3, en[3]);
CSR_WRITE_1(l, PAR + 4, en[4]);
CSR_WRITE_1(l, PAR + 5, en[5]);
CSR_WRITE_1(l, MAR + 0, 0);
CSR_WRITE_1(l, MAR + 1, 0);
CSR_WRITE_1(l, MAR + 2, 0);
CSR_WRITE_1(l, MAR + 3, 0);
CSR_WRITE_1(l, MAR + 4, 0);
CSR_WRITE_1(l, MAR + 5, 0);
CSR_WRITE_1(l, MAR + 6, 0);
CSR_WRITE_1(l, MAR + 7, 0);
printf("waiting for linkup ... ");
mii_dealan(l, 5);
val = CSR_READ_1(l, NSR);
if ((val & NSR_LINKST) == 0) {
printf("failed; cable problem?\n");
return NULL;
}
val = mii_read(l, l->phy, 17);
if (val & (03 << 14))
printf("100Mbps");
if (val & (03 << 12))
printf("10Mbps");
fdx = !!(val & (05 << 13));
if (fdx) {
printf("-FDX");
val = CSR_READ_1(l, FCR);
CSR_WRITE_1(l, FCR, val | FCR_FLCE);
}
printf("\n");
CSR_WRITE_1(l, NSR, ~0);
CSR_WRITE_1(l, ISR, ~0);
CSR_WRITE_1(l, TCR2, TCR2_ONEPM);
CSR_WRITE_1(l, RCR, RCR_RXEN | RCR_WTDIS | RCR_DIS_LONG | RCR_DIS_CRC);
CSR_WRITE_1(l, IMR, IMR_PAR);
memcpy(aux, l->en, 6);
return l;
}
int
dm9k_send(void *dev, char *buf, unsigned int len)
{
struct local *l = dev;
unsigned int val, cnt, bound;
if (len > 1520) {
printf("dm9k_send: len > 1520 (%u)\n", len);
len = 1520;
}
CSR_WRITE_1(l, ISR, ISR_PTM);
for (cnt = 0; cnt < len; cnt += 2) {
val = (buf[1] << 8) | buf[0];
CSR_WRITE_2(l, MWCMD, val);
buf += 2;
}
CSR_WRITE_1(l, TXPLL, len);
CSR_WRITE_1(l, TXPLH, len >> 8);
CSR_WRITE_1(l, TCR, TCR_TXREQ);
bound = getsecs() + 1;
do {
val = CSR_READ_1(l, TCR);
if ((val & TCR_TXREQ) == 0)
goto done;
} while (getsecs() < bound);
printf("xmit failed\n");
return -1;
done:
return len;
}
int
dm9k_recv(void *dev, char *buf, unsigned int maxlen, unsigned int timo)
{
struct local *l = dev;
unsigned int bound, val, mark, stat, len, upto, cnt;
char *ptr;
bound = getsecs() + timo;
again:
do {
val = CSR_READ_1(l, ISR);
if (val & ISR_PRS)
goto gotone;
} while (getsecs() < bound);
printf("receive timeout (%d seconds wait)\n", timo);
errno = 0;
return -1;
gotone:
CSR_WRITE_1(l, ISR, ISR_PRS);
(void) CSR_READ_2(l, MRCMDX);
mark = CSR_READ_2(l, MRCMDX);
if ((mark & 03) != 01) {
stat = CSR_READ_1(l, RSR);
printf("dm9k_recv: mark %x, RSR %x\n", mark, stat);
goto again;
}
stat = CSR_READ_2(l, MRCMD);
len = CSR_READ_2(l, MRCMD);
if (stat & (RSR_MF<<8)) {
for (cnt = 0; cnt < len; cnt += 2)
(void) CSR_READ_2(l, MRCMD);
printf("bcast/mcast frame, len = %d\n", len);
goto again;
}
upto = len - 4;
if (upto > maxlen)
upto = maxlen;
ptr = buf;
for (cnt = 0; cnt < upto; cnt += 2) {
val = CSR_READ_2(l, MRCMD);
ptr[0] = val;
ptr[1] = val >> 8;
ptr += 2;
}
for (; cnt < len; cnt += 2)
(void) CSR_READ_2(l, MRCMD);
return upto;
}
static unsigned int
mii_read(struct local *l, int phy, int reg)
{
int v;
CSR_WRITE_1(l, EPAR, phy << 6 | reg);
CSR_WRITE_1(l, EPCR, EP_EPOS | EP_ERPRR);
do {
v = CSR_READ_1(l, EPCR);
} while (v & EP_ERRE);
CSR_WRITE_1(l, EPCR, 0);
v = (CSR_READ_1(l, EPDRH) << 8) | CSR_READ_1(l, EPDRL);
return v;
}
static void
mii_write(struct local *l, int phy, int reg, int data)
{
int v;
CSR_WRITE_1(l, EPAR, phy << 6 | reg);
CSR_WRITE_1(l, EPDRL, data);
CSR_WRITE_1(l, EPDRH, data >> 8);
CSR_WRITE_1(l, EPCR, EP_EPOS | EP_ERPRW);
do {
v = CSR_READ_1(l, EPCR);
} while (v & EP_ERRE);
CSR_WRITE_1(l, EPCR, 0);
}
#define MII_BMCR 0x00
#define BMCR_RESET 0x8000
#define BMCR_AUTOEN 0x1000
#define BMCR_ISO 0x0400
#define BMCR_STARTNEG 0x0200
#define MII_BMSR 0x01
#define BMSR_ACOMP 0x0020
#define BMSR_LINK 0x0004
#define MII_ANAR 0x04
#define ANAR_FC 0x0400
#define ANAR_TX_FD 0x0100
#define ANAR_TX 0x0080
#define ANAR_10_FD 0x0040
#define ANAR_10 0x0020
#define ANAR_CSMA 0x0001
#define MII_ANLPAR 0x05
static void
mii_dealan(struct local *l, unsigned int timo)
{
unsigned int bound;
mii_write(l, l->phy, MII_ANAR, ANAR_TX_FD | ANAR_TX | ANAR_10_FD |
ANAR_10 | ANAR_CSMA | ANAR_FC);
mii_write(l, l->phy, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
l->anlpar = 0;
bound = getsecs() + timo;
do {
l->bmsr = mii_read(l, l->phy, MII_BMSR) |
mii_read(l, l->phy, MII_BMSR);
if ((l->bmsr & BMSR_LINK) && (l->bmsr & BMSR_ACOMP)) {
l->anlpar = mii_read(l, l->phy, MII_ANLPAR);
break;
}
usleep(10 * 1000);
} while (getsecs() < bound);
return;
}