1f9790aebSLuigi Rizzo /* 217885a7bSLuigi Rizzo * Copyright (C) 2013-2014 Universita` di Pisa. All rights reserved. 3f9790aebSLuigi Rizzo * 4f9790aebSLuigi Rizzo * Redistribution and use in source and binary forms, with or without 5f9790aebSLuigi Rizzo * modification, are permitted provided that the following conditions 6f9790aebSLuigi Rizzo * are met: 7f9790aebSLuigi Rizzo * 1. Redistributions of source code must retain the above copyright 8f9790aebSLuigi Rizzo * notice, this list of conditions and the following disclaimer. 9f9790aebSLuigi Rizzo * 2. Redistributions in binary form must reproduce the above copyright 10f9790aebSLuigi Rizzo * notice, this list of conditions and the following disclaimer in the 11f9790aebSLuigi Rizzo * documentation and/or other materials provided with the distribution. 12f9790aebSLuigi Rizzo * 13f9790aebSLuigi Rizzo * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14f9790aebSLuigi Rizzo * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15f9790aebSLuigi Rizzo * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16f9790aebSLuigi Rizzo * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 17f9790aebSLuigi Rizzo * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18f9790aebSLuigi Rizzo * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19f9790aebSLuigi Rizzo * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20f9790aebSLuigi Rizzo * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21f9790aebSLuigi Rizzo * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22f9790aebSLuigi Rizzo * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23f9790aebSLuigi Rizzo * SUCH DAMAGE. 24f9790aebSLuigi Rizzo */ 25f9790aebSLuigi Rizzo 26f9790aebSLuigi Rizzo /* 27f9790aebSLuigi Rizzo * This module implements netmap support on top of standard, 28f9790aebSLuigi Rizzo * unmodified device drivers. 29f9790aebSLuigi Rizzo * 30f9790aebSLuigi Rizzo * A NIOCREGIF request is handled here if the device does not 31f9790aebSLuigi Rizzo * have native support. TX and RX rings are emulated as follows: 32f9790aebSLuigi Rizzo * 33f9790aebSLuigi Rizzo * NIOCREGIF 34f9790aebSLuigi Rizzo * We preallocate a block of TX mbufs (roughly as many as 35f9790aebSLuigi Rizzo * tx descriptors; the number is not critical) to speed up 36f9790aebSLuigi Rizzo * operation during transmissions. The refcount on most of 37f9790aebSLuigi Rizzo * these buffers is artificially bumped up so we can recycle 38f9790aebSLuigi Rizzo * them more easily. Also, the destructor is intercepted 39f9790aebSLuigi Rizzo * so we use it as an interrupt notification to wake up 40f9790aebSLuigi Rizzo * processes blocked on a poll(). 41f9790aebSLuigi Rizzo * 42f9790aebSLuigi Rizzo * For each receive ring we allocate one "struct mbq" 43f9790aebSLuigi Rizzo * (an mbuf tailq plus a spinlock). We intercept packets 44f9790aebSLuigi Rizzo * (through if_input) 45f9790aebSLuigi Rizzo * on the receive path and put them in the mbq from which 46f9790aebSLuigi Rizzo * netmap receive routines can grab them. 47f9790aebSLuigi Rizzo * 48f9790aebSLuigi Rizzo * TX: 49f9790aebSLuigi Rizzo * in the generic_txsync() routine, netmap buffers are copied 50f9790aebSLuigi Rizzo * (or linked, in a future) to the preallocated mbufs 51f9790aebSLuigi Rizzo * and pushed to the transmit queue. Some of these mbufs 52f9790aebSLuigi Rizzo * (those with NS_REPORT, or otherwise every half ring) 53f9790aebSLuigi Rizzo * have the refcount=1, others have refcount=2. 54f9790aebSLuigi Rizzo * When the destructor is invoked, we take that as 55f9790aebSLuigi Rizzo * a notification that all mbufs up to that one in 56f9790aebSLuigi Rizzo * the specific ring have been completed, and generate 57f9790aebSLuigi Rizzo * the equivalent of a transmit interrupt. 58f9790aebSLuigi Rizzo * 59f9790aebSLuigi Rizzo * RX: 60f9790aebSLuigi Rizzo * 61f9790aebSLuigi Rizzo */ 62f9790aebSLuigi Rizzo 63f9790aebSLuigi Rizzo #ifdef __FreeBSD__ 64f9790aebSLuigi Rizzo 65f9790aebSLuigi Rizzo #include <sys/cdefs.h> /* prerequisite */ 66f9790aebSLuigi Rizzo __FBSDID("$FreeBSD$"); 67f9790aebSLuigi Rizzo 68f9790aebSLuigi Rizzo #include <sys/types.h> 69f9790aebSLuigi Rizzo #include <sys/errno.h> 70f9790aebSLuigi Rizzo #include <sys/malloc.h> 71f9790aebSLuigi Rizzo #include <sys/lock.h> /* PROT_EXEC */ 72f9790aebSLuigi Rizzo #include <sys/rwlock.h> 73f9790aebSLuigi Rizzo #include <sys/socket.h> /* sockaddrs */ 74f9790aebSLuigi Rizzo #include <sys/selinfo.h> 75f9790aebSLuigi Rizzo #include <net/if.h> 76f9790aebSLuigi Rizzo #include <net/if_var.h> 77f9790aebSLuigi Rizzo #include <machine/bus.h> /* bus_dmamap_* in netmap_kern.h */ 78f9790aebSLuigi Rizzo 79f9790aebSLuigi Rizzo // XXX temporary - D() defined here 80f9790aebSLuigi Rizzo #include <net/netmap.h> 81f9790aebSLuigi Rizzo #include <dev/netmap/netmap_kern.h> 82f9790aebSLuigi Rizzo #include <dev/netmap/netmap_mem2.h> 83f9790aebSLuigi Rizzo 84e4166283SLuigi Rizzo #define rtnl_lock() ND("rtnl_lock called") 85e4166283SLuigi Rizzo #define rtnl_unlock() ND("rtnl_unlock called") 86f9790aebSLuigi Rizzo #define MBUF_TXQ(m) ((m)->m_pkthdr.flowid) 87f0ea3689SLuigi Rizzo #define MBUF_RXQ(m) ((m)->m_pkthdr.flowid) 88f9790aebSLuigi Rizzo #define smp_mb() 89f9790aebSLuigi Rizzo 90f9790aebSLuigi Rizzo /* 915899a007SLuigi Rizzo * FreeBSD mbuf allocator/deallocator in emulation mode: 925899a007SLuigi Rizzo * 935899a007SLuigi Rizzo * We allocate EXT_PACKET mbuf+clusters, but need to set M_NOFREE 945899a007SLuigi Rizzo * so that the destructor, if invoked, will not free the packet. 955899a007SLuigi Rizzo * In principle we should set the destructor only on demand, 965899a007SLuigi Rizzo * but since there might be a race we better do it on allocation. 975899a007SLuigi Rizzo * As a consequence, we also need to set the destructor or we 985899a007SLuigi Rizzo * would leak buffers. 99f9790aebSLuigi Rizzo */ 100f9790aebSLuigi Rizzo 101f9790aebSLuigi Rizzo /* 1025899a007SLuigi Rizzo * mbuf wrappers 103f9790aebSLuigi Rizzo */ 104f9790aebSLuigi Rizzo 1054bf50f18SLuigi Rizzo /* mbuf destructor, also need to change the type to EXT_EXTREF, 106f9790aebSLuigi Rizzo * add an M_NOFREE flag, and then clear the flag and 107f9790aebSLuigi Rizzo * chain into uma_zfree(zone_pack, mf) 108f9790aebSLuigi Rizzo * (or reinstall the buffer ?) 109f9790aebSLuigi Rizzo */ 110f9790aebSLuigi Rizzo #define SET_MBUF_DESTRUCTOR(m, fn) do { \ 111f9790aebSLuigi Rizzo (m)->m_ext.ext_free = (void *)fn; \ 112f9790aebSLuigi Rizzo (m)->m_ext.ext_type = EXT_EXTREF; \ 113f9790aebSLuigi Rizzo } while (0) 114f9790aebSLuigi Rizzo 115e4166283SLuigi Rizzo static void 116e4166283SLuigi Rizzo netmap_default_mbuf_destructor(struct mbuf *m) 117e4166283SLuigi Rizzo { 1184bf50f18SLuigi Rizzo /* restore original mbuf */ 1194bf50f18SLuigi Rizzo m->m_ext.ext_buf = m->m_data = m->m_ext.ext_arg1; 1204bf50f18SLuigi Rizzo m->m_ext.ext_arg1 = NULL; 121e4166283SLuigi Rizzo m->m_ext.ext_type = EXT_PACKET; 122e4166283SLuigi Rizzo m->m_ext.ext_free = NULL; 1234bf50f18SLuigi Rizzo if (GET_MBUF_REFCNT(m) == 0) 1244bf50f18SLuigi Rizzo SET_MBUF_REFCNT(m, 1); 125e4166283SLuigi Rizzo uma_zfree(zone_pack, m); 126e4166283SLuigi Rizzo } 127e4166283SLuigi Rizzo 128e4166283SLuigi Rizzo static inline struct mbuf * 129e4166283SLuigi Rizzo netmap_get_mbuf(int len) 130e4166283SLuigi Rizzo { 131e4166283SLuigi Rizzo struct mbuf *m; 132*fddd4f62SNavdeep Parhar m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 133e4166283SLuigi Rizzo if (m) { 134*fddd4f62SNavdeep Parhar m->m_flags |= M_NOFREE; /* XXXNP: Almost certainly incorrect. */ 1354bf50f18SLuigi Rizzo m->m_ext.ext_arg1 = m->m_ext.ext_buf; // XXX save 136e4166283SLuigi Rizzo m->m_ext.ext_free = (void *)netmap_default_mbuf_destructor; 137e4166283SLuigi Rizzo m->m_ext.ext_type = EXT_EXTREF; 1384bf50f18SLuigi Rizzo ND(5, "create m %p refcnt %d", m, GET_MBUF_REFCNT(m)); 139e4166283SLuigi Rizzo } 140e4166283SLuigi Rizzo return m; 141e4166283SLuigi Rizzo } 142f9790aebSLuigi Rizzo 143f9790aebSLuigi Rizzo 144f9790aebSLuigi Rizzo 145f9790aebSLuigi Rizzo #else /* linux */ 146f9790aebSLuigi Rizzo 147f9790aebSLuigi Rizzo #include "bsd_glue.h" 148f9790aebSLuigi Rizzo 149f9790aebSLuigi Rizzo #include <linux/rtnetlink.h> /* rtnl_[un]lock() */ 150f9790aebSLuigi Rizzo #include <linux/ethtool.h> /* struct ethtool_ops, get_ringparam */ 151f9790aebSLuigi Rizzo #include <linux/hrtimer.h> 152f9790aebSLuigi Rizzo 153f9790aebSLuigi Rizzo //#define REG_RESET 154f9790aebSLuigi Rizzo 155f9790aebSLuigi Rizzo #endif /* linux */ 156f9790aebSLuigi Rizzo 157f9790aebSLuigi Rizzo 158f9790aebSLuigi Rizzo /* Common headers. */ 159f9790aebSLuigi Rizzo #include <net/netmap.h> 160f9790aebSLuigi Rizzo #include <dev/netmap/netmap_kern.h> 161f9790aebSLuigi Rizzo #include <dev/netmap/netmap_mem2.h> 162f9790aebSLuigi Rizzo 163f9790aebSLuigi Rizzo 164f9790aebSLuigi Rizzo 165f9790aebSLuigi Rizzo /* ======================== usage stats =========================== */ 166f9790aebSLuigi Rizzo 1674bf50f18SLuigi Rizzo #ifdef RATE_GENERIC 168f9790aebSLuigi Rizzo #define IFRATE(x) x 169f9790aebSLuigi Rizzo struct rate_stats { 170f9790aebSLuigi Rizzo unsigned long txpkt; 171f9790aebSLuigi Rizzo unsigned long txsync; 172f9790aebSLuigi Rizzo unsigned long txirq; 173f9790aebSLuigi Rizzo unsigned long rxpkt; 174f9790aebSLuigi Rizzo unsigned long rxirq; 175f9790aebSLuigi Rizzo unsigned long rxsync; 176f9790aebSLuigi Rizzo }; 177f9790aebSLuigi Rizzo 178f9790aebSLuigi Rizzo struct rate_context { 179f9790aebSLuigi Rizzo unsigned refcount; 180f9790aebSLuigi Rizzo struct timer_list timer; 181f9790aebSLuigi Rizzo struct rate_stats new; 182f9790aebSLuigi Rizzo struct rate_stats old; 183f9790aebSLuigi Rizzo }; 184f9790aebSLuigi Rizzo 185f9790aebSLuigi Rizzo #define RATE_PRINTK(_NAME_) \ 186f9790aebSLuigi Rizzo printk( #_NAME_ " = %lu Hz\n", (cur._NAME_ - ctx->old._NAME_)/RATE_PERIOD); 187f9790aebSLuigi Rizzo #define RATE_PERIOD 2 188f9790aebSLuigi Rizzo static void rate_callback(unsigned long arg) 189f9790aebSLuigi Rizzo { 190f9790aebSLuigi Rizzo struct rate_context * ctx = (struct rate_context *)arg; 191f9790aebSLuigi Rizzo struct rate_stats cur = ctx->new; 192f9790aebSLuigi Rizzo int r; 193f9790aebSLuigi Rizzo 194f9790aebSLuigi Rizzo RATE_PRINTK(txpkt); 195f9790aebSLuigi Rizzo RATE_PRINTK(txsync); 196f9790aebSLuigi Rizzo RATE_PRINTK(txirq); 197f9790aebSLuigi Rizzo RATE_PRINTK(rxpkt); 198f9790aebSLuigi Rizzo RATE_PRINTK(rxsync); 199f9790aebSLuigi Rizzo RATE_PRINTK(rxirq); 200f9790aebSLuigi Rizzo printk("\n"); 201f9790aebSLuigi Rizzo 202f9790aebSLuigi Rizzo ctx->old = cur; 203f9790aebSLuigi Rizzo r = mod_timer(&ctx->timer, jiffies + 204f9790aebSLuigi Rizzo msecs_to_jiffies(RATE_PERIOD * 1000)); 205f9790aebSLuigi Rizzo if (unlikely(r)) 206f9790aebSLuigi Rizzo D("[v1000] Error: mod_timer()"); 207f9790aebSLuigi Rizzo } 208f9790aebSLuigi Rizzo 209f9790aebSLuigi Rizzo static struct rate_context rate_ctx; 210f9790aebSLuigi Rizzo 2114bf50f18SLuigi Rizzo void generic_rate(int txp, int txs, int txi, int rxp, int rxs, int rxi) 2124bf50f18SLuigi Rizzo { 2134bf50f18SLuigi Rizzo if (txp) rate_ctx.new.txpkt++; 2144bf50f18SLuigi Rizzo if (txs) rate_ctx.new.txsync++; 2154bf50f18SLuigi Rizzo if (txi) rate_ctx.new.txirq++; 2164bf50f18SLuigi Rizzo if (rxp) rate_ctx.new.rxpkt++; 2174bf50f18SLuigi Rizzo if (rxs) rate_ctx.new.rxsync++; 2184bf50f18SLuigi Rizzo if (rxi) rate_ctx.new.rxirq++; 2194bf50f18SLuigi Rizzo } 2204bf50f18SLuigi Rizzo 221f9790aebSLuigi Rizzo #else /* !RATE */ 222f9790aebSLuigi Rizzo #define IFRATE(x) 223f9790aebSLuigi Rizzo #endif /* !RATE */ 224f9790aebSLuigi Rizzo 225f9790aebSLuigi Rizzo 226f9790aebSLuigi Rizzo /* =============== GENERIC NETMAP ADAPTER SUPPORT ================= */ 227f9790aebSLuigi Rizzo 228f9790aebSLuigi Rizzo /* 229f9790aebSLuigi Rizzo * Wrapper used by the generic adapter layer to notify 230f9790aebSLuigi Rizzo * the poller threads. Differently from netmap_rx_irq(), we check 2314bf50f18SLuigi Rizzo * only NAF_NETMAP_ON instead of NAF_NATIVE_ON to enable the irq. 232f9790aebSLuigi Rizzo */ 233f9790aebSLuigi Rizzo static void 234f9790aebSLuigi Rizzo netmap_generic_irq(struct ifnet *ifp, u_int q, u_int *work_done) 235f9790aebSLuigi Rizzo { 2364bf50f18SLuigi Rizzo struct netmap_adapter *na = NA(ifp); 2374bf50f18SLuigi Rizzo if (unlikely(!nm_netmap_on(na))) 238f9790aebSLuigi Rizzo return; 239f9790aebSLuigi Rizzo 240f9790aebSLuigi Rizzo netmap_common_irq(ifp, q, work_done); 241f9790aebSLuigi Rizzo } 242f9790aebSLuigi Rizzo 243f9790aebSLuigi Rizzo 244f9790aebSLuigi Rizzo /* Enable/disable netmap mode for a generic network interface. */ 24517885a7bSLuigi Rizzo static int 24617885a7bSLuigi Rizzo generic_netmap_register(struct netmap_adapter *na, int enable) 247f9790aebSLuigi Rizzo { 248f9790aebSLuigi Rizzo struct netmap_generic_adapter *gna = (struct netmap_generic_adapter *)na; 249f9790aebSLuigi Rizzo struct mbuf *m; 250f9790aebSLuigi Rizzo int error; 251f9790aebSLuigi Rizzo int i, r; 252f9790aebSLuigi Rizzo 253f9790aebSLuigi Rizzo if (!na) 254f9790aebSLuigi Rizzo return EINVAL; 255f9790aebSLuigi Rizzo 256f9790aebSLuigi Rizzo #ifdef REG_RESET 257f9790aebSLuigi Rizzo error = ifp->netdev_ops->ndo_stop(ifp); 258f9790aebSLuigi Rizzo if (error) { 259f9790aebSLuigi Rizzo return error; 260f9790aebSLuigi Rizzo } 261f9790aebSLuigi Rizzo #endif /* REG_RESET */ 262f9790aebSLuigi Rizzo 263f9790aebSLuigi Rizzo if (enable) { /* Enable netmap mode. */ 264e4166283SLuigi Rizzo /* Init the mitigation support on all the rx queues. */ 265f0ea3689SLuigi Rizzo gna->mit = malloc(na->num_rx_rings * sizeof(struct nm_generic_mit), 266f0ea3689SLuigi Rizzo M_DEVBUF, M_NOWAIT | M_ZERO); 267f0ea3689SLuigi Rizzo if (!gna->mit) { 268f0ea3689SLuigi Rizzo D("mitigation allocation failed"); 269f0ea3689SLuigi Rizzo error = ENOMEM; 270f0ea3689SLuigi Rizzo goto out; 271f0ea3689SLuigi Rizzo } 272f0ea3689SLuigi Rizzo for (r=0; r<na->num_rx_rings; r++) 2734bf50f18SLuigi Rizzo netmap_mitigation_init(&gna->mit[r], r, na); 274f0ea3689SLuigi Rizzo 275f9790aebSLuigi Rizzo /* Initialize the rx queue, as generic_rx_handler() can 276f9790aebSLuigi Rizzo * be called as soon as netmap_catch_rx() returns. 277f9790aebSLuigi Rizzo */ 278f9790aebSLuigi Rizzo for (r=0; r<na->num_rx_rings; r++) { 279f9790aebSLuigi Rizzo mbq_safe_init(&na->rx_rings[r].rx_queue); 280f9790aebSLuigi Rizzo } 281f9790aebSLuigi Rizzo 282f9790aebSLuigi Rizzo /* 283f9790aebSLuigi Rizzo * Preallocate packet buffers for the tx rings. 284f9790aebSLuigi Rizzo */ 28517885a7bSLuigi Rizzo for (r=0; r<na->num_tx_rings; r++) 28617885a7bSLuigi Rizzo na->tx_rings[r].tx_pool = NULL; 287f9790aebSLuigi Rizzo for (r=0; r<na->num_tx_rings; r++) { 288f9790aebSLuigi Rizzo na->tx_rings[r].tx_pool = malloc(na->num_tx_desc * sizeof(struct mbuf *), 289f9790aebSLuigi Rizzo M_DEVBUF, M_NOWAIT | M_ZERO); 290f9790aebSLuigi Rizzo if (!na->tx_rings[r].tx_pool) { 291f9790aebSLuigi Rizzo D("tx_pool allocation failed"); 292f9790aebSLuigi Rizzo error = ENOMEM; 29317885a7bSLuigi Rizzo goto free_tx_pools; 294f9790aebSLuigi Rizzo } 29517885a7bSLuigi Rizzo for (i=0; i<na->num_tx_desc; i++) 29617885a7bSLuigi Rizzo na->tx_rings[r].tx_pool[i] = NULL; 297f9790aebSLuigi Rizzo for (i=0; i<na->num_tx_desc; i++) { 2984bf50f18SLuigi Rizzo m = netmap_get_mbuf(NETMAP_BUF_SIZE(na)); 299f9790aebSLuigi Rizzo if (!m) { 300f9790aebSLuigi Rizzo D("tx_pool[%d] allocation failed", i); 301f9790aebSLuigi Rizzo error = ENOMEM; 30217885a7bSLuigi Rizzo goto free_tx_pools; 303f9790aebSLuigi Rizzo } 304f9790aebSLuigi Rizzo na->tx_rings[r].tx_pool[i] = m; 305f9790aebSLuigi Rizzo } 306f9790aebSLuigi Rizzo } 307f9790aebSLuigi Rizzo rtnl_lock(); 308f9790aebSLuigi Rizzo /* Prepare to intercept incoming traffic. */ 309847bf383SLuigi Rizzo error = netmap_catch_rx(gna, 1); 310f9790aebSLuigi Rizzo if (error) { 311f2637526SLuigi Rizzo D("netdev_rx_handler_register() failed (%d)", error); 312f9790aebSLuigi Rizzo goto register_handler; 313f9790aebSLuigi Rizzo } 3144bf50f18SLuigi Rizzo na->na_flags |= NAF_NETMAP_ON; 315f9790aebSLuigi Rizzo 316f9790aebSLuigi Rizzo /* Make netmap control the packet steering. */ 31717885a7bSLuigi Rizzo netmap_catch_tx(gna, 1); 318f9790aebSLuigi Rizzo 319f9790aebSLuigi Rizzo rtnl_unlock(); 320f9790aebSLuigi Rizzo 3214bf50f18SLuigi Rizzo #ifdef RATE_GENERIC 322f9790aebSLuigi Rizzo if (rate_ctx.refcount == 0) { 323f9790aebSLuigi Rizzo D("setup_timer()"); 324f9790aebSLuigi Rizzo memset(&rate_ctx, 0, sizeof(rate_ctx)); 325f9790aebSLuigi Rizzo setup_timer(&rate_ctx.timer, &rate_callback, (unsigned long)&rate_ctx); 326f9790aebSLuigi Rizzo if (mod_timer(&rate_ctx.timer, jiffies + msecs_to_jiffies(1500))) { 327f9790aebSLuigi Rizzo D("Error: mod_timer()"); 328f9790aebSLuigi Rizzo } 329f9790aebSLuigi Rizzo } 330f9790aebSLuigi Rizzo rate_ctx.refcount++; 331f9790aebSLuigi Rizzo #endif /* RATE */ 332f9790aebSLuigi Rizzo 333f2637526SLuigi Rizzo } else if (na->tx_rings[0].tx_pool) { 334f2637526SLuigi Rizzo /* Disable netmap mode. We enter here only if the previous 335f2637526SLuigi Rizzo generic_netmap_register(na, 1) was successfull. 336f2637526SLuigi Rizzo If it was not, na->tx_rings[0].tx_pool was set to NULL by the 337f2637526SLuigi Rizzo error handling code below. */ 338f9790aebSLuigi Rizzo rtnl_lock(); 339f9790aebSLuigi Rizzo 3404bf50f18SLuigi Rizzo na->na_flags &= ~NAF_NETMAP_ON; 341f9790aebSLuigi Rizzo 342f9790aebSLuigi Rizzo /* Release packet steering control. */ 34317885a7bSLuigi Rizzo netmap_catch_tx(gna, 0); 344f9790aebSLuigi Rizzo 345f9790aebSLuigi Rizzo /* Do not intercept packets on the rx path. */ 346847bf383SLuigi Rizzo netmap_catch_rx(gna, 0); 347f9790aebSLuigi Rizzo 348f9790aebSLuigi Rizzo rtnl_unlock(); 349f9790aebSLuigi Rizzo 350f9790aebSLuigi Rizzo /* Free the mbufs going to the netmap rings */ 351f9790aebSLuigi Rizzo for (r=0; r<na->num_rx_rings; r++) { 352f9790aebSLuigi Rizzo mbq_safe_purge(&na->rx_rings[r].rx_queue); 353f9790aebSLuigi Rizzo mbq_safe_destroy(&na->rx_rings[r].rx_queue); 354f9790aebSLuigi Rizzo } 355f9790aebSLuigi Rizzo 356f0ea3689SLuigi Rizzo for (r=0; r<na->num_rx_rings; r++) 357f0ea3689SLuigi Rizzo netmap_mitigation_cleanup(&gna->mit[r]); 358f0ea3689SLuigi Rizzo free(gna->mit, M_DEVBUF); 359f9790aebSLuigi Rizzo 360f9790aebSLuigi Rizzo for (r=0; r<na->num_tx_rings; r++) { 361f9790aebSLuigi Rizzo for (i=0; i<na->num_tx_desc; i++) { 362f9790aebSLuigi Rizzo m_freem(na->tx_rings[r].tx_pool[i]); 363f9790aebSLuigi Rizzo } 364f9790aebSLuigi Rizzo free(na->tx_rings[r].tx_pool, M_DEVBUF); 365f9790aebSLuigi Rizzo } 366f9790aebSLuigi Rizzo 3674bf50f18SLuigi Rizzo #ifdef RATE_GENERIC 368f9790aebSLuigi Rizzo if (--rate_ctx.refcount == 0) { 369f9790aebSLuigi Rizzo D("del_timer()"); 370f9790aebSLuigi Rizzo del_timer(&rate_ctx.timer); 371f9790aebSLuigi Rizzo } 372f9790aebSLuigi Rizzo #endif 373f9790aebSLuigi Rizzo } 374f9790aebSLuigi Rizzo 375f9790aebSLuigi Rizzo #ifdef REG_RESET 376f9790aebSLuigi Rizzo error = ifp->netdev_ops->ndo_open(ifp); 377f9790aebSLuigi Rizzo if (error) { 378f2637526SLuigi Rizzo goto free_tx_pools; 379f9790aebSLuigi Rizzo } 380f9790aebSLuigi Rizzo #endif 381f9790aebSLuigi Rizzo 382f9790aebSLuigi Rizzo return 0; 383f9790aebSLuigi Rizzo 384f9790aebSLuigi Rizzo register_handler: 385f9790aebSLuigi Rizzo rtnl_unlock(); 38617885a7bSLuigi Rizzo free_tx_pools: 38717885a7bSLuigi Rizzo for (r=0; r<na->num_tx_rings; r++) { 38817885a7bSLuigi Rizzo if (na->tx_rings[r].tx_pool == NULL) 38917885a7bSLuigi Rizzo continue; 39017885a7bSLuigi Rizzo for (i=0; i<na->num_tx_desc; i++) 39117885a7bSLuigi Rizzo if (na->tx_rings[r].tx_pool[i]) 392f9790aebSLuigi Rizzo m_freem(na->tx_rings[r].tx_pool[i]); 393f9790aebSLuigi Rizzo free(na->tx_rings[r].tx_pool, M_DEVBUF); 394f2637526SLuigi Rizzo na->tx_rings[r].tx_pool = NULL; 395f2637526SLuigi Rizzo } 396f2637526SLuigi Rizzo for (r=0; r<na->num_rx_rings; r++) { 397f0ea3689SLuigi Rizzo netmap_mitigation_cleanup(&gna->mit[r]); 398f2637526SLuigi Rizzo mbq_safe_destroy(&na->rx_rings[r].rx_queue); 399f9790aebSLuigi Rizzo } 400f0ea3689SLuigi Rizzo free(gna->mit, M_DEVBUF); 401f0ea3689SLuigi Rizzo out: 402f9790aebSLuigi Rizzo 403f9790aebSLuigi Rizzo return error; 404f9790aebSLuigi Rizzo } 405f9790aebSLuigi Rizzo 406f9790aebSLuigi Rizzo /* 407f9790aebSLuigi Rizzo * Callback invoked when the device driver frees an mbuf used 408f9790aebSLuigi Rizzo * by netmap to transmit a packet. This usually happens when 409f9790aebSLuigi Rizzo * the NIC notifies the driver that transmission is completed. 410f9790aebSLuigi Rizzo */ 411f9790aebSLuigi Rizzo static void 412f9790aebSLuigi Rizzo generic_mbuf_destructor(struct mbuf *m) 413f9790aebSLuigi Rizzo { 414f9790aebSLuigi Rizzo netmap_generic_irq(MBUF_IFP(m), MBUF_TXQ(m), NULL); 415f9790aebSLuigi Rizzo #ifdef __FreeBSD__ 416e4166283SLuigi Rizzo if (netmap_verbose) 417e4166283SLuigi Rizzo RD(5, "Tx irq (%p) queue %d index %d" , m, MBUF_TXQ(m), (int)(uintptr_t)m->m_ext.ext_arg1); 418e4166283SLuigi Rizzo netmap_default_mbuf_destructor(m); 419f9790aebSLuigi Rizzo #endif /* __FreeBSD__ */ 420f9790aebSLuigi Rizzo IFRATE(rate_ctx.new.txirq++); 421f9790aebSLuigi Rizzo } 422f9790aebSLuigi Rizzo 4234bf50f18SLuigi Rizzo extern int netmap_adaptive_io; 4244bf50f18SLuigi Rizzo 42517885a7bSLuigi Rizzo /* Record completed transmissions and update hwtail. 426f9790aebSLuigi Rizzo * 42717885a7bSLuigi Rizzo * The oldest tx buffer not yet completed is at nr_hwtail + 1, 428f9790aebSLuigi Rizzo * nr_hwcur is the first unsent buffer. 429f9790aebSLuigi Rizzo */ 43017885a7bSLuigi Rizzo static u_int 431f9790aebSLuigi Rizzo generic_netmap_tx_clean(struct netmap_kring *kring) 432f9790aebSLuigi Rizzo { 43317885a7bSLuigi Rizzo u_int const lim = kring->nkr_num_slots - 1; 43417885a7bSLuigi Rizzo u_int nm_i = nm_next(kring->nr_hwtail, lim); 435f9790aebSLuigi Rizzo u_int hwcur = kring->nr_hwcur; 436f9790aebSLuigi Rizzo u_int n = 0; 437f9790aebSLuigi Rizzo struct mbuf **tx_pool = kring->tx_pool; 438f9790aebSLuigi Rizzo 43917885a7bSLuigi Rizzo while (nm_i != hwcur) { /* buffers not completed */ 44017885a7bSLuigi Rizzo struct mbuf *m = tx_pool[nm_i]; 441f9790aebSLuigi Rizzo 442f9790aebSLuigi Rizzo if (unlikely(m == NULL)) { 44317885a7bSLuigi Rizzo /* this is done, try to replenish the entry */ 4444bf50f18SLuigi Rizzo tx_pool[nm_i] = m = netmap_get_mbuf(NETMAP_BUF_SIZE(kring->na)); 445f9790aebSLuigi Rizzo if (unlikely(m == NULL)) { 446f9790aebSLuigi Rizzo D("mbuf allocation failed, XXX error"); 447f9790aebSLuigi Rizzo // XXX how do we proceed ? break ? 448f9790aebSLuigi Rizzo return -ENOMEM; 449f9790aebSLuigi Rizzo } 450f9790aebSLuigi Rizzo } else if (GET_MBUF_REFCNT(m) != 1) { 451f9790aebSLuigi Rizzo break; /* This mbuf is still busy: its refcnt is 2. */ 452f9790aebSLuigi Rizzo } 453f9790aebSLuigi Rizzo n++; 45417885a7bSLuigi Rizzo nm_i = nm_next(nm_i, lim); 4554bf50f18SLuigi Rizzo #if 0 /* rate adaptation */ 4564bf50f18SLuigi Rizzo if (netmap_adaptive_io > 1) { 4574bf50f18SLuigi Rizzo if (n >= netmap_adaptive_io) 4584bf50f18SLuigi Rizzo break; 4594bf50f18SLuigi Rizzo } else if (netmap_adaptive_io) { 4604bf50f18SLuigi Rizzo /* if hwcur - nm_i < lim/8 do an early break 4614bf50f18SLuigi Rizzo * so we prevent the sender from stalling. See CVT. 4624bf50f18SLuigi Rizzo */ 4634bf50f18SLuigi Rizzo if (hwcur >= nm_i) { 4644bf50f18SLuigi Rizzo if (hwcur - nm_i < lim/2) 4654bf50f18SLuigi Rizzo break; 4664bf50f18SLuigi Rizzo } else { 4674bf50f18SLuigi Rizzo if (hwcur + lim + 1 - nm_i < lim/2) 4684bf50f18SLuigi Rizzo break; 4694bf50f18SLuigi Rizzo } 4704bf50f18SLuigi Rizzo } 4714bf50f18SLuigi Rizzo #endif 472f9790aebSLuigi Rizzo } 47317885a7bSLuigi Rizzo kring->nr_hwtail = nm_prev(nm_i, lim); 47417885a7bSLuigi Rizzo ND("tx completed [%d] -> hwtail %d", n, kring->nr_hwtail); 475f9790aebSLuigi Rizzo 476f9790aebSLuigi Rizzo return n; 477f9790aebSLuigi Rizzo } 478f9790aebSLuigi Rizzo 479f9790aebSLuigi Rizzo 480f9790aebSLuigi Rizzo /* 48117885a7bSLuigi Rizzo * We have pending packets in the driver between nr_hwtail +1 and hwcur. 482f9790aebSLuigi Rizzo * Compute a position in the middle, to be used to generate 483f9790aebSLuigi Rizzo * a notification. 484f9790aebSLuigi Rizzo */ 485f9790aebSLuigi Rizzo static inline u_int 486f9790aebSLuigi Rizzo generic_tx_event_middle(struct netmap_kring *kring, u_int hwcur) 487f9790aebSLuigi Rizzo { 488f9790aebSLuigi Rizzo u_int n = kring->nkr_num_slots; 48917885a7bSLuigi Rizzo u_int ntc = nm_next(kring->nr_hwtail, n-1); 490f9790aebSLuigi Rizzo u_int e; 491f9790aebSLuigi Rizzo 492f9790aebSLuigi Rizzo if (hwcur >= ntc) { 493f9790aebSLuigi Rizzo e = (hwcur + ntc) / 2; 494f9790aebSLuigi Rizzo } else { /* wrap around */ 495f9790aebSLuigi Rizzo e = (hwcur + n + ntc) / 2; 496f9790aebSLuigi Rizzo if (e >= n) { 497f9790aebSLuigi Rizzo e -= n; 498f9790aebSLuigi Rizzo } 499f9790aebSLuigi Rizzo } 500f9790aebSLuigi Rizzo 501f9790aebSLuigi Rizzo if (unlikely(e >= n)) { 502f9790aebSLuigi Rizzo D("This cannot happen"); 503f9790aebSLuigi Rizzo e = 0; 504f9790aebSLuigi Rizzo } 505f9790aebSLuigi Rizzo 506f9790aebSLuigi Rizzo return e; 507f9790aebSLuigi Rizzo } 508f9790aebSLuigi Rizzo 509f9790aebSLuigi Rizzo /* 51017885a7bSLuigi Rizzo * We have pending packets in the driver between nr_hwtail+1 and hwcur. 511f9790aebSLuigi Rizzo * Schedule a notification approximately in the middle of the two. 512f9790aebSLuigi Rizzo * There is a race but this is only called within txsync which does 513f9790aebSLuigi Rizzo * a double check. 514f9790aebSLuigi Rizzo */ 515f9790aebSLuigi Rizzo static void 516f9790aebSLuigi Rizzo generic_set_tx_event(struct netmap_kring *kring, u_int hwcur) 517f9790aebSLuigi Rizzo { 518f9790aebSLuigi Rizzo struct mbuf *m; 519f9790aebSLuigi Rizzo u_int e; 520f9790aebSLuigi Rizzo 52117885a7bSLuigi Rizzo if (nm_next(kring->nr_hwtail, kring->nkr_num_slots -1) == hwcur) { 52217885a7bSLuigi Rizzo return; /* all buffers are free */ 523f9790aebSLuigi Rizzo } 524f9790aebSLuigi Rizzo e = generic_tx_event_middle(kring, hwcur); 525f9790aebSLuigi Rizzo 526f9790aebSLuigi Rizzo m = kring->tx_pool[e]; 527e4166283SLuigi Rizzo ND(5, "Request Event at %d mbuf %p refcnt %d", e, m, m ? GET_MBUF_REFCNT(m) : -2 ); 528f9790aebSLuigi Rizzo if (m == NULL) { 529f9790aebSLuigi Rizzo /* This can happen if there is already an event on the netmap 530f9790aebSLuigi Rizzo slot 'e': There is nothing to do. */ 531f9790aebSLuigi Rizzo return; 532f9790aebSLuigi Rizzo } 533f9790aebSLuigi Rizzo kring->tx_pool[e] = NULL; 534f9790aebSLuigi Rizzo SET_MBUF_DESTRUCTOR(m, generic_mbuf_destructor); 535f9790aebSLuigi Rizzo 536f9790aebSLuigi Rizzo // XXX wmb() ? 537f9790aebSLuigi Rizzo /* Decrement the refcount an free it if we have the last one. */ 538f9790aebSLuigi Rizzo m_freem(m); 539f9790aebSLuigi Rizzo smp_mb(); 540f9790aebSLuigi Rizzo } 541f9790aebSLuigi Rizzo 542f9790aebSLuigi Rizzo 543f9790aebSLuigi Rizzo /* 544f9790aebSLuigi Rizzo * generic_netmap_txsync() transforms netmap buffers into mbufs 545f9790aebSLuigi Rizzo * and passes them to the standard device driver 546f9790aebSLuigi Rizzo * (ndo_start_xmit() or ifp->if_transmit() ). 547f9790aebSLuigi Rizzo * On linux this is not done directly, but using dev_queue_xmit(), 548f9790aebSLuigi Rizzo * since it implements the TX flow control (and takes some locks). 549f9790aebSLuigi Rizzo */ 550f9790aebSLuigi Rizzo static int 5514bf50f18SLuigi Rizzo generic_netmap_txsync(struct netmap_kring *kring, int flags) 552f9790aebSLuigi Rizzo { 5534bf50f18SLuigi Rizzo struct netmap_adapter *na = kring->na; 554f9790aebSLuigi Rizzo struct ifnet *ifp = na->ifp; 555f9790aebSLuigi Rizzo struct netmap_ring *ring = kring->ring; 55617885a7bSLuigi Rizzo u_int nm_i; /* index into the netmap ring */ // j 55717885a7bSLuigi Rizzo u_int const lim = kring->nkr_num_slots - 1; 55817885a7bSLuigi Rizzo u_int const head = kring->rhead; 5594bf50f18SLuigi Rizzo u_int ring_nr = kring->ring_id; 560f9790aebSLuigi Rizzo 561f9790aebSLuigi Rizzo IFRATE(rate_ctx.new.txsync++); 562f9790aebSLuigi Rizzo 563f9790aebSLuigi Rizzo // TODO: handle the case of mbuf allocation failure 564f9790aebSLuigi Rizzo 565f9790aebSLuigi Rizzo rmb(); 56617885a7bSLuigi Rizzo 567f9790aebSLuigi Rizzo /* 56817885a7bSLuigi Rizzo * First part: process new packets to send. 569f9790aebSLuigi Rizzo */ 57017885a7bSLuigi Rizzo nm_i = kring->nr_hwcur; 57117885a7bSLuigi Rizzo if (nm_i != head) { /* we have new packets to send */ 57217885a7bSLuigi Rizzo while (nm_i != head) { 57317885a7bSLuigi Rizzo struct netmap_slot *slot = &ring->slot[nm_i]; 574f9790aebSLuigi Rizzo u_int len = slot->len; 5754bf50f18SLuigi Rizzo void *addr = NMB(na, slot); 57617885a7bSLuigi Rizzo 57717885a7bSLuigi Rizzo /* device-specific */ 578f9790aebSLuigi Rizzo struct mbuf *m; 579f9790aebSLuigi Rizzo int tx_ret; 580f9790aebSLuigi Rizzo 5814bf50f18SLuigi Rizzo NM_CHECK_ADDR_LEN(na, addr, len); 58217885a7bSLuigi Rizzo 583f9790aebSLuigi Rizzo /* Tale a mbuf from the tx pool and copy in the user packet. */ 58417885a7bSLuigi Rizzo m = kring->tx_pool[nm_i]; 585f9790aebSLuigi Rizzo if (unlikely(!m)) { 586f9790aebSLuigi Rizzo RD(5, "This should never happen"); 5874bf50f18SLuigi Rizzo kring->tx_pool[nm_i] = m = netmap_get_mbuf(NETMAP_BUF_SIZE(na)); 588f9790aebSLuigi Rizzo if (unlikely(m == NULL)) { 589f9790aebSLuigi Rizzo D("mbuf allocation failed"); 590f9790aebSLuigi Rizzo break; 591f9790aebSLuigi Rizzo } 592f9790aebSLuigi Rizzo } 593f9790aebSLuigi Rizzo /* XXX we should ask notifications when NS_REPORT is set, 594f9790aebSLuigi Rizzo * or roughly every half frame. We can optimize this 595f9790aebSLuigi Rizzo * by lazily requesting notifications only when a 596f9790aebSLuigi Rizzo * transmission fails. Probably the best way is to 597f9790aebSLuigi Rizzo * break on failures and set notifications when 59817885a7bSLuigi Rizzo * ring->cur == ring->tail || nm_i != cur 599f9790aebSLuigi Rizzo */ 600f9790aebSLuigi Rizzo tx_ret = generic_xmit_frame(ifp, m, addr, len, ring_nr); 601f9790aebSLuigi Rizzo if (unlikely(tx_ret)) { 6024bf50f18SLuigi Rizzo ND(5, "start_xmit failed: err %d [nm_i %u, head %u, hwtail %u]", 60317885a7bSLuigi Rizzo tx_ret, nm_i, head, kring->nr_hwtail); 604f9790aebSLuigi Rizzo /* 605f9790aebSLuigi Rizzo * No room for this mbuf in the device driver. 606f9790aebSLuigi Rizzo * Request a notification FOR A PREVIOUS MBUF, 607f9790aebSLuigi Rizzo * then call generic_netmap_tx_clean(kring) to do the 608f9790aebSLuigi Rizzo * double check and see if we can free more buffers. 609f9790aebSLuigi Rizzo * If there is space continue, else break; 610f9790aebSLuigi Rizzo * NOTE: the double check is necessary if the problem 611f9790aebSLuigi Rizzo * occurs in the txsync call after selrecord(). 612f9790aebSLuigi Rizzo * Also, we need some way to tell the caller that not 613f9790aebSLuigi Rizzo * all buffers were queued onto the device (this was 614f9790aebSLuigi Rizzo * not a problem with native netmap driver where space 615f9790aebSLuigi Rizzo * is preallocated). The bridge has a similar problem 616f9790aebSLuigi Rizzo * and we solve it there by dropping the excess packets. 617f9790aebSLuigi Rizzo */ 61817885a7bSLuigi Rizzo generic_set_tx_event(kring, nm_i); 619f9790aebSLuigi Rizzo if (generic_netmap_tx_clean(kring)) { /* space now available */ 620f9790aebSLuigi Rizzo continue; 621f9790aebSLuigi Rizzo } else { 622f9790aebSLuigi Rizzo break; 623f9790aebSLuigi Rizzo } 624f9790aebSLuigi Rizzo } 625f9790aebSLuigi Rizzo slot->flags &= ~(NS_REPORT | NS_BUF_CHANGED); 62617885a7bSLuigi Rizzo nm_i = nm_next(nm_i, lim); 627f0ea3689SLuigi Rizzo IFRATE(rate_ctx.new.txpkt ++); 628f9790aebSLuigi Rizzo } 629f9790aebSLuigi Rizzo 630f9790aebSLuigi Rizzo /* Update hwcur to the next slot to transmit. */ 63117885a7bSLuigi Rizzo kring->nr_hwcur = nm_i; /* not head, we could break early */ 63217885a7bSLuigi Rizzo } 633f9790aebSLuigi Rizzo 63417885a7bSLuigi Rizzo /* 63517885a7bSLuigi Rizzo * Second, reclaim completed buffers 63617885a7bSLuigi Rizzo */ 63717885a7bSLuigi Rizzo if (flags & NAF_FORCE_RECLAIM || nm_kr_txempty(kring)) { 638f9790aebSLuigi Rizzo /* No more available slots? Set a notification event 639f9790aebSLuigi Rizzo * on a netmap slot that will be cleaned in the future. 640f9790aebSLuigi Rizzo * No doublecheck is performed, since txsync() will be 641f9790aebSLuigi Rizzo * called twice by netmap_poll(). 642f9790aebSLuigi Rizzo */ 64317885a7bSLuigi Rizzo generic_set_tx_event(kring, nm_i); 644f9790aebSLuigi Rizzo } 64517885a7bSLuigi Rizzo ND("tx #%d, hwtail = %d", n, kring->nr_hwtail); 646f9790aebSLuigi Rizzo 64717885a7bSLuigi Rizzo generic_netmap_tx_clean(kring); 64817885a7bSLuigi Rizzo 649f9790aebSLuigi Rizzo return 0; 650f9790aebSLuigi Rizzo } 651f9790aebSLuigi Rizzo 65217885a7bSLuigi Rizzo 653f9790aebSLuigi Rizzo /* 654f9790aebSLuigi Rizzo * This handler is registered (through netmap_catch_rx()) 655f9790aebSLuigi Rizzo * within the attached network interface 656f9790aebSLuigi Rizzo * in the RX subsystem, so that every mbuf passed up by 657f9790aebSLuigi Rizzo * the driver can be stolen to the network stack. 658f9790aebSLuigi Rizzo * Stolen packets are put in a queue where the 659f9790aebSLuigi Rizzo * generic_netmap_rxsync() callback can extract them. 660f9790aebSLuigi Rizzo */ 66117885a7bSLuigi Rizzo void 66217885a7bSLuigi Rizzo generic_rx_handler(struct ifnet *ifp, struct mbuf *m) 663f9790aebSLuigi Rizzo { 664f9790aebSLuigi Rizzo struct netmap_adapter *na = NA(ifp); 665f9790aebSLuigi Rizzo struct netmap_generic_adapter *gna = (struct netmap_generic_adapter *)na; 666f9790aebSLuigi Rizzo u_int work_done; 667f0ea3689SLuigi Rizzo u_int rr = MBUF_RXQ(m); // receive ring number 668f0ea3689SLuigi Rizzo 669f0ea3689SLuigi Rizzo if (rr >= na->num_rx_rings) { 670f0ea3689SLuigi Rizzo rr = rr % na->num_rx_rings; // XXX expensive... 671f0ea3689SLuigi Rizzo } 672f9790aebSLuigi Rizzo 673f9790aebSLuigi Rizzo /* limit the size of the queue */ 674f9790aebSLuigi Rizzo if (unlikely(mbq_len(&na->rx_rings[rr].rx_queue) > 1024)) { 675f9790aebSLuigi Rizzo m_freem(m); 676f9790aebSLuigi Rizzo } else { 677f9790aebSLuigi Rizzo mbq_safe_enqueue(&na->rx_rings[rr].rx_queue, m); 678f9790aebSLuigi Rizzo } 679f9790aebSLuigi Rizzo 680f9790aebSLuigi Rizzo if (netmap_generic_mit < 32768) { 681f9790aebSLuigi Rizzo /* no rx mitigation, pass notification up */ 682f9790aebSLuigi Rizzo netmap_generic_irq(na->ifp, rr, &work_done); 683f9790aebSLuigi Rizzo IFRATE(rate_ctx.new.rxirq++); 684f9790aebSLuigi Rizzo } else { 685f9790aebSLuigi Rizzo /* same as send combining, filter notification if there is a 686f9790aebSLuigi Rizzo * pending timer, otherwise pass it up and start a timer. 687f9790aebSLuigi Rizzo */ 688f0ea3689SLuigi Rizzo if (likely(netmap_mitigation_active(&gna->mit[rr]))) { 689f9790aebSLuigi Rizzo /* Record that there is some pending work. */ 690f0ea3689SLuigi Rizzo gna->mit[rr].mit_pending = 1; 691f9790aebSLuigi Rizzo } else { 692f9790aebSLuigi Rizzo netmap_generic_irq(na->ifp, rr, &work_done); 693f9790aebSLuigi Rizzo IFRATE(rate_ctx.new.rxirq++); 694f0ea3689SLuigi Rizzo netmap_mitigation_start(&gna->mit[rr]); 695f9790aebSLuigi Rizzo } 696f9790aebSLuigi Rizzo } 697f9790aebSLuigi Rizzo } 698f9790aebSLuigi Rizzo 699f9790aebSLuigi Rizzo /* 700f9790aebSLuigi Rizzo * generic_netmap_rxsync() extracts mbufs from the queue filled by 701f9790aebSLuigi Rizzo * generic_netmap_rx_handler() and puts their content in the netmap 702f9790aebSLuigi Rizzo * receive ring. 703f9790aebSLuigi Rizzo * Access must be protected because the rx handler is asynchronous, 704f9790aebSLuigi Rizzo */ 705f9790aebSLuigi Rizzo static int 7064bf50f18SLuigi Rizzo generic_netmap_rxsync(struct netmap_kring *kring, int flags) 707f9790aebSLuigi Rizzo { 708f9790aebSLuigi Rizzo struct netmap_ring *ring = kring->ring; 7094bf50f18SLuigi Rizzo struct netmap_adapter *na = kring->na; 71017885a7bSLuigi Rizzo u_int nm_i; /* index into the netmap ring */ //j, 71117885a7bSLuigi Rizzo u_int n; 71217885a7bSLuigi Rizzo u_int const lim = kring->nkr_num_slots - 1; 713847bf383SLuigi Rizzo u_int const head = kring->rhead; 714f9790aebSLuigi Rizzo int force_update = (flags & NAF_FORCE_READ) || kring->nr_kflags & NKR_PENDINTR; 715f9790aebSLuigi Rizzo 71617885a7bSLuigi Rizzo if (head > lim) 717f9790aebSLuigi Rizzo return netmap_ring_reinit(kring); 718f9790aebSLuigi Rizzo 71917885a7bSLuigi Rizzo /* 72017885a7bSLuigi Rizzo * First part: import newly received packets. 72117885a7bSLuigi Rizzo */ 722f9790aebSLuigi Rizzo if (netmap_no_pendintr || force_update) { 72317885a7bSLuigi Rizzo /* extract buffers from the rx queue, stop at most one 72417885a7bSLuigi Rizzo * slot before nr_hwcur (stop_i) 72517885a7bSLuigi Rizzo */ 726f9790aebSLuigi Rizzo uint16_t slot_flags = kring->nkr_slot_flags; 72717885a7bSLuigi Rizzo u_int stop_i = nm_prev(kring->nr_hwcur, lim); 72817885a7bSLuigi Rizzo 72917885a7bSLuigi Rizzo nm_i = kring->nr_hwtail; /* first empty slot in the receive ring */ 73017885a7bSLuigi Rizzo for (n = 0; nm_i != stop_i; n++) { 73117885a7bSLuigi Rizzo int len; 7324bf50f18SLuigi Rizzo void *addr = NMB(na, &ring->slot[nm_i]); 733f9790aebSLuigi Rizzo struct mbuf *m; 734f9790aebSLuigi Rizzo 73517885a7bSLuigi Rizzo /* we only check the address here on generic rx rings */ 7364bf50f18SLuigi Rizzo if (addr == NETMAP_BUF_BASE(na)) { /* Bad buffer */ 737f9790aebSLuigi Rizzo return netmap_ring_reinit(kring); 738f9790aebSLuigi Rizzo } 739f9790aebSLuigi Rizzo /* 740f9790aebSLuigi Rizzo * Call the locked version of the function. 74117885a7bSLuigi Rizzo * XXX Ideally we could grab a batch of mbufs at once 74217885a7bSLuigi Rizzo * and save some locking overhead. 743f9790aebSLuigi Rizzo */ 744f9790aebSLuigi Rizzo m = mbq_safe_dequeue(&kring->rx_queue); 74517885a7bSLuigi Rizzo if (!m) /* no more data */ 746f9790aebSLuigi Rizzo break; 747f9790aebSLuigi Rizzo len = MBUF_LEN(m); 748f9790aebSLuigi Rizzo m_copydata(m, 0, len, addr); 74917885a7bSLuigi Rizzo ring->slot[nm_i].len = len; 75017885a7bSLuigi Rizzo ring->slot[nm_i].flags = slot_flags; 751f9790aebSLuigi Rizzo m_freem(m); 75217885a7bSLuigi Rizzo nm_i = nm_next(nm_i, lim); 753f9790aebSLuigi Rizzo } 754f9790aebSLuigi Rizzo if (n) { 75517885a7bSLuigi Rizzo kring->nr_hwtail = nm_i; 756f9790aebSLuigi Rizzo IFRATE(rate_ctx.new.rxpkt += n); 757f9790aebSLuigi Rizzo } 758f9790aebSLuigi Rizzo kring->nr_kflags &= ~NKR_PENDINTR; 759f9790aebSLuigi Rizzo } 760f9790aebSLuigi Rizzo 761f9790aebSLuigi Rizzo // XXX should we invert the order ? 76217885a7bSLuigi Rizzo /* 76317885a7bSLuigi Rizzo * Second part: skip past packets that userspace has released. 76417885a7bSLuigi Rizzo */ 76517885a7bSLuigi Rizzo nm_i = kring->nr_hwcur; 76617885a7bSLuigi Rizzo if (nm_i != head) { 767f9790aebSLuigi Rizzo /* Userspace has released some packets. */ 76817885a7bSLuigi Rizzo for (n = 0; nm_i != head; n++) { 76917885a7bSLuigi Rizzo struct netmap_slot *slot = &ring->slot[nm_i]; 770f9790aebSLuigi Rizzo 771f9790aebSLuigi Rizzo slot->flags &= ~NS_BUF_CHANGED; 77217885a7bSLuigi Rizzo nm_i = nm_next(nm_i, lim); 773f9790aebSLuigi Rizzo } 77417885a7bSLuigi Rizzo kring->nr_hwcur = head; 775f9790aebSLuigi Rizzo } 776f9790aebSLuigi Rizzo IFRATE(rate_ctx.new.rxsync++); 777f9790aebSLuigi Rizzo 778f9790aebSLuigi Rizzo return 0; 779f9790aebSLuigi Rizzo } 780f9790aebSLuigi Rizzo 781f9790aebSLuigi Rizzo static void 782f9790aebSLuigi Rizzo generic_netmap_dtor(struct netmap_adapter *na) 783f9790aebSLuigi Rizzo { 784f9790aebSLuigi Rizzo struct netmap_generic_adapter *gna = (struct netmap_generic_adapter*)na; 785847bf383SLuigi Rizzo struct ifnet *ifp = netmap_generic_getifp(gna); 786f9790aebSLuigi Rizzo struct netmap_adapter *prev_na = gna->prev; 787f9790aebSLuigi Rizzo 788f9790aebSLuigi Rizzo if (prev_na != NULL) { 789f9790aebSLuigi Rizzo D("Released generic NA %p", gna); 790847bf383SLuigi Rizzo if_rele(ifp); 791847bf383SLuigi Rizzo netmap_adapter_put(prev_na); 792847bf383SLuigi Rizzo if (na->ifp == NULL) { 793847bf383SLuigi Rizzo /* 794847bf383SLuigi Rizzo * The driver has been removed without releasing 795847bf383SLuigi Rizzo * the reference so we need to do it here. 796847bf383SLuigi Rizzo */ 797f9790aebSLuigi Rizzo netmap_adapter_put(prev_na); 798f9790aebSLuigi Rizzo } 799847bf383SLuigi Rizzo } 800f9790aebSLuigi Rizzo WNA(ifp) = prev_na; 801f9790aebSLuigi Rizzo D("Restored native NA %p", prev_na); 802f9790aebSLuigi Rizzo na->ifp = NULL; 803f9790aebSLuigi Rizzo } 804f9790aebSLuigi Rizzo 805f9790aebSLuigi Rizzo /* 806f9790aebSLuigi Rizzo * generic_netmap_attach() makes it possible to use netmap on 807f9790aebSLuigi Rizzo * a device without native netmap support. 808f9790aebSLuigi Rizzo * This is less performant than native support but potentially 809f9790aebSLuigi Rizzo * faster than raw sockets or similar schemes. 810f9790aebSLuigi Rizzo * 811f9790aebSLuigi Rizzo * In this "emulated" mode, netmap rings do not necessarily 812f9790aebSLuigi Rizzo * have the same size as those in the NIC. We use a default 813f9790aebSLuigi Rizzo * value and possibly override it if the OS has ways to fetch the 814f9790aebSLuigi Rizzo * actual configuration. 815f9790aebSLuigi Rizzo */ 816f9790aebSLuigi Rizzo int 817f9790aebSLuigi Rizzo generic_netmap_attach(struct ifnet *ifp) 818f9790aebSLuigi Rizzo { 819f9790aebSLuigi Rizzo struct netmap_adapter *na; 820f9790aebSLuigi Rizzo struct netmap_generic_adapter *gna; 821f9790aebSLuigi Rizzo int retval; 822f9790aebSLuigi Rizzo u_int num_tx_desc, num_rx_desc; 823f9790aebSLuigi Rizzo 824f9790aebSLuigi Rizzo num_tx_desc = num_rx_desc = netmap_generic_ringsize; /* starting point */ 825f9790aebSLuigi Rizzo 826db5cb211SLuigi Rizzo generic_find_num_desc(ifp, &num_tx_desc, &num_rx_desc); /* ignore errors */ 827f9790aebSLuigi Rizzo ND("Netmap ring size: TX = %d, RX = %d", num_tx_desc, num_rx_desc); 828e4166283SLuigi Rizzo if (num_tx_desc == 0 || num_rx_desc == 0) { 829e4166283SLuigi Rizzo D("Device has no hw slots (tx %u, rx %u)", num_tx_desc, num_rx_desc); 830e4166283SLuigi Rizzo return EINVAL; 831e4166283SLuigi Rizzo } 832f9790aebSLuigi Rizzo 833f9790aebSLuigi Rizzo gna = malloc(sizeof(*gna), M_DEVBUF, M_NOWAIT | M_ZERO); 834f9790aebSLuigi Rizzo if (gna == NULL) { 835f9790aebSLuigi Rizzo D("no memory on attach, give up"); 836f9790aebSLuigi Rizzo return ENOMEM; 837f9790aebSLuigi Rizzo } 838f9790aebSLuigi Rizzo na = (struct netmap_adapter *)gna; 839847bf383SLuigi Rizzo strncpy(na->name, ifp->if_xname, sizeof(na->name)); 840f9790aebSLuigi Rizzo na->ifp = ifp; 841f9790aebSLuigi Rizzo na->num_tx_desc = num_tx_desc; 842f9790aebSLuigi Rizzo na->num_rx_desc = num_rx_desc; 843f9790aebSLuigi Rizzo na->nm_register = &generic_netmap_register; 844f9790aebSLuigi Rizzo na->nm_txsync = &generic_netmap_txsync; 845f9790aebSLuigi Rizzo na->nm_rxsync = &generic_netmap_rxsync; 846f9790aebSLuigi Rizzo na->nm_dtor = &generic_netmap_dtor; 8474bf50f18SLuigi Rizzo /* when using generic, NAF_NETMAP_ON is set so we force 848f9790aebSLuigi Rizzo * NAF_SKIP_INTR to use the regular interrupt handler 849f9790aebSLuigi Rizzo */ 850f0ea3689SLuigi Rizzo na->na_flags = NAF_SKIP_INTR | NAF_HOST_RINGS; 851f9790aebSLuigi Rizzo 852f9790aebSLuigi Rizzo ND("[GNA] num_tx_queues(%d), real_num_tx_queues(%d), len(%lu)", 853f9790aebSLuigi Rizzo ifp->num_tx_queues, ifp->real_num_tx_queues, 854f9790aebSLuigi Rizzo ifp->tx_queue_len); 855f9790aebSLuigi Rizzo ND("[GNA] num_rx_queues(%d), real_num_rx_queues(%d)", 856f9790aebSLuigi Rizzo ifp->num_rx_queues, ifp->real_num_rx_queues); 857f9790aebSLuigi Rizzo 858f9790aebSLuigi Rizzo generic_find_num_queues(ifp, &na->num_tx_rings, &na->num_rx_rings); 859f9790aebSLuigi Rizzo 860f9790aebSLuigi Rizzo retval = netmap_attach_common(na); 861f9790aebSLuigi Rizzo if (retval) { 862f9790aebSLuigi Rizzo free(gna, M_DEVBUF); 863f9790aebSLuigi Rizzo } 864f9790aebSLuigi Rizzo 865f9790aebSLuigi Rizzo return retval; 866f9790aebSLuigi Rizzo } 867