#include <sys/param.h>
#include <sys/systm.h>
#include <sys/sockio.h>
#include <sys/mbuf.h>
#include <sys/malloc.h>
#include <sys/kernel.h>
#include <sys/interrupt.h>
#include <sys/socket.h>
#include <sys/serialize.h>
#include <net/if.h>
#include <net/ifq_var.h>
#include <net/if_arp.h>
#include <net/ethernet.h>
#include <net/if_dl.h>
#include <net/if_media.h>
#include <net/bpf.h>
#include <vm/vm.h>
#include <vm/pmap.h>
#include <sys/bus.h>
#include <sys/rman.h>
#include <dev/netif/mii_layer/mii.h>
#include <dev/netif/mii_layer/miivar.h>
#include "pcidevs.h"
#include <bus/pci/pcireg.h>
#include <bus/pci/pcivar.h>
#define LGE_USEIOSPACE
#include "if_lgereg.h"
#include "miibus_if.h"
static struct lge_type lge_devs[] = {
{ PCI_VENDOR_LEVELONE, PCI_PRODUCT_LEVELONE_LXT1001,
"Level 1 Gigabit Ethernet" },
{ 0, 0, NULL }
};
static int lge_probe(device_t);
static int lge_attach(device_t);
static int lge_detach(device_t);
static int lge_alloc_jumbo_mem(struct lge_softc *);
static void lge_free_jumbo_mem(struct lge_softc *);
static struct lge_jslot
*lge_jalloc(struct lge_softc *);
static void lge_jfree(void *);
static void lge_jref(void *);
static int lge_newbuf(struct lge_softc *, struct lge_rx_desc *,
struct mbuf *);
static int lge_encap(struct lge_softc *, struct mbuf *, uint32_t *);
static void lge_rxeof(struct lge_softc *, int);
static void lge_rxeoc(struct lge_softc *);
static void lge_txeof(struct lge_softc *);
static void lge_intr(void *);
static void lge_tick(void *);
static void lge_tick_serialized(void *);
static void lge_start(struct ifnet *, struct ifaltq_subque *);
static int lge_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
static void lge_init(void *);
static void lge_stop(struct lge_softc *);
static void lge_watchdog(struct ifnet *);
static void lge_shutdown(device_t);
static int lge_ifmedia_upd(struct ifnet *);
static void lge_ifmedia_sts(struct ifnet *, struct ifmediareq *);
static void lge_eeprom_getword(struct lge_softc *, int, uint16_t *);
static void lge_read_eeprom(struct lge_softc *, caddr_t, int, int);
static int lge_miibus_readreg(device_t, int, int);
static int lge_miibus_writereg(device_t, int, int, int);
static void lge_miibus_statchg(device_t);
static void lge_setmulti(struct lge_softc *);
static void lge_reset(struct lge_softc *);
static int lge_list_rx_init(struct lge_softc *);
static int lge_list_tx_init(struct lge_softc *);
#ifdef LGE_USEIOSPACE
#define LGE_RES SYS_RES_IOPORT
#define LGE_RID LGE_PCI_LOIO
#else
#define LGE_RES SYS_RES_MEMORY
#define LGE_RID LGE_PCI_LOMEM
#endif
static device_method_t lge_methods[] = {
DEVMETHOD(device_probe, lge_probe),
DEVMETHOD(device_attach, lge_attach),
DEVMETHOD(device_detach, lge_detach),
DEVMETHOD(device_shutdown, lge_shutdown),
DEVMETHOD(bus_print_child, bus_generic_print_child),
DEVMETHOD(bus_driver_added, bus_generic_driver_added),
DEVMETHOD(miibus_readreg, lge_miibus_readreg),
DEVMETHOD(miibus_writereg, lge_miibus_writereg),
DEVMETHOD(miibus_statchg, lge_miibus_statchg),
DEVMETHOD_END
};
static DEFINE_CLASS_0(lge, lge_driver, lge_methods, sizeof(struct lge_softc));
static devclass_t lge_devclass;
DECLARE_DUMMY_MODULE(if_lge);
DRIVER_MODULE(if_lge, pci, lge_driver, lge_devclass, NULL, NULL);
DRIVER_MODULE(miibus, lge, miibus_driver, miibus_devclass, NULL, NULL);
#define LGE_SETBIT(sc, reg, x) \
CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x))
#define LGE_CLRBIT(sc, reg, x) \
CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x))
#define SIO_SET(x) \
CSR_WRITE_4(sc, LGE_MEAR, CSR_READ_4(sc, LGE_MEAR) | (x))
#define SIO_CLR(x) \
CSR_WRITE_4(sc, LGE_MEAR, CSR_READ_4(sc, LGE_MEAR) & ~(x))
static void
lge_eeprom_getword(struct lge_softc *sc, int addr, uint16_t *dest)
{
int i;
uint32_t val;
CSR_WRITE_4(sc, LGE_EECTL, LGE_EECTL_CMD_READ|
LGE_EECTL_SINGLEACCESS | ((addr >> 1) << 8));
for (i = 0; i < LGE_TIMEOUT; i++) {
if ((CSR_READ_4(sc, LGE_EECTL) & LGE_EECTL_CMD_READ) == 0)
break;
}
if (i == LGE_TIMEOUT) {
kprintf("lge%d: EEPROM read timed out\n", sc->lge_unit);
return;
}
val = CSR_READ_4(sc, LGE_EEDATA);
if (addr & 1)
*dest = (val >> 16) & 0xFFFF;
else
*dest = val & 0xFFFF;
}
static void
lge_read_eeprom(struct lge_softc *sc, caddr_t dest, int off, int cnt)
{
int i;
uint16_t word = 0, *ptr;
for (i = 0; i < cnt; i++) {
lge_eeprom_getword(sc, off + i, &word);
ptr = (uint16_t *)(dest + (i * 2));
*ptr = ntohs(word);
}
}
static int
lge_miibus_readreg(device_t dev, int phy, int reg)
{
struct lge_softc *sc = device_get_softc(dev);
int i;
if (sc->lge_pcs == 0 && phy == 0)
return(0);
CSR_WRITE_4(sc, LGE_GMIICTL, (phy << 8) | reg | LGE_GMIICMD_READ);
for (i = 0; i < LGE_TIMEOUT; i++) {
if ((CSR_READ_4(sc, LGE_GMIICTL) & LGE_GMIICTL_CMDBUSY) == 0)
break;
}
if (i == LGE_TIMEOUT) {
kprintf("lge%d: PHY read timed out\n", sc->lge_unit);
return(0);
}
return(CSR_READ_4(sc, LGE_GMIICTL) >> 16);
}
static int
lge_miibus_writereg(device_t dev, int phy, int reg, int data)
{
struct lge_softc *sc = device_get_softc(dev);
int i;
CSR_WRITE_4(sc, LGE_GMIICTL,
(data << 16) | (phy << 8) | reg | LGE_GMIICMD_WRITE);
for (i = 0; i < LGE_TIMEOUT; i++) {
if ((CSR_READ_4(sc, LGE_GMIICTL) & LGE_GMIICTL_CMDBUSY) == 0)
break;
}
if (i == LGE_TIMEOUT) {
kprintf("lge%d: PHY write timed out\n", sc->lge_unit);
return(0);
}
return(0);
}
static void
lge_miibus_statchg(device_t dev)
{
struct lge_softc *sc = device_get_softc(dev);
struct mii_data *mii = device_get_softc(sc->lge_miibus);
LGE_CLRBIT(sc, LGE_GMIIMODE, LGE_GMIIMODE_SPEED);
switch (IFM_SUBTYPE(mii->mii_media_active)) {
case IFM_1000_T:
case IFM_1000_SX:
LGE_SETBIT(sc, LGE_GMIIMODE, LGE_SPEED_1000);
break;
case IFM_100_TX:
LGE_SETBIT(sc, LGE_GMIIMODE, LGE_SPEED_100);
break;
case IFM_10_T:
LGE_SETBIT(sc, LGE_GMIIMODE, LGE_SPEED_10);
break;
default:
LGE_SETBIT(sc, LGE_GMIIMODE, LGE_SPEED_1000);
break;
}
if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX)
LGE_SETBIT(sc, LGE_GMIIMODE, LGE_GMIIMODE_FDX);
else
LGE_CLRBIT(sc, LGE_GMIIMODE, LGE_GMIIMODE_FDX);
}
static void
lge_setmulti(struct lge_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
struct ifmultiaddr *ifma;
uint32_t h = 0, hashes[2] = { 0, 0 };
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1 | LGE_MODE1_RX_MCAST);
if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
CSR_WRITE_4(sc, LGE_MAR0, 0xFFFFFFFF);
CSR_WRITE_4(sc, LGE_MAR1, 0xFFFFFFFF);
return;
}
CSR_WRITE_4(sc, LGE_MAR0, 0);
CSR_WRITE_4(sc, LGE_MAR1, 0);
TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
if (ifma->ifma_addr->sa_family != AF_LINK)
continue;
h = ether_crc32_be(LLADDR((struct sockaddr_dl *)
ifma->ifma_addr), ETHER_ADDR_LEN) >> 26;
if (h < 32)
hashes[0] |= (1 << h);
else
hashes[1] |= (1 << (h - 32));
}
CSR_WRITE_4(sc, LGE_MAR0, hashes[0]);
CSR_WRITE_4(sc, LGE_MAR1, hashes[1]);
return;
}
static void
lge_reset(struct lge_softc *sc)
{
int i;
LGE_SETBIT(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL0 | LGE_MODE1_SOFTRST);
for (i = 0; i < LGE_TIMEOUT; i++) {
if ((CSR_READ_4(sc, LGE_MODE1) & LGE_MODE1_SOFTRST) == 0)
break;
}
if (i == LGE_TIMEOUT)
kprintf("lge%d: reset never completed\n", sc->lge_unit);
DELAY(1000);
}
static int
lge_probe(device_t dev)
{
struct lge_type *t;
uint16_t vendor, product;
vendor = pci_get_vendor(dev);
product = pci_get_device(dev);
for (t = lge_devs; t->lge_name != NULL; t++) {
if (vendor == t->lge_vid && product == t->lge_did) {
device_set_desc(dev, t->lge_name);
return(0);
}
}
return(ENXIO);
}
static int
lge_attach(device_t dev)
{
uint8_t eaddr[ETHER_ADDR_LEN];
struct lge_softc *sc;
struct ifnet *ifp;
int unit, error = 0, rid;
sc = device_get_softc(dev);
unit = device_get_unit(dev);
callout_init(&sc->lge_stat_timer);
lwkt_serialize_init(&sc->lge_jslot_serializer);
if (pci_get_powerstate(dev) != PCI_POWERSTATE_D0) {
uint32_t iobase, membase, irq;
iobase = pci_read_config(dev, LGE_PCI_LOIO, 4);
membase = pci_read_config(dev, LGE_PCI_LOMEM, 4);
irq = pci_read_config(dev, LGE_PCI_INTLINE, 4);
device_printf(dev, "chip is in %s power mode "
"-- setting to D0\n",
pci_powerstate_to_str(pci_get_powerstate(dev)));
pci_set_powerstate(dev, PCI_POWERSTATE_D0);
pci_write_config(dev, LGE_PCI_LOIO, iobase, 4);
pci_write_config(dev, LGE_PCI_LOMEM, membase, 4);
pci_write_config(dev, LGE_PCI_INTLINE, irq, 4);
}
pci_enable_busmaster(dev);
rid = LGE_RID;
sc->lge_res = bus_alloc_resource_any(dev, LGE_RES, &rid, RF_ACTIVE);
if (sc->lge_res == NULL) {
kprintf("lge%d: couldn't map ports/memory\n", unit);
error = ENXIO;
goto fail;
}
sc->lge_btag = rman_get_bustag(sc->lge_res);
sc->lge_bhandle = rman_get_bushandle(sc->lge_res);
rid = 0;
sc->lge_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
RF_SHAREABLE | RF_ACTIVE);
if (sc->lge_irq == NULL) {
kprintf("lge%d: couldn't map interrupt\n", unit);
error = ENXIO;
goto fail;
}
lge_reset(sc);
lge_read_eeprom(sc, (caddr_t)&eaddr[0], LGE_EE_NODEADDR_0, 1);
lge_read_eeprom(sc, (caddr_t)&eaddr[2], LGE_EE_NODEADDR_1, 1);
lge_read_eeprom(sc, (caddr_t)&eaddr[4], LGE_EE_NODEADDR_2, 1);
sc->lge_unit = unit;
sc->lge_ldata = contigmalloc(sizeof(struct lge_list_data), M_DEVBUF,
M_WAITOK | M_ZERO, 0, 0xffffffff, PAGE_SIZE, 0);
if (sc->lge_ldata == NULL) {
kprintf("lge%d: no memory for list buffers!\n", unit);
error = ENXIO;
goto fail;
}
if (lge_alloc_jumbo_mem(sc)) {
kprintf("lge%d: jumbo buffer allocation failed\n",
sc->lge_unit);
error = ENXIO;
goto fail;
}
ifp = &sc->arpcom.ac_if;
ifp->if_softc = sc;
if_initname(ifp, "lge", unit);
ifp->if_mtu = ETHERMTU;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
ifp->if_ioctl = lge_ioctl;
ifp->if_start = lge_start;
ifp->if_watchdog = lge_watchdog;
ifp->if_init = lge_init;
ifp->if_baudrate = 1000000000;
ifq_set_maxlen(&ifp->if_snd, LGE_TX_LIST_CNT - 1);
ifq_set_ready(&ifp->if_snd);
ifp->if_capabilities = IFCAP_RXCSUM;
ifp->if_capenable = ifp->if_capabilities;
if (CSR_READ_4(sc, LGE_GMIIMODE) & LGE_GMIIMODE_PCSENH)
sc->lge_pcs = 1;
else
sc->lge_pcs = 0;
if (mii_phy_probe(dev, &sc->lge_miibus,
lge_ifmedia_upd, lge_ifmedia_sts)) {
kprintf("lge%d: MII without any PHY!\n", sc->lge_unit);
error = ENXIO;
goto fail;
}
ether_ifattach(ifp, eaddr, NULL);
ifq_set_cpuid(&ifp->if_snd, rman_get_cpuid(sc->lge_irq));
error = bus_setup_intr(dev, sc->lge_irq, INTR_MPSAFE,
lge_intr, sc, &sc->lge_intrhand,
ifp->if_serializer);
if (error) {
ether_ifdetach(ifp);
kprintf("lge%d: couldn't set up irq\n", unit);
goto fail;
}
return(0);
fail:
lge_detach(dev);
return(error);
}
static int
lge_detach(device_t dev)
{
struct lge_softc *sc= device_get_softc(dev);
struct ifnet *ifp = &sc->arpcom.ac_if;
if (device_is_attached(dev)) {
lwkt_serialize_enter(ifp->if_serializer);
lge_reset(sc);
lge_stop(sc);
bus_teardown_intr(dev, sc->lge_irq, sc->lge_intrhand);
lwkt_serialize_exit(ifp->if_serializer);
ether_ifdetach(ifp);
}
if (sc->lge_miibus)
device_delete_child(dev, sc->lge_miibus);
bus_generic_detach(dev);
if (sc->lge_irq)
bus_release_resource(dev, SYS_RES_IRQ, 0, sc->lge_irq);
if (sc->lge_res)
bus_release_resource(dev, LGE_RES, LGE_RID, sc->lge_res);
if (sc->lge_ldata)
contigfree(sc->lge_ldata, sizeof(struct lge_list_data),
M_DEVBUF);
lge_free_jumbo_mem(sc);
return(0);
}
static int
lge_list_tx_init(struct lge_softc *sc)
{
struct lge_list_data *ld;
struct lge_ring_data *cd;
int i;
cd = &sc->lge_cdata;
ld = sc->lge_ldata;
for (i = 0; i < LGE_TX_LIST_CNT; i++) {
ld->lge_tx_list[i].lge_mbuf = NULL;
ld->lge_tx_list[i].lge_ctl = 0;
}
cd->lge_tx_prod = cd->lge_tx_cons = 0;
return(0);
}
static int
lge_list_rx_init(struct lge_softc *sc)
{
struct lge_list_data *ld;
struct lge_ring_data *cd;
int i;
ld = sc->lge_ldata;
cd = &sc->lge_cdata;
cd->lge_rx_prod = cd->lge_rx_cons = 0;
CSR_WRITE_4(sc, LGE_RXDESC_ADDR_HI, 0);
for (i = 0; i < LGE_RX_LIST_CNT; i++) {
if (CSR_READ_1(sc, LGE_RXCMDFREE_8BIT) == 0)
break;
if (lge_newbuf(sc, &ld->lge_rx_list[i], NULL) == ENOBUFS)
return(ENOBUFS);
}
CSR_READ_4(sc, LGE_ISR);
return(0);
}
static int
lge_newbuf(struct lge_softc *sc, struct lge_rx_desc *c, struct mbuf *m)
{
struct mbuf *m_new = NULL;
struct lge_jslot *buf;
if (m == NULL) {
MGETHDR(m_new, M_NOWAIT, MT_DATA);
if (m_new == NULL) {
kprintf("lge%d: no memory for rx list "
"-- packet dropped!\n", sc->lge_unit);
return(ENOBUFS);
}
buf = lge_jalloc(sc);
if (buf == NULL) {
#ifdef LGE_VERBOSE
kprintf("lge%d: jumbo allocation failed "
"-- packet dropped!\n", sc->lge_unit);
#endif
m_freem(m_new);
return(ENOBUFS);
}
m_new->m_ext.ext_arg = buf;
m_new->m_ext.ext_buf = buf->lge_buf;
m_new->m_ext.ext_free = lge_jfree;
m_new->m_ext.ext_ref = lge_jref;
m_new->m_ext.ext_size = LGE_JUMBO_FRAMELEN;
m_new->m_data = m_new->m_ext.ext_buf;
m_new->m_flags |= M_EXT;
m_new->m_len = m_new->m_pkthdr.len = m_new->m_ext.ext_size;
} else {
m_new = m;
m_new->m_len = m_new->m_pkthdr.len = LGE_JLEN;
m_new->m_data = m_new->m_ext.ext_buf;
}
m_adj(m_new, ETHER_ALIGN);
c->lge_mbuf = m_new;
c->lge_fragptr_hi = 0;
c->lge_fragptr_lo = vtophys(mtod(m_new, caddr_t));
c->lge_fraglen = m_new->m_len;
c->lge_ctl = m_new->m_len | LGE_RXCTL_WANTINTR | LGE_FRAGCNT(1);
c->lge_sts = 0;
CSR_WRITE_4(sc, LGE_RXDESC_ADDR_LO, vtophys(c));
LGE_INC(sc->lge_cdata.lge_rx_prod, LGE_RX_LIST_CNT);
return(0);
}
static int
lge_alloc_jumbo_mem(struct lge_softc *sc)
{
struct lge_jslot *entry;
caddr_t ptr;
int i;
sc->lge_cdata.lge_jumbo_buf = contigmalloc(LGE_JMEM, M_DEVBUF,
M_WAITOK, 0, 0xffffffff, PAGE_SIZE, 0);
if (sc->lge_cdata.lge_jumbo_buf == NULL) {
kprintf("lge%d: no memory for jumbo buffers!\n", sc->lge_unit);
return(ENOBUFS);
}
SLIST_INIT(&sc->lge_jfree_listhead);
ptr = sc->lge_cdata.lge_jumbo_buf;
for (i = 0; i < LGE_JSLOTS; i++) {
entry = &sc->lge_cdata.lge_jslots[i];
entry->lge_sc = sc;
entry->lge_buf = ptr;
entry->lge_inuse = 0;
entry->lge_slot = i;
SLIST_INSERT_HEAD(&sc->lge_jfree_listhead, entry, jslot_link);
ptr += LGE_JLEN;
}
return(0);
}
static void
lge_free_jumbo_mem(struct lge_softc *sc)
{
if (sc->lge_cdata.lge_jumbo_buf)
contigfree(sc->lge_cdata.lge_jumbo_buf, LGE_JMEM, M_DEVBUF);
}
static struct lge_jslot *
lge_jalloc(struct lge_softc *sc)
{
struct lge_jslot *entry;
lwkt_serialize_enter(&sc->lge_jslot_serializer);
entry = SLIST_FIRST(&sc->lge_jfree_listhead);
if (entry) {
SLIST_REMOVE_HEAD(&sc->lge_jfree_listhead, jslot_link);
entry->lge_inuse = 1;
} else {
#ifdef LGE_VERBOSE
kprintf("lge%d: no free jumbo buffers\n", sc->lge_unit);
#endif
}
lwkt_serialize_exit(&sc->lge_jslot_serializer);
return(entry);
}
static void
lge_jref(void *arg)
{
struct lge_jslot *entry = (struct lge_jslot *)arg;
struct lge_softc *sc = entry->lge_sc;
if (&sc->lge_cdata.lge_jslots[entry->lge_slot] != entry)
panic("lge_jref: asked to reference buffer "
"that we don't manage!");
else if (entry->lge_inuse == 0)
panic("lge_jref: buffer already free!");
else
atomic_add_int(&entry->lge_inuse, 1);
}
static void
lge_jfree(void *arg)
{
struct lge_jslot *entry = (struct lge_jslot *)arg;
struct lge_softc *sc = entry->lge_sc;
if (sc == NULL)
panic("lge_jfree: can't find softc pointer!");
if (&sc->lge_cdata.lge_jslots[entry->lge_slot] != entry) {
panic("lge_jfree: asked to free buffer that we don't manage!");
} else if (entry->lge_inuse == 0) {
panic("lge_jfree: buffer already free!");
} else {
lwkt_serialize_enter(&sc->lge_jslot_serializer);
atomic_subtract_int(&entry->lge_inuse, 1);
if (entry->lge_inuse == 0) {
SLIST_INSERT_HEAD(&sc->lge_jfree_listhead,
entry, jslot_link);
}
lwkt_serialize_exit(&sc->lge_jslot_serializer);
}
}
static void
lge_rxeof(struct lge_softc *sc, int cnt)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
struct mbuf *m;
struct lge_rx_desc *cur_rx;
int c, i, total_len = 0;
uint32_t rxsts, rxctl;
c = cnt;
i = sc->lge_cdata.lge_rx_cons;
while(c) {
struct mbuf *m0 = NULL;
cur_rx = &sc->lge_ldata->lge_rx_list[i];
rxctl = cur_rx->lge_ctl;
rxsts = cur_rx->lge_sts;
m = cur_rx->lge_mbuf;
cur_rx->lge_mbuf = NULL;
total_len = LGE_RXBYTES(cur_rx);
LGE_INC(i, LGE_RX_LIST_CNT);
c--;
if (rxctl & LGE_RXCTL_ERRMASK) {
IFNET_STAT_INC(ifp, ierrors, 1);
lge_newbuf(sc, &LGE_RXTAIL(sc), m);
continue;
}
if (lge_newbuf(sc, &LGE_RXTAIL(sc), NULL) == ENOBUFS) {
m0 = m_devget(mtod(m, char *) - ETHER_ALIGN,
total_len + ETHER_ALIGN, 0, ifp);
lge_newbuf(sc, &LGE_RXTAIL(sc), m);
if (m0 == NULL) {
kprintf("lge%d: no receive buffers "
"available -- packet dropped!\n",
sc->lge_unit);
IFNET_STAT_INC(ifp, ierrors, 1);
continue;
}
m_adj(m0, ETHER_ALIGN);
m = m0;
} else {
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = m->m_len = total_len;
}
IFNET_STAT_INC(ifp, ipackets, 1);
if (rxsts & LGE_RXSTS_ISIP)
m->m_pkthdr.csum_flags |= CSUM_IP_CHECKED;
if (!(rxsts & LGE_RXSTS_IPCSUMERR))
m->m_pkthdr.csum_flags |= CSUM_IP_VALID;
if ((rxsts & LGE_RXSTS_ISTCP &&
!(rxsts & LGE_RXSTS_TCPCSUMERR)) ||
(rxsts & LGE_RXSTS_ISUDP &&
!(rxsts & LGE_RXSTS_UDPCSUMERR))) {
m->m_pkthdr.csum_flags |=
CSUM_DATA_VALID|CSUM_PSEUDO_HDR|
CSUM_FRAG_NOT_CHECKED;
m->m_pkthdr.csum_data = 0xffff;
}
ifp->if_input(ifp, m, NULL, -1);
}
sc->lge_cdata.lge_rx_cons = i;
}
static void
lge_rxeoc(struct lge_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
ifp->if_flags &= ~IFF_RUNNING;
lge_init(sc);
}
static void
lge_txeof(struct lge_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
struct lge_tx_desc *cur_tx = NULL;
uint32_t idx, txdone;
ifp->if_timer = 0;
idx = sc->lge_cdata.lge_tx_cons;
txdone = CSR_READ_1(sc, LGE_TXDMADONE_8BIT);
while (idx != sc->lge_cdata.lge_tx_prod && txdone) {
cur_tx = &sc->lge_ldata->lge_tx_list[idx];
IFNET_STAT_INC(ifp, opackets, 1);
if (cur_tx->lge_mbuf != NULL) {
m_freem(cur_tx->lge_mbuf);
cur_tx->lge_mbuf = NULL;
}
cur_tx->lge_ctl = 0;
txdone--;
LGE_INC(idx, LGE_TX_LIST_CNT);
ifp->if_timer = 0;
}
sc->lge_cdata.lge_tx_cons = idx;
if (cur_tx != NULL)
ifq_clr_oactive(&ifp->if_snd);
}
static void
lge_tick(void *xsc)
{
struct lge_softc *sc = xsc;
struct ifnet *ifp = &sc->arpcom.ac_if;
lwkt_serialize_enter(ifp->if_serializer);
lge_tick_serialized(xsc);
lwkt_serialize_exit(ifp->if_serializer);
}
static void
lge_tick_serialized(void *xsc)
{
struct lge_softc *sc = xsc;
struct mii_data *mii;
struct ifnet *ifp = &sc->arpcom.ac_if;
CSR_WRITE_4(sc, LGE_STATSIDX, LGE_STATS_SINGLE_COLL_PKTS);
IFNET_STAT_INC(ifp, collisions, CSR_READ_4(sc, LGE_STATSVAL));
CSR_WRITE_4(sc, LGE_STATSIDX, LGE_STATS_MULTI_COLL_PKTS);
IFNET_STAT_INC(ifp, collisions, CSR_READ_4(sc, LGE_STATSVAL));
if (!sc->lge_link) {
mii = device_get_softc(sc->lge_miibus);
mii_tick(mii);
mii_pollstat(mii);
if (mii->mii_media_status & IFM_ACTIVE &&
IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
sc->lge_link++;
if (IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_SX||
IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_T)
kprintf("lge%d: gigabit link up\n",
sc->lge_unit);
if (!ifq_is_empty(&ifp->if_snd))
if_devstart(ifp);
}
}
callout_reset(&sc->lge_stat_timer, hz, lge_tick, sc);
}
static void
lge_intr(void *arg)
{
struct lge_softc *sc = arg;
struct ifnet *ifp = &sc->arpcom.ac_if;
uint32_t status;
if ((ifp->if_flags & IFF_UP) == 0) {
lge_stop(sc);
return;
}
for (;;) {
status = CSR_READ_4(sc, LGE_ISR);
if ((status & LGE_INTRS) == 0)
break;
if ((status & (LGE_ISR_TXCMDFIFO_EMPTY|LGE_ISR_TXDMA_DONE)))
lge_txeof(sc);
if (status & LGE_ISR_RXDMA_DONE)
lge_rxeof(sc, LGE_RX_DMACNT(status));
if (status & LGE_ISR_RXCMDFIFO_EMPTY)
lge_rxeoc(sc);
if (status & LGE_ISR_PHY_INTR) {
sc->lge_link = 0;
callout_stop(&sc->lge_stat_timer);
lge_tick_serialized(sc);
}
}
CSR_WRITE_4(sc, LGE_IMR, LGE_IMR_SETRST_CTL0|LGE_IMR_INTR_ENB);
if (!ifq_is_empty(&ifp->if_snd))
if_devstart(ifp);
}
static int
lge_encap(struct lge_softc *sc, struct mbuf *m_head, uint32_t *txidx)
{
struct lge_frag *f = NULL;
struct lge_tx_desc *cur_tx;
struct mbuf *m;
int frag = 0, tot_len = 0;
m = m_head;
cur_tx = &sc->lge_ldata->lge_tx_list[*txidx];
frag = 0;
for (m = m_head; m != NULL; m = m->m_next) {
if (m->m_len != 0) {
if (frag == LGE_FRAG_CNT)
break;
tot_len += m->m_len;
f = &cur_tx->lge_frags[frag];
f->lge_fraglen = m->m_len;
f->lge_fragptr_lo = vtophys(mtod(m, vm_offset_t));
f->lge_fragptr_hi = 0;
frag++;
}
}
KASSERT(m == NULL, ("too many fragments"));
cur_tx->lge_mbuf = m_head;
cur_tx->lge_ctl = LGE_TXCTL_WANTINTR|LGE_FRAGCNT(frag)|tot_len;
LGE_INC((*txidx), LGE_TX_LIST_CNT);
CSR_WRITE_4(sc, LGE_TXDESC_ADDR_LO, vtophys(cur_tx));
return(0);
}
static void
lge_start(struct ifnet *ifp, struct ifaltq_subque *ifsq)
{
struct lge_softc *sc = ifp->if_softc;
struct mbuf *m_head = NULL, *m_defragged;
uint32_t idx;
int need_timer;
ASSERT_ALTQ_SQ_DEFAULT(ifp, ifsq);
if (!sc->lge_link) {
ifq_purge(&ifp->if_snd);
return;
}
idx = sc->lge_cdata.lge_tx_prod;
if (ifq_is_oactive(&ifp->if_snd))
return;
need_timer = 0;
while(sc->lge_ldata->lge_tx_list[idx].lge_mbuf == NULL) {
struct mbuf *m;
int frags;
if (CSR_READ_1(sc, LGE_TXCMDFREE_8BIT) == 0) {
ifq_set_oactive(&ifp->if_snd);
break;
}
m_defragged = NULL;
m_head = ifq_dequeue(&ifp->if_snd);
if (m_head == NULL)
break;
again:
frags = 0;
for (m = m_head; m != NULL; m = m->m_next)
++frags;
if (frags > LGE_FRAG_CNT) {
if (m_defragged != NULL) {
m_freem(m_head);
continue;
}
m_defragged = m_defrag(m_head, M_NOWAIT);
if (m_defragged == NULL) {
m_freem(m_head);
continue;
}
m_head = m_defragged;
goto again;
}
lge_encap(sc, m_head, &idx);
need_timer = 1;
BPF_MTAP(ifp, m_head);
}
if (!need_timer)
return;
sc->lge_cdata.lge_tx_prod = idx;
ifp->if_timer = 5;
}
static void
lge_init(void *xsc)
{
struct lge_softc *sc = xsc;
struct ifnet *ifp = &sc->arpcom.ac_if;
if (ifp->if_flags & IFF_RUNNING)
return;
lge_stop(sc);
lge_reset(sc);
CSR_WRITE_4(sc, LGE_PAR0, *(uint32_t *)(&sc->arpcom.ac_enaddr[0]));
CSR_WRITE_4(sc, LGE_PAR1, *(uint32_t *)(&sc->arpcom.ac_enaddr[4]));
if (lge_list_rx_init(sc) == ENOBUFS) {
kprintf("lge%d: initialization failed: no "
"memory for rx buffers\n", sc->lge_unit);
lge_stop(sc);
return;
}
lge_list_tx_init(sc);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_UCAST |
LGE_MODE1_TX_CRC | LGE_MODE1_TXPAD |
LGE_MODE1_RX_FLOWCTL | LGE_MODE1_SETRST_CTL0 |
LGE_MODE1_SETRST_CTL1 | LGE_MODE1_SETRST_CTL2);
if (ifp->if_flags & IFF_PROMISC) {
CSR_WRITE_4(sc, LGE_MODE1,
LGE_MODE1_SETRST_CTL1 | LGE_MODE1_RX_PROMISC);
} else {
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_PROMISC);
}
if (ifp->if_flags & IFF_BROADCAST) {
CSR_WRITE_4(sc, LGE_MODE1,
LGE_MODE1_SETRST_CTL1 | LGE_MODE1_RX_BCAST);
} else {
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_BCAST);
}
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1|LGE_MODE1_RMVPAD);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_ERRPKTS);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1 | LGE_MODE1_RX_GIANTS);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_TX_FLOWCTL);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_FLOWCTL);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_CRC);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_MPACK_ENB);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_VLAN_RX | LGE_MODE1_VLAN_TX |
LGE_MODE1_VLAN_STRIP | LGE_MODE1_VLAN_INSERT);
CSR_WRITE_2(sc, LGE_RXFIFO_HIWAT, 0x3FFF);
CSR_WRITE_4(sc, LGE_IMR, LGE_IMR_SETRST_CTL1|LGE_IMR_RXFIFO_WAT);
lge_setmulti(sc);
CSR_WRITE_4(sc, LGE_MODE2, LGE_MODE2_RX_IPCSUM |
LGE_MODE2_RX_TCPCSUM | LGE_MODE2_RX_UDPCSUM |
LGE_MODE2_RX_ERRCSUM);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL0 | LGE_MODE1_GMIIPOLL);
CSR_WRITE_4(sc, LGE_RXDESC_ADDR_HI, 0);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1 | LGE_MODE1_RX_ENB);
CSR_WRITE_4(sc, LGE_TXDESC_ADDR_HI, 0);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1 | LGE_MODE1_TX_ENB);
CSR_WRITE_4(sc, LGE_IMR, LGE_IMR_SETRST_CTL0 |
LGE_IMR_SETRST_CTL1 | LGE_IMR_INTR_ENB|LGE_INTRS);
lge_ifmedia_upd(ifp);
ifp->if_flags |= IFF_RUNNING;
ifq_clr_oactive(&ifp->if_snd);
callout_reset(&sc->lge_stat_timer, hz, lge_tick, sc);
}
static int
lge_ifmedia_upd(struct ifnet *ifp)
{
struct lge_softc *sc = ifp->if_softc;
struct mii_data *mii = device_get_softc(sc->lge_miibus);
sc->lge_link = 0;
if (mii->mii_instance) {
struct mii_softc *miisc;
LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
mii_phy_reset(miisc);
}
mii_mediachg(mii);
return(0);
}
static void
lge_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
{
struct lge_softc *sc = ifp->if_softc;
struct mii_data *mii;
mii = device_get_softc(sc->lge_miibus);
mii_pollstat(mii);
ifmr->ifm_active = mii->mii_media_active;
ifmr->ifm_status = mii->mii_media_status;
}
static int
lge_ioctl(struct ifnet *ifp, u_long command, caddr_t data, struct ucred *cr)
{
struct lge_softc *sc = ifp->if_softc;
struct ifreq *ifr = (struct ifreq *) data;
struct mii_data *mii;
int error = 0;
switch(command) {
case SIOCSIFMTU:
if (ifr->ifr_mtu > LGE_JUMBO_MTU)
error = EINVAL;
else
ifp->if_mtu = ifr->ifr_mtu;
break;
case SIOCSIFFLAGS:
if (ifp->if_flags & IFF_UP) {
if (ifp->if_flags & IFF_RUNNING &&
ifp->if_flags & IFF_PROMISC &&
!(sc->lge_if_flags & IFF_PROMISC)) {
CSR_WRITE_4(sc, LGE_MODE1,
LGE_MODE1_SETRST_CTL1|
LGE_MODE1_RX_PROMISC);
} else if (ifp->if_flags & IFF_RUNNING &&
!(ifp->if_flags & IFF_PROMISC) &&
sc->lge_if_flags & IFF_PROMISC) {
CSR_WRITE_4(sc, LGE_MODE1,
LGE_MODE1_RX_PROMISC);
} else {
ifp->if_flags &= ~IFF_RUNNING;
lge_init(sc);
}
} else {
if (ifp->if_flags & IFF_RUNNING)
lge_stop(sc);
}
sc->lge_if_flags = ifp->if_flags;
error = 0;
break;
case SIOCADDMULTI:
case SIOCDELMULTI:
lge_setmulti(sc);
error = 0;
break;
case SIOCGIFMEDIA:
case SIOCSIFMEDIA:
mii = device_get_softc(sc->lge_miibus);
error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command);
break;
default:
error = ether_ioctl(ifp, command, data);
break;
}
return(error);
}
static void
lge_watchdog(struct ifnet *ifp)
{
struct lge_softc *sc = ifp->if_softc;
IFNET_STAT_INC(ifp, oerrors, 1);
kprintf("lge%d: watchdog timeout\n", sc->lge_unit);
lge_stop(sc);
lge_reset(sc);
ifp->if_flags &= ~IFF_RUNNING;
lge_init(sc);
if (!ifq_is_empty(&ifp->if_snd))
if_devstart(ifp);
}
static void
lge_stop(struct lge_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
int i;
ifp->if_timer = 0;
callout_stop(&sc->lge_stat_timer);
CSR_WRITE_4(sc, LGE_IMR, LGE_IMR_INTR_ENB);
CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_ENB|LGE_MODE1_TX_ENB);
sc->lge_link = 0;
for (i = 0; i < LGE_RX_LIST_CNT; i++) {
if (sc->lge_ldata->lge_rx_list[i].lge_mbuf != NULL) {
m_freem(sc->lge_ldata->lge_rx_list[i].lge_mbuf);
sc->lge_ldata->lge_rx_list[i].lge_mbuf = NULL;
}
}
bzero(&sc->lge_ldata->lge_rx_list, sizeof(sc->lge_ldata->lge_rx_list));
for (i = 0; i < LGE_TX_LIST_CNT; i++) {
if (sc->lge_ldata->lge_tx_list[i].lge_mbuf != NULL) {
m_freem(sc->lge_ldata->lge_tx_list[i].lge_mbuf);
sc->lge_ldata->lge_tx_list[i].lge_mbuf = NULL;
}
}
bzero(&sc->lge_ldata->lge_tx_list, sizeof(sc->lge_ldata->lge_tx_list));
ifp->if_flags &= ~IFF_RUNNING;
ifq_clr_oactive(&ifp->if_snd);
}
static void
lge_shutdown(device_t dev)
{
struct lge_softc *sc = device_get_softc(dev);
lge_reset(sc);
lge_stop(sc);
}