#include <sys/param.h>
#include <sys/bus.h>
#include <sys/endian.h>
#include <sys/in_cksum.h>
#include <sys/kernel.h>
#include <sys/interrupt.h>
#include <sys/mbuf.h>
#include <sys/malloc.h>
#include <sys/queue.h>
#include <sys/rman.h>
#include <sys/serialize.h>
#include <sys/socket.h>
#include <sys/sockio.h>
#include <sys/sysctl.h>
#include <net/bpf.h>
#include <net/ethernet.h>
#include <net/if.h>
#include <net/if_arp.h>
#include <net/if_dl.h>
#include <net/if_media.h>
#include <net/ifq_var.h>
#include <net/vlan/if_vlan_var.h>
#include <netinet/ip.h>
#include <netinet/udp.h>
#include <dev/netif/mii_layer/mii.h>
#include <dev/netif/mii_layer/miivar.h>
#include <dev/netif/mii_layer/brgphyreg.h>
#include <bus/pci/pcireg.h>
#include <bus/pci/pcivar.h>
#include "pcidevs.h"
#include <dev/netif/sk/if_skreg.h>
#include <dev/netif/sk/yukonreg.h>
#include <dev/netif/sk/xmaciireg.h>
#include <dev/netif/sk/if_skvar.h>
#include "miibus_if.h"
#if 0
#define SK_DEBUG
#endif
#if 0
#define SK_RXCSUM
#endif
static const struct skc_type {
uint16_t skc_vid;
uint16_t skc_did;
const char *skc_name;
} skc_devs[] = {
{ PCI_VENDOR_3COM, PCI_PRODUCT_3COM_3C940,
"3Com 3C940" },
{ PCI_VENDOR_3COM, PCI_PRODUCT_3COM_3C940B,
"3Com 3C940B" },
{ PCI_VENDOR_CNET, PCI_PRODUCT_CNET_GIGACARD,
"CNet GigaCard" },
{ PCI_VENDOR_DLINK, PCI_PRODUCT_DLINK_DGE530T_A1,
"D-Link DGE-530T A1" },
{ PCI_VENDOR_DLINK, PCI_PRODUCT_DLINK_DGE530T_B1,
"D-Link DGE-530T B1" },
{ PCI_VENDOR_LINKSYS, PCI_PRODUCT_LINKSYS_EG1032,
"Linksys EG1032 v2" },
{ PCI_VENDOR_LINKSYS, PCI_PRODUCT_LINKSYS_EG1064,
"Linksys EG1064" },
{ PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON,
"Marvell Yukon 88E8001/8003/8010" },
{ PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_BELKIN,
"Belkin F5D5005" },
{ PCI_VENDOR_SCHNEIDERKOCH, PCI_PRODUCT_SCHNEIDERKOCH_SKNET_GE,
"SysKonnect SK-NET" },
{ PCI_VENDOR_SCHNEIDERKOCH, PCI_PRODUCT_SCHNEIDERKOCH_SK9821v2,
"SysKonnect SK9821 v2" },
{ 0, 0, NULL }
};
static int skc_probe(device_t);
static int skc_attach(device_t);
static int skc_detach(device_t);
static void skc_shutdown(device_t);
static int skc_sysctl_imtime(SYSCTL_HANDLER_ARGS);
static int sk_probe(device_t);
static int sk_attach(device_t);
static int sk_detach(device_t);
static void sk_tick(void *);
static void sk_yukon_tick(void *);
static void sk_intr(void *);
static void sk_intr_bcom(struct sk_if_softc *);
static void sk_intr_xmac(struct sk_if_softc *);
static void sk_intr_yukon(struct sk_if_softc *);
static void sk_rxeof(struct sk_if_softc *);
static void sk_txeof(struct sk_if_softc *);
static int sk_encap(struct sk_if_softc *, struct mbuf **, uint32_t *);
static void sk_start(struct ifnet *, struct ifaltq_subque *);
static int sk_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
static void sk_init(void *);
static void sk_init_xmac(struct sk_if_softc *);
static void sk_init_yukon(struct sk_if_softc *);
static void sk_stop(struct sk_if_softc *);
static void sk_watchdog(struct ifnet *);
static int sk_ifmedia_upd(struct ifnet *);
static void sk_ifmedia_sts(struct ifnet *, struct ifmediareq *);
static void sk_reset(struct sk_softc *);
static int sk_newbuf_jumbo(struct sk_if_softc *, int, int);
static int sk_newbuf_std(struct sk_if_softc *, int, int);
static int sk_jpool_alloc(device_t);
static void sk_jpool_free(struct sk_if_softc *);
static struct sk_jpool_entry
*sk_jalloc(struct sk_if_softc *);
static void sk_jfree(void *);
static void sk_jref(void *);
static int sk_init_rx_ring(struct sk_if_softc *);
static int sk_init_tx_ring(struct sk_if_softc *);
static int sk_miibus_readreg(device_t, int, int);
static int sk_miibus_writereg(device_t, int, int, int);
static void sk_miibus_statchg(device_t);
static int sk_xmac_miibus_readreg(struct sk_if_softc *, int, int);
static int sk_xmac_miibus_writereg(struct sk_if_softc *, int, int, int);
static void sk_xmac_miibus_statchg(struct sk_if_softc *);
static int sk_marv_miibus_readreg(struct sk_if_softc *, int, int);
static int sk_marv_miibus_writereg(struct sk_if_softc *, int, int, int);
static void sk_marv_miibus_statchg(struct sk_if_softc *);
static void sk_setfilt(struct sk_if_softc *, caddr_t, int);
static void sk_setmulti(struct sk_if_softc *);
static void sk_setpromisc(struct sk_if_softc *);
#ifdef SK_RXCSUM
static void sk_rxcsum(struct ifnet *, struct mbuf *, const uint16_t,
const uint16_t);
#endif
static int sk_dma_alloc(device_t);
static void sk_dma_free(device_t);
#ifdef SK_DEBUG
#define DPRINTF(x) if (skdebug) kprintf x
#define DPRINTFN(n,x) if (skdebug >= (n)) kprintf x
static int skdebug = 2;
static void sk_dump_txdesc(struct sk_tx_desc *, int);
static void sk_dump_mbuf(struct mbuf *);
static void sk_dump_bytes(const char *, int);
#else
#define DPRINTF(x)
#define DPRINTFN(n,x)
#endif
static int skc_imtime = SK_IMTIME_DEFAULT;
TUNABLE_INT("hw.skc.imtime", &skc_imtime);
static device_method_t skc_methods[] = {
DEVMETHOD(device_probe, skc_probe),
DEVMETHOD(device_attach, skc_attach),
DEVMETHOD(device_detach, skc_detach),
DEVMETHOD(device_shutdown, skc_shutdown),
DEVMETHOD(bus_print_child, bus_generic_print_child),
DEVMETHOD(bus_driver_added, bus_generic_driver_added),
DEVMETHOD_END
};
static DEFINE_CLASS_0(skc, skc_driver, skc_methods, sizeof(struct sk_softc));
static devclass_t skc_devclass;
static device_method_t sk_methods[] = {
DEVMETHOD(device_probe, sk_probe),
DEVMETHOD(device_attach, sk_attach),
DEVMETHOD(device_detach, sk_detach),
DEVMETHOD(device_shutdown, bus_generic_shutdown),
DEVMETHOD(bus_print_child, bus_generic_print_child),
DEVMETHOD(bus_driver_added, bus_generic_driver_added),
DEVMETHOD(miibus_readreg, sk_miibus_readreg),
DEVMETHOD(miibus_writereg, sk_miibus_writereg),
DEVMETHOD(miibus_statchg, sk_miibus_statchg),
DEVMETHOD_END
};
static DEFINE_CLASS_0(sk, sk_driver, sk_methods, sizeof(struct sk_if_softc));
static devclass_t sk_devclass;
DECLARE_DUMMY_MODULE(if_sk);
DRIVER_MODULE(if_sk, pci, skc_driver, skc_devclass, NULL, NULL);
DRIVER_MODULE(if_sk, skc, sk_driver, sk_devclass, NULL, NULL);
DRIVER_MODULE(miibus, sk, miibus_driver, miibus_devclass, NULL, NULL);
static __inline uint32_t
sk_win_read_4(struct sk_softc *sc, uint32_t reg)
{
return CSR_READ_4(sc, reg);
}
static __inline uint16_t
sk_win_read_2(struct sk_softc *sc, uint32_t reg)
{
return CSR_READ_2(sc, reg);
}
static __inline uint8_t
sk_win_read_1(struct sk_softc *sc, uint32_t reg)
{
return CSR_READ_1(sc, reg);
}
static __inline void
sk_win_write_4(struct sk_softc *sc, uint32_t reg, uint32_t x)
{
CSR_WRITE_4(sc, reg, x);
}
static __inline void
sk_win_write_2(struct sk_softc *sc, uint32_t reg, uint16_t x)
{
CSR_WRITE_2(sc, reg, x);
}
static __inline void
sk_win_write_1(struct sk_softc *sc, uint32_t reg, uint8_t x)
{
CSR_WRITE_1(sc, reg, x);
}
static __inline int
sk_newbuf(struct sk_if_softc *sc_if, int idx, int wait)
{
int ret;
if (sc_if->sk_use_jumbo)
ret = sk_newbuf_jumbo(sc_if, idx, wait);
else
ret = sk_newbuf_std(sc_if, idx, wait);
return ret;
}
static int
sk_miibus_readreg(device_t dev, int phy, int reg)
{
struct sk_if_softc *sc_if = device_get_softc(dev);
if (SK_IS_GENESIS(sc_if->sk_softc))
return sk_xmac_miibus_readreg(sc_if, phy, reg);
else
return sk_marv_miibus_readreg(sc_if, phy, reg);
}
static int
sk_miibus_writereg(device_t dev, int phy, int reg, int val)
{
struct sk_if_softc *sc_if = device_get_softc(dev);
if (SK_IS_GENESIS(sc_if->sk_softc))
return sk_xmac_miibus_writereg(sc_if, phy, reg, val);
else
return sk_marv_miibus_writereg(sc_if, phy, reg, val);
}
static void
sk_miibus_statchg(device_t dev)
{
struct sk_if_softc *sc_if = device_get_softc(dev);
if (SK_IS_GENESIS(sc_if->sk_softc))
sk_xmac_miibus_statchg(sc_if);
else
sk_marv_miibus_statchg(sc_if);
}
static int
sk_xmac_miibus_readreg(struct sk_if_softc *sc_if, int phy, int reg)
{
int i;
DPRINTFN(9, ("sk_xmac_miibus_readreg\n"));
if (sc_if->sk_phytype == SK_PHYTYPE_XMAC && phy != 0)
return(0);
SK_XM_WRITE_2(sc_if, XM_PHY_ADDR, reg|(phy << 8));
SK_XM_READ_2(sc_if, XM_PHY_DATA);
if (sc_if->sk_phytype != SK_PHYTYPE_XMAC) {
for (i = 0; i < SK_TIMEOUT; i++) {
DELAY(1);
if (SK_XM_READ_2(sc_if, XM_MMUCMD) &
XM_MMUCMD_PHYDATARDY)
break;
}
if (i == SK_TIMEOUT) {
if_printf(&sc_if->arpcom.ac_if,
"phy failed to come ready\n");
return(0);
}
}
DELAY(1);
return(SK_XM_READ_2(sc_if, XM_PHY_DATA));
}
static int
sk_xmac_miibus_writereg(struct sk_if_softc *sc_if, int phy, int reg, int val)
{
int i;
DPRINTFN(9, ("sk_xmac_miibus_writereg\n"));
SK_XM_WRITE_2(sc_if, XM_PHY_ADDR, reg|(phy << 8));
for (i = 0; i < SK_TIMEOUT; i++) {
if ((SK_XM_READ_2(sc_if, XM_MMUCMD) & XM_MMUCMD_PHYBUSY) == 0)
break;
}
if (i == SK_TIMEOUT) {
if_printf(&sc_if->arpcom.ac_if, "phy failed to come ready\n");
return(ETIMEDOUT);
}
SK_XM_WRITE_2(sc_if, XM_PHY_DATA, val);
for (i = 0; i < SK_TIMEOUT; i++) {
DELAY(1);
if ((SK_XM_READ_2(sc_if, XM_MMUCMD) & XM_MMUCMD_PHYBUSY) == 0)
break;
}
if (i == SK_TIMEOUT)
if_printf(&sc_if->arpcom.ac_if, "phy write timed out\n");
return(0);
}
static void
sk_xmac_miibus_statchg(struct sk_if_softc *sc_if)
{
struct mii_data *mii;
mii = device_get_softc(sc_if->sk_miibus);
DPRINTFN(9, ("sk_xmac_miibus_statchg\n"));
if (sc_if->sk_phytype != SK_PHYTYPE_XMAC) {
if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX)
SK_XM_SETBIT_2(sc_if, XM_MMUCMD, XM_MMUCMD_GMIIFDX);
else
SK_XM_CLRBIT_2(sc_if, XM_MMUCMD, XM_MMUCMD_GMIIFDX);
}
}
static int
sk_marv_miibus_readreg(struct sk_if_softc *sc_if, int phy, int reg)
{
uint16_t val;
int i;
if (phy != 0 ||
(sc_if->sk_phytype != SK_PHYTYPE_MARV_COPPER &&
sc_if->sk_phytype != SK_PHYTYPE_MARV_FIBER)) {
DPRINTFN(9, ("sk_marv_miibus_readreg (skip) phy=%d, reg=%#x\n",
phy, reg));
return(0);
}
SK_YU_WRITE_2(sc_if, YUKON_SMICR, YU_SMICR_PHYAD(phy) |
YU_SMICR_REGAD(reg) | YU_SMICR_OP_READ);
for (i = 0; i < SK_TIMEOUT; i++) {
DELAY(1);
val = SK_YU_READ_2(sc_if, YUKON_SMICR);
if (val & YU_SMICR_READ_VALID)
break;
}
if (i == SK_TIMEOUT) {
if_printf(&sc_if->arpcom.ac_if, "phy failed to come ready\n");
return(0);
}
DPRINTFN(9, ("sk_marv_miibus_readreg: i=%d, timeout=%d\n", i,
SK_TIMEOUT));
val = SK_YU_READ_2(sc_if, YUKON_SMIDR);
DPRINTFN(9, ("sk_marv_miibus_readreg phy=%d, reg=%#x, val=%#x\n",
phy, reg, val));
return(val);
}
static int
sk_marv_miibus_writereg(struct sk_if_softc *sc_if, int phy, int reg, int val)
{
int i;
DPRINTFN(9, ("sk_marv_miibus_writereg phy=%d reg=%#x val=%#x\n",
phy, reg, val));
SK_YU_WRITE_2(sc_if, YUKON_SMIDR, val);
SK_YU_WRITE_2(sc_if, YUKON_SMICR, YU_SMICR_PHYAD(phy) |
YU_SMICR_REGAD(reg) | YU_SMICR_OP_WRITE);
for (i = 0; i < SK_TIMEOUT; i++) {
DELAY(1);
if (SK_YU_READ_2(sc_if, YUKON_SMICR) & YU_SMICR_BUSY)
break;
}
if (i == SK_TIMEOUT)
if_printf(&sc_if->arpcom.ac_if, "phy write timed out\n");
return(0);
}
static void
sk_marv_miibus_statchg(struct sk_if_softc *sc_if)
{
DPRINTFN(9, ("sk_marv_miibus_statchg: gpcr=%x\n",
SK_YU_READ_2(sc_if, YUKON_GPCR)));
}
#define HASH_BITS 6
static uint32_t
sk_xmac_hash(caddr_t addr)
{
uint32_t crc;
crc = ether_crc32_le(addr, ETHER_ADDR_LEN);
return (~crc & ((1 << HASH_BITS) - 1));
}
static uint32_t
sk_yukon_hash(caddr_t addr)
{
uint32_t crc;
crc = ether_crc32_be(addr, ETHER_ADDR_LEN);
return (crc & ((1 << HASH_BITS) - 1));
}
static void
sk_setfilt(struct sk_if_softc *sc_if, caddr_t addr, int slot)
{
int base;
base = XM_RXFILT_ENTRY(slot);
SK_XM_WRITE_2(sc_if, base, *(uint16_t *)(&addr[0]));
SK_XM_WRITE_2(sc_if, base + 2, *(uint16_t *)(&addr[2]));
SK_XM_WRITE_2(sc_if, base + 4, *(uint16_t *)(&addr[4]));
}
static void
sk_setmulti(struct sk_if_softc *sc_if)
{
struct sk_softc *sc = sc_if->sk_softc;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
uint32_t hashes[2] = { 0, 0 };
int h = 0, i;
struct ifmultiaddr *ifma;
uint8_t dummy[] = { 0, 0, 0, 0, 0 ,0 };
switch(sc->sk_type) {
case SK_GENESIS:
for (i = 1; i < XM_RXFILT_MAX; i++)
sk_setfilt(sc_if, (caddr_t)&dummy, i);
SK_XM_WRITE_4(sc_if, XM_MAR0, 0);
SK_XM_WRITE_4(sc_if, XM_MAR2, 0);
break;
case SK_YUKON:
case SK_YUKON_LITE:
case SK_YUKON_LP:
SK_YU_WRITE_2(sc_if, YUKON_MCAH1, 0);
SK_YU_WRITE_2(sc_if, YUKON_MCAH2, 0);
SK_YU_WRITE_2(sc_if, YUKON_MCAH3, 0);
SK_YU_WRITE_2(sc_if, YUKON_MCAH4, 0);
break;
}
if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
hashes[0] = 0xFFFFFFFF;
hashes[1] = 0xFFFFFFFF;
} else {
i = 1;
TAILQ_FOREACH_REVERSE(ifma, &ifp->if_multiaddrs, ifmultihead,
ifma_link) {
caddr_t maddr;
if (ifma->ifma_addr->sa_family != AF_LINK)
continue;
maddr = LLADDR((struct sockaddr_dl *)ifma->ifma_addr);
if (SK_IS_GENESIS(sc) && i < XM_RXFILT_MAX) {
sk_setfilt(sc_if, maddr, i);
i++;
continue;
}
switch(sc->sk_type) {
case SK_GENESIS:
h = sk_xmac_hash(maddr);
break;
case SK_YUKON:
case SK_YUKON_LITE:
case SK_YUKON_LP:
h = sk_yukon_hash(maddr);
break;
}
if (h < 32)
hashes[0] |= (1 << h);
else
hashes[1] |= (1 << (h - 32));
}
}
switch(sc->sk_type) {
case SK_GENESIS:
SK_XM_SETBIT_4(sc_if, XM_MODE, XM_MODE_RX_USE_HASH|
XM_MODE_RX_USE_PERFECT);
SK_XM_WRITE_4(sc_if, XM_MAR0, hashes[0]);
SK_XM_WRITE_4(sc_if, XM_MAR2, hashes[1]);
break;
case SK_YUKON:
case SK_YUKON_LITE:
case SK_YUKON_LP:
SK_YU_WRITE_2(sc_if, YUKON_MCAH1, hashes[0] & 0xffff);
SK_YU_WRITE_2(sc_if, YUKON_MCAH2, (hashes[0] >> 16) & 0xffff);
SK_YU_WRITE_2(sc_if, YUKON_MCAH3, hashes[1] & 0xffff);
SK_YU_WRITE_2(sc_if, YUKON_MCAH4, (hashes[1] >> 16) & 0xffff);
break;
}
}
static void
sk_setpromisc(struct sk_if_softc *sc_if)
{
struct sk_softc *sc = sc_if->sk_softc;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
switch(sc->sk_type) {
case SK_GENESIS:
if (ifp->if_flags & IFF_PROMISC)
SK_XM_SETBIT_4(sc_if, XM_MODE, XM_MODE_RX_PROMISC);
else
SK_XM_CLRBIT_4(sc_if, XM_MODE, XM_MODE_RX_PROMISC);
break;
case SK_YUKON:
case SK_YUKON_LITE:
case SK_YUKON_LP:
if (ifp->if_flags & IFF_PROMISC) {
SK_YU_CLRBIT_2(sc_if, YUKON_RCR,
YU_RCR_UFLEN | YU_RCR_MUFLEN);
} else {
SK_YU_SETBIT_2(sc_if, YUKON_RCR,
YU_RCR_UFLEN | YU_RCR_MUFLEN);
}
break;
}
}
static int
sk_init_rx_ring(struct sk_if_softc *sc_if)
{
struct sk_chain_data *cd = &sc_if->sk_cdata;
struct sk_ring_data *rd = &sc_if->sk_rdata;
int i, nexti, error;
bzero(rd->sk_rx_ring, SK_RX_RING_SIZE);
for (i = 0; i < SK_RX_RING_CNT; i++) {
bus_addr_t paddr;
if (i == (SK_RX_RING_CNT - 1))
nexti = 0;
else
nexti = i + 1;
paddr = rd->sk_rx_ring_paddr +
(nexti * sizeof(struct sk_rx_desc));
rd->sk_rx_ring[i].sk_next = htole32(SK_ADDR_LO(paddr));
rd->sk_rx_ring[i].sk_csum1_start = htole16(ETHER_HDR_LEN);
rd->sk_rx_ring[i].sk_csum2_start =
htole16(ETHER_HDR_LEN + sizeof(struct ip));
error = sk_newbuf(sc_if, i, 1);
if (error) {
if_printf(&sc_if->arpcom.ac_if,
"failed alloc of %dth mbuf\n", i);
return error;
}
}
cd->sk_rx_prod = 0;
cd->sk_rx_cons = 0;
return (0);
}
static int
sk_init_tx_ring(struct sk_if_softc *sc_if)
{
struct sk_ring_data *rd = &sc_if->sk_rdata;
int i, nexti;
bzero(rd->sk_tx_ring, SK_TX_RING_SIZE);
for (i = 0; i < SK_TX_RING_CNT; i++) {
bus_addr_t paddr;
if (i == (SK_TX_RING_CNT - 1))
nexti = 0;
else
nexti = i + 1;
paddr = rd->sk_tx_ring_paddr +
(nexti * sizeof(struct sk_tx_desc));
rd->sk_tx_ring[i].sk_next = htole32(SK_ADDR_LO(paddr));
}
sc_if->sk_cdata.sk_tx_prod = 0;
sc_if->sk_cdata.sk_tx_cons = 0;
sc_if->sk_cdata.sk_tx_cnt = 0;
return (0);
}
static int
sk_newbuf_jumbo(struct sk_if_softc *sc_if, int idx, int wait)
{
struct sk_jpool_entry *entry;
struct mbuf *m_new = NULL;
struct sk_rx_desc *r;
bus_addr_t paddr;
KKASSERT(idx < SK_RX_RING_CNT && idx >= 0);
MGETHDR(m_new, wait ? M_WAITOK : M_NOWAIT, MT_DATA);
if (m_new == NULL)
return ENOBUFS;
entry = sk_jalloc(sc_if);
if (entry == NULL) {
m_freem(m_new);
DPRINTFN(1, ("%s jumbo allocation failed -- packet "
"dropped!\n", sc_if->arpcom.ac_if.if_xname));
return ENOBUFS;
}
m_new->m_ext.ext_arg = entry;
m_new->m_ext.ext_buf = entry->buf;
m_new->m_ext.ext_free = sk_jfree;
m_new->m_ext.ext_ref = sk_jref;
m_new->m_ext.ext_size = SK_JLEN;
m_new->m_flags |= M_EXT;
m_new->m_data = m_new->m_ext.ext_buf;
m_new->m_len = m_new->m_pkthdr.len = m_new->m_ext.ext_size;
paddr = entry->paddr;
m_adj(m_new, ETHER_ALIGN);
paddr += ETHER_ALIGN;
sc_if->sk_cdata.sk_rx_mbuf[idx] = m_new;
r = &sc_if->sk_rdata.sk_rx_ring[idx];
r->sk_data_lo = htole32(SK_ADDR_LO(paddr));
r->sk_data_hi = htole32(SK_ADDR_HI(paddr));
r->sk_ctl = htole32(m_new->m_pkthdr.len | SK_RXSTAT);
return 0;
}
static int
sk_newbuf_std(struct sk_if_softc *sc_if, int idx, int wait)
{
struct mbuf *m_new = NULL;
struct sk_chain_data *cd = &sc_if->sk_cdata;
struct sk_rx_desc *r;
bus_dma_segment_t seg;
bus_dmamap_t map;
int error, nseg;
KKASSERT(idx < SK_RX_RING_CNT && idx >= 0);
m_new = m_getcl(wait ? M_WAITOK : M_NOWAIT, MT_DATA, M_PKTHDR);
if (m_new == NULL)
return ENOBUFS;
m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
m_adj(m_new, ETHER_ALIGN);
error = bus_dmamap_load_mbuf_segment(cd->sk_rx_dtag, cd->sk_rx_dmap_tmp,
m_new, &seg, 1, &nseg, BUS_DMA_NOWAIT);
if (error) {
m_freem(m_new);
if (wait) {
if_printf(&sc_if->arpcom.ac_if,
"could not map RX mbuf\n");
}
return error;
}
if (cd->sk_rx_mbuf[idx] != NULL) {
bus_dmamap_sync(cd->sk_rx_dtag, cd->sk_rx_dmap[idx],
BUS_DMASYNC_POSTREAD);
bus_dmamap_unload(cd->sk_rx_dtag, cd->sk_rx_dmap[idx]);
}
map = cd->sk_rx_dmap_tmp;
cd->sk_rx_dmap_tmp = cd->sk_rx_dmap[idx];
cd->sk_rx_dmap[idx] = map;
cd->sk_rx_mbuf[idx] = m_new;
r = &sc_if->sk_rdata.sk_rx_ring[idx];
r->sk_data_lo = htole32(SK_ADDR_LO(seg.ds_addr));
r->sk_data_hi = htole32(SK_ADDR_HI(seg.ds_addr));
r->sk_ctl = htole32(m_new->m_pkthdr.len | SK_RXSTAT);
return 0;
}
static struct sk_jpool_entry *
sk_jalloc(struct sk_if_softc *sc_if)
{
struct sk_chain_data *cd = &sc_if->sk_cdata;
struct sk_jpool_entry *entry;
lwkt_serialize_enter(&cd->sk_jpool_serializer);
entry = SLIST_FIRST(&cd->sk_jpool_free_ent);
if (entry != NULL) {
SLIST_REMOVE_HEAD(&cd->sk_jpool_free_ent, entry_next);
entry->inuse = 1;
} else {
DPRINTF(("no free jumbo buffer\n"));
}
lwkt_serialize_exit(&cd->sk_jpool_serializer);
return entry;
}
static void
sk_jfree(void *arg)
{
struct sk_jpool_entry *entry = arg;
struct sk_chain_data *cd = &entry->sc_if->sk_cdata;
if (&cd->sk_jpool_ent[entry->slot] != entry)
panic("%s: free wrong jumbo buffer", __func__);
else if (entry->inuse == 0)
panic("%s: jumbo buffer already freed", __func__);
lwkt_serialize_enter(&cd->sk_jpool_serializer);
atomic_subtract_int(&entry->inuse, 1);
if (entry->inuse == 0)
SLIST_INSERT_HEAD(&cd->sk_jpool_free_ent, entry, entry_next);
lwkt_serialize_exit(&cd->sk_jpool_serializer);
}
static void
sk_jref(void *arg)
{
struct sk_jpool_entry *entry = arg;
struct sk_chain_data *cd = &entry->sc_if->sk_cdata;
if (&cd->sk_jpool_ent[entry->slot] != entry)
panic("%s: free wrong jumbo buffer", __func__);
else if (entry->inuse == 0)
panic("%s: jumbo buffer already freed", __func__);
atomic_add_int(&entry->inuse, 1);
}
static int
sk_ifmedia_upd(struct ifnet *ifp)
{
struct sk_if_softc *sc_if = ifp->if_softc;
struct mii_data *mii;
mii = device_get_softc(sc_if->sk_miibus);
sk_init(sc_if);
mii_mediachg(mii);
return(0);
}
static void
sk_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
{
struct sk_if_softc *sc_if;
struct mii_data *mii;
sc_if = ifp->if_softc;
mii = device_get_softc(sc_if->sk_miibus);
mii_pollstat(mii);
ifmr->ifm_active = mii->mii_media_active;
ifmr->ifm_status = mii->mii_media_status;
}
static int
sk_ioctl(struct ifnet *ifp, u_long command, caddr_t data, struct ucred *cr)
{
struct sk_if_softc *sc_if = ifp->if_softc;
struct ifreq *ifr = (struct ifreq *)data;
struct mii_data *mii;
int error = 0;
ASSERT_SERIALIZED(ifp->if_serializer);
switch(command) {
case SIOCSIFMTU:
if (ifr->ifr_mtu > SK_JUMBO_MTU)
error = EINVAL;
else {
ifp->if_mtu = ifr->ifr_mtu;
ifp->if_flags &= ~IFF_RUNNING;
sk_init(sc_if);
}
break;
case SIOCSIFFLAGS:
if (ifp->if_flags & IFF_UP) {
if (ifp->if_flags & IFF_RUNNING) {
if ((ifp->if_flags ^ sc_if->sk_if_flags)
& IFF_PROMISC) {
sk_setpromisc(sc_if);
sk_setmulti(sc_if);
}
} else
sk_init(sc_if);
} else {
if (ifp->if_flags & IFF_RUNNING)
sk_stop(sc_if);
}
sc_if->sk_if_flags = ifp->if_flags;
break;
case SIOCADDMULTI:
case SIOCDELMULTI:
sk_setmulti(sc_if);
break;
case SIOCGIFMEDIA:
case SIOCSIFMEDIA:
mii = device_get_softc(sc_if->sk_miibus);
error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command);
break;
default:
error = ether_ioctl(ifp, command, data);
break;
}
return(error);
}
static int
skc_probe(device_t dev)
{
const struct skc_type *t;
uint16_t vid, did;
vid = pci_get_vendor(dev);
did = pci_get_device(dev);
if (vid == PCI_VENDOR_LINKSYS &&
did == PCI_PRODUCT_LINKSYS_EG1032 &&
pci_get_subdevice(dev) != SUBDEVICEID_LINKSYS_EG1032_REV2)
return ENXIO;
for (t = skc_devs; t->skc_name != NULL; t++) {
if (vid == t->skc_vid && did == t->skc_did) {
device_set_desc(dev, t->skc_name);
return 0;
}
}
return ENXIO;
}
static void
sk_reset(struct sk_softc *sc)
{
DPRINTFN(2, ("sk_reset\n"));
CSR_WRITE_2(sc, SK_CSR, SK_CSR_SW_RESET);
CSR_WRITE_2(sc, SK_CSR, SK_CSR_MASTER_RESET);
if (SK_IS_YUKON(sc))
CSR_WRITE_2(sc, SK_LINK_CTRL, SK_LINK_RESET_SET);
DELAY(1000);
CSR_WRITE_2(sc, SK_CSR, SK_CSR_SW_UNRESET);
DELAY(2);
CSR_WRITE_2(sc, SK_CSR, SK_CSR_MASTER_UNRESET);
if (SK_IS_YUKON(sc))
CSR_WRITE_2(sc, SK_LINK_CTRL, SK_LINK_RESET_CLEAR);
DPRINTFN(2, ("sk_reset: sk_csr=%x\n", CSR_READ_2(sc, SK_CSR)));
DPRINTFN(2, ("sk_reset: sk_link_ctrl=%x\n",
CSR_READ_2(sc, SK_LINK_CTRL)));
if (SK_IS_GENESIS(sc)) {
sk_win_write_2(sc, SK_PKTARB_CTL, SK_PKTARBCTL_UNRESET);
sk_win_write_2(sc, SK_RXPA1_TINIT, SK_PKTARB_TIMEOUT);
sk_win_write_2(sc, SK_TXPA1_TINIT, SK_PKTARB_TIMEOUT);
sk_win_write_2(sc, SK_RXPA2_TINIT, SK_PKTARB_TIMEOUT);
sk_win_write_2(sc, SK_TXPA2_TINIT, SK_PKTARB_TIMEOUT);
}
sk_win_write_4(sc, SK_RAMCTL, SK_RAMCTL_UNRESET);
KKASSERT(sc->sk_imtimer_ticks != 0 && sc->sk_imtime != 0);
sk_win_write_4(sc, SK_IMTIMERINIT, SK_IM_USECS(sc, sc->sk_imtime));
sk_win_write_4(sc, SK_IMMR, SK_ISR_TX1_S_EOF|SK_ISR_TX2_S_EOF|
SK_ISR_RX1_EOF|SK_ISR_RX2_EOF);
sk_win_write_1(sc, SK_IMTIMERCTL, SK_IMCTL_START);
}
static int
sk_probe(device_t dev)
{
struct sk_softc *sc = device_get_softc(device_get_parent(dev));
const char *revstr = "", *name = NULL;
char devname[80];
switch (sc->sk_type) {
case SK_GENESIS:
name = "SysKonnect GEnesis";
break;
case SK_YUKON:
name = "Marvell Yukon";
break;
case SK_YUKON_LITE:
name = "Marvell Yukon Lite";
switch (sc->sk_rev) {
case SK_YUKON_LITE_REV_A0:
revstr = " rev.A0";
break;
case SK_YUKON_LITE_REV_A1:
revstr = " rev.A1";
break;
case SK_YUKON_LITE_REV_A3:
revstr = " rev.A3";
break;
}
break;
case SK_YUKON_LP:
name = "Marvell Yukon LP";
break;
default:
return ENXIO;
}
ksnprintf(devname, sizeof(devname), "%s%s (0x%x)",
name, revstr, sc->sk_rev);
device_set_desc_copy(dev, devname);
return 0;
}
static int
sk_attach(device_t dev)
{
struct sk_softc *sc = device_get_softc(device_get_parent(dev));
struct sk_if_softc *sc_if = device_get_softc(dev);
struct ifnet *ifp = &sc_if->arpcom.ac_if;
int i, error, if_attached = 0;
if_initname(ifp, device_get_name(dev), device_get_unit(dev));
sc_if->sk_port = *(int *)device_get_ivars(dev);
KKASSERT(sc_if->sk_port == SK_PORT_A || sc_if->sk_port == SK_PORT_B);
sc_if->sk_softc = sc;
sc->sk_if[sc_if->sk_port] = sc_if;
kfree(device_get_ivars(dev), M_DEVBUF);
device_set_ivars(dev, NULL);
if (sc_if->sk_port == SK_PORT_A)
sc_if->sk_tx_bmu = SK_BMU_TXS_CSR0;
if (sc_if->sk_port == SK_PORT_B)
sc_if->sk_tx_bmu = SK_BMU_TXS_CSR1;
DPRINTFN(2, ("begin sk_attach: port=%d\n", sc_if->sk_port));
for (i = 0; i < ETHER_ADDR_LEN; i++) {
sc_if->arpcom.ac_enaddr[i] =
sk_win_read_1(sc, SK_MAC0_0 + (sc_if->sk_port * 8) + i);
}
if (sk_win_read_1(sc, SK_CONFIG) & SK_CONFIG_SINGLEMAC) {
uint32_t chunk, val;
chunk = sc->sk_ramsize / 2;
val = sc->sk_rboff / sizeof(uint64_t);
sc_if->sk_rx_ramstart = val;
val += (chunk / sizeof(uint64_t));
sc_if->sk_rx_ramend = val - 1;
sc_if->sk_tx_ramstart = val;
val += (chunk / sizeof(uint64_t));
sc_if->sk_tx_ramend = val - 1;
} else {
uint32_t chunk, val;
chunk = sc->sk_ramsize / 4;
val = (sc->sk_rboff + (chunk * 2 * sc_if->sk_port)) /
sizeof(uint64_t);
sc_if->sk_rx_ramstart = val;
val += (chunk / sizeof(uint64_t));
sc_if->sk_rx_ramend = val - 1;
sc_if->sk_tx_ramstart = val;
val += (chunk / sizeof(uint64_t));
sc_if->sk_tx_ramend = val - 1;
}
DPRINTFN(2, ("sk_attach: rx_ramstart=%#x rx_ramend=%#x\n"
" tx_ramstart=%#x tx_ramend=%#x\n",
sc_if->sk_rx_ramstart, sc_if->sk_rx_ramend,
sc_if->sk_tx_ramstart, sc_if->sk_tx_ramend));
sc_if->sk_phytype = sk_win_read_1(sc, SK_EPROM1) & 0xF;
if (SK_IS_GENESIS(sc)) {
switch (sc_if->sk_phytype) {
case SK_PHYTYPE_XMAC:
sc_if->sk_phyaddr = SK_PHYADDR_XMAC;
break;
case SK_PHYTYPE_BCOM:
sc_if->sk_phyaddr = SK_PHYADDR_BCOM;
break;
default:
device_printf(dev, "unsupported PHY type: %d\n",
sc_if->sk_phytype);
error = ENXIO;
goto fail;
}
}
if (SK_IS_YUKON(sc)) {
if ((sc_if->sk_phytype < SK_PHYTYPE_MARV_COPPER &&
sc->sk_pmd != 'L' && sc->sk_pmd != 'S')) {
sc_if->sk_phytype = SK_PHYTYPE_MARV_COPPER;
sc->sk_coppertype = 1;
}
sc_if->sk_phyaddr = SK_PHYADDR_MARV;
if (!(sc->sk_coppertype))
sc_if->sk_phytype = SK_PHYTYPE_MARV_FIBER;
}
error = sk_dma_alloc(dev);
if (error)
goto fail;
ifp->if_softc = sc_if;
ifp->if_mtu = ETHERMTU;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
ifp->if_ioctl = sk_ioctl;
ifp->if_start = sk_start;
ifp->if_watchdog = sk_watchdog;
ifp->if_init = sk_init;
ifp->if_baudrate = 1000000000;
ifq_set_maxlen(&ifp->if_snd, SK_TX_RING_CNT - 1);
ifq_set_ready(&ifp->if_snd);
ifp->if_capabilities = IFCAP_VLAN_MTU;
sc_if->sk_use_jumbo = 0;
ether_ifattach(ifp, sc_if->arpcom.ac_enaddr, &sc->sk_serializer);
if_attached = 1;
switch (sc->sk_type) {
case SK_GENESIS:
sk_init_xmac(sc_if);
break;
case SK_YUKON:
case SK_YUKON_LITE:
case SK_YUKON_LP:
sk_init_yukon(sc_if);
break;
default:
device_printf(dev, "unknown device type %d\n", sc->sk_type);
error = ENXIO;
goto fail;
}
DPRINTFN(2, ("sk_attach: 1\n"));
error = mii_phy_probe(dev, &sc_if->sk_miibus,
sk_ifmedia_upd, sk_ifmedia_sts);
if (error) {
device_printf(dev, "no PHY found!\n");
goto fail;
}
callout_init(&sc_if->sk_tick_timer);
DPRINTFN(2, ("sk_attach: end\n"));
return 0;
fail:
if (if_attached)
ether_ifdetach(ifp);
sk_detach(dev);
sc->sk_if[sc_if->sk_port] = NULL;
return error;
}
static int
skc_attach(device_t dev)
{
struct sk_softc *sc = device_get_softc(dev);
uint8_t skrs;
int *port;
int error, cpuid;
DPRINTFN(2, ("begin skc_attach\n"));
sc->sk_dev = dev;
lwkt_serialize_init(&sc->sk_serializer);
#ifndef BURN_BRIDGES
if (pci_get_powerstate(dev) != PCI_POWERSTATE_D0) {
uint32_t iobase, membase, irq;
iobase = pci_read_config(dev, SK_PCI_LOIO, 4);
membase = pci_read_config(dev, SK_PCI_LOMEM, 4);
irq = pci_read_config(dev, SK_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, SK_PCI_LOIO, iobase, 4);
pci_write_config(dev, SK_PCI_LOMEM, membase, 4);
pci_write_config(dev, SK_PCI_INTLINE, irq, 4);
}
#endif
pci_enable_busmaster(dev);
sc->sk_res_rid = SK_PCI_LOMEM;
sc->sk_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
&sc->sk_res_rid, RF_ACTIVE);
if (sc->sk_res == NULL) {
device_printf(dev, "couldn't map memory\n");
error = ENXIO;
goto fail;
}
sc->sk_btag = rman_get_bustag(sc->sk_res);
sc->sk_bhandle = rman_get_bushandle(sc->sk_res);
sc->sk_type = sk_win_read_1(sc, SK_CHIPVER);
sc->sk_rev = (sk_win_read_1(sc, SK_CONFIG) >> 4);
if (!SK_IS_GENESIS(sc) && !SK_IS_YUKON(sc)) {
device_printf(dev, "unknown chip type: %d\n", sc->sk_type);
error = ENXIO;
goto fail;
}
DPRINTFN(2, ("skc_attach: allocate interrupt\n"));
sc->sk_irq_rid = 0;
sc->sk_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->sk_irq_rid,
RF_SHAREABLE | RF_ACTIVE);
if (sc->sk_irq == NULL) {
device_printf(dev, "couldn't map interrupt\n");
error = ENXIO;
goto fail;
}
switch (sc->sk_type) {
case SK_GENESIS:
sc->sk_imtimer_ticks = SK_IMTIMER_TICKS_GENESIS;
break;
default:
sc->sk_imtimer_ticks = SK_IMTIMER_TICKS_YUKON;
break;
}
sc->sk_imtime = skc_imtime;
sk_reset(sc);
skrs = sk_win_read_1(sc, SK_EPROM0);
if (SK_IS_GENESIS(sc)) {
switch(skrs) {
case SK_RAMSIZE_512K_64:
sc->sk_ramsize = 0x80000;
sc->sk_rboff = SK_RBOFF_0;
break;
case SK_RAMSIZE_1024K_64:
sc->sk_ramsize = 0x100000;
sc->sk_rboff = SK_RBOFF_80000;
break;
case SK_RAMSIZE_1024K_128:
sc->sk_ramsize = 0x100000;
sc->sk_rboff = SK_RBOFF_0;
break;
case SK_RAMSIZE_2048K_128:
sc->sk_ramsize = 0x200000;
sc->sk_rboff = SK_RBOFF_0;
break;
default:
device_printf(dev, "unknown ram size: %d\n", skrs);
error = ENXIO;
goto fail;
}
} else {
if (skrs == 0x00)
sc->sk_ramsize = 0x20000;
else
sc->sk_ramsize = skrs * (1<<12);
sc->sk_rboff = SK_RBOFF_0;
}
DPRINTFN(2, ("skc_attach: ramsize=%d (%dk), rboff=%d\n",
sc->sk_ramsize, sc->sk_ramsize / 1024,
sc->sk_rboff));
sc->sk_pmd = sk_win_read_1(sc, SK_PMDTYPE);
if (sc->sk_pmd == 'T' || sc->sk_pmd == '1')
sc->sk_coppertype = 1;
else
sc->sk_coppertype = 0;
if (sc->sk_type == SK_YUKON || sc->sk_type == SK_YUKON_LP) {
uint32_t flashaddr;
uint8_t testbyte;
flashaddr = sk_win_read_4(sc, SK_EP_ADDR);
sk_win_write_1(sc, SK_EP_ADDR+3, 0xff);
testbyte = sk_win_read_1(sc, SK_EP_ADDR+3);
if (testbyte != 0) {
sc->sk_type = SK_YUKON_LITE;
sc->sk_rev = SK_YUKON_LITE_REV_A0;
sk_win_write_4(sc, SK_EP_ADDR, flashaddr);
}
}
SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
OID_AUTO, "imtime", CTLTYPE_INT | CTLFLAG_RW,
sc, 0, skc_sysctl_imtime, "I",
"Interrupt moderation time (usec).");
sc->sk_devs[SK_PORT_A] = device_add_child(dev, "sk", -1);
port = kmalloc(sizeof(*port), M_DEVBUF, M_WAITOK);
*port = SK_PORT_A;
device_set_ivars(sc->sk_devs[SK_PORT_A], port);
if (!(sk_win_read_1(sc, SK_CONFIG) & SK_CONFIG_SINGLEMAC)) {
sc->sk_devs[SK_PORT_B] = device_add_child(dev, "sk", -1);
port = kmalloc(sizeof(*port), M_DEVBUF, M_WAITOK);
*port = SK_PORT_B;
device_set_ivars(sc->sk_devs[SK_PORT_B], port);
}
CSR_WRITE_2(sc, SK_LED, SK_LED_GREEN_ON);
bus_generic_attach(dev);
cpuid = rman_get_cpuid(sc->sk_irq);
if (sc->sk_if[0] != NULL)
ifq_set_cpuid(&sc->sk_if[0]->arpcom.ac_if.if_snd, cpuid);
if (sc->sk_if[1] != NULL)
ifq_set_cpuid(&sc->sk_if[1]->arpcom.ac_if.if_snd, cpuid);
error = bus_setup_intr(dev, sc->sk_irq, INTR_MPSAFE, sk_intr, sc,
&sc->sk_intrhand, &sc->sk_serializer);
if (error) {
device_printf(dev, "couldn't set up irq\n");
goto fail;
}
return 0;
fail:
skc_detach(dev);
return error;
}
static int
sk_detach(device_t dev)
{
struct sk_if_softc *sc_if = device_get_softc(dev);
if (device_is_attached(dev)) {
struct sk_softc *sc = sc_if->sk_softc;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
lwkt_serialize_enter(ifp->if_serializer);
if (sc->sk_intrhand != NULL) {
if (sc->sk_if[SK_PORT_A] != NULL)
sk_stop(sc->sk_if[SK_PORT_A]);
if (sc->sk_if[SK_PORT_B] != NULL)
sk_stop(sc->sk_if[SK_PORT_B]);
bus_teardown_intr(sc->sk_dev, sc->sk_irq,
sc->sk_intrhand);
sc->sk_intrhand = NULL;
}
lwkt_serialize_exit(ifp->if_serializer);
ether_ifdetach(ifp);
}
if (sc_if->sk_miibus != NULL)
device_delete_child(dev, sc_if->sk_miibus);
sk_dma_free(dev);
return 0;
}
static int
skc_detach(device_t dev)
{
struct sk_softc *sc = device_get_softc(dev);
int *port;
#ifdef INVARIANTS
if (device_is_attached(dev)) {
KASSERT(sc->sk_intrhand == NULL,
("intr has not been torn down yet"));
}
#endif
if (sc->sk_devs[SK_PORT_A] != NULL) {
port = device_get_ivars(sc->sk_devs[SK_PORT_A]);
if (port != NULL) {
kfree(port, M_DEVBUF);
device_set_ivars(sc->sk_devs[SK_PORT_A], NULL);
}
device_delete_child(dev, sc->sk_devs[SK_PORT_A]);
}
if (sc->sk_devs[SK_PORT_B] != NULL) {
port = device_get_ivars(sc->sk_devs[SK_PORT_B]);
if (port != NULL) {
kfree(port, M_DEVBUF);
device_set_ivars(sc->sk_devs[SK_PORT_B], NULL);
}
device_delete_child(dev, sc->sk_devs[SK_PORT_B]);
}
if (sc->sk_irq != NULL) {
bus_release_resource(dev, SYS_RES_IRQ, sc->sk_irq_rid,
sc->sk_irq);
}
if (sc->sk_res != NULL) {
bus_release_resource(dev, SYS_RES_MEMORY, sc->sk_res_rid,
sc->sk_res);
}
return 0;
}
static int
sk_encap(struct sk_if_softc *sc_if, struct mbuf **m_head0, uint32_t *txidx)
{
struct sk_chain_data *cd = &sc_if->sk_cdata;
struct sk_ring_data *rd = &sc_if->sk_rdata;
struct sk_tx_desc *f = NULL;
uint32_t frag, cur, sk_ctl;
bus_dma_segment_t segs[SK_NTXSEG];
bus_dmamap_t map;
int i, error, maxsegs, nsegs;
DPRINTFN(2, ("sk_encap\n"));
maxsegs = SK_TX_RING_CNT - sc_if->sk_cdata.sk_tx_cnt - SK_NDESC_RESERVE;
KASSERT(maxsegs >= SK_NDESC_SPARE, ("not enough spare TX desc"));
if (maxsegs > SK_NTXSEG)
maxsegs = SK_NTXSEG;
cur = frag = *txidx;
#ifdef SK_DEBUG
if (skdebug >= 2)
sk_dump_mbuf(*m_head0);
#endif
map = cd->sk_tx_dmap[*txidx];
error = bus_dmamap_load_mbuf_defrag(cd->sk_tx_dtag, map, m_head0,
segs, maxsegs, &nsegs, BUS_DMA_NOWAIT);
if (error) {
m_freem(*m_head0);
*m_head0 = NULL;
return error;
}
DPRINTFN(2, ("sk_encap: nsegs=%d\n", nsegs));
bus_dmamap_sync(cd->sk_tx_dtag, map, BUS_DMASYNC_PREWRITE);
for (i = 0; i < nsegs; i++) {
f = &rd->sk_tx_ring[frag];
f->sk_data_lo = htole32(SK_ADDR_LO(segs[i].ds_addr));
f->sk_data_hi = htole32(SK_ADDR_HI(segs[i].ds_addr));
sk_ctl = segs[i].ds_len | SK_OPCODE_DEFAULT;
if (i == 0)
sk_ctl |= SK_TXCTL_FIRSTFRAG;
else
sk_ctl |= SK_TXCTL_OWN;
f->sk_ctl = htole32(sk_ctl);
cur = frag;
SK_INC(frag, SK_TX_RING_CNT);
}
cd->sk_tx_mbuf[cur] = *m_head0;
cd->sk_tx_dmap[*txidx] = cd->sk_tx_dmap[cur];
cd->sk_tx_dmap[cur] = map;
rd->sk_tx_ring[cur].sk_ctl |=
htole32(SK_TXCTL_LASTFRAG|SK_TXCTL_EOF_INTR);
rd->sk_tx_ring[*txidx].sk_ctl |= htole32(SK_TXCTL_OWN);
sc_if->sk_cdata.sk_tx_cnt += nsegs;
#ifdef SK_DEBUG
if (skdebug >= 2) {
struct sk_tx_desc *desc;
uint32_t idx;
for (idx = *txidx; idx != frag; SK_INC(idx, SK_TX_RING_CNT)) {
desc = &sc_if->sk_rdata->sk_tx_ring[idx];
sk_dump_txdesc(desc, idx);
}
}
#endif
*txidx = frag;
DPRINTFN(2, ("sk_encap: completed successfully\n"));
return (0);
}
static void
sk_start(struct ifnet *ifp, struct ifaltq_subque *ifsq)
{
struct sk_if_softc *sc_if = ifp->if_softc;
struct sk_softc *sc = sc_if->sk_softc;
uint32_t idx = sc_if->sk_cdata.sk_tx_prod;
int trans = 0;
ASSERT_ALTQ_SQ_DEFAULT(ifp, ifsq);
DPRINTFN(2, ("sk_start\n"));
if ((ifp->if_flags & IFF_RUNNING) == 0 || ifq_is_oactive(&ifp->if_snd))
return;
while (sc_if->sk_cdata.sk_tx_mbuf[idx] == NULL) {
struct mbuf *m_head;
if (SK_IS_OACTIVE(sc_if)) {
ifq_set_oactive(&ifp->if_snd);
break;
}
m_head = ifq_dequeue(&ifp->if_snd);
if (m_head == NULL)
break;
if (sk_encap(sc_if, &m_head, &idx)) {
if (sc_if->sk_cdata.sk_tx_cnt == 0) {
continue;
} else {
ifq_set_oactive(&ifp->if_snd);
break;
}
}
trans = 1;
BPF_MTAP(ifp, m_head);
}
if (!trans)
return;
if (idx != sc_if->sk_cdata.sk_tx_prod) {
sc_if->sk_cdata.sk_tx_prod = idx;
CSR_WRITE_4(sc, sc_if->sk_tx_bmu, SK_TXBMU_TX_START);
ifp->if_timer = 5;
}
}
static void
sk_watchdog(struct ifnet *ifp)
{
struct sk_if_softc *sc_if = ifp->if_softc;
ASSERT_SERIALIZED(ifp->if_serializer);
sk_txeof(sc_if);
if (sc_if->sk_cdata.sk_tx_cnt != 0) {
if_printf(&sc_if->arpcom.ac_if, "watchdog timeout\n");
IFNET_STAT_INC(ifp, oerrors, 1);
ifp->if_flags &= ~IFF_RUNNING;
sk_init(sc_if);
}
}
static void
skc_shutdown(device_t dev)
{
struct sk_softc *sc = device_get_softc(dev);
DPRINTFN(2, ("sk_shutdown\n"));
lwkt_serialize_enter(&sc->sk_serializer);
CSR_WRITE_2(sc, SK_LED, SK_LED_GREEN_OFF);
sk_reset(sc);
lwkt_serialize_exit(&sc->sk_serializer);
}
static __inline int
sk_rxvalid(struct sk_softc *sc, uint32_t stat, uint32_t len)
{
if (sc->sk_type == SK_GENESIS) {
if ((stat & XM_RXSTAT_ERRFRAME) == XM_RXSTAT_ERRFRAME ||
XM_RXSTAT_BYTES(stat) != len)
return (0);
} else {
if ((stat & (YU_RXSTAT_CRCERR | YU_RXSTAT_LONGERR |
YU_RXSTAT_MIIERR | YU_RXSTAT_BADFC | YU_RXSTAT_GOODFC |
YU_RXSTAT_JABBER)) != 0 ||
(stat & YU_RXSTAT_RXOK) != YU_RXSTAT_RXOK ||
YU_RXSTAT_BYTES(stat) != len)
return (0);
}
return (1);
}
static void
sk_rxeof(struct sk_if_softc *sc_if)
{
struct sk_softc *sc = sc_if->sk_softc;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
struct sk_chain_data *cd = &sc_if->sk_cdata;
struct sk_ring_data *rd = &sc_if->sk_rdata;
int i, max_frmlen;
DPRINTFN(2, ("sk_rxeof\n"));
i = cd->sk_rx_prod;
if (sc_if->sk_use_jumbo)
max_frmlen = SK_JUMBO_FRAMELEN;
else
max_frmlen = ETHER_MAX_LEN;
for (;;) {
struct sk_rx_desc *cur_desc;
uint32_t rxstat, sk_ctl;
#ifdef SK_RXCSUM
uint16_t csum1, csum2;
#endif
int cur, total_len;
struct mbuf *m;
cur = i;
cur_desc = &rd->sk_rx_ring[cur];
sk_ctl = le32toh(cur_desc->sk_ctl);
if (sk_ctl & SK_RXCTL_OWN) {
cd->sk_rx_prod = cur;
break;
}
rxstat = le32toh(cur_desc->sk_xmac_rxstat);
total_len = SK_RXBYTES(le32toh(cur_desc->sk_ctl));
#ifdef SK_RXCSUM
csum1 = le16toh(cur_desc->sk_csum1);
csum2 = le16toh(cur_desc->sk_csum2);
#endif
m = cd->sk_rx_mbuf[cur];
SK_INC(i, SK_RX_RING_CNT);
if ((sk_ctl & (SK_RXCTL_STATUS_VALID | SK_RXCTL_FIRSTFRAG |
SK_RXCTL_LASTFRAG)) != (SK_RXCTL_STATUS_VALID |
SK_RXCTL_FIRSTFRAG | SK_RXCTL_LASTFRAG) ||
total_len < SK_MIN_FRAMELEN || total_len > max_frmlen ||
sk_rxvalid(sc, rxstat, total_len) == 0) {
IFNET_STAT_INC(ifp, ierrors, 1);
cur_desc->sk_ctl = htole32(m->m_pkthdr.len | SK_RXSTAT);
continue;
}
if (sk_newbuf(sc_if, cur, 0)) {
IFNET_STAT_INC(ifp, ierrors, 1);
cur_desc->sk_ctl = htole32(m->m_pkthdr.len | SK_RXSTAT);
continue;
} else {
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = m->m_len = total_len;
}
#ifdef SK_RXCSUM
sk_rxcsum(ifp, m, csum1, csum2);
#endif
IFNET_STAT_INC(ifp, ipackets, 1);
ifp->if_input(ifp, m, NULL, -1);
}
}
#ifdef SK_RXCSUM
static void
sk_rxcsum(struct ifnet *ifp, struct mbuf *m,
const uint16_t csum1, const uint16_t csum2)
{
struct ether_header *eh;
struct ip *ip;
uint8_t *pp;
int hlen, len, plen;
uint16_t iph_csum, ipo_csum, ipd_csum, csum;
pp = mtod(m, uint8_t *);
plen = m->m_pkthdr.len;
if (plen < sizeof(*eh))
return;
eh = (struct ether_header *)pp;
iph_csum = in_addword(csum1, (~csum2 & 0xffff));
if (eh->ether_type == htons(ETHERTYPE_VLAN)) {
uint16_t *xp = (uint16_t *)pp;
xp = (uint16_t *)pp;
if (xp[1] != htons(ETHERTYPE_IP))
return;
iph_csum = in_addword(iph_csum, (~xp[0] & 0xffff));
iph_csum = in_addword(iph_csum, (~xp[1] & 0xffff));
xp = (uint16_t *)(pp + sizeof(struct ip));
iph_csum = in_addword(iph_csum, xp[0]);
iph_csum = in_addword(iph_csum, xp[1]);
pp += EVL_ENCAPLEN;
} else if (eh->ether_type != htons(ETHERTYPE_IP)) {
return;
}
pp += sizeof(*eh);
plen -= sizeof(*eh);
ip = (struct ip *)pp;
if (ip->ip_v != IPVERSION)
return;
hlen = ip->ip_hl << 2;
if (hlen < sizeof(struct ip))
return;
if (hlen > ntohs(ip->ip_len))
return;
if (plen != ntohs(ip->ip_len))
return;
len = hlen - sizeof(struct ip);
if (len > 0) {
uint16_t *p;
p = (uint16_t *)(ip + 1);
ipo_csum = 0;
for (ipo_csum = 0; len > 0; len -= sizeof(*p), p++)
ipo_csum = in_addword(ipo_csum, *p);
iph_csum = in_addword(iph_csum, ipo_csum);
ipd_csum = in_addword(csum2, (~ipo_csum & 0xffff));
} else {
ipd_csum = csum2;
}
if (iph_csum != 0xffff)
return;
m->m_pkthdr.csum_flags = CSUM_IP_CHECKED | CSUM_IP_VALID;
if (ip->ip_off & htons(IP_MF | IP_OFFMASK))
return;
pp += hlen;
if (ip->ip_p == IPPROTO_UDP) {
struct udphdr *uh = (struct udphdr *)pp;
if (uh->uh_sum == 0)
return;
} else if (ip->ip_p != IPPROTO_TCP) {
return;
}
csum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr,
htonl(ntohs(ip->ip_len) - hlen + ip->ip_p) + ipd_csum);
if (csum == 0xffff) {
m->m_pkthdr.csum_data = csum;
m->m_pkthdr.csum_flags |= (CSUM_DATA_VALID | CSUM_PSEUDO_HDR);
}
}
#endif
static void
sk_txeof(struct sk_if_softc *sc_if)
{
struct sk_chain_data *cd = &sc_if->sk_cdata;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
uint32_t idx;
DPRINTFN(2, ("sk_txeof\n"));
idx = cd->sk_tx_cons;
while (idx != cd->sk_tx_prod) {
struct sk_tx_desc *cur_tx;
uint32_t sk_ctl;
cur_tx = &sc_if->sk_rdata.sk_tx_ring[idx];
sk_ctl = le32toh(cur_tx->sk_ctl);
#ifdef SK_DEBUG
if (skdebug >= 2)
sk_dump_txdesc(cur_tx, idx);
#endif
if (sk_ctl & SK_TXCTL_OWN)
break;
if (sk_ctl & SK_TXCTL_LASTFRAG)
IFNET_STAT_INC(ifp, opackets, 1);
if (cd->sk_tx_mbuf[idx] != NULL) {
bus_dmamap_unload(cd->sk_tx_dtag, cd->sk_tx_dmap[idx]);
m_freem(cd->sk_tx_mbuf[idx]);
cd->sk_tx_mbuf[idx] = NULL;
}
sc_if->sk_cdata.sk_tx_cnt--;
SK_INC(idx, SK_TX_RING_CNT);
}
if (!SK_IS_OACTIVE(sc_if))
ifq_clr_oactive(&ifp->if_snd);
if (sc_if->sk_cdata.sk_tx_cnt == 0)
ifp->if_timer = 0;
sc_if->sk_cdata.sk_tx_cons = idx;
}
static void
sk_tick(void *xsc_if)
{
struct sk_if_softc *sc_if = xsc_if;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
struct mii_data *mii = device_get_softc(sc_if->sk_miibus);
int i;
DPRINTFN(2, ("sk_tick\n"));
lwkt_serialize_enter(ifp->if_serializer);
if ((ifp->if_flags & IFF_UP) == 0) {
lwkt_serialize_exit(ifp->if_serializer);
return;
}
if (sc_if->sk_phytype == SK_PHYTYPE_BCOM) {
sk_intr_bcom(sc_if);
lwkt_serialize_exit(ifp->if_serializer);
return;
}
for (i = 0; i < 3; i++) {
if (SK_XM_READ_2(sc_if, XM_GPIO) & XM_GPIO_GP0_SET)
break;
}
if (i != 3) {
callout_reset(&sc_if->sk_tick_timer, hz, sk_tick, sc_if);
lwkt_serialize_exit(ifp->if_serializer);
return;
}
SK_XM_CLRBIT_2(sc_if, XM_IMR, XM_IMR_GP0_SET);
SK_XM_READ_2(sc_if, XM_ISR);
mii_tick(mii);
callout_stop(&sc_if->sk_tick_timer);
lwkt_serialize_exit(ifp->if_serializer);
}
static void
sk_yukon_tick(void *xsc_if)
{
struct sk_if_softc *sc_if = xsc_if;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
struct mii_data *mii = device_get_softc(sc_if->sk_miibus);
lwkt_serialize_enter(ifp->if_serializer);
mii_tick(mii);
callout_reset(&sc_if->sk_tick_timer, hz, sk_yukon_tick, sc_if);
lwkt_serialize_exit(ifp->if_serializer);
}
static void
sk_intr_bcom(struct sk_if_softc *sc_if)
{
struct mii_data *mii = device_get_softc(sc_if->sk_miibus);
struct ifnet *ifp = &sc_if->arpcom.ac_if;
int status;
DPRINTFN(2, ("sk_intr_bcom\n"));
SK_XM_CLRBIT_2(sc_if, XM_MMUCMD, XM_MMUCMD_TX_ENB|XM_MMUCMD_RX_ENB);
status = sk_xmac_miibus_readreg(sc_if, SK_PHYADDR_BCOM, BRGPHY_MII_ISR);
if ((ifp->if_flags & IFF_RUNNING) == 0) {
sk_init_xmac(sc_if);
return;
}
if (status & (BRGPHY_ISR_LNK_CHG|BRGPHY_ISR_AN_PR)) {
int lstat;
lstat = sk_xmac_miibus_readreg(sc_if, SK_PHYADDR_BCOM,
BRGPHY_MII_AUXSTS);
if (!(lstat & BRGPHY_AUXSTS_LINK) && sc_if->sk_link) {
mii_mediachg(mii);
SK_IF_WRITE_1(sc_if, 0,
SK_LINKLED1_CTL, SK_LINKLED_OFF);
sc_if->sk_link = 0;
} else if (status & BRGPHY_ISR_LNK_CHG) {
sk_xmac_miibus_writereg(sc_if, SK_PHYADDR_BCOM,
BRGPHY_MII_IMR, 0xFF00);
mii_tick(mii);
sc_if->sk_link = 1;
SK_IF_WRITE_1(sc_if, 0, SK_LINKLED1_CTL,
SK_LINKLED_ON|SK_LINKLED_LINKSYNC_OFF|
SK_LINKLED_BLINK_OFF);
} else {
mii_tick(mii);
callout_reset(&sc_if->sk_tick_timer, hz,
sk_tick, sc_if);
}
}
SK_XM_SETBIT_2(sc_if, XM_MMUCMD, XM_MMUCMD_TX_ENB|XM_MMUCMD_RX_ENB);
}
static void
sk_intr_xmac(struct sk_if_softc *sc_if)
{
uint16_t status;
status = SK_XM_READ_2(sc_if, XM_ISR);
DPRINTFN(2, ("sk_intr_xmac\n"));
if (sc_if->sk_phytype == SK_PHYTYPE_XMAC &&
(status & (XM_ISR_GP0_SET | XM_ISR_AUTONEG_DONE))) {
if (status & XM_ISR_GP0_SET)
SK_XM_SETBIT_2(sc_if, XM_IMR, XM_IMR_GP0_SET);
callout_reset(&sc_if->sk_tick_timer, hz,
sk_tick, sc_if);
}
if (status & XM_IMR_TX_UNDERRUN)
SK_XM_SETBIT_4(sc_if, XM_MODE, XM_MODE_FLUSH_TXFIFO);
if (status & XM_IMR_RX_OVERRUN)
SK_XM_SETBIT_4(sc_if, XM_MODE, XM_MODE_FLUSH_RXFIFO);
}
static void
sk_intr_yukon(struct sk_if_softc *sc_if)
{
uint8_t status;
status = SK_IF_READ_1(sc_if, 0, SK_GMAC_ISR);
if ((status & SK_GMAC_INT_RX_OVER) != 0) {
SK_IF_WRITE_1(sc_if, 0, SK_RXMF1_CTRL_TEST,
SK_RFCTL_RX_FIFO_OVER);
}
if ((status & SK_GMAC_INT_TX_UNDER) != 0) {
SK_IF_WRITE_1(sc_if, 0, SK_RXMF1_CTRL_TEST,
SK_TFCTL_TX_FIFO_UNDER);
}
DPRINTFN(2, ("sk_intr_yukon status=%#x\n", status));
}
static void
sk_intr(void *xsc)
{
struct sk_softc *sc = xsc;
struct sk_if_softc *sc_if0 = sc->sk_if[SK_PORT_A];
struct sk_if_softc *sc_if1 = sc->sk_if[SK_PORT_B];
struct ifnet *ifp0 = NULL, *ifp1 = NULL;
uint32_t status;
ASSERT_SERIALIZED(&sc->sk_serializer);
status = CSR_READ_4(sc, SK_ISSR);
if (status == 0 || status == 0xffffffff)
return;
if (sc_if0 != NULL)
ifp0 = &sc_if0->arpcom.ac_if;
if (sc_if1 != NULL)
ifp1 = &sc_if1->arpcom.ac_if;
for (; (status &= sc->sk_intrmask) != 0;) {
if (sc_if0 && (status & SK_ISR_RX1_EOF)) {
sk_rxeof(sc_if0);
CSR_WRITE_4(sc, SK_BMU_RX_CSR0,
SK_RXBMU_CLR_IRQ_EOF|SK_RXBMU_RX_START);
}
if (sc_if1 && (status & SK_ISR_RX2_EOF)) {
sk_rxeof(sc_if1);
CSR_WRITE_4(sc, SK_BMU_RX_CSR1,
SK_RXBMU_CLR_IRQ_EOF|SK_RXBMU_RX_START);
}
if (sc_if0 && (status & SK_ISR_TX1_S_EOF)) {
sk_txeof(sc_if0);
CSR_WRITE_4(sc, SK_BMU_TXS_CSR0,
SK_TXBMU_CLR_IRQ_EOF);
}
if (sc_if1 && (status & SK_ISR_TX2_S_EOF)) {
sk_txeof(sc_if1);
CSR_WRITE_4(sc, SK_BMU_TXS_CSR1,
SK_TXBMU_CLR_IRQ_EOF);
}
if (sc_if0 && (status & SK_ISR_MAC1) &&
(ifp0->if_flags & IFF_RUNNING)) {
if (SK_IS_GENESIS(sc))
sk_intr_xmac(sc_if0);
else
sk_intr_yukon(sc_if0);
}
if (sc_if1 && (status & SK_ISR_MAC2) &&
(ifp1->if_flags & IFF_RUNNING)) {
if (SK_IS_GENESIS(sc))
sk_intr_xmac(sc_if1);
else
sk_intr_yukon(sc_if1);
}
if (status & SK_ISR_EXTERNAL_REG) {
if (sc_if0 != NULL &&
sc_if0->sk_phytype == SK_PHYTYPE_BCOM)
sk_intr_bcom(sc_if0);
if (sc_if1 != NULL &&
sc_if1->sk_phytype == SK_PHYTYPE_BCOM)
sk_intr_bcom(sc_if1);
}
status = CSR_READ_4(sc, SK_ISSR);
}
CSR_WRITE_4(sc, SK_IMR, sc->sk_intrmask);
if (ifp0 != NULL && !ifq_is_empty(&ifp0->if_snd))
if_devstart(ifp0);
if (ifp1 != NULL && !ifq_is_empty(&ifp1->if_snd))
if_devstart(ifp1);
}
static void
sk_init_xmac(struct sk_if_softc *sc_if)
{
struct sk_softc *sc = sc_if->sk_softc;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
static const struct sk_bcom_hack bhack[] = {
{ 0x18, 0x0c20 }, { 0x17, 0x0012 }, { 0x15, 0x1104 }, { 0x17, 0x0013 },
{ 0x15, 0x0404 }, { 0x17, 0x8006 }, { 0x15, 0x0132 }, { 0x17, 0x8006 },
{ 0x15, 0x0232 }, { 0x17, 0x800D }, { 0x15, 0x000F }, { 0x18, 0x0420 },
{ 0, 0 } };
DPRINTFN(2, ("sk_init_xmac\n"));
SK_IF_WRITE_2(sc_if, 0, SK_TXF1_MACCTL, SK_TXMACCTL_XMAC_UNRESET);
DELAY(1000);
SK_XM_SETBIT_2(sc_if, XM_GPIO, XM_GPIO_RESETMAC);
sc_if->sk_xmac_rev = XM_XMAC_REV(SK_XM_READ_4(sc_if, XM_DEVID));
if (sc_if->sk_phytype == SK_PHYTYPE_BCOM) {
int i = 0;
uint32_t val;
val = sk_win_read_4(sc, SK_GPIO);
if (sc_if->sk_port == SK_PORT_A)
val |= SK_GPIO_DIR0|SK_GPIO_DAT0;
else
val |= SK_GPIO_DIR2|SK_GPIO_DAT2;
sk_win_write_4(sc, SK_GPIO, val);
SK_XM_SETBIT_2(sc_if, XM_HWCFG, XM_HWCFG_GMIIMODE);
sk_xmac_miibus_writereg(sc_if, SK_PHYADDR_BCOM,
BRGPHY_MII_BMCR, BRGPHY_BMCR_RESET);
DELAY(10000);
sk_xmac_miibus_writereg(sc_if, SK_PHYADDR_BCOM,
BRGPHY_MII_IMR, 0xFFF0);
if (sk_xmac_miibus_readreg(sc_if, SK_PHYADDR_BCOM, 0x03)
== 0x6041) {
while(bhack[i].reg) {
sk_xmac_miibus_writereg(sc_if, SK_PHYADDR_BCOM,
bhack[i].reg, bhack[i].val);
i++;
}
}
}
SK_XM_WRITE_2(sc_if, XM_PAR0,
*(uint16_t *)(&sc_if->arpcom.ac_enaddr[0]));
SK_XM_WRITE_2(sc_if, XM_PAR1,
*(uint16_t *)(&sc_if->arpcom.ac_enaddr[2]));
SK_XM_WRITE_2(sc_if, XM_PAR2,
*(uint16_t *)(&sc_if->arpcom.ac_enaddr[4]));
SK_XM_SETBIT_4(sc_if, XM_MODE, XM_MODE_RX_USE_STATION);
if (ifp->if_flags & IFF_BROADCAST)
SK_XM_CLRBIT_4(sc_if, XM_MODE, XM_MODE_RX_NOBROAD);
else
SK_XM_SETBIT_4(sc_if, XM_MODE, XM_MODE_RX_NOBROAD);
SK_XM_SETBIT_2(sc_if, XM_RXCMD, XM_RXCMD_STRIPFCS);
SK_XM_SETBIT_2(sc_if, XM_TXCMD, XM_TXCMD_AUTOPAD);
if (sc_if->sk_use_jumbo) {
SK_XM_SETBIT_4(sc_if, XM_MODE, XM_MODE_RX_BADFRAMES|
XM_MODE_RX_GIANTS|XM_MODE_RX_RUNTS|XM_MODE_RX_CRCERRS|
XM_MODE_RX_INRANGELEN);
}
SK_XM_SETBIT_2(sc_if, XM_RXCMD, XM_RXCMD_BIGPKTOK);
SK_XM_WRITE_2(sc_if, XM_TX_REQTHRESH, SK_XM_TX_FIFOTHRESH);
sk_setpromisc(sc_if);
sk_setmulti(sc_if);
SK_XM_READ_2(sc_if, XM_ISR);
if (sc_if->sk_phytype == SK_PHYTYPE_XMAC)
SK_XM_WRITE_2(sc_if, XM_IMR, XM_INTRS);
else
SK_XM_WRITE_2(sc_if, XM_IMR, 0xFFFF);
switch(sc_if->sk_xmac_rev) {
case XM_XMAC_REV_B2:
sk_win_write_1(sc, SK_RCINIT_RX1, SK_RCINIT_XMAC_B2);
sk_win_write_1(sc, SK_RCINIT_TX1, SK_RCINIT_XMAC_B2);
sk_win_write_1(sc, SK_RCINIT_RX2, SK_RCINIT_XMAC_B2);
sk_win_write_1(sc, SK_RCINIT_TX2, SK_RCINIT_XMAC_B2);
sk_win_write_1(sc, SK_MINIT_RX1, SK_MINIT_XMAC_B2);
sk_win_write_1(sc, SK_MINIT_TX1, SK_MINIT_XMAC_B2);
sk_win_write_1(sc, SK_MINIT_RX2, SK_MINIT_XMAC_B2);
sk_win_write_1(sc, SK_MINIT_TX2, SK_MINIT_XMAC_B2);
sk_win_write_1(sc, SK_RECOVERY_CTL, SK_RECOVERY_XMAC_B2);
break;
case XM_XMAC_REV_C1:
sk_win_write_1(sc, SK_RCINIT_RX1, SK_RCINIT_XMAC_C1);
sk_win_write_1(sc, SK_RCINIT_TX1, SK_RCINIT_XMAC_C1);
sk_win_write_1(sc, SK_RCINIT_RX2, SK_RCINIT_XMAC_C1);
sk_win_write_1(sc, SK_RCINIT_TX2, SK_RCINIT_XMAC_C1);
sk_win_write_1(sc, SK_MINIT_RX1, SK_MINIT_XMAC_C1);
sk_win_write_1(sc, SK_MINIT_TX1, SK_MINIT_XMAC_C1);
sk_win_write_1(sc, SK_MINIT_RX2, SK_MINIT_XMAC_C1);
sk_win_write_1(sc, SK_MINIT_TX2, SK_MINIT_XMAC_C1);
sk_win_write_1(sc, SK_RECOVERY_CTL, SK_RECOVERY_XMAC_B2);
break;
default:
break;
}
sk_win_write_2(sc, SK_MACARB_CTL,
SK_MACARBCTL_UNRESET|SK_MACARBCTL_FASTOE_OFF);
sc_if->sk_link = 1;
}
static void
sk_init_yukon(struct sk_if_softc *sc_if)
{
uint32_t phy, v;
uint16_t reg;
struct sk_softc *sc;
int i;
sc = sc_if->sk_softc;
DPRINTFN(2, ("sk_init_yukon: start: sk_csr=%#x\n",
CSR_READ_4(sc_if->sk_softc, SK_CSR)));
if (sc->sk_type == SK_YUKON_LITE &&
sc->sk_rev >= SK_YUKON_LITE_REV_A3) {
v = sk_win_read_4(sc, SK_GPIO);
v |= SK_GPIO_DIR9 | SK_GPIO_DAT9;
sk_win_write_4(sc, SK_GPIO, v);
}
DPRINTFN(6, ("sk_init_yukon: 1\n"));
SK_IF_WRITE_4(sc_if, 0, SK_GPHY_CTRL, SK_GPHY_RESET_SET);
SK_IF_WRITE_4(sc_if, 0, SK_GMAC_CTRL, SK_GMAC_RESET_SET);
DELAY(1000);
DPRINTFN(6, ("sk_init_yukon: 2\n"));
if (sc->sk_type == SK_YUKON_LITE &&
sc->sk_rev >= SK_YUKON_LITE_REV_A3) {
v = sk_win_read_4(sc, SK_GPIO);
v |= SK_GPIO_DIR9;
v &= ~SK_GPIO_DAT9;
sk_win_write_4(sc, SK_GPIO, v);
}
phy = SK_GPHY_INT_POL_HI | SK_GPHY_DIS_FC | SK_GPHY_DIS_SLEEP |
SK_GPHY_ENA_XC | SK_GPHY_ANEG_ALL | SK_GPHY_ENA_PAUSE;
if (sc->sk_coppertype)
phy |= SK_GPHY_COPPER;
else
phy |= SK_GPHY_FIBER;
DPRINTFN(3, ("sk_init_yukon: phy=%#x\n", phy));
SK_IF_WRITE_4(sc_if, 0, SK_GPHY_CTRL, phy | SK_GPHY_RESET_SET);
DELAY(1000);
SK_IF_WRITE_4(sc_if, 0, SK_GPHY_CTRL, phy | SK_GPHY_RESET_CLEAR);
SK_IF_WRITE_4(sc_if, 0, SK_GMAC_CTRL, SK_GMAC_LOOP_OFF |
SK_GMAC_PAUSE_ON | SK_GMAC_RESET_CLEAR);
DPRINTFN(3, ("sk_init_yukon: gmac_ctrl=%#x\n",
SK_IF_READ_4(sc_if, 0, SK_GMAC_CTRL)));
DPRINTFN(6, ("sk_init_yukon: 3\n"));
DPRINTFN(6, ("sk_init_yukon: 4\n"));
SK_IF_READ_2(sc_if, 0, SK_GMAC_ISR);
DPRINTFN(6, ("sk_init_yukon: 4a\n"));
reg = SK_YU_READ_2(sc_if, YUKON_PAR);
DPRINTFN(6, ("sk_init_yukon: YUKON_PAR=%#x\n", reg));
reg |= YU_PAR_MIB_CLR;
DPRINTFN(6, ("sk_init_yukon: YUKON_PAR=%#x\n", reg));
DPRINTFN(6, ("sk_init_yukon: 4b\n"));
SK_YU_WRITE_2(sc_if, YUKON_PAR, reg);
DPRINTFN(6, ("sk_init_yukon: 5\n"));
reg &= ~YU_PAR_MIB_CLR;
SK_YU_WRITE_2(sc_if, YUKON_PAR, reg);
DPRINTFN(6, ("sk_init_yukon: 7\n"));
SK_YU_WRITE_2(sc_if, YUKON_RCR, YU_RCR_CRCR);
DPRINTFN(6, ("sk_init_yukon: 8\n"));
SK_YU_WRITE_2(sc_if, YUKON_TPR, YU_TPR_JAM_LEN(0x3) |
YU_TPR_JAM_IPG(0xb) | YU_TPR_JAM2DATA_IPG(0x1a) );
DPRINTFN(6, ("sk_init_yukon: 9\n"));
reg = YU_SMR_DATA_BLIND(0x1c) | YU_SMR_MFL_VLAN | YU_SMR_IPG_DATA(0x1e);
if (sc_if->sk_use_jumbo)
reg |= YU_SMR_MFL_JUMBO;
SK_YU_WRITE_2(sc_if, YUKON_SMR, reg);
DPRINTFN(6, ("sk_init_yukon: 10\n"));
for (i = 0; i < 3; i++) {
SK_YU_WRITE_2(sc_if, YUKON_SAL1 + i * 4,
sc_if->arpcom.ac_enaddr[i * 2] |
sc_if->arpcom.ac_enaddr[i * 2 + 1] << 8);
}
for (i = 0; i < 3; i++) {
reg = sk_win_read_2(sc_if->sk_softc,
SK_MAC1_0 + i * 2 + sc_if->sk_port * 8);
SK_YU_WRITE_2(sc_if, YUKON_SAL2 + i * 4, reg);
}
sk_setpromisc(sc_if);
DPRINTFN(6, ("sk_init_yukon: 11\n"));
sk_setmulti(sc_if);
DPRINTFN(6, ("sk_init_yukon: 12\n"));
SK_YU_WRITE_2(sc_if, YUKON_TIMR, 0);
SK_YU_WRITE_2(sc_if, YUKON_RIMR, 0);
SK_YU_WRITE_2(sc_if, YUKON_TRIMR, 0);
v = YU_RXSTAT_FOFL | YU_RXSTAT_CRCERR | YU_RXSTAT_MIIERR |
YU_RXSTAT_BADFC | YU_RXSTAT_GOODFC | YU_RXSTAT_RUNT |
YU_RXSTAT_JABBER;
SK_IF_WRITE_2(sc_if, 0, SK_RXMF1_FLUSH_MASK, v);
if (sc->sk_type == SK_YUKON_LITE && sc->sk_rev == SK_YUKON_LITE_REV_A0)
v = SK_TFCTL_OPERATION_ON;
else
v = SK_TFCTL_OPERATION_ON | SK_RFCTL_FIFO_FLUSH_ON;
SK_IF_WRITE_1(sc_if, 0, SK_RXMF1_CTRL_TEST, SK_RFCTL_RESET_CLEAR);
SK_IF_WRITE_2(sc_if, 0, SK_RXMF1_CTRL_TEST, v);
SK_IF_WRITE_2(sc_if, 0, SK_RXMF1_FLUSH_THRESHOLD,
SK_RFCTL_FIFO_THRESHOLD + 1);
SK_IF_WRITE_1(sc_if, 0, SK_TXMF1_CTRL_TEST, SK_TFCTL_RESET_CLEAR);
SK_IF_WRITE_2(sc_if, 0, SK_TXMF1_CTRL_TEST, SK_TFCTL_OPERATION_ON);
DPRINTFN(6, ("sk_init_yukon: end\n"));
}
static void
sk_init(void *xsc_if)
{
struct sk_if_softc *sc_if = xsc_if;
struct sk_softc *sc = sc_if->sk_softc;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
struct mii_data *mii = device_get_softc(sc_if->sk_miibus);
DPRINTFN(2, ("sk_init\n"));
ASSERT_SERIALIZED(ifp->if_serializer);
if (ifp->if_flags & IFF_RUNNING)
return;
sk_stop(sc_if);
if (ifp->if_mtu > ETHER_MAX_LEN)
sc_if->sk_use_jumbo = 1;
else
sc_if->sk_use_jumbo = 0;
DPRINTF(("use jumbo buffer: %s\n", sc_if->sk_use_jumbo ? "YES" : "NO"));
if (SK_IS_GENESIS(sc)) {
SK_IF_WRITE_1(sc_if, 0, SK_LINKLED1_CTL, SK_LINKLED_ON);
SK_IF_WRITE_1(sc_if, 0, SK_LINKLED1_CTL,
SK_LINKLED_LINKSYNC_ON);
SK_IF_WRITE_1(sc_if, 0, SK_RXLED1_CTL,
SK_RXLEDCTL_COUNTER_START);
SK_IF_WRITE_1(sc_if, 0, SK_TXLED1_CTL,
SK_TXLEDCTL_COUNTER_START);
}
SK_IF_WRITE_4(sc_if, 0, SK_DPT_INIT, SK_DPT_TIMER_MAX);
switch (sc->sk_type) {
case SK_GENESIS:
sk_init_xmac(sc_if);
break;
case SK_YUKON:
case SK_YUKON_LITE:
case SK_YUKON_LP:
sk_init_yukon(sc_if);
break;
}
mii_mediachg(mii);
if (SK_IS_GENESIS(sc)) {
SK_IF_WRITE_4(sc_if, 0, SK_RXF1_CTL, SK_FIFO_UNRESET);
SK_IF_WRITE_4(sc_if, 0, SK_RXF1_END, SK_FIFO_END);
SK_IF_WRITE_4(sc_if, 0, SK_RXF1_CTL, SK_FIFO_ON);
SK_IF_WRITE_4(sc_if, 0, SK_TXF1_CTL, SK_FIFO_UNRESET);
SK_IF_WRITE_4(sc_if, 0, SK_TXF1_END, SK_FIFO_END);
SK_IF_WRITE_4(sc_if, 0, SK_TXF1_CTL, SK_FIFO_ON);
}
SK_IF_WRITE_1(sc_if, 0, SK_TXAR1_COUNTERCTL,
SK_TXARCTL_ON | SK_TXARCTL_FSYNC_ON);
SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_CTLTST, SK_RBCTL_UNRESET);
SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_START, sc_if->sk_rx_ramstart);
SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_WR_PTR, sc_if->sk_rx_ramstart);
SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_RD_PTR, sc_if->sk_rx_ramstart);
SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_END, sc_if->sk_rx_ramend);
SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_CTLTST, SK_RBCTL_ON);
SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_CTLTST, SK_RBCTL_UNRESET);
SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_CTLTST, SK_RBCTL_STORENFWD_ON);
SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_START, sc_if->sk_tx_ramstart);
SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_WR_PTR, sc_if->sk_tx_ramstart);
SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_RD_PTR, sc_if->sk_tx_ramstart);
SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_END, sc_if->sk_tx_ramend);
SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_CTLTST, SK_RBCTL_ON);
SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_BMU_CSR, SK_RXBMU_ONLINE);
SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_CURADDR_LO,
SK_ADDR_LO(sc_if->sk_rdata.sk_rx_ring_paddr));
SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_CURADDR_HI,
SK_ADDR_HI(sc_if->sk_rdata.sk_rx_ring_paddr));
SK_IF_WRITE_4(sc_if, 1, SK_TXQS1_BMU_CSR, SK_TXBMU_ONLINE);
SK_IF_WRITE_4(sc_if, 1, SK_TXQS1_CURADDR_LO,
SK_ADDR_LO(sc_if->sk_rdata.sk_tx_ring_paddr));
SK_IF_WRITE_4(sc_if, 1, SK_TXQS1_CURADDR_HI,
SK_ADDR_HI(sc_if->sk_rdata.sk_tx_ring_paddr));
if (sk_init_rx_ring(sc_if) == ENOBUFS) {
if_printf(ifp, "initialization failed: "
"no memory for rx buffers\n");
sk_stop(sc_if);
return;
}
if (sk_init_tx_ring(sc_if) == ENOBUFS) {
if_printf(ifp, "initialization failed: "
"no memory for tx buffers\n");
sk_stop(sc_if);
return;
}
CSR_READ_4(sc, SK_ISSR);
if (sc_if->sk_port == SK_PORT_A)
sc->sk_intrmask |= SK_INTRS1;
else
sc->sk_intrmask |= SK_INTRS2;
sc->sk_intrmask |= SK_ISR_EXTERNAL_REG;
CSR_WRITE_4(sc, SK_IMR, sc->sk_intrmask);
SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_BMU_CSR, SK_RXBMU_RX_START);
if (SK_IS_GENESIS(sc)) {
SK_XM_CLRBIT_2(sc_if, XM_MMUCMD, XM_MMUCMD_IGNPAUSE);
SK_XM_SETBIT_2(sc_if, XM_MMUCMD,
XM_MMUCMD_TX_ENB|XM_MMUCMD_RX_ENB);
}
if (SK_IS_YUKON(sc)) {
uint16_t reg = SK_YU_READ_2(sc_if, YUKON_GPCR);
reg |= YU_GPCR_TXEN | YU_GPCR_RXEN;
#if 0
reg &= ~(YU_GPCR_SPEED | YU_GPCR_DPLX_DIS);
#endif
SK_YU_WRITE_2(sc_if, YUKON_GPCR, reg);
}
SK_IF_WRITE_4(sc_if, 0, SK_DPT_TIMER_CTRL, SK_DPT_TCTL_START);
CSR_WRITE_4(sc, sc_if->sk_tx_bmu, SK_TXBMU_TX_START);
ifp->if_flags |= IFF_RUNNING;
ifq_clr_oactive(&ifp->if_snd);
if (SK_IS_YUKON(sc))
callout_reset(&sc_if->sk_tick_timer, hz, sk_yukon_tick, sc_if);
}
static void
sk_stop(struct sk_if_softc *sc_if)
{
struct sk_softc *sc = sc_if->sk_softc;
struct ifnet *ifp = &sc_if->arpcom.ac_if;
struct sk_chain_data *cd = &sc_if->sk_cdata;
uint32_t val;
int i;
ASSERT_SERIALIZED(ifp->if_serializer);
DPRINTFN(2, ("sk_stop\n"));
callout_stop(&sc_if->sk_tick_timer);
ifp->if_flags &= ~IFF_RUNNING;
ifq_clr_oactive(&ifp->if_snd);
SK_IF_WRITE_4(sc_if, 0, SK_DPT_TIMER_CTRL, SK_DPT_TCTL_STOP);
CSR_WRITE_4(sc, sc_if->sk_tx_bmu, SK_TXBMU_TX_STOP);
for (i = 0; i < SK_TIMEOUT; i++) {
val = CSR_READ_4(sc, sc_if->sk_tx_bmu);
if (!(val & SK_TXBMU_TX_STOP))
break;
DELAY(1);
}
if (i == SK_TIMEOUT)
if_printf(ifp, "cannot stop transfer of Tx descriptors\n");
SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_BMU_CSR, SK_RXBMU_RX_STOP);
for (i = 0; i < SK_TIMEOUT; i++) {
val = SK_IF_READ_4(sc_if, 0, SK_RXQ1_BMU_CSR);
if (!(val & SK_RXBMU_RX_STOP))
break;
DELAY(1);
}
if (i == SK_TIMEOUT)
if_printf(ifp, "cannot stop transfer of Rx descriptors\n");
if (sc_if->sk_phytype == SK_PHYTYPE_BCOM) {
val = sk_win_read_4(sc, SK_GPIO);
if (sc_if->sk_port == SK_PORT_A) {
val |= SK_GPIO_DIR0;
val &= ~SK_GPIO_DAT0;
} else {
val |= SK_GPIO_DIR2;
val &= ~SK_GPIO_DAT2;
}
sk_win_write_4(sc, SK_GPIO, val);
}
SK_XM_SETBIT_2(sc_if, XM_GPIO, XM_GPIO_RESETMAC);
switch (sc->sk_type) {
case SK_GENESIS:
SK_IF_WRITE_2(sc_if, 0, SK_TXF1_MACCTL, SK_TXMACCTL_XMAC_RESET);
SK_IF_WRITE_4(sc_if, 0, SK_RXF1_CTL, SK_FIFO_RESET);
break;
case SK_YUKON:
case SK_YUKON_LITE:
case SK_YUKON_LP:
SK_IF_WRITE_1(sc_if,0, SK_RXMF1_CTRL_TEST, SK_RFCTL_RESET_SET);
SK_IF_WRITE_1(sc_if,0, SK_TXMF1_CTRL_TEST, SK_TFCTL_RESET_SET);
break;
}
SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_BMU_CSR, SK_RXBMU_OFFLINE);
SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_CTLTST, SK_RBCTL_RESET | SK_RBCTL_OFF);
SK_IF_WRITE_4(sc_if, 1, SK_TXQS1_BMU_CSR, SK_TXBMU_OFFLINE);
SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_CTLTST,
SK_RBCTL_RESET | SK_RBCTL_OFF);
SK_IF_WRITE_1(sc_if, 0, SK_TXAR1_COUNTERCTL, SK_TXARCTL_OFF);
SK_IF_WRITE_1(sc_if, 0, SK_RXLED1_CTL, SK_RXLEDCTL_COUNTER_STOP);
SK_IF_WRITE_1(sc_if, 0, SK_TXLED1_CTL, SK_RXLEDCTL_COUNTER_STOP);
SK_IF_WRITE_1(sc_if, 0, SK_LINKLED1_CTL, SK_LINKLED_OFF);
SK_IF_WRITE_1(sc_if, 0, SK_LINKLED1_CTL, SK_LINKLED_LINKSYNC_OFF);
if (sc_if->sk_port == SK_PORT_A)
sc->sk_intrmask &= ~SK_INTRS1;
else
sc->sk_intrmask &= ~SK_INTRS2;
CSR_WRITE_4(sc, SK_IMR, sc->sk_intrmask);
SK_XM_READ_2(sc_if, XM_ISR);
SK_XM_WRITE_2(sc_if, XM_IMR, 0xFFFF);
for (i = 0; i < SK_RX_RING_CNT; i++) {
if (cd->sk_rx_mbuf[i] != NULL) {
if (!sc_if->sk_use_jumbo) {
bus_dmamap_unload(cd->sk_rx_dtag,
cd->sk_rx_dmap[i]);
}
m_freem(cd->sk_rx_mbuf[i]);
cd->sk_rx_mbuf[i] = NULL;
}
}
for (i = 0; i < SK_TX_RING_CNT; i++) {
if (cd->sk_tx_mbuf[i] != NULL) {
bus_dmamap_unload(cd->sk_tx_dtag, cd->sk_tx_dmap[i]);
m_freem(cd->sk_tx_mbuf[i]);
cd->sk_tx_mbuf[i] = NULL;
}
}
}
#ifdef SK_DEBUG
static void
sk_dump_txdesc(struct sk_tx_desc *desc, int idx)
{
#define DESC_PRINT(X) \
if (X) \
kprintf("txdesc[%d]." #X "=%#x\n", \
idx, X);
DESC_PRINT(le32toh(desc->sk_ctl));
DESC_PRINT(le32toh(desc->sk_next));
DESC_PRINT(le32toh(desc->sk_data_lo));
DESC_PRINT(le32toh(desc->sk_data_hi));
DESC_PRINT(le32toh(desc->sk_xmac_txstat));
DESC_PRINT(le16toh(desc->sk_rsvd0));
DESC_PRINT(le16toh(desc->sk_csum_startval));
DESC_PRINT(le16toh(desc->sk_csum_startpos));
DESC_PRINT(le16toh(desc->sk_csum_writepos));
DESC_PRINT(le16toh(desc->sk_rsvd1));
#undef PRINT
}
static void
sk_dump_bytes(const char *data, int len)
{
int c, i, j;
for (i = 0; i < len; i += 16) {
kprintf("%08x ", i);
c = len - i;
if (c > 16) c = 16;
for (j = 0; j < c; j++) {
kprintf("%02x ", data[i + j] & 0xff);
if ((j & 0xf) == 7 && j > 0)
kprintf(" ");
}
for (; j < 16; j++)
kprintf(" ");
kprintf(" ");
for (j = 0; j < c; j++) {
int ch = data[i + j] & 0xff;
kprintf("%c", ' ' <= ch && ch <= '~' ? ch : ' ');
}
kprintf("\n");
if (c < 16)
break;
}
}
static void
sk_dump_mbuf(struct mbuf *m)
{
int count = m->m_pkthdr.len;
kprintf("m=%p, m->m_pkthdr.len=%d\n", m, m->m_pkthdr.len);
while (count > 0 && m) {
kprintf("m=%p, m->m_data=%p, m->m_len=%d\n",
m, m->m_data, m->m_len);
sk_dump_bytes(mtod(m, char *), m->m_len);
count -= m->m_len;
m = m->m_next;
}
}
#endif
static int
sk_jpool_alloc(device_t dev)
{
struct sk_if_softc *sc_if = device_get_softc(dev);
struct sk_chain_data *cd = &sc_if->sk_cdata;
bus_dmamem_t dmem;
bus_addr_t paddr;
caddr_t buf;
int error, i;
lwkt_serialize_init(&cd->sk_jpool_serializer);
error = bus_dmamem_coherent(cd->sk_buf_dtag, PAGE_SIZE , 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
SK_JMEM, BUS_DMA_WAITOK, &dmem);
if (error) {
device_printf(dev, "can't allocate jumbo frame pool\n");
return error;
}
cd->sk_jpool_dtag = dmem.dmem_tag;
cd->sk_jpool_dmap = dmem.dmem_map;
cd->sk_jpool = dmem.dmem_addr;
paddr = dmem.dmem_busaddr;
SLIST_INIT(&cd->sk_jpool_free_ent);
buf = cd->sk_jpool;
for (i = 0; i < SK_JSLOTS; i++) {
struct sk_jpool_entry *entry = &cd->sk_jpool_ent[i];
entry->sc_if = sc_if;
entry->inuse = 0;
entry->slot = i;
entry->buf = buf;
entry->paddr = paddr;
SLIST_INSERT_HEAD(&cd->sk_jpool_free_ent, entry, entry_next);
buf += SK_JLEN;
paddr += SK_JLEN;
}
return 0;
}
static void
sk_jpool_free(struct sk_if_softc *sc_if)
{
struct sk_chain_data *cd = &sc_if->sk_cdata;
if (cd->sk_jpool_dtag != NULL) {
bus_dmamap_unload(cd->sk_jpool_dtag, cd->sk_jpool_dmap);
bus_dmamem_free(cd->sk_jpool_dtag, cd->sk_jpool,
cd->sk_jpool_dmap);
bus_dma_tag_destroy(cd->sk_jpool_dtag);
cd->sk_jpool_dtag = NULL;
}
}
static int
sk_dma_alloc(device_t dev)
{
struct sk_if_softc *sc_if = device_get_softc(dev);
struct sk_chain_data *cd = &sc_if->sk_cdata;
struct sk_ring_data *rd = &sc_if->sk_rdata;
bus_dmamem_t dmem;
int i, j, error;
error = bus_dma_tag_create(NULL, 1, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
BUS_SPACE_MAXSIZE_32BIT, 0,
BUS_SPACE_MAXSIZE_32BIT,
0, &sc_if->sk_parent_dtag);
if (error) {
device_printf(dev, "can't create parent DMA tag\n");
return error;
}
error = bus_dma_tag_create(sc_if->sk_parent_dtag,
1, SK_RING_BOUNDARY,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
BUS_SPACE_MAXSIZE_32BIT, 0,
BUS_SPACE_MAXSIZE_32BIT,
0, &rd->sk_ring_dtag);
if (error) {
device_printf(dev, "can't create ring DMA tag\n");
return error;
}
error = bus_dma_tag_create(sc_if->sk_parent_dtag, 1, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
BUS_SPACE_MAXSIZE_32BIT, 0,
BUS_SPACE_MAXSIZE_32BIT,
0, &cd->sk_buf_dtag);
if (error) {
device_printf(dev, "can't create buf DMA tag\n");
return error;
}
error = bus_dmamem_coherent(rd->sk_ring_dtag, SK_RING_ALIGN, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
SK_TX_RING_SIZE,
BUS_DMA_WAITOK | BUS_DMA_ZERO, &dmem);
if (error) {
device_printf(dev, "can't allocate TX ring\n");
return error;
}
rd->sk_tx_ring_dtag = dmem.dmem_tag;
rd->sk_tx_ring_dmap = dmem.dmem_map;
rd->sk_tx_ring = dmem.dmem_addr;
rd->sk_tx_ring_paddr = dmem.dmem_busaddr;
error = bus_dmamem_coherent(rd->sk_ring_dtag, SK_RING_ALIGN, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
SK_RX_RING_SIZE,
BUS_DMA_WAITOK | BUS_DMA_ZERO, &dmem);
if (error) {
device_printf(dev, "can't allocate TX ring\n");
return error;
}
rd->sk_rx_ring_dtag = dmem.dmem_tag;
rd->sk_rx_ring_dmap = dmem.dmem_map;
rd->sk_rx_ring = dmem.dmem_addr;
rd->sk_rx_ring_paddr = dmem.dmem_busaddr;
error = sk_jpool_alloc(dev);
if (error) {
device_printf(dev, "jumbo buffer allocation failed\n");
return error;
}
error = bus_dma_tag_create(cd->sk_buf_dtag, 1, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
SK_JLEN, SK_NTXSEG, SK_JLEN,
BUS_DMA_ALLOCNOW | BUS_DMA_WAITOK |
BUS_DMA_ONEBPAGE,
&cd->sk_tx_dtag);
if (error) {
device_printf(dev, "can't create TX DMA tag\n");
return error;
}
for (i = 0; i < SK_TX_RING_CNT; i++) {
error = bus_dmamap_create(cd->sk_tx_dtag,
BUS_DMA_WAITOK | BUS_DMA_ONEBPAGE,
&cd->sk_tx_dmap[i]);
if (error) {
device_printf(dev, "can't create %dth TX DMA map\n", i);
for (j = 0; j < i; ++j) {
bus_dmamap_destroy(cd->sk_tx_dtag,
cd->sk_tx_dmap[i]);
}
bus_dma_tag_destroy(cd->sk_tx_dtag);
cd->sk_tx_dtag = NULL;
return error;
}
}
error = bus_dma_tag_create(cd->sk_buf_dtag, 1, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
MCLBYTES, 1, MCLBYTES,
BUS_DMA_ALLOCNOW | BUS_DMA_WAITOK,
&cd->sk_rx_dtag);
if (error) {
device_printf(dev, "can't create RX DMA tag\n");
return error;
}
error = bus_dmamap_create(cd->sk_rx_dtag, BUS_DMA_WAITOK,
&cd->sk_rx_dmap_tmp);
if (error) {
device_printf(dev, "can't create spare RX DMA map\n");
bus_dma_tag_destroy(cd->sk_rx_dtag);
cd->sk_rx_dtag = NULL;
return error;
}
for (i = 0; i < SK_RX_RING_CNT; ++i) {
error = bus_dmamap_create(cd->sk_rx_dtag, BUS_DMA_WAITOK,
&cd->sk_rx_dmap[i]);
if (error) {
device_printf(dev, "can't create %dth RX DMA map\n", i);
for (j = 0; j < i; ++j) {
bus_dmamap_destroy(cd->sk_rx_dtag,
cd->sk_rx_dmap[i]);
}
bus_dmamap_destroy(cd->sk_rx_dtag, cd->sk_rx_dmap_tmp);
bus_dma_tag_destroy(cd->sk_rx_dtag);
cd->sk_rx_dtag = NULL;
return error;
}
}
return 0;
}
static void
sk_dma_free(device_t dev)
{
struct sk_if_softc *sc_if = device_get_softc(dev);
struct sk_chain_data *cd = &sc_if->sk_cdata;
struct sk_ring_data *rd = &sc_if->sk_rdata;
int i;
if (cd->sk_tx_dtag != NULL) {
for (i = 0; i < SK_TX_RING_CNT; ++i) {
KASSERT(cd->sk_tx_mbuf[i] == NULL,
("sk_stop() is not called before %s()",
__func__));
bus_dmamap_destroy(cd->sk_tx_dtag, cd->sk_tx_dmap[i]);
}
bus_dma_tag_destroy(cd->sk_tx_dtag);
}
if (cd->sk_rx_dtag != NULL) {
for (i = 0; i < SK_RX_RING_CNT; ++i) {
KASSERT(cd->sk_rx_mbuf[i] == NULL,
("sk_stop() is not called before %s()",
__func__));
bus_dmamap_destroy(cd->sk_rx_dtag, cd->sk_rx_dmap[i]);
}
bus_dmamap_destroy(cd->sk_rx_dtag, cd->sk_rx_dmap_tmp);
bus_dma_tag_destroy(cd->sk_rx_dtag);
}
sk_jpool_free(sc_if);
if (rd->sk_rx_ring_dtag != NULL) {
bus_dmamap_unload(rd->sk_rx_ring_dtag, rd->sk_rx_ring_dmap);
bus_dmamem_free(rd->sk_rx_ring_dtag, rd->sk_rx_ring,
rd->sk_rx_ring_dmap);
bus_dma_tag_destroy(rd->sk_rx_ring_dtag);
}
if (rd->sk_tx_ring_dtag != NULL) {
bus_dmamap_unload(rd->sk_tx_ring_dtag, rd->sk_tx_ring_dmap);
bus_dmamem_free(rd->sk_tx_ring_dtag, rd->sk_tx_ring,
rd->sk_tx_ring_dmap);
bus_dma_tag_destroy(rd->sk_tx_ring_dtag);
}
if (rd->sk_ring_dtag != NULL)
bus_dma_tag_destroy(rd->sk_ring_dtag);
if (cd->sk_buf_dtag != NULL)
bus_dma_tag_destroy(cd->sk_buf_dtag);
if (sc_if->sk_parent_dtag != NULL)
bus_dma_tag_destroy(sc_if->sk_parent_dtag);
}
static int
skc_sysctl_imtime(SYSCTL_HANDLER_ARGS)
{
struct sk_softc *sc = arg1;
struct lwkt_serialize *slize = &sc->sk_serializer;
int error = 0, v;
lwkt_serialize_enter(slize);
v = sc->sk_imtime;
error = sysctl_handle_int(oidp, &v, 0, req);
if (error || req->newptr == NULL)
goto back;
if (v <= 0) {
error = EINVAL;
goto back;
}
if (sc->sk_imtime != v) {
sc->sk_imtime = v;
sk_win_write_4(sc, SK_IMTIMERINIT,
SK_IM_USECS(sc, sc->sk_imtime));
sk_win_write_4(sc, SK_IMTIMER, 0);
}
back:
lwkt_serialize_exit(slize);
return error;
}