1231650Sluigi/* 2262153Sluigi * Copyright (C) 2011-2014 Matteo Landi, Luigi Rizzo. All rights reserved. 3231650Sluigi * 4231650Sluigi * Redistribution and use in source and binary forms, with or without 5231650Sluigi * modification, are permitted provided that the following conditions 6231650Sluigi * are met: 7231650Sluigi * 1. Redistributions of source code must retain the above copyright 8231650Sluigi * notice, this list of conditions and the following disclaimer. 9231650Sluigi * 2. Redistributions in binary form must reproduce the above copyright 10231650Sluigi * notice, this list of conditions and the following disclaimer in the 11231650Sluigi * documentation and/or other materials provided with the distribution. 12231650Sluigi * 13231650Sluigi * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14231650Sluigi * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15231650Sluigi * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16231650Sluigi * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 17231650Sluigi * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18231650Sluigi * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19231650Sluigi * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20231650Sluigi * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21231650Sluigi * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22231650Sluigi * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23231650Sluigi * SUCH DAMAGE. 24231650Sluigi */ 25231650Sluigi 26235549Sluigi 27231650Sluigi/* 28231650Sluigi * $FreeBSD$ 29231650Sluigi * 30262153Sluigi * netmap support for: lem 31231650Sluigi * 32235549Sluigi * For details on netmap support please see ixgbe_netmap.h 33231650Sluigi */ 34231650Sluigi 35262153Sluigi 36231650Sluigi#include <net/netmap.h> 37231650Sluigi#include <sys/selinfo.h> 38231650Sluigi#include <vm/vm.h> 39231650Sluigi#include <vm/pmap.h> /* vtophys ? */ 40231650Sluigi#include <dev/netmap/netmap_kern.h> 41231650Sluigi 42231650Sluigi 43231650Sluigi/* 44262153Sluigi * Register/unregister. We are already under netmap lock. 45231650Sluigi */ 46231650Sluigistatic int 47262153Sluigilem_netmap_reg(struct netmap_adapter *na, int onoff) 48231650Sluigi{ 49262153Sluigi struct ifnet *ifp = na->ifp; 50231650Sluigi struct adapter *adapter = ifp->if_softc; 51231650Sluigi 52257768Sluigi EM_CORE_LOCK(adapter); 53257768Sluigi 54231650Sluigi lem_disable_intr(adapter); 55231650Sluigi 56231650Sluigi /* Tell the stack that the interface is no longer active */ 57231650Sluigi ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 58231650Sluigi 59231650Sluigi#ifndef EM_LEGACY_IRQ // XXX do we need this ? 60231650Sluigi taskqueue_block(adapter->tq); 61231650Sluigi taskqueue_drain(adapter->tq, &adapter->rxtx_task); 62231650Sluigi taskqueue_drain(adapter->tq, &adapter->link_task); 63231650Sluigi#endif /* !EM_LEGCY_IRQ */ 64262153Sluigi 65262153Sluigi /* enable or disable flags and callbacks in na and ifp */ 66231650Sluigi if (onoff) { 67262153Sluigi nm_set_native_flags(na); 68231650Sluigi } else { 69262153Sluigi nm_clear_native_flags(na); 70231650Sluigi } 71262153Sluigi lem_init_locked(adapter); /* also enable intr */ 72231650Sluigi 73231650Sluigi#ifndef EM_LEGACY_IRQ 74231650Sluigi taskqueue_unblock(adapter->tq); // XXX do we need this ? 75231650Sluigi#endif /* !EM_LEGCY_IRQ */ 76231650Sluigi 77257768Sluigi EM_CORE_UNLOCK(adapter); 78257768Sluigi 79262153Sluigi return (ifp->if_drv_flags & IFF_DRV_RUNNING ? 0 : 1); 80231650Sluigi} 81231650Sluigi 82231650Sluigi 83231650Sluigi/* 84231650Sluigi * Reconcile kernel and user view of the transmit ring. 85231650Sluigi */ 86231650Sluigistatic int 87262153Sluigilem_netmap_txsync(struct netmap_adapter *na, u_int ring_nr, int flags) 88231650Sluigi{ 89262153Sluigi struct ifnet *ifp = na->ifp; 90235549Sluigi struct netmap_kring *kring = &na->tx_rings[ring_nr]; 91231650Sluigi struct netmap_ring *ring = kring->ring; 92262153Sluigi u_int nm_i; /* index into the netmap ring */ 93262153Sluigi u_int nic_i; /* index into the NIC ring */ 94262153Sluigi u_int const lim = kring->nkr_num_slots - 1; 95262153Sluigi u_int const head = kring->rhead; 96231650Sluigi /* generate an interrupt approximately every half ring */ 97262153Sluigi u_int report_frequency = kring->nkr_num_slots >> 1; 98231650Sluigi 99262153Sluigi /* device-specific */ 100262153Sluigi struct adapter *adapter = ifp->if_softc; 101231650Sluigi 102231650Sluigi bus_dmamap_sync(adapter->txdma.dma_tag, adapter->txdma.dma_map, 103231650Sluigi BUS_DMASYNC_POSTREAD); 104262153Sluigi 105235549Sluigi /* 106262153Sluigi * First part: process new packets to send. 107235549Sluigi */ 108262153Sluigi 109262153Sluigi nm_i = kring->nr_hwcur; 110262153Sluigi if (nm_i != head) { /* we have new packets to send */ 111262153Sluigi nic_i = netmap_idx_k2n(kring, nm_i); 112262153Sluigi while (nm_i != head) { 113262153Sluigi struct netmap_slot *slot = &ring->slot[nm_i]; 114262153Sluigi u_int len = slot->len; 115235549Sluigi uint64_t paddr; 116235549Sluigi void *addr = PNMB(slot, &paddr); 117231650Sluigi 118262153Sluigi /* device-specific */ 119262153Sluigi struct e1000_tx_desc *curr = &adapter->tx_desc_base[nic_i]; 120262153Sluigi struct em_buffer *txbuf = &adapter->tx_buffer_area[nic_i]; 121262153Sluigi int flags = (slot->flags & NS_REPORT || 122262153Sluigi nic_i == 0 || nic_i == report_frequency) ? 123262153Sluigi E1000_TXD_CMD_RS : 0; 124231650Sluigi 125262153Sluigi NM_CHECK_ADDR_LEN(addr, len); 126262153Sluigi 127262153Sluigi if (slot->flags & NS_BUF_CHANGED) { 128231650Sluigi /* buffer has changed, reload map */ 129262153Sluigi curr->buffer_addr = htole64(paddr); 130231650Sluigi netmap_reload_map(adapter->txtag, txbuf->map, addr); 131231650Sluigi } 132262153Sluigi slot->flags &= ~(NS_REPORT | NS_BUF_CHANGED); 133262153Sluigi 134262153Sluigi /* Fill the slot in the NIC ring. */ 135235549Sluigi curr->upper.data = 0; 136262153Sluigi curr->lower.data = htole32(adapter->txd_cmd | len | 137235549Sluigi (E1000_TXD_CMD_EOP | flags) ); 138262153Sluigi bus_dmamap_sync(adapter->txtag, txbuf->map, 139262153Sluigi BUS_DMASYNC_PREWRITE); 140231650Sluigi 141262153Sluigi nm_i = nm_next(nm_i, lim); 142262153Sluigi nic_i = nm_next(nic_i, lim); 143231650Sluigi } 144262153Sluigi kring->nr_hwcur = head; 145231650Sluigi 146262153Sluigi /* synchronize the NIC ring */ 147231650Sluigi bus_dmamap_sync(adapter->txdma.dma_tag, adapter->txdma.dma_map, 148262153Sluigi BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 149231650Sluigi 150262153Sluigi /* (re)start the tx unit up to slot nic_i (excluded) */ 151262153Sluigi E1000_WRITE_REG(&adapter->hw, E1000_TDT(0), nic_i); 152231650Sluigi } 153231650Sluigi 154262153Sluigi /* 155262153Sluigi * Second part: reclaim buffers for completed transmissions. 156262153Sluigi */ 157262153Sluigi if (ticks != kring->last_reclaim || flags & NAF_FORCE_RECLAIM || nm_kr_txempty(kring)) { 158262153Sluigi kring->last_reclaim = ticks; 159231650Sluigi /* record completed transmissions using TDH */ 160262153Sluigi nic_i = E1000_READ_REG(&adapter->hw, E1000_TDH(0)); 161262153Sluigi if (nic_i >= kring->nkr_num_slots) { /* XXX can it happen ? */ 162262153Sluigi D("TDH wrap %d", nic_i); 163262153Sluigi nic_i -= kring->nkr_num_slots; 164231650Sluigi } 165262153Sluigi adapter->next_tx_to_clean = nic_i; 166262153Sluigi kring->nr_hwtail = nm_prev(netmap_idx_n2k(kring, nic_i), lim); 167231650Sluigi } 168231650Sluigi 169262153Sluigi nm_txsync_finalize(kring); 170262153Sluigi 171231650Sluigi return 0; 172231650Sluigi} 173231650Sluigi 174231650Sluigi 175231650Sluigi/* 176231650Sluigi * Reconcile kernel and user view of the receive ring. 177231650Sluigi */ 178231650Sluigistatic int 179262153Sluigilem_netmap_rxsync(struct netmap_adapter *na, u_int ring_nr, int flags) 180231650Sluigi{ 181262153Sluigi struct ifnet *ifp = na->ifp; 182235549Sluigi struct netmap_kring *kring = &na->rx_rings[ring_nr]; 183231650Sluigi struct netmap_ring *ring = kring->ring; 184262153Sluigi u_int nm_i; /* index into the netmap ring */ 185262153Sluigi u_int nic_i; /* index into the NIC ring */ 186262153Sluigi u_int n; 187262153Sluigi u_int const lim = kring->nkr_num_slots - 1; 188262153Sluigi u_int const head = nm_rxsync_prologue(kring); 189257768Sluigi int force_update = (flags & NAF_FORCE_READ) || kring->nr_kflags & NKR_PENDINTR; 190231650Sluigi 191262153Sluigi /* device-specific */ 192262153Sluigi struct adapter *adapter = ifp->if_softc; 193262153Sluigi 194262153Sluigi if (head > lim) 195231650Sluigi return netmap_ring_reinit(kring); 196231650Sluigi 197231650Sluigi /* XXX check sync modes */ 198231650Sluigi bus_dmamap_sync(adapter->rxdma.dma_tag, adapter->rxdma.dma_map, 199231650Sluigi BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 200231650Sluigi 201235549Sluigi /* 202262153Sluigi * First part: import newly received packets. 203235549Sluigi */ 204235549Sluigi if (netmap_no_pendintr || force_update) { 205246355Sluigi uint16_t slot_flags = kring->nkr_slot_flags; 206246355Sluigi 207262153Sluigi nic_i = adapter->next_rx_desc_to_check; 208262153Sluigi nm_i = netmap_idx_n2k(kring, nic_i); 209262153Sluigi 210235549Sluigi for (n = 0; ; n++) { 211262153Sluigi struct e1000_rx_desc *curr = &adapter->rx_desc_base[nic_i]; 212235549Sluigi uint32_t staterr = le32toh(curr->status); 213235549Sluigi int len; 214231650Sluigi 215235549Sluigi if ((staterr & E1000_RXD_STAT_DD) == 0) 216235549Sluigi break; 217235549Sluigi len = le16toh(curr->length) - 4; // CRC 218235549Sluigi if (len < 0) { 219262153Sluigi D("bogus pkt size %d nic idx %d", len, nic_i); 220235549Sluigi len = 0; 221235549Sluigi } 222262153Sluigi ring->slot[nm_i].len = len; 223262153Sluigi ring->slot[nm_i].flags = slot_flags; 224235549Sluigi bus_dmamap_sync(adapter->rxtag, 225262153Sluigi adapter->rx_buffer_area[nic_i].map, 226262153Sluigi BUS_DMASYNC_POSTREAD); 227262153Sluigi nm_i = nm_next(nm_i, lim); 228262153Sluigi nic_i = nm_next(nic_i, lim); 229235549Sluigi } 230235549Sluigi if (n) { /* update the state variables */ 231262153Sluigi ND("%d new packets at nic %d nm %d tail %d", 232262153Sluigi n, 233262153Sluigi adapter->next_rx_desc_to_check, 234262153Sluigi netmap_idx_n2k(kring, adapter->next_rx_desc_to_check), 235262153Sluigi kring->nr_hwtail); 236262153Sluigi adapter->next_rx_desc_to_check = nic_i; 237262153Sluigi // ifp->if_ipackets += n; 238262153Sluigi kring->nr_hwtail = nm_i; 239235549Sluigi } 240235549Sluigi kring->nr_kflags &= ~NKR_PENDINTR; 241235549Sluigi } 242231650Sluigi 243262153Sluigi /* 244262153Sluigi * Second part: skip past packets that userspace has released. 245262153Sluigi */ 246262153Sluigi nm_i = kring->nr_hwcur; 247262153Sluigi if (nm_i != head) { 248262153Sluigi nic_i = netmap_idx_k2n(kring, nm_i); 249262153Sluigi for (n = 0; nm_i != head; n++) { 250262153Sluigi struct netmap_slot *slot = &ring->slot[nm_i]; 251231650Sluigi uint64_t paddr; 252231650Sluigi void *addr = PNMB(slot, &paddr); 253231650Sluigi 254262153Sluigi struct e1000_rx_desc *curr = &adapter->rx_desc_base[nic_i]; 255262153Sluigi struct em_buffer *rxbuf = &adapter->rx_buffer_area[nic_i]; 256235549Sluigi 257262153Sluigi if (addr == netmap_buffer_base) /* bad buf */ 258262153Sluigi goto ring_reset; 259262153Sluigi 260231650Sluigi if (slot->flags & NS_BUF_CHANGED) { 261235549Sluigi /* buffer has changed, reload map */ 262262153Sluigi curr->buffer_addr = htole64(paddr); 263235549Sluigi netmap_reload_map(adapter->rxtag, rxbuf->map, addr); 264231650Sluigi slot->flags &= ~NS_BUF_CHANGED; 265231650Sluigi } 266235549Sluigi curr->status = 0; 267231650Sluigi bus_dmamap_sync(adapter->rxtag, rxbuf->map, 268231650Sluigi BUS_DMASYNC_PREREAD); 269262153Sluigi nm_i = nm_next(nm_i, lim); 270262153Sluigi nic_i = nm_next(nic_i, lim); 271231650Sluigi } 272262153Sluigi kring->nr_hwcur = head; 273231650Sluigi bus_dmamap_sync(adapter->rxdma.dma_tag, adapter->rxdma.dma_map, 274231650Sluigi BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 275231650Sluigi /* 276231650Sluigi * IMPORTANT: we must leave one free slot in the ring, 277262153Sluigi * so move nic_i back by one unit 278231650Sluigi */ 279262153Sluigi nic_i = nm_prev(nic_i, lim); 280262153Sluigi E1000_WRITE_REG(&adapter->hw, E1000_RDT(0), nic_i); 281231650Sluigi } 282262153Sluigi 283262153Sluigi /* tell userspace that there might be new packets */ 284262153Sluigi nm_rxsync_finalize(kring); 285262153Sluigi 286231650Sluigi return 0; 287262153Sluigi 288262153Sluigiring_reset: 289262153Sluigi return netmap_ring_reinit(kring); 290231650Sluigi} 291235549Sluigi 292235549Sluigi 293235549Sluigistatic void 294235549Sluigilem_netmap_attach(struct adapter *adapter) 295235549Sluigi{ 296235549Sluigi struct netmap_adapter na; 297235549Sluigi 298235549Sluigi bzero(&na, sizeof(na)); 299235549Sluigi 300235549Sluigi na.ifp = adapter->ifp; 301257768Sluigi na.na_flags = NAF_BDG_MAYSLEEP; 302235549Sluigi na.num_tx_desc = adapter->num_tx_desc; 303235549Sluigi na.num_rx_desc = adapter->num_rx_desc; 304235549Sluigi na.nm_txsync = lem_netmap_txsync; 305235549Sluigi na.nm_rxsync = lem_netmap_rxsync; 306235549Sluigi na.nm_register = lem_netmap_reg; 307262153Sluigi na.num_tx_rings = na.num_rx_rings = 1; 308262153Sluigi netmap_attach(&na); 309235549Sluigi} 310235549Sluigi 311231650Sluigi/* end of file */ 312