#include <sys/param.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <lib/libsa/stand.h>
#include <lib/libsa/net.h>
#include "globals.h"
#define CSR_WRITE_1(l, r, v) out8((l)->csr+(r), (v))
#define CSR_READ_1(l, r) in8((l)->csr+(r))
#define CSR_WRITE_2(l, r, v) out16rb((l)->csr+(r), (v))
#define CSR_READ_2(l, r) in16rb((l)->csr+(r))
#define CSR_WRITE_4(l, r, v) out32rb((l)->csr+(r), (v))
#define CSR_READ_4(l, r) in32rb((l)->csr+(r))
#define VTOPHYS(va) (uint32_t)(va)
#define DEVTOV(pa) (uint32_t)(pa)
#define wbinv(adr, siz) _wbinv(VTOPHYS(adr), (uint32_t)(siz))
#define inv(adr, siz) _inv(VTOPHYS(adr), (uint32_t)(siz))
#define DELAY(n) delay(n)
#define ALLOC(T,A) (T *)allocaligned(sizeof(T),(A))
struct desc {
uint32_t xd0, xd1, xd2, xd3;
};
#define T0_OWN 0x80000000
#define T0_EOR 0x40000000
#define T0_FS 0x20000000
#define T0_LS 0x10000000
#define T0_FRMASK 0x0000ffff
#define R0_OWN 0x80000000
#define R0_EOR 0x40000000
#define R0_BUFLEN 0x00003ff8
#define R0_FS 0x20000000
#define R0_LS 0x10000000
#define R0_RES 0x00200000
#define R0_RUNT 0x00100000
#define R0_CRC 0x00080000
#define R0_FRMASK 0x00003fff
#define RGE_IDR0 0x00
#define RGE_IDR1 0x01
#define RGE_IDR2 0x02
#define RGE_IDR3 0x03
#define RGE_IDR4 0x04
#define RGE_IDR5 0x05
#define RGE_TNPDS 0x20
#define RGE_THPDS 0x28
#define RGE_CR 0x37
#define CR_RESET (1U << 4)
#define CR_RXEN (1U << 3)
#define CR_TXEN (1U << 2)
#define RGE_TPPOLL 0x38
#define RGE_IMR 0x3c
#define RGE_ISR 0x3e
#define RGE_TCR 0x40
#define TCR_MAXDMA 0x0700
#define RGE_RCR 0x44
#define RCR_RXTFH 0xe000
#define RCR_MAXDMA 0x0700
#define RCR_AE (1U << 5)
#define RCR_RE (1U << 4)
#define RCR_AB (1U << 3)
#define RCR_AM (1U << 2)
#define RCR_APM (1U << 1)
#define RCR_AAP (1U << 0)
#define RGE_EECMD 0x50
#define EECMD_LOCK 0x00
#define EECMD_UNLOCK 0xc0
#define RGE_PHYAR 0x60
#define RGE_PHYSR 0x6c
#define RGE_RMS 0xda
#define RGE_RDSAR 0xe4
#define RGE_ETTHR 0xec
#define FRAMESIZE 1536
struct local {
struct desc txd[2];
uint8_t _hole0[256 - 2 * sizeof(struct desc)];
struct desc rxd[2];
uint8_t _hole1[256 - 2 * sizeof(struct desc)];
uint8_t rxstore[2][FRAMESIZE];
unsigned csr, tx, rx;
unsigned phy, bmsr, anlpar;
unsigned tcr, rcr;
};
static int mii_read(struct local *, int, int);
static void mii_write(struct local *, int, int, int);
static void mii_initphy(struct local *);
static void mii_dealan(struct local *, unsigned);
int
rge_match(unsigned tag, void *data)
{
unsigned v;
v = pcicfgread(tag, PCI_ID_REG);
switch (v) {
case PCI_DEVICE(0x10ec, 0x8167):
case PCI_DEVICE(0x10ec, 0x8169):
return 1;
}
return 0;
}
void *
rge_init(unsigned tag, void *data)
{
unsigned val;
struct local *l;
struct desc *txd, *rxd;
uint32_t reg;
uint8_t *en;
l = ALLOC(struct local, 256);
memset(l, 0, sizeof(struct local));
l->csr = DEVTOV(pcicfgread(tag, 0x14));
CSR_WRITE_1(l, RGE_CR, CR_RESET);
do {
val = CSR_READ_1(l, RGE_CR);
} while (val & CR_RESET);
mii_initphy(l);
en = data;
if (brdtype == BRD_QNAPTS) {
read_mac_from_flash(en);
CSR_WRITE_1(l, RGE_EECMD, EECMD_UNLOCK);
reg = en[0] | (en[1] << 8) | (en[2] << 16) | (en[3] << 24);
CSR_WRITE_4(l, RGE_IDR0, reg);
reg = en[4] | (en[5] << 8);
CSR_WRITE_4(l, RGE_IDR4, reg);
CSR_WRITE_1(l, RGE_EECMD, EECMD_LOCK);
} else {
en[0] = CSR_READ_1(l, RGE_IDR0);
en[1] = CSR_READ_1(l, RGE_IDR1);
en[2] = CSR_READ_1(l, RGE_IDR2);
en[3] = CSR_READ_1(l, RGE_IDR3);
en[4] = CSR_READ_1(l, RGE_IDR4);
en[5] = CSR_READ_1(l, RGE_IDR5);
}
printf("MAC address %02x:%02x:%02x:%02x:%02x:%02x\n",
en[0], en[1], en[2], en[3], en[4], en[5]);
DPRINTF(("PHY %d (%04x.%04x)\n", l->phy,
mii_read(l, l->phy, 2), mii_read(l, l->phy, 3)));
mii_dealan(l, 5);
val = CSR_READ_1(l, RGE_PHYSR);
if (val & (1U << 4))
printf("1000Mbps");
if (val & (1U << 3))
printf("100Mbps");
if (val & (1U << 2))
printf("10Mbps");
if (val & (1U << 0))
printf("-FDX");
printf("\n");
txd = &l->txd[0];
txd[1].xd0 = htole32(T0_EOR);
rxd = &l->rxd[0];
rxd[0].xd0 = htole32(R0_OWN | FRAMESIZE);
rxd[0].xd2 = htole32(VTOPHYS(l->rxstore[0]));
rxd[1].xd0 = htole32(R0_OWN | R0_EOR | FRAMESIZE);
rxd[1].xd2 = htole32(VTOPHYS(l->rxstore[1]));
wbinv(l, sizeof(struct local));
l->tx = l->rx = 0;
l->tcr = (03 << 24) | (07 << 8);
l->rcr = (07 << 13) | (07 << 8) | RCR_APM;
CSR_WRITE_1(l, RGE_CR, CR_TXEN | CR_RXEN);
CSR_WRITE_1(l, RGE_ETTHR, 0x3f);
CSR_WRITE_2(l, RGE_RMS, FRAMESIZE);
CSR_WRITE_4(l, RGE_TCR, l->tcr);
CSR_WRITE_4(l, RGE_RCR, l->rcr);
CSR_WRITE_4(l, RGE_TNPDS, VTOPHYS(txd));
CSR_WRITE_4(l, RGE_RDSAR, VTOPHYS(rxd));
CSR_WRITE_4(l, RGE_TNPDS + 4, 0);
CSR_WRITE_4(l, RGE_RDSAR + 4, 0);
CSR_WRITE_2(l, RGE_ISR, ~0);
CSR_WRITE_2(l, RGE_IMR, 0);
return l;
}
int
rge_send(void *dev, char *buf, unsigned len)
{
struct local *l = dev;
volatile struct desc *txd;
unsigned loop, ret;
char tmp[60];
ret = len;
if (len < 60) {
memcpy(tmp, buf, len);
buf = tmp;
memset(buf + len, 0, 60 - len);
len = 60;
}
wbinv(buf, len);
txd = &l->txd[l->tx];
txd->xd2 = htole32(VTOPHYS(buf));
txd->xd0 &= htole32(T0_EOR);
txd->xd0 |= htole32(T0_OWN | T0_FS | T0_LS | (len & T0_FRMASK));
wbinv(txd, sizeof(struct desc));
CSR_WRITE_1(l, RGE_TPPOLL, 0x40);
loop = 100;
do {
if ((le32toh(txd->xd0) & T0_OWN) == 0)
goto done;
DELAY(10);
inv(txd, sizeof(struct desc));
} while (--loop > 0);
printf("xmit failed\n");
return -1;
done:
l->tx ^= 1;
return ret;
}
int
rge_recv(void *dev, char *buf, unsigned maxlen, unsigned timo)
{
struct local *l = dev;
volatile struct desc *rxd;
unsigned bound, rxstat, len;
uint8_t *ptr;
bound = 1000 * timo;
#if 0
printf("recving with %u sec. timeout\n", timo);
#endif
again:
rxd = &l->rxd[l->rx];
do {
inv(rxd, sizeof(struct desc));
rxstat = le32toh(rxd->xd0);
if ((rxstat & R0_OWN) == 0)
goto gotone;
DELAY(1000);
} while (--bound > 0);
errno = 0;
return -1;
gotone:
if (rxstat & R0_RES) {
rxd->xd0 &= htole32(R0_EOR);
rxd->xd0 |= htole32(R0_OWN | FRAMESIZE);
wbinv(rxd, sizeof(struct desc));
l->rx ^= 1;
goto again;
}
len = rxstat & R0_FRMASK;
if (len > maxlen)
len = maxlen;
ptr = l->rxstore[l->rx];
inv(ptr, len);
memcpy(buf, ptr, len);
rxd->xd0 &= htole32(R0_EOR);
rxd->xd0 |= htole32(R0_OWN | FRAMESIZE);
wbinv(rxd, sizeof(struct desc));
l->rx ^= 1;
return len;
}
static int
mii_read(struct local *l, int phy, int reg)
{
unsigned v;
v = reg << 16;
CSR_WRITE_4(l, RGE_PHYAR, v);
DELAY(1000);
do {
DELAY(100);
v = CSR_READ_4(l, RGE_PHYAR);
} while ((v & (1U << 31)) == 0);
return v & 0xffff;
}
static void
mii_write(struct local *l, int phy, int reg, int data)
{
unsigned v;
v = (reg << 16) | (data & 0xffff) | (1U << 31);
CSR_WRITE_4(l, RGE_PHYAR, v);
DELAY(1000);
do {
DELAY(100);
v = CSR_READ_4(l, RGE_PHYAR);
} while (v & (1U << 31));
}
#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
#define MII_GTCR 0x09
#define GANA_1000TFDX 0x0200
#define GANA_1000THDX 0x0100
#define MII_GTSR 0x0a
#define GLPA_1000TFDX 0x0800
#define GLPA_1000THDX 0x0400
#define GLPA_ASM_DIR 0x0200
static void
mii_initphy(struct local *l)
{
int bound, ctl, phy, sts;
phy = 7;
ctl = mii_read(l, phy, MII_BMCR);
mii_write(l, phy, MII_BMCR, ctl | BMCR_RESET);
bound = 100;
do {
DELAY(10);
ctl = mii_read(l, phy, MII_BMCR);
if (ctl == 0xffff) {
printf("MII: PHY %d has died after reset\n", phy);
return;
}
} while (bound-- > 0 && (ctl & BMCR_RESET));
if (bound == 0) {
printf("PHY %d reset failed\n", phy);
}
ctl &= ~BMCR_ISO;
mii_write(l, phy, MII_BMCR, ctl);
sts = mii_read(l, phy, MII_BMSR) |
mii_read(l, phy, MII_BMSR);
l->phy = phy;
l->bmsr = sts;
}
void
mii_dealan(struct local *l, unsigned timo)
{
unsigned anar, gtcr, bound;
anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10 | ANAR_CSMA;
anar |= ANAR_FC;
gtcr = GANA_1000TFDX | GANA_1000THDX;
mii_write(l, l->phy, MII_ANAR, anar);
mii_write(l, l->phy, MII_GTCR, gtcr);
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;
}
DELAY(10 * 1000);
} while (getsecs() < bound);
return;
}