#include "bpfilter.h"
#include "kstat.h"
#include "vlan.h"
#include <sys/param.h>
#include <sys/device.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/sockio.h>
#include <sys/systm.h>
#include <sys/atomic.h>
#include <sys/intrmap.h>
#include <sys/kstat.h>
#include <net/bpf.h>
#include <net/if.h>
#include <net/toeplitz.h>
#include <net/if_media.h>
#include <net/route.h>
#include <netinet/in.h>
#include <netinet/if_ether.h>
#include <netinet/ip.h>
#include <netinet/tcp.h>
#include <netinet/tcp_timer.h>
#include <netinet/tcp_var.h>
#include <netinet/udp.h>
#include <machine/bus.h>
#include <dev/pci/if_vmxreg.h>
#include <dev/pci/pcivar.h>
#include <dev/pci/pcidevs.h>
#define VMX_MAX_QUEUES MIN(VMXNET3_MAX_TX_QUEUES, VMXNET3_MAX_RX_QUEUES)
#define NTXDESC 512
#define NTXSEGS 8
#define NRXDESC 512
#define NTXCOMPDESC NTXDESC
#define NRXCOMPDESC (NRXDESC * 2)
#define VMXNET3_DRIVER_VERSION 0x00010000
#define VMX_TX_GEN htole32(VMXNET3_TX_GEN_M << VMXNET3_TX_GEN_S)
#define VMX_TXC_GEN htole32(VMXNET3_TXC_GEN_M << VMXNET3_TXC_GEN_S)
#define VMX_RX_GEN htole32(VMXNET3_RX_GEN_M << VMXNET3_RX_GEN_S)
#define VMX_RXC_GEN htole32(VMXNET3_RXC_GEN_M << VMXNET3_RXC_GEN_S)
struct vmx_dmamem {
bus_dmamap_t vdm_map;
bus_dma_segment_t vdm_seg;
int vdm_nsegs;
size_t vdm_size;
caddr_t vdm_kva;
};
#define VMX_DMA_MAP(_vdm) ((_vdm)->vdm_map)
#define VMX_DMA_DVA(_vdm) ((_vdm)->vdm_map->dm_segs[0].ds_addr)
#define VMX_DMA_KVA(_vdm) ((void *)(_vdm)->vdm_kva)
#define VMX_DMA_LEN(_vdm) ((_vdm)->vdm_size)
struct vmxnet3_softc;
struct vmxnet3_txring {
struct vmx_dmamem dmamem;
struct mbuf *m[NTXDESC];
bus_dmamap_t dmap[NTXDESC];
struct vmxnet3_txdesc *txd;
u_int32_t gen;
volatile u_int prod;
volatile u_int cons;
};
struct vmxnet3_rxring {
struct vmxnet3_softc *sc;
struct vmxnet3_rxq_shared *rs;
struct vmx_dmamem dmamem;
struct mbuf *m[NRXDESC];
bus_dmamap_t dmap[NRXDESC];
struct mutex mtx;
struct if_rxring rxr;
struct timeout refill;
struct vmxnet3_rxdesc *rxd;
bus_size_t rxh;
u_int fill;
u_int32_t gen;
u_int8_t rid;
};
struct vmxnet3_comp_ring {
struct vmx_dmamem dmamem;
union {
struct vmxnet3_txcompdesc *txcd;
struct vmxnet3_rxcompdesc *rxcd;
};
u_int next;
u_int32_t gen;
struct mbuf *sendmp;
struct mbuf *lastmp;
};
struct vmxnet3_txqueue {
struct vmxnet3_softc *sc;
struct vmxnet3_txring cmd_ring;
struct vmxnet3_comp_ring comp_ring;
struct vmxnet3_txq_shared *ts;
struct ifqueue *ifq;
caddr_t *bpfp;
struct kstat *txkstat;
unsigned int queue;
} __aligned(64);
struct vmxnet3_rxqueue {
struct vmxnet3_softc *sc;
struct vmxnet3_rxring cmd_ring[2];
struct vmxnet3_comp_ring comp_ring;
struct vmxnet3_rxq_shared *rs;
struct ifiqueue *ifiq;
struct kstat *rxkstat;
} __aligned(64);
struct vmxnet3_queue {
struct vmxnet3_txqueue tx;
struct vmxnet3_rxqueue rx;
struct vmxnet3_softc *sc;
char intrname[16];
void *ih;
int intr;
caddr_t bpf;
};
struct vmxnet3_softc {
struct device sc_dev;
struct arpcom sc_arpcom;
struct ifmedia sc_media;
bus_space_tag_t sc_iot0;
bus_space_tag_t sc_iot1;
bus_space_handle_t sc_ioh0;
bus_space_handle_t sc_ioh1;
bus_dma_tag_t sc_dmat;
void *sc_ih;
int sc_nqueues;
struct vmxnet3_queue *sc_q;
struct intrmap *sc_intrmap;
u_int sc_vrrs;
struct vmxnet3_driver_shared *sc_ds;
u_int8_t *sc_mcast;
struct vmxnet3_upt1_rss_conf *sc_rss;
#if NKSTAT > 0
struct rwlock sc_kstat_lock;
struct timeval sc_kstat_updated;
#endif
};
#define JUMBO_LEN ((16 * 1024) - 1)
#define DMAADDR(map) ((map)->dm_segs[0].ds_addr)
#define READ_BAR0(sc, reg) bus_space_read_4((sc)->sc_iot0, (sc)->sc_ioh0, reg)
#define READ_BAR1(sc, reg) bus_space_read_4((sc)->sc_iot1, (sc)->sc_ioh1, reg)
#define WRITE_BAR0(sc, reg, val) \
bus_space_write_4((sc)->sc_iot0, (sc)->sc_ioh0, reg, val)
#define WRITE_BAR1(sc, reg, val) \
bus_space_write_4((sc)->sc_iot1, (sc)->sc_ioh1, reg, val)
#define WRITE_CMD(sc, cmd) WRITE_BAR1(sc, VMXNET3_BAR1_CMD, cmd)
int vmxnet3_match(struct device *, void *, void *);
void vmxnet3_attach(struct device *, struct device *, void *);
int vmxnet3_dma_init(struct vmxnet3_softc *);
int vmxnet3_alloc_txring(struct vmxnet3_softc *, int, int);
int vmxnet3_alloc_rxring(struct vmxnet3_softc *, int, int);
void vmxnet3_txinit(struct vmxnet3_softc *, struct vmxnet3_txqueue *);
void vmxnet3_rxinit(struct vmxnet3_softc *, struct vmxnet3_rxqueue *);
void vmxnet3_txstop(struct vmxnet3_softc *, struct vmxnet3_txqueue *);
void vmxnet3_rxstop(struct vmxnet3_softc *, struct vmxnet3_rxqueue *);
void vmxnet3_link_state(struct vmxnet3_softc *);
void vmxnet3_enable_all_intrs(struct vmxnet3_softc *);
void vmxnet3_disable_all_intrs(struct vmxnet3_softc *);
int vmxnet3_intr(void *);
int vmxnet3_intr_intx(void *);
int vmxnet3_intr_event(void *);
int vmxnet3_intr_queue(void *);
void vmxnet3_evintr(struct vmxnet3_softc *);
void vmxnet3_txintr(struct vmxnet3_softc *, struct vmxnet3_txqueue *);
void vmxnet3_rxintr(struct vmxnet3_softc *, struct vmxnet3_rxqueue *);
void vmxnet3_rxfill_tick(void *);
void vmxnet3_rxfill(struct vmxnet3_rxring *);
void vmxnet3_iff(struct vmxnet3_softc *);
void vmxnet3_rx_offload(struct vmxnet3_rxcompdesc *, struct mbuf *);
void vmxnet3_stop(struct ifnet *);
void vmxnet3_reset(struct vmxnet3_softc *);
int vmxnet3_init(struct vmxnet3_softc *);
int vmxnet3_ioctl(struct ifnet *, u_long, caddr_t);
void vmxnet3_start(struct ifqueue *);
void vmxnet3_watchdog(struct ifnet *);
void vmxnet3_media_status(struct ifnet *, struct ifmediareq *);
int vmxnet3_media_change(struct ifnet *);
void *vmxnet3_dma_allocmem(struct vmxnet3_softc *, u_int, u_int, bus_addr_t *);
static int vmx_dmamem_alloc(struct vmxnet3_softc *, struct vmx_dmamem *,
bus_size_t, u_int);
#ifdef notyet
static void vmx_dmamem_free(struct vmxnet3_softc *, struct vmx_dmamem *);
#endif
#if NKSTAT > 0
static void vmx_kstat_init(struct vmxnet3_softc *);
static void vmx_kstat_txstats(struct vmxnet3_softc *,
struct vmxnet3_txqueue *, int);
static void vmx_kstat_rxstats(struct vmxnet3_softc *,
struct vmxnet3_rxqueue *, int);
#endif
const struct pci_matchid vmx_devices[] = {
{ PCI_VENDOR_VMWARE, PCI_PRODUCT_VMWARE_NET_3 }
};
const struct cfattach vmx_ca = {
sizeof(struct vmxnet3_softc), vmxnet3_match, vmxnet3_attach
};
struct cfdriver vmx_cd = {
NULL, "vmx", DV_IFNET
};
int
vmxnet3_match(struct device *parent, void *match, void *aux)
{
return (pci_matchbyid(aux, vmx_devices, nitems(vmx_devices)));
}
void
vmxnet3_attach(struct device *parent, struct device *self, void *aux)
{
struct vmxnet3_softc *sc = (void *)self;
struct pci_attach_args *pa = aux;
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
pci_intr_handle_t ih;
const char *intrstr;
u_int memtype, ver, macl, mach, intrcfg;
u_char enaddr[ETHER_ADDR_LEN];
int (*isr)(void *);
int msix = 0;
int i;
memtype = pci_mapreg_type(pa->pa_pc, pa->pa_tag, 0x10);
if (pci_mapreg_map(pa, 0x10, memtype, 0, &sc->sc_iot0, &sc->sc_ioh0,
NULL, NULL, 0)) {
printf(": failed to map BAR0\n");
return;
}
memtype = pci_mapreg_type(pa->pa_pc, pa->pa_tag, 0x14);
if (pci_mapreg_map(pa, 0x14, memtype, 0, &sc->sc_iot1, &sc->sc_ioh1,
NULL, NULL, 0)) {
printf(": failed to map BAR1\n");
return;
}
ver = READ_BAR1(sc, VMXNET3_BAR1_VRRS);
if (ISSET(ver, 0x2)) {
sc->sc_vrrs = 2;
} else if (ISSET(ver, 0x1)) {
sc->sc_vrrs = 1;
} else {
printf(": unsupported hardware version 0x%x\n", ver);
return;
}
WRITE_BAR1(sc, VMXNET3_BAR1_VRRS, sc->sc_vrrs);
ver = READ_BAR1(sc, VMXNET3_BAR1_UVRS);
if (!ISSET(ver, 0x1)) {
printf(": incompatible UPT version 0x%x\n", ver);
return;
}
WRITE_BAR1(sc, VMXNET3_BAR1_UVRS, 1);
sc->sc_dmat = pa->pa_dmat;
WRITE_CMD(sc, VMXNET3_CMD_GET_INTRCFG);
intrcfg = READ_BAR1(sc, VMXNET3_BAR1_CMD);
isr = vmxnet3_intr;
sc->sc_nqueues = 1;
switch (intrcfg & VMXNET3_INTRCFG_TYPE_MASK) {
case VMXNET3_INTRCFG_TYPE_AUTO:
case VMXNET3_INTRCFG_TYPE_MSIX:
msix = pci_intr_msix_count(pa);
if (msix > 0) {
if (pci_intr_map_msix(pa, 0, &ih) == 0) {
msix--;
if (msix == 0)
break;
isr = vmxnet3_intr_event;
sc->sc_intrmap = intrmap_create(&sc->sc_dev,
msix, MIN(VMX_MAX_QUEUES, IF_MAX_VECTORS),
INTRMAP_POWEROF2);
sc->sc_nqueues = intrmap_count(sc->sc_intrmap);
}
break;
}
case VMXNET3_INTRCFG_TYPE_MSI:
if (pci_intr_map_msi(pa, &ih) == 0)
break;
case VMXNET3_INTRCFG_TYPE_INTX:
isr = vmxnet3_intr_intx;
if (pci_intr_map(pa, &ih) == 0)
break;
printf(": failed to map interrupt\n");
return;
}
intrstr = pci_intr_string(pa->pa_pc, ih);
sc->sc_ih = pci_intr_establish(pa->pa_pc, ih, IPL_NET | IPL_MPSAFE,
isr, sc, self->dv_xname);
if (sc->sc_ih == NULL) {
printf(": unable to establish interrupt handler");
if (intrstr != NULL)
printf(" at %s", intrstr);
printf("\n");
return;
}
if (intrstr)
printf(": %s", intrstr);
sc->sc_q = mallocarray(sc->sc_nqueues, sizeof(*sc->sc_q),
M_DEVBUF, M_WAITOK|M_ZERO);
if (sc->sc_intrmap != NULL) {
for (i = 0; i < sc->sc_nqueues; i++) {
struct vmxnet3_queue *q;
int vec;
q = &sc->sc_q[i];
vec = i + 1;
if (pci_intr_map_msix(pa, vec, &ih) != 0) {
printf(", failed to map interrupt %d\n", vec);
return;
}
snprintf(q->intrname, sizeof(q->intrname), "%s:%d",
self->dv_xname, i);
q->ih = pci_intr_establish_cpu(pa->pa_pc, ih,
IPL_NET | IPL_MPSAFE,
intrmap_cpu(sc->sc_intrmap, i),
vmxnet3_intr_queue, q, q->intrname);
if (q->ih == NULL) {
printf(": unable to establish interrupt %d\n",
vec);
return;
}
q->intr = vec;
q->sc = sc;
}
}
if (vmxnet3_dma_init(sc)) {
printf(": failed to setup DMA\n");
return;
}
printf(", %d queue%s", sc->sc_nqueues, sc->sc_nqueues > 1 ? "s" : "");
WRITE_CMD(sc, VMXNET3_CMD_GET_MACL);
macl = READ_BAR1(sc, VMXNET3_BAR1_CMD);
enaddr[0] = macl;
enaddr[1] = macl >> 8;
enaddr[2] = macl >> 16;
enaddr[3] = macl >> 24;
WRITE_CMD(sc, VMXNET3_CMD_GET_MACH);
mach = READ_BAR1(sc, VMXNET3_BAR1_CMD);
enaddr[4] = mach;
enaddr[5] = mach >> 8;
WRITE_BAR1(sc, VMXNET3_BAR1_MACL, macl);
WRITE_BAR1(sc, VMXNET3_BAR1_MACH, mach);
printf(", address %s\n", ether_sprintf(enaddr));
bcopy(enaddr, sc->sc_arpcom.ac_enaddr, 6);
strlcpy(ifp->if_xname, self->dv_xname, IFNAMSIZ);
ifp->if_softc = sc;
ifp->if_flags = IFF_BROADCAST | IFF_MULTICAST | IFF_SIMPLEX;
ifp->if_xflags = IFXF_MPSAFE;
ifp->if_ioctl = vmxnet3_ioctl;
ifp->if_qstart = vmxnet3_start;
ifp->if_watchdog = vmxnet3_watchdog;
ifp->if_hardmtu = VMXNET3_MAX_MTU;
ifp->if_capabilities = IFCAP_VLAN_MTU;
if (sc->sc_ds->upt_features & UPT1_F_CSUM) {
ifp->if_capabilities |= IFCAP_CSUM_TCPv4 | IFCAP_CSUM_UDPv4;
ifp->if_capabilities |= IFCAP_CSUM_TCPv6 | IFCAP_CSUM_UDPv6;
}
ifp->if_capabilities |= IFCAP_TSOv4 | IFCAP_TSOv6;
if (sc->sc_vrrs == 2) {
ifp->if_xflags |= IFXF_LRO;
ifp->if_capabilities |= IFCAP_LRO;
}
#if NVLAN > 0
if (sc->sc_ds->upt_features & UPT1_F_VLAN)
ifp->if_capabilities |= IFCAP_VLAN_HWTAGGING;
#endif
ifq_init_maxlen(&ifp->if_snd, NTXDESC);
ifmedia_init(&sc->sc_media, IFM_IMASK, vmxnet3_media_change,
vmxnet3_media_status);
ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_AUTO, 0, NULL);
ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_10G_T|IFM_FDX, 0, NULL);
ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_10G_T, 0, NULL);
ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_1000_T|IFM_FDX, 0, NULL);
ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_1000_T, 0, NULL);
ifmedia_set(&sc->sc_media, IFM_ETHER|IFM_AUTO);
if_attach(ifp);
ether_ifattach(ifp);
vmxnet3_link_state(sc);
if_attach_queues(ifp, sc->sc_nqueues);
if_attach_iqueues(ifp, sc->sc_nqueues);
#if NKSTAT > 0
vmx_kstat_init(sc);
#endif
for (i = 0; i < sc->sc_nqueues; i++) {
struct vmxnet3_queue *q = &sc->sc_q[i];
struct ifiqueue *ifiq;
ifp->if_ifqs[i]->ifq_softc = &q->tx;
q->tx.ifq = ifp->if_ifqs[i];
ifiq = ifp->if_iqs[i];
q->rx.ifiq = ifiq;
#if NBPFILTER > 0
if (sc->sc_intrmap != NULL) {
bpfxattach(&q->bpf, q->intrname,
ifp, DLT_EN10MB, ETHER_HDR_LEN);
ifiq->ifiq_bpfp = &q->bpf;
}
q->tx.bpfp = &q->bpf;
#endif
#if NKSTAT > 0
vmx_kstat_txstats(sc, &sc->sc_q[i].tx, i);
vmx_kstat_rxstats(sc, &sc->sc_q[i].rx, i);
#endif
}
}
int
vmxnet3_dma_init(struct vmxnet3_softc *sc)
{
struct vmxnet3_driver_shared *ds;
struct vmxnet3_txq_shared *ts;
struct vmxnet3_rxq_shared *rs;
bus_addr_t ds_pa, qs_pa, mcast_pa;
int i, queue, qs_len, intr;
u_int major, minor, release_code, rev;
qs_len = sc->sc_nqueues * (sizeof *ts + sizeof *rs);
ts = vmxnet3_dma_allocmem(sc, qs_len, VMXNET3_DMADESC_ALIGN, &qs_pa);
if (ts == NULL)
return -1;
for (queue = 0; queue < sc->sc_nqueues; queue++)
sc->sc_q[queue].tx.ts = ts++;
rs = (void *)ts;
for (queue = 0; queue < sc->sc_nqueues; queue++)
sc->sc_q[queue].rx.rs = rs++;
for (queue = 0; queue < sc->sc_nqueues; queue++) {
intr = sc->sc_q[queue].intr;
if (vmxnet3_alloc_txring(sc, queue, intr))
return -1;
if (vmxnet3_alloc_rxring(sc, queue, intr))
return -1;
}
sc->sc_mcast = vmxnet3_dma_allocmem(sc, 682 * ETHER_ADDR_LEN, 32, &mcast_pa);
if (sc->sc_mcast == NULL)
return -1;
ds = vmxnet3_dma_allocmem(sc, sizeof *sc->sc_ds, 8, &ds_pa);
if (ds == NULL)
return -1;
sc->sc_ds = ds;
ds->magic = VMXNET3_REV1_MAGIC;
ds->version = VMXNET3_DRIVER_VERSION;
major = 0;
minor = 0;
release_code = 0;
rev = 0;
#ifdef __LP64__
ds->guest = release_code << 30 | rev << 22 | major << 14 | minor << 6
| VMXNET3_GOS_FREEBSD | VMXNET3_GOS_64BIT;
#else
ds->guest = release_code << 30 | rev << 22 | major << 14 | minor << 6
| VMXNET3_GOS_FREEBSD | VMXNET3_GOS_32BIT;
#endif
ds->vmxnet3_revision = 1;
ds->upt_version = 1;
ds->upt_features = UPT1_F_CSUM;
#if NVLAN > 0
ds->upt_features |= UPT1_F_VLAN;
#endif
ds->driver_data = ~0ULL;
ds->driver_data_len = 0;
ds->queue_shared = qs_pa;
ds->queue_shared_len = qs_len;
ds->mtu = VMXNET3_MAX_MTU;
ds->ntxqueue = sc->sc_nqueues;
ds->nrxqueue = sc->sc_nqueues;
ds->mcast_table = mcast_pa;
ds->automask = 1;
ds->nintr = 1 + (sc->sc_intrmap != NULL ? sc->sc_nqueues : 0);
ds->evintr = 0;
ds->ictrl = VMXNET3_ICTRL_DISABLE_ALL;
for (i = 0; i < ds->nintr; i++)
ds->modlevel[i] = UPT1_IMOD_ADAPTIVE;
if (sc->sc_nqueues > 1) {
struct vmxnet3_upt1_rss_conf *rsscfg;
bus_addr_t rss_pa;
rsscfg = vmxnet3_dma_allocmem(sc, sizeof(*rsscfg), 8, &rss_pa);
rsscfg->hash_type = UPT1_RSS_HASH_TYPE_TCP_IPV4 |
UPT1_RSS_HASH_TYPE_IPV4 |
UPT1_RSS_HASH_TYPE_TCP_IPV6 |
UPT1_RSS_HASH_TYPE_IPV6;
rsscfg->hash_func = UPT1_RSS_HASH_FUNC_TOEPLITZ;
rsscfg->hash_key_size = sizeof(rsscfg->hash_key);
stoeplitz_to_key(rsscfg->hash_key, sizeof(rsscfg->hash_key));
rsscfg->ind_table_size = sizeof(rsscfg->ind_table);
for (i = 0; i < sizeof(rsscfg->ind_table); i++)
rsscfg->ind_table[i] = i % sc->sc_nqueues;
ds->upt_features |= UPT1_F_RSS;
ds->rss.version = 1;
ds->rss.len = sizeof(*rsscfg);
ds->rss.paddr = rss_pa;
sc->sc_rss = rsscfg;
}
WRITE_BAR1(sc, VMXNET3_BAR1_DSL, ds_pa);
WRITE_BAR1(sc, VMXNET3_BAR1_DSH, (u_int64_t)ds_pa >> 32);
return 0;
}
int
vmxnet3_alloc_txring(struct vmxnet3_softc *sc, int queue, int intr)
{
struct vmxnet3_txqueue *tq = &sc->sc_q[queue].tx;
struct vmxnet3_txq_shared *ts;
struct vmxnet3_txring *ring = &tq->cmd_ring;
struct vmxnet3_comp_ring *comp_ring = &tq->comp_ring;
int idx;
tq->queue = queue;
if (vmx_dmamem_alloc(sc, &ring->dmamem,
NTXDESC * sizeof(struct vmxnet3_txdesc), 512) != 0)
return -1;
ring->txd = VMX_DMA_KVA(&ring->dmamem);
if (vmx_dmamem_alloc(sc, &comp_ring->dmamem,
NTXCOMPDESC * sizeof(comp_ring->txcd[0]), 512) != 0)
return -1;
comp_ring->txcd = VMX_DMA_KVA(&comp_ring->dmamem);
for (idx = 0; idx < NTXDESC; idx++) {
if (bus_dmamap_create(sc->sc_dmat, MAXMCLBYTES, NTXSEGS,
VMXNET3_TX_LEN_M, 0, BUS_DMA_NOWAIT | BUS_DMA_64BIT,
&ring->dmap[idx]))
return -1;
}
ts = tq->ts;
bzero(ts, sizeof *ts);
ts->npending = 0;
ts->intr_threshold = 1;
ts->cmd_ring = VMX_DMA_DVA(&ring->dmamem);
ts->cmd_ring_len = NTXDESC;
ts->comp_ring = VMX_DMA_DVA(&comp_ring->dmamem);
ts->comp_ring_len = NTXCOMPDESC;
ts->driver_data = ~0ULL;
ts->driver_data_len = 0;
ts->intr_idx = intr;
ts->stopped = 1;
ts->error = 0;
return 0;
}
int
vmxnet3_alloc_rxring(struct vmxnet3_softc *sc, int queue, int intr)
{
struct vmxnet3_rxqueue *rq = &sc->sc_q[queue].rx;
struct vmxnet3_rxq_shared *rs;
struct vmxnet3_rxring *ring;
struct vmxnet3_comp_ring *comp_ring;
int i, idx;
for (i = 0; i < 2; i++) {
ring = &rq->cmd_ring[i];
if (vmx_dmamem_alloc(sc, &ring->dmamem,
NRXDESC * sizeof(struct vmxnet3_rxdesc), 512) != 0)
return -1;
ring->rxd = VMX_DMA_KVA(&ring->dmamem);
}
comp_ring = &rq->comp_ring;
if (vmx_dmamem_alloc(sc, &comp_ring->dmamem,
NRXCOMPDESC * sizeof(comp_ring->rxcd[0]), 512) != 0)
return -1;
comp_ring->rxcd = VMX_DMA_KVA(&comp_ring->dmamem);
for (i = 0; i < 2; i++) {
ring = &rq->cmd_ring[i];
ring->sc = sc;
ring->rid = i;
mtx_init(&ring->mtx, IPL_NET);
timeout_set(&ring->refill, vmxnet3_rxfill_tick, ring);
for (idx = 0; idx < NRXDESC; idx++) {
if (bus_dmamap_create(sc->sc_dmat, JUMBO_LEN, 1,
JUMBO_LEN, 0, BUS_DMA_NOWAIT | BUS_DMA_64BIT,
&ring->dmap[idx]))
return -1;
}
ring->rs = rq->rs;
ring->rxh = (i == 0) ?
VMXNET3_BAR0_RXH1(queue) : VMXNET3_BAR0_RXH2(queue);
}
rs = rq->rs;
bzero(rs, sizeof *rs);
rs->cmd_ring[0] = VMX_DMA_DVA(&rq->cmd_ring[0].dmamem);
rs->cmd_ring[1] = VMX_DMA_DVA(&rq->cmd_ring[1].dmamem);
rs->cmd_ring_len[0] = NRXDESC;
rs->cmd_ring_len[1] = NRXDESC;
rs->comp_ring = VMX_DMA_DVA(&comp_ring->dmamem);
rs->comp_ring_len = NRXCOMPDESC;
rs->driver_data = ~0ULL;
rs->driver_data_len = 0;
rs->intr_idx = intr;
rs->stopped = 1;
rs->error = 0;
return 0;
}
void
vmxnet3_txinit(struct vmxnet3_softc *sc, struct vmxnet3_txqueue *tq)
{
struct vmxnet3_txring *ring = &tq->cmd_ring;
struct vmxnet3_comp_ring *comp_ring = &tq->comp_ring;
ring->cons = ring->prod = 0;
ring->gen = VMX_TX_GEN;
comp_ring->next = 0;
comp_ring->gen = VMX_TXC_GEN;
memset(VMX_DMA_KVA(&ring->dmamem), 0,
VMX_DMA_LEN(&ring->dmamem));
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem), BUS_DMASYNC_PREWRITE);
memset(VMX_DMA_KVA(&comp_ring->dmamem), 0,
VMX_DMA_LEN(&comp_ring->dmamem));
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&comp_ring->dmamem),
0, VMX_DMA_LEN(&comp_ring->dmamem), BUS_DMASYNC_PREREAD);
ifq_clr_oactive(tq->ifq);
}
void
vmxnet3_rxfill_tick(void *arg)
{
struct vmxnet3_rxring *ring = arg;
if (!mtx_enter_try(&ring->mtx))
return;
vmxnet3_rxfill(ring);
mtx_leave(&ring->mtx);
}
void
vmxnet3_rxfill(struct vmxnet3_rxring *ring)
{
struct vmxnet3_softc *sc = ring->sc;
struct vmxnet3_rxdesc *rxd;
struct mbuf *m;
bus_dmamap_t map;
u_int slots;
unsigned int prod;
uint32_t rgen;
uint32_t type = htole32(VMXNET3_BTYPE_HEAD << VMXNET3_RX_BTYPE_S);
if (ring->rid == 1)
type = htole32(VMXNET3_BTYPE_BODY << VMXNET3_RX_BTYPE_S);
MUTEX_ASSERT_LOCKED(&ring->mtx);
slots = if_rxr_get(&ring->rxr, NRXDESC);
if (slots == 0)
return;
prod = ring->fill;
rgen = ring->gen;
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem), BUS_DMASYNC_POSTWRITE);
do {
KASSERT(ring->m[prod] == NULL);
m = MCLGETL(NULL, M_DONTWAIT, JUMBO_LEN);
if (m == NULL)
break;
m->m_pkthdr.len = m->m_len = JUMBO_LEN;
m_adj(m, ETHER_ALIGN);
map = ring->dmap[prod];
if (bus_dmamap_load_mbuf(sc->sc_dmat, map, m, BUS_DMA_NOWAIT))
panic("load mbuf");
bus_dmamap_sync(sc->sc_dmat, map, 0, map->dm_mapsize,
BUS_DMASYNC_PREREAD);
ring->m[prod] = m;
rxd = &ring->rxd[prod];
rxd->rx_addr = htole64(DMAADDR(map));
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem),
BUS_DMASYNC_PREWRITE|BUS_DMASYNC_POSTWRITE);
rxd->rx_word2 = (htole32(m->m_pkthdr.len & VMXNET3_RX_LEN_M) <<
VMXNET3_RX_LEN_S) | type | rgen;
if (++prod == NRXDESC) {
prod = 0;
rgen ^= VMX_RX_GEN;
}
} while (--slots > 0);
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem), BUS_DMASYNC_PREWRITE);
if_rxr_put(&ring->rxr, slots);
ring->fill = prod;
ring->gen = rgen;
if (if_rxr_inuse(&ring->rxr) == 0)
timeout_add(&ring->refill, 1);
if (ring->rs->update_rxhead)
WRITE_BAR0(sc, ring->rxh, prod);
}
void
vmxnet3_rxinit(struct vmxnet3_softc *sc, struct vmxnet3_rxqueue *rq)
{
struct vmxnet3_rxring *ring;
struct vmxnet3_comp_ring *comp_ring;
int i;
for (i = 0; i < 2; i++) {
ring = &rq->cmd_ring[i];
if_rxr_init(&ring->rxr, 2, NRXDESC - 1);
ring->fill = 0;
ring->gen = VMX_RX_GEN;
memset(VMX_DMA_KVA(&ring->dmamem), 0,
VMX_DMA_LEN(&ring->dmamem));
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem), BUS_DMASYNC_PREWRITE);
mtx_enter(&ring->mtx);
vmxnet3_rxfill(ring);
mtx_leave(&ring->mtx);
}
comp_ring = &rq->comp_ring;
comp_ring->next = 0;
comp_ring->gen = VMX_RXC_GEN;
comp_ring->sendmp = NULL;
comp_ring->lastmp = NULL;
memset(VMX_DMA_KVA(&comp_ring->dmamem), 0,
VMX_DMA_LEN(&comp_ring->dmamem));
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&comp_ring->dmamem),
0, VMX_DMA_LEN(&comp_ring->dmamem), BUS_DMASYNC_PREREAD);
}
void
vmxnet3_txstop(struct vmxnet3_softc *sc, struct vmxnet3_txqueue *tq)
{
struct vmxnet3_txring *ring = &tq->cmd_ring;
struct vmxnet3_comp_ring *comp_ring = &tq->comp_ring;
struct ifqueue *ifq = tq->ifq;
int idx;
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&comp_ring->dmamem),
0, VMX_DMA_LEN(&comp_ring->dmamem), BUS_DMASYNC_POSTREAD);
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem), BUS_DMASYNC_POSTWRITE);
for (idx = 0; idx < NTXDESC; idx++) {
if (ring->m[idx]) {
bus_dmamap_unload(sc->sc_dmat, ring->dmap[idx]);
m_freem(ring->m[idx]);
ring->m[idx] = NULL;
}
}
ifq_purge(ifq);
ifq_clr_oactive(ifq);
}
void
vmxnet3_rxstop(struct vmxnet3_softc *sc, struct vmxnet3_rxqueue *rq)
{
struct vmxnet3_rxring *ring;
struct vmxnet3_comp_ring *comp_ring = &rq->comp_ring;
int i, idx;
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&comp_ring->dmamem),
0, VMX_DMA_LEN(&comp_ring->dmamem), BUS_DMASYNC_POSTREAD);
for (i = 0; i < 2; i++) {
ring = &rq->cmd_ring[i];
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem), BUS_DMASYNC_POSTWRITE);
timeout_del(&ring->refill);
for (idx = 0; idx < NRXDESC; idx++) {
struct mbuf *m = ring->m[idx];
if (m == NULL)
continue;
ring->m[idx] = NULL;
m_freem(m);
bus_dmamap_unload(sc->sc_dmat, ring->dmap[idx]);
}
}
}
void
vmxnet3_link_state(struct vmxnet3_softc *sc)
{
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
u_int x, link, speed;
WRITE_CMD(sc, VMXNET3_CMD_GET_LINK);
x = READ_BAR1(sc, VMXNET3_BAR1_CMD);
speed = x >> 16;
if (x & 1) {
ifp->if_baudrate = IF_Mbps(speed);
link = LINK_STATE_UP;
} else
link = LINK_STATE_DOWN;
if (ifp->if_link_state != link) {
ifp->if_link_state = link;
if_link_state_change(ifp);
}
}
static inline void
vmxnet3_enable_intr(struct vmxnet3_softc *sc, int irq)
{
WRITE_BAR0(sc, VMXNET3_BAR0_IMASK(irq), 0);
}
static inline void
vmxnet3_disable_intr(struct vmxnet3_softc *sc, int irq)
{
WRITE_BAR0(sc, VMXNET3_BAR0_IMASK(irq), 1);
}
void
vmxnet3_enable_all_intrs(struct vmxnet3_softc *sc)
{
int i;
sc->sc_ds->ictrl &= ~VMXNET3_ICTRL_DISABLE_ALL;
vmxnet3_enable_intr(sc, 0);
if (sc->sc_intrmap) {
for (i = 0; i < sc->sc_nqueues; i++)
vmxnet3_enable_intr(sc, sc->sc_q[i].intr);
}
}
void
vmxnet3_disable_all_intrs(struct vmxnet3_softc *sc)
{
int i;
sc->sc_ds->ictrl |= VMXNET3_ICTRL_DISABLE_ALL;
vmxnet3_disable_intr(sc, 0);
if (sc->sc_intrmap) {
for (i = 0; i < sc->sc_nqueues; i++)
vmxnet3_disable_intr(sc, sc->sc_q[i].intr);
}
}
int
vmxnet3_intr_intx(void *arg)
{
struct vmxnet3_softc *sc = arg;
if (READ_BAR1(sc, VMXNET3_BAR1_INTR) == 0)
return 0;
return (vmxnet3_intr(sc));
}
int
vmxnet3_intr(void *arg)
{
struct vmxnet3_softc *sc = arg;
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
if (sc->sc_ds->event) {
KERNEL_LOCK();
vmxnet3_evintr(sc);
KERNEL_UNLOCK();
}
if (ifp->if_flags & IFF_RUNNING) {
vmxnet3_rxintr(sc, &sc->sc_q[0].rx);
vmxnet3_txintr(sc, &sc->sc_q[0].tx);
vmxnet3_enable_intr(sc, 0);
}
return 1;
}
int
vmxnet3_intr_event(void *arg)
{
struct vmxnet3_softc *sc = arg;
if (sc->sc_ds->event) {
KERNEL_LOCK();
vmxnet3_evintr(sc);
KERNEL_UNLOCK();
}
vmxnet3_enable_intr(sc, 0);
return 1;
}
int
vmxnet3_intr_queue(void *arg)
{
struct vmxnet3_queue *q = arg;
vmxnet3_rxintr(q->sc, &q->rx);
vmxnet3_txintr(q->sc, &q->tx);
vmxnet3_enable_intr(q->sc, q->intr);
return 1;
}
void
vmxnet3_evintr(struct vmxnet3_softc *sc)
{
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
u_int event = sc->sc_ds->event;
struct vmxnet3_txq_shared *ts;
struct vmxnet3_rxq_shared *rs;
WRITE_BAR1(sc, VMXNET3_BAR1_EVENT, event);
if (event & VMXNET3_EVENT_LINK)
vmxnet3_link_state(sc);
if (event & (VMXNET3_EVENT_TQERROR | VMXNET3_EVENT_RQERROR)) {
WRITE_CMD(sc, VMXNET3_CMD_GET_STATUS);
ts = sc->sc_q[0].tx.ts;
if (ts->stopped)
printf("%s: TX error 0x%x\n", ifp->if_xname, ts->error);
rs = sc->sc_q[0].rx.rs;
if (rs->stopped)
printf("%s: RX error 0x%x\n", ifp->if_xname, rs->error);
vmxnet3_init(sc);
}
if (event & VMXNET3_EVENT_DIC)
printf("%s: device implementation change event\n",
ifp->if_xname);
if (event & VMXNET3_EVENT_DEBUG)
printf("%s: debug event\n", ifp->if_xname);
}
void
vmxnet3_txintr(struct vmxnet3_softc *sc, struct vmxnet3_txqueue *tq)
{
struct ifqueue *ifq = tq->ifq;
struct vmxnet3_txring *ring = &tq->cmd_ring;
struct vmxnet3_comp_ring *comp_ring = &tq->comp_ring;
struct vmxnet3_txcompdesc *txcd;
bus_dmamap_t map;
struct mbuf *m;
u_int prod, cons, next;
uint32_t rgen;
unsigned int done = 0;
prod = ring->prod;
cons = ring->cons;
if (cons == prod)
return;
next = comp_ring->next;
rgen = comp_ring->gen;
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&comp_ring->dmamem),
0, VMX_DMA_LEN(&comp_ring->dmamem), BUS_DMASYNC_POSTREAD);
do {
txcd = &comp_ring->txcd[next];
if ((txcd->txc_word3 & VMX_TXC_GEN) != rgen)
break;
if (++next == NTXCOMPDESC) {
next = 0;
rgen ^= VMX_TXC_GEN;
}
m = ring->m[cons];
ring->m[cons] = NULL;
KASSERT(m != NULL);
map = ring->dmap[cons];
bus_dmamap_unload(sc->sc_dmat, map);
m_freem(m);
cons = (letoh32(txcd->txc_word0) >> VMXNET3_TXC_EOPIDX_S) &
VMXNET3_TXC_EOPIDX_M;
cons++;
done = 1;
cons %= NTXDESC;
} while (cons != prod);
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&comp_ring->dmamem),
0, VMX_DMA_LEN(&comp_ring->dmamem), BUS_DMASYNC_PREREAD);
comp_ring->next = next;
comp_ring->gen = rgen;
ring->cons = cons;
if (done && ifq_is_oactive(ifq))
ifq_restart(ifq);
}
void
vmxnet3_rxintr(struct vmxnet3_softc *sc, struct vmxnet3_rxqueue *rq)
{
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
struct vmxnet3_comp_ring *comp_ring = &rq->comp_ring;
struct vmxnet3_rxring *ring;
struct vmxnet3_rxcompdesc *rxcd;
struct mbuf_list ml = MBUF_LIST_INITIALIZER();
struct mbuf *m;
bus_dmamap_t map;
unsigned int idx;
unsigned int next, rgen;
unsigned int rid, done[2] = {0, 0};
next = comp_ring->next;
rgen = comp_ring->gen;
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&comp_ring->dmamem),
0, VMX_DMA_LEN(&comp_ring->dmamem), BUS_DMASYNC_POSTREAD);
for (;;) {
rxcd = &comp_ring->rxcd[next];
if ((rxcd->rxc_word3 & VMX_RXC_GEN) != rgen)
break;
if (++next == NRXCOMPDESC) {
next = 0;
rgen ^= VMX_RXC_GEN;
}
idx = letoh32((rxcd->rxc_word0 >> VMXNET3_RXC_IDX_S) &
VMXNET3_RXC_IDX_M);
if (letoh32((rxcd->rxc_word0 >> VMXNET3_RXC_QID_S) &
VMXNET3_RXC_QID_M) < sc->sc_nqueues)
rid = 0;
else
rid = 1;
ring = &rq->cmd_ring[rid];
m = ring->m[idx];
KASSERT(m != NULL);
ring->m[idx] = NULL;
map = ring->dmap[idx];
bus_dmamap_sync(sc->sc_dmat, map, 0, map->dm_mapsize,
BUS_DMASYNC_POSTREAD);
bus_dmamap_unload(sc->sc_dmat, map);
done[rid]++;
if (letoh32((rxcd->rxc_word3 & VMXNET3_RXC_TYPE_M) >>
VMXNET3_RXC_TYPE_S) == 4 &&
ISSET(rxcd->rxc_word0, VMXNET3_RXC_SOP)) {
m->m_pkthdr.ph_mss = letoh32(rxcd->rxc_word1 &
VMXNET3_RXC_SEG_CNT_M);
}
m->m_len = letoh32((rxcd->rxc_word2 >> VMXNET3_RXC_LEN_S) &
VMXNET3_RXC_LEN_M);
if (comp_ring->sendmp == NULL) {
comp_ring->sendmp = comp_ring->lastmp = m;
comp_ring->sendmp->m_pkthdr.len = 0;
} else {
CLR(m->m_flags, M_PKTHDR);
comp_ring->lastmp->m_next = m;
comp_ring->lastmp = m;
}
comp_ring->sendmp->m_pkthdr.len += m->m_len;
if (!ISSET(rxcd->rxc_word0, VMXNET3_RXC_EOP))
continue;
if (letoh32(rxcd->rxc_word2 & VMXNET3_RXC_ERROR)) {
ifp->if_ierrors++;
m_freem(comp_ring->sendmp);
comp_ring->sendmp = comp_ring->lastmp = NULL;
continue;
}
if (comp_ring->sendmp->m_pkthdr.len < VMXNET3_MIN_MTU) {
m_freem(comp_ring->sendmp);
comp_ring->sendmp = comp_ring->lastmp = NULL;
continue;
}
if (((letoh32(rxcd->rxc_word0) >> VMXNET3_RXC_RSSTYPE_S) &
VMXNET3_RXC_RSSTYPE_M) != VMXNET3_RXC_RSSTYPE_NONE) {
comp_ring->sendmp->m_pkthdr.ph_flowid =
letoh32(rxcd->rxc_word1);
SET(comp_ring->sendmp->m_pkthdr.csum_flags, M_FLOWID);
}
vmxnet3_rx_offload(rxcd, comp_ring->sendmp);
ml_enqueue(&ml, comp_ring->sendmp);
comp_ring->sendmp = comp_ring->lastmp = NULL;
}
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&comp_ring->dmamem),
0, VMX_DMA_LEN(&comp_ring->dmamem), BUS_DMASYNC_PREREAD);
comp_ring->next = next;
comp_ring->gen = rgen;
for (int i = 0; i < 2; i++) {
if (done[i] == 0)
continue;
ring = &rq->cmd_ring[i];
if (ifiq_input(rq->ifiq, &ml))
if_rxr_livelocked(&ring->rxr);
mtx_enter(&ring->mtx);
if_rxr_put(&ring->rxr, done[i]);
vmxnet3_rxfill(ring);
mtx_leave(&ring->mtx);
}
}
void
vmxnet3_iff(struct vmxnet3_softc *sc)
{
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
struct arpcom *ac = &sc->sc_arpcom;
struct vmxnet3_driver_shared *ds = sc->sc_ds;
struct ether_multi *enm;
struct ether_multistep step;
u_int mode;
u_int8_t *p;
ds->mcast_tablelen = 0;
CLR(ifp->if_flags, IFF_ALLMULTI);
mode = VMXNET3_RXMODE_BCAST | VMXNET3_RXMODE_UCAST;
if (ISSET(ifp->if_flags, IFF_PROMISC) || ac->ac_multirangecnt > 0 ||
ac->ac_multicnt > 682) {
SET(ifp->if_flags, IFF_ALLMULTI);
SET(mode, (VMXNET3_RXMODE_ALLMULTI | VMXNET3_RXMODE_MCAST));
if (ifp->if_flags & IFF_PROMISC)
SET(mode, VMXNET3_RXMODE_PROMISC);
} else {
p = sc->sc_mcast;
ETHER_FIRST_MULTI(step, ac, enm);
while (enm != NULL) {
bcopy(enm->enm_addrlo, p, ETHER_ADDR_LEN);
p += ETHER_ADDR_LEN;
ETHER_NEXT_MULTI(step, enm);
}
if (ac->ac_multicnt > 0) {
SET(mode, VMXNET3_RXMODE_MCAST);
ds->mcast_tablelen = p - sc->sc_mcast;
}
}
WRITE_CMD(sc, VMXNET3_CMD_SET_FILTER);
ds->rxmode = mode;
WRITE_CMD(sc, VMXNET3_CMD_SET_RXMODE);
}
void
vmxnet3_rx_offload(struct vmxnet3_rxcompdesc *rxcd, struct mbuf *m)
{
uint32_t pkts;
#if NVLAN > 0
if (ISSET(rxcd->rxc_word2, VMXNET3_RXC_VLAN)) {
SET(m->m_flags, M_VLANTAG);
m->m_pkthdr.ether_vtag = letoh32((rxcd->rxc_word2 >>
VMXNET3_RXC_VLANTAG_S) & VMXNET3_RXC_VLANTAG_M);
}
#endif
if (ISSET(rxcd->rxc_word0, VMXNET3_RXC_NOCSUM))
return;
if (ISSET(rxcd->rxc_word3, VMXNET3_RXC_IPV4) &&
ISSET(rxcd->rxc_word3, VMXNET3_RXC_IPSUM_OK))
SET(m->m_pkthdr.csum_flags, M_IPV4_CSUM_IN_OK);
if (ISSET(rxcd->rxc_word3, VMXNET3_RXC_FRAGMENT))
return;
if (ISSET(rxcd->rxc_word3, VMXNET3_RXC_CSUM_OK)) {
if (ISSET(rxcd->rxc_word3, VMXNET3_RXC_TCP))
SET(m->m_pkthdr.csum_flags, M_TCP_CSUM_IN_OK);
else if (ISSET(rxcd->rxc_word3, VMXNET3_RXC_UDP))
SET(m->m_pkthdr.csum_flags, M_UDP_CSUM_IN_OK);
}
pkts = m->m_pkthdr.ph_mss;
m->m_pkthdr.ph_mss = 0;
if (pkts > 1) {
struct ether_extracted ext;
uint32_t paylen;
ether_extract_headers(m, &ext);
paylen = ext.iplen;
if (ext.ip4 || ext.ip6)
paylen -= ext.iphlen;
if (ext.tcp) {
paylen -= ext.tcphlen;
tcpstat_inc(tcps_inhwlro);
tcpstat_add(tcps_inpktlro, pkts);
} else {
tcpstat_inc(tcps_inbadlro);
}
if (ext.tcp && paylen >= pkts) {
SET(m->m_pkthdr.csum_flags, M_TCP_TSO);
m->m_pkthdr.ph_mss = paylen / pkts;
}
if (ext.tcp &&
ISSET(m->m_pkthdr.csum_flags, M_TCP_CSUM_IN_OK)) {
SET(m->m_pkthdr.csum_flags, M_TCP_CSUM_OUT);
}
}
}
void
vmxnet3_stop(struct ifnet *ifp)
{
struct vmxnet3_softc *sc = ifp->if_softc;
int queue;
ifp->if_flags &= ~IFF_RUNNING;
ifp->if_timer = 0;
vmxnet3_disable_all_intrs(sc);
WRITE_CMD(sc, VMXNET3_CMD_DISABLE);
if (sc->sc_intrmap != NULL) {
for (queue = 0; queue < sc->sc_nqueues; queue++)
intr_barrier(sc->sc_q[queue].ih);
} else
intr_barrier(sc->sc_ih);
for (queue = 0; queue < sc->sc_nqueues; queue++)
vmxnet3_txstop(sc, &sc->sc_q[queue].tx);
for (queue = 0; queue < sc->sc_nqueues; queue++)
vmxnet3_rxstop(sc, &sc->sc_q[queue].rx);
}
void
vmxnet3_reset(struct vmxnet3_softc *sc)
{
WRITE_CMD(sc, VMXNET3_CMD_RESET);
}
void
vmxnet4_set_features(struct vmxnet3_softc *sc)
{
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
if (ISSET(ifp->if_xflags, IFXF_LRO))
SET(sc->sc_ds->upt_features, UPT1_F_LRO);
else
CLR(sc->sc_ds->upt_features, UPT1_F_LRO);
WRITE_CMD(sc, VMXNET3_CMD_SET_FEATURE);
}
int
vmxnet3_init(struct vmxnet3_softc *sc)
{
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
int queue;
vmxnet3_stop(ifp);
#if 0
vmxnet3_reset(sc);
#endif
for (queue = 0; queue < sc->sc_nqueues; queue++)
vmxnet3_txinit(sc, &sc->sc_q[queue].tx);
for (queue = 0; queue < sc->sc_nqueues; queue++)
vmxnet3_rxinit(sc, &sc->sc_q[queue].rx);
for (queue = 0; queue < sc->sc_nqueues; queue++) {
WRITE_BAR0(sc, VMXNET3_BAR0_RXH1(queue), 0);
WRITE_BAR0(sc, VMXNET3_BAR0_RXH2(queue), 0);
}
WRITE_CMD(sc, VMXNET3_CMD_ENABLE);
if (READ_BAR1(sc, VMXNET3_BAR1_CMD)) {
printf("%s: failed to initialize\n", ifp->if_xname);
vmxnet3_stop(ifp);
return EIO;
}
vmxnet4_set_features(sc);
vmxnet3_iff(sc);
vmxnet3_enable_all_intrs(sc);
vmxnet3_link_state(sc);
ifp->if_flags |= IFF_RUNNING;
return 0;
}
static int
vmx_rxr_info(struct vmxnet3_softc *sc, struct if_rxrinfo *ifri)
{
struct if_rxring_info *ifrs, *ifr;
int error;
unsigned int i;
ifrs = mallocarray(sc->sc_nqueues, sizeof(*ifrs),
M_TEMP, M_WAITOK|M_ZERO|M_CANFAIL);
if (ifrs == NULL)
return (ENOMEM);
for (i = 0; i < sc->sc_nqueues; i++) {
struct if_rxring *rxr = &sc->sc_q[i].rx.cmd_ring[0].rxr;
ifr = &ifrs[i];
ifr->ifr_size = JUMBO_LEN;
snprintf(ifr->ifr_name, sizeof(ifr->ifr_name), "%u", i);
ifr->ifr_info = *rxr;
}
error = if_rxr_info_ioctl(ifri, i, ifrs);
free(ifrs, M_TEMP, i * sizeof(*ifrs));
return (error);
}
int
vmxnet3_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
{
struct vmxnet3_softc *sc = ifp->if_softc;
struct ifreq *ifr = (struct ifreq *)data;
int error = 0, s;
s = splnet();
switch (cmd) {
case SIOCSIFADDR:
ifp->if_flags |= IFF_UP;
if ((ifp->if_flags & IFF_RUNNING) == 0)
error = vmxnet3_init(sc);
break;
case SIOCSIFFLAGS:
if (ifp->if_flags & IFF_UP) {
if (ifp->if_flags & IFF_RUNNING)
error = ENETRESET;
else
error = vmxnet3_init(sc);
} else {
if (ifp->if_flags & IFF_RUNNING)
vmxnet3_stop(ifp);
}
break;
case SIOCSIFXFLAGS:
if (ISSET(ifr->ifr_flags, IFXF_LRO) !=
ISSET(ifp->if_xflags, IFXF_LRO)) {
if (ISSET(ifr->ifr_flags, IFXF_LRO))
SET(ifp->if_xflags, IFXF_LRO);
else
CLR(ifp->if_xflags, IFXF_LRO);
vmxnet4_set_features(sc);
}
break;
case SIOCSIFMEDIA:
case SIOCGIFMEDIA:
error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
break;
case SIOCGIFRXR:
error = vmx_rxr_info(sc, (struct if_rxrinfo *)ifr->ifr_data);
break;
default:
error = ether_ioctl(ifp, &sc->sc_arpcom, cmd, data);
}
if (error == ENETRESET) {
if (ifp->if_flags & IFF_RUNNING)
vmxnet3_iff(sc);
error = 0;
}
splx(s);
return error;
}
static inline int
vmx_load_mbuf(bus_dma_tag_t dmat, bus_dmamap_t map, struct mbuf *m)
{
int error;
error = bus_dmamap_load_mbuf(dmat, map, m,
BUS_DMA_STREAMING | BUS_DMA_NOWAIT);
if (error != EFBIG)
return (error);
error = m_defrag(m, M_DONTWAIT);
if (error != 0)
return (error);
return (bus_dmamap_load_mbuf(dmat, map, m,
BUS_DMA_STREAMING | BUS_DMA_NOWAIT));
}
void
vmxnet3_tx_offload(struct vmxnet3_txdesc *sop, struct mbuf *m)
{
struct ether_extracted ext;
uint32_t offset = 0;
uint32_t hdrlen;
#if NVLAN > 0
if (ISSET(m->m_flags, M_VLANTAG)) {
sop->tx_word3 |= htole32(VMXNET3_TX_VTAG_MODE);
sop->tx_word3 |= htole32((m->m_pkthdr.ether_vtag &
VMXNET3_TX_VLANTAG_M) << VMXNET3_TX_VLANTAG_S);
}
#endif
if (!ISSET(m->m_pkthdr.csum_flags, M_TCP_CSUM_OUT) &&
!ISSET(m->m_pkthdr.csum_flags, M_UDP_CSUM_OUT))
return;
ether_extract_headers(m, &ext);
hdrlen = sizeof(*ext.eh);
if (ext.evh)
hdrlen = sizeof(*ext.evh);
if (ext.ip4 || ext.ip6)
hdrlen += ext.iphlen;
if (ext.tcp)
offset = hdrlen + offsetof(struct tcphdr, th_sum);
else if (ext.udp)
offset = hdrlen + offsetof(struct udphdr, uh_sum);
else
return;
if (!ISSET(m->m_pkthdr.csum_flags, M_TCP_TSO)) {
hdrlen &= VMXNET3_TX_HLEN_M;
offset &= VMXNET3_TX_OP_M;
sop->tx_word3 |= htole32(VMXNET3_OM_CSUM << VMXNET3_TX_OM_S);
sop->tx_word3 |= htole32(hdrlen << VMXNET3_TX_HLEN_S);
sop->tx_word2 |= htole32(offset << VMXNET3_TX_OP_S);
return;
}
if (ext.tcp == NULL || m->m_pkthdr.ph_mss == 0) {
tcpstat_inc(tcps_outbadtso);
return;
}
if (ext.ip4)
ext.ip4->ip_sum = 0;
hdrlen += ext.tcphlen;
hdrlen &= VMXNET3_TX_HLEN_M;
sop->tx_word3 |= htole32(VMXNET3_OM_TSO << VMXNET3_TX_OM_S);
sop->tx_word3 |= htole32(hdrlen << VMXNET3_TX_HLEN_S);
sop->tx_word2 |= htole32(m->m_pkthdr.ph_mss << VMXNET3_TX_OP_S);
tcpstat_add(tcps_outpkttso, (m->m_pkthdr.len - hdrlen +
m->m_pkthdr.ph_mss - 1) / m->m_pkthdr.ph_mss);
}
void
vmxnet3_start(struct ifqueue *ifq)
{
struct ifnet *ifp = ifq->ifq_if;
struct vmxnet3_softc *sc = ifp->if_softc;
struct vmxnet3_txqueue *tq = ifq->ifq_softc;
struct vmxnet3_txring *ring = &tq->cmd_ring;
struct vmxnet3_txdesc *txd, *sop;
bus_dmamap_t map;
unsigned int prod, free, i;
unsigned int post = 0;
uint32_t rgen, gen;
#if NBPFILTER > 0
caddr_t if_bpf;
#endif
struct mbuf *m;
free = ring->cons;
prod = ring->prod;
if (free <= prod)
free += NTXDESC;
free -= prod;
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem), BUS_DMASYNC_POSTWRITE);
rgen = ring->gen;
for (;;) {
int hdrlen;
if (free <= NTXSEGS)
break;
m = ifq_dequeue(ifq);
if (m == NULL)
break;
hdrlen = sizeof(struct ether_header) + sizeof(struct ip) +
sizeof(struct tcphdr);
if (ISSET(m->m_pkthdr.csum_flags, M_TCP_TSO) &&
m->m_len < hdrlen && hdrlen <= m->m_pkthdr.len) {
hdrlen = MHLEN;
hdrlen -= mtod(m, unsigned long) & (sizeof(long) - 1);
if (hdrlen > m->m_pkthdr.len)
hdrlen = m->m_pkthdr.len;
if ((m = m_pullup(m, hdrlen)) == NULL) {
ifq->ifq_errors++;
continue;
}
}
map = ring->dmap[prod];
if (vmx_load_mbuf(sc->sc_dmat, map, m) != 0) {
ifq->ifq_errors++;
m_freem(m);
continue;
}
#if NBPFILTER > 0
if_bpf = ifp->if_bpf;
if (if_bpf)
bpf_mtap_ether(if_bpf, m, BPF_DIRECTION_OUT);
if_bpf = *tq->bpfp;
if (if_bpf)
bpf_mtap_ether(if_bpf, m, BPF_DIRECTION_OUT);
#endif
ring->m[prod] = m;
bus_dmamap_sync(sc->sc_dmat, map, 0,
map->dm_mapsize, BUS_DMASYNC_PREWRITE);
free -= map->dm_nsegs;
if (free <= NTXSEGS)
ifq_set_oactive(ifq);
gen = rgen ^ VMX_TX_GEN;
sop = &ring->txd[prod];
for (i = 0; i < map->dm_nsegs; i++) {
txd = &ring->txd[prod];
txd->tx_addr = htole64(map->dm_segs[i].ds_addr);
txd->tx_word2 = htole32(map->dm_segs[i].ds_len <<
VMXNET3_TX_LEN_S) | gen;
txd->tx_word3 = 0;
if (++prod == NTXDESC) {
prod = 0;
rgen ^= VMX_TX_GEN;
}
gen = rgen;
}
txd->tx_word3 = htole32(VMXNET3_TX_EOP | VMXNET3_TX_COMPREQ);
vmxnet3_tx_offload(sop, m);
ring->prod = prod;
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem),
BUS_DMASYNC_PREWRITE|BUS_DMASYNC_POSTWRITE);
sop->tx_word2 ^= VMX_TX_GEN;
post = 1;
}
bus_dmamap_sync(sc->sc_dmat, VMX_DMA_MAP(&ring->dmamem),
0, VMX_DMA_LEN(&ring->dmamem), BUS_DMASYNC_PREWRITE);
if (!post)
return;
ring->gen = rgen;
WRITE_BAR0(sc, VMXNET3_BAR0_TXH(tq->queue), prod);
}
void
vmxnet3_watchdog(struct ifnet *ifp)
{
struct vmxnet3_softc *sc = ifp->if_softc;
int s;
printf("%s: device timeout\n", ifp->if_xname);
s = splnet();
vmxnet3_init(sc);
splx(s);
}
void
vmxnet3_media_status(struct ifnet *ifp, struct ifmediareq *ifmr)
{
struct vmxnet3_softc *sc = ifp->if_softc;
vmxnet3_link_state(sc);
ifmr->ifm_status = IFM_AVALID;
ifmr->ifm_active = IFM_ETHER;
if (ifp->if_link_state != LINK_STATE_UP)
return;
ifmr->ifm_status |= IFM_ACTIVE;
if (ifp->if_baudrate >= IF_Gbps(10))
ifmr->ifm_active |= IFM_10G_T;
}
int
vmxnet3_media_change(struct ifnet *ifp)
{
return 0;
}
void *
vmxnet3_dma_allocmem(struct vmxnet3_softc *sc, u_int size, u_int align, bus_addr_t *pa)
{
bus_dma_tag_t t = sc->sc_dmat;
bus_dma_segment_t segs[1];
bus_dmamap_t map;
caddr_t va;
int n;
if (bus_dmamem_alloc(t, size, align, 0, segs, 1, &n,
BUS_DMA_NOWAIT | BUS_DMA_64BIT))
return NULL;
if (bus_dmamem_map(t, segs, 1, size, &va, BUS_DMA_NOWAIT))
return NULL;
if (bus_dmamap_create(t, size, 1, size, 0,
BUS_DMA_NOWAIT | BUS_DMA_64BIT, &map))
return NULL;
if (bus_dmamap_load(t, map, va, size, NULL, BUS_DMA_NOWAIT))
return NULL;
bzero(va, size);
*pa = DMAADDR(map);
bus_dmamap_unload(t, map);
bus_dmamap_destroy(t, map);
return va;
}
static int
vmx_dmamem_alloc(struct vmxnet3_softc *sc, struct vmx_dmamem *vdm,
bus_size_t size, u_int align)
{
vdm->vdm_size = size;
if (bus_dmamap_create(sc->sc_dmat, vdm->vdm_size, 1,
vdm->vdm_size, 0,
BUS_DMA_WAITOK | BUS_DMA_ALLOCNOW | BUS_DMA_64BIT,
&vdm->vdm_map) != 0)
return (1);
if (bus_dmamem_alloc(sc->sc_dmat, vdm->vdm_size,
align, 0, &vdm->vdm_seg, 1, &vdm->vdm_nsegs,
BUS_DMA_WAITOK | BUS_DMA_ZERO | BUS_DMA_64BIT) != 0)
goto destroy;
if (bus_dmamem_map(sc->sc_dmat, &vdm->vdm_seg, vdm->vdm_nsegs,
vdm->vdm_size, &vdm->vdm_kva, BUS_DMA_WAITOK) != 0)
goto free;
if (bus_dmamap_load(sc->sc_dmat, vdm->vdm_map, vdm->vdm_kva,
vdm->vdm_size, NULL, BUS_DMA_WAITOK) != 0)
goto unmap;
return (0);
unmap:
bus_dmamem_unmap(sc->sc_dmat, vdm->vdm_kva, vdm->vdm_size);
free:
bus_dmamem_free(sc->sc_dmat, &vdm->vdm_seg, 1);
destroy:
bus_dmamap_destroy(sc->sc_dmat, vdm->vdm_map);
return (1);
}
#ifdef notyet
static void
vmx_dmamem_free(struct vmxnet3_softc *sc, struct vmx_dmamem *vdm)
{
bus_dmamap_unload(sc->sc_dmat, vdm->vdm_map);
bus_dmamem_unmap(sc->sc_dmat, vdm->vdm_kva, vdm->vdm_size);
bus_dmamem_free(sc->sc_dmat, &vdm->vdm_seg, 1);
bus_dmamap_destroy(sc->sc_dmat, vdm->vdm_map);
}
#endif
#if NKSTAT > 0
static const struct timeval vmx_kstat_rate = { 1, 0 };
struct vmx_kstat_tpl {
const char *name;
enum kstat_kv_unit unit;
};
static const struct vmx_kstat_tpl vmx_rx_kstat_tpl[UPT1_RxStats_count] = {
{ "LRO packets", KSTAT_KV_U_PACKETS },
{ "LRO bytes", KSTAT_KV_U_BYTES },
{ "ucast packets", KSTAT_KV_U_PACKETS },
{ "ucast bytes", KSTAT_KV_U_BYTES },
{ "mcast packets", KSTAT_KV_U_PACKETS },
{ "mcast bytes", KSTAT_KV_U_BYTES },
{ "bcast packets", KSTAT_KV_U_PACKETS },
{ "bcast bytes", KSTAT_KV_U_BYTES },
{ "no buffers", KSTAT_KV_U_PACKETS },
{ "errors", KSTAT_KV_U_PACKETS },
};
static const struct vmx_kstat_tpl vmx_tx_kstat_tpl[UPT1_TxStats_count] = {
{ "TSO packets", KSTAT_KV_U_PACKETS },
{ "TSO bytes", KSTAT_KV_U_BYTES },
{ "ucast packets", KSTAT_KV_U_PACKETS },
{ "ucast bytes", KSTAT_KV_U_BYTES },
{ "mcast packets", KSTAT_KV_U_PACKETS },
{ "mcast bytes", KSTAT_KV_U_BYTES },
{ "bcast packets", KSTAT_KV_U_PACKETS },
{ "bcast bytes", KSTAT_KV_U_BYTES },
{ "errors", KSTAT_KV_U_PACKETS },
{ "discards", KSTAT_KV_U_PACKETS },
};
static void
vmx_kstat_init(struct vmxnet3_softc *sc)
{
rw_init(&sc->sc_kstat_lock, "vmxkstat");
}
static int
vmx_kstat_read(struct kstat *ks)
{
struct vmxnet3_softc *sc = ks->ks_softc;
struct kstat_kv *kvs = ks->ks_data;
uint64_t *vs = ks->ks_ptr;
unsigned int n, i;
if (ratecheck(&sc->sc_kstat_updated, &vmx_kstat_rate)) {
WRITE_CMD(sc, VMXNET3_CMD_GET_STATS);
}
n = ks->ks_datalen / sizeof(*kvs);
for (i = 0; i < n; i++)
kstat_kv_u64(&kvs[i]) = lemtoh64(&vs[i]);
TIMEVAL_TO_TIMESPEC(&sc->sc_kstat_updated, &ks->ks_updated);
return (0);
}
static struct kstat *
vmx_kstat_create(struct vmxnet3_softc *sc, const char *name, unsigned int unit,
const struct vmx_kstat_tpl *tpls, unsigned int n, uint64_t *vs)
{
struct kstat *ks;
struct kstat_kv *kvs;
unsigned int i;
ks = kstat_create(sc->sc_dev.dv_xname, 0, name, unit,
KSTAT_T_KV, 0);
if (ks == NULL)
return (NULL);
kvs = mallocarray(n, sizeof(*kvs), M_DEVBUF, M_WAITOK|M_ZERO);
for (i = 0; i < n; i++) {
const struct vmx_kstat_tpl *tpl = &tpls[i];
kstat_kv_unit_init(&kvs[i], tpl->name,
KSTAT_KV_T_COUNTER64, tpl->unit);
}
ks->ks_softc = sc;
kstat_set_wlock(ks, &sc->sc_kstat_lock);
ks->ks_ptr = vs;
ks->ks_data = kvs;
ks->ks_datalen = n * sizeof(*kvs);
ks->ks_read = vmx_kstat_read;
TIMEVAL_TO_TIMESPEC(&vmx_kstat_rate, &ks->ks_interval);
kstat_install(ks);
return (ks);
}
static void
vmx_kstat_txstats(struct vmxnet3_softc *sc, struct vmxnet3_txqueue *tq,
int unit)
{
tq->txkstat = vmx_kstat_create(sc, "vmx-txstats", unit,
vmx_tx_kstat_tpl, nitems(vmx_tx_kstat_tpl), tq->ts->stats);
}
static void
vmx_kstat_rxstats(struct vmxnet3_softc *sc, struct vmxnet3_rxqueue *rq,
int unit)
{
rq->rxkstat = vmx_kstat_create(sc, "vmx-rxstats", unit,
vmx_rx_kstat_tpl, nitems(vmx_rx_kstat_tpl), rq->rs->stats);
}
#endif