xref: /dflybsd-src/sys/net/netmap/netmap_generic.c (revision f933b737dabc806a2f1680f0afea2fb42a345b92)
1fb578518SFranco Fichtner /*
2fb578518SFranco Fichtner  * Copyright (C) 2013 Universita` di Pisa. All rights reserved.
3fb578518SFranco Fichtner  *
4fb578518SFranco Fichtner  * Redistribution and use in source and binary forms, with or without
5fb578518SFranco Fichtner  * modification, are permitted provided that the following conditions
6fb578518SFranco Fichtner  * are met:
7fb578518SFranco Fichtner  *   1. Redistributions of source code must retain the above copyright
8fb578518SFranco Fichtner  *      notice, this list of conditions and the following disclaimer.
9fb578518SFranco Fichtner  *   2. Redistributions in binary form must reproduce the above copyright
10fb578518SFranco Fichtner  *      notice, this list of conditions and the following disclaimer in the
11fb578518SFranco Fichtner  *      documentation and/or other materials provided with the distribution.
12fb578518SFranco Fichtner  *
13fb578518SFranco Fichtner  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
14fb578518SFranco Fichtner  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
15fb578518SFranco Fichtner  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
16fb578518SFranco Fichtner  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
17fb578518SFranco Fichtner  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
18fb578518SFranco Fichtner  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
19fb578518SFranco Fichtner  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
20fb578518SFranco Fichtner  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
21fb578518SFranco Fichtner  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
22fb578518SFranco Fichtner  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
23fb578518SFranco Fichtner  * SUCH DAMAGE.
24fb578518SFranco Fichtner  */
25fb578518SFranco Fichtner 
26fb578518SFranco Fichtner /*
27fb578518SFranco Fichtner  * This module implements netmap support on top of standard,
28fb578518SFranco Fichtner  * unmodified device drivers.
29fb578518SFranco Fichtner  *
30fb578518SFranco Fichtner  * A NIOCREGIF request is handled here if the device does not
31fb578518SFranco Fichtner  * have native support. TX and RX rings are emulated as follows:
32fb578518SFranco Fichtner  *
33fb578518SFranco Fichtner  * NIOCREGIF
34fb578518SFranco Fichtner  *	We preallocate a block of TX mbufs (roughly as many as
35fb578518SFranco Fichtner  *	tx descriptors; the number is not critical) to speed up
36fb578518SFranco Fichtner  *	operation during transmissions. The refcount on most of
37fb578518SFranco Fichtner  *	these buffers is artificially bumped up so we can recycle
38fb578518SFranco Fichtner  *	them more easily. Also, the destructor is intercepted
39fb578518SFranco Fichtner  *	so we use it as an interrupt notification to wake up
40fb578518SFranco Fichtner  *	processes blocked on a poll().
41fb578518SFranco Fichtner  *
42fb578518SFranco Fichtner  *	For each receive ring we allocate one "struct mbq"
43fb578518SFranco Fichtner  *	(an mbuf tailq plus a spinlock). We intercept packets
44fb578518SFranco Fichtner  *	(through if_input)
45fb578518SFranco Fichtner  *	on the receive path and put them in the mbq from which
46fb578518SFranco Fichtner  *	netmap receive routines can grab them.
47fb578518SFranco Fichtner  *
48fb578518SFranco Fichtner  * TX:
49fb578518SFranco Fichtner  *	in the generic_txsync() routine, netmap buffers are copied
50fb578518SFranco Fichtner  *	(or linked, in a future) to the preallocated mbufs
51fb578518SFranco Fichtner  *	and pushed to the transmit queue. Some of these mbufs
52fb578518SFranco Fichtner  *	(those with NS_REPORT, or otherwise every half ring)
53fb578518SFranco Fichtner  *	have the refcount=1, others have refcount=2.
54fb578518SFranco Fichtner  *	When the destructor is invoked, we take that as
55fb578518SFranco Fichtner  *	a notification that all mbufs up to that one in
56fb578518SFranco Fichtner  *	the specific ring have been completed, and generate
57fb578518SFranco Fichtner  *	the equivalent of a transmit interrupt.
58fb578518SFranco Fichtner  *
59fb578518SFranco Fichtner  * RX:
60fb578518SFranco Fichtner  *
61fb578518SFranco Fichtner  */
62fb578518SFranco Fichtner 
63fb578518SFranco Fichtner 
64785c7ee6SFranco Fichtner #include <sys/cdefs.h> /* prerequisite */
65785c7ee6SFranco Fichtner __FBSDID("$FreeBSD: head/sys/dev/netmap/netmap.c 257666 2013-11-05 01:06:22Z luigi $");
66785c7ee6SFranco Fichtner 
67fb578518SFranco Fichtner #include <sys/types.h>
68fb578518SFranco Fichtner #include <sys/errno.h>
69fb578518SFranco Fichtner #include <sys/malloc.h>
70fb578518SFranco Fichtner #include <sys/lock.h>   /* PROT_EXEC */
71fb578518SFranco Fichtner #include <sys/socket.h> /* sockaddrs */
7213431b3eSFranco Fichtner #include <sys/event.h>
73fb578518SFranco Fichtner #include <net/if.h>
74fb578518SFranco Fichtner #include <net/if_var.h>
75ed9bd855SFranco Fichtner #include <sys/bus.h>        /* bus_dmamap_* in netmap_kern.h */
76fb578518SFranco Fichtner 
77fb578518SFranco Fichtner // XXX temporary - D() defined here
78*f933b737SSascha Wildner #include <net/netmap/netmap.h>
79b3f97fadSFranco Fichtner #include <net/netmap/netmap_kern.h>
80b3f97fadSFranco Fichtner #include <net/netmap/netmap_mem2.h>
81fb578518SFranco Fichtner 
82fb578518SFranco Fichtner #define rtnl_lock() D("rtnl_lock called");
83fb578518SFranco Fichtner #define rtnl_unlock() D("rtnl_lock called");
84bf9f7c16SFranco Fichtner #define MBUF_TXQ(m)	((m)->m_pkthdr.hash)
85fb578518SFranco Fichtner #define smp_mb()
86fb578518SFranco Fichtner 
87fb578518SFranco Fichtner /*
88fb578518SFranco Fichtner  * mbuf wrappers
89fb578518SFranco Fichtner  */
90fb578518SFranco Fichtner 
91fb578518SFranco Fichtner /*
92fb578518SFranco Fichtner  * we allocate an EXT_PACKET
93fb578518SFranco Fichtner  */
94b5523eacSSascha Wildner #define netmap_get_mbuf(len) m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR)
95fb578518SFranco Fichtner 
96fb578518SFranco Fichtner /* mbuf destructor, also need to change the type to EXT_EXTREF,
97fb578518SFranco Fichtner  * add an M_NOFREE flag, and then clear the flag and
98fb578518SFranco Fichtner  * chain into uma_zfree(zone_pack, mf)
99fb578518SFranco Fichtner  * (or reinstall the buffer ?)
100fb578518SFranco Fichtner  */
101fb578518SFranco Fichtner #define SET_MBUF_DESTRUCTOR(m, fn)	do {		\
102fb578518SFranco Fichtner 		(m)->m_ext.ext_free = (void *)fn;	\
103bf9f7c16SFranco Fichtner 		/* (m)->m_ext.ext_type = EXT_EXTREF; */	\
104fb578518SFranco Fichtner 	} while (0)
105fb578518SFranco Fichtner 
106fb578518SFranco Fichtner 
107fb578518SFranco Fichtner #define GET_MBUF_REFCNT(m)	((m)->m_ext.ref_cnt ? *(m)->m_ext.ref_cnt : -1)
108fb578518SFranco Fichtner 
109fb578518SFranco Fichtner /* ======================== usage stats =========================== */
110fb578518SFranco Fichtner 
111fb578518SFranco Fichtner #ifdef RATE
112fb578518SFranco Fichtner #define IFRATE(x) x
113fb578518SFranco Fichtner struct rate_stats {
114fb578518SFranco Fichtner     unsigned long txpkt;
115fb578518SFranco Fichtner     unsigned long txsync;
116fb578518SFranco Fichtner     unsigned long txirq;
117fb578518SFranco Fichtner     unsigned long rxpkt;
118fb578518SFranco Fichtner     unsigned long rxirq;
119fb578518SFranco Fichtner     unsigned long rxsync;
120fb578518SFranco Fichtner };
121fb578518SFranco Fichtner 
122fb578518SFranco Fichtner struct rate_context {
123fb578518SFranco Fichtner     unsigned refcount;
124fb578518SFranco Fichtner     struct timer_list timer;
125fb578518SFranco Fichtner     struct rate_stats new;
126fb578518SFranco Fichtner     struct rate_stats old;
127fb578518SFranco Fichtner };
128fb578518SFranco Fichtner 
129fb578518SFranco Fichtner #define RATE_PRINTK(_NAME_) \
130fb578518SFranco Fichtner     printk( #_NAME_ " = %lu Hz\n", (cur._NAME_ - ctx->old._NAME_)/RATE_PERIOD);
131fb578518SFranco Fichtner #define RATE_PERIOD  2
rate_callback(unsigned long arg)132fb578518SFranco Fichtner static void rate_callback(unsigned long arg)
133fb578518SFranco Fichtner {
134fb578518SFranco Fichtner     struct rate_context * ctx = (struct rate_context *)arg;
135fb578518SFranco Fichtner     struct rate_stats cur = ctx->new;
136fb578518SFranco Fichtner     int r;
137fb578518SFranco Fichtner 
138fb578518SFranco Fichtner     RATE_PRINTK(txpkt);
139fb578518SFranco Fichtner     RATE_PRINTK(txsync);
140fb578518SFranco Fichtner     RATE_PRINTK(txirq);
141fb578518SFranco Fichtner     RATE_PRINTK(rxpkt);
142fb578518SFranco Fichtner     RATE_PRINTK(rxsync);
143fb578518SFranco Fichtner     RATE_PRINTK(rxirq);
144fb578518SFranco Fichtner     printk("\n");
145fb578518SFranco Fichtner 
146fb578518SFranco Fichtner     ctx->old = cur;
147fb578518SFranco Fichtner     r = mod_timer(&ctx->timer, jiffies +
148fb578518SFranco Fichtner                                 msecs_to_jiffies(RATE_PERIOD * 1000));
149fb578518SFranco Fichtner     if (unlikely(r))
150fb578518SFranco Fichtner         D("[v1000] Error: mod_timer()");
151fb578518SFranco Fichtner }
152fb578518SFranco Fichtner 
153fb578518SFranco Fichtner static struct rate_context rate_ctx;
154fb578518SFranco Fichtner 
155fb578518SFranco Fichtner #else /* !RATE */
156fb578518SFranco Fichtner #define IFRATE(x)
157fb578518SFranco Fichtner #endif /* !RATE */
158fb578518SFranco Fichtner 
159fb578518SFranco Fichtner 
160fb578518SFranco Fichtner /* =============== GENERIC NETMAP ADAPTER SUPPORT ================= */
161fb578518SFranco Fichtner #define GENERIC_BUF_SIZE        netmap_buf_size    /* Size of the mbufs in the Tx pool. */
162fb578518SFranco Fichtner 
163fb578518SFranco Fichtner /*
164fb578518SFranco Fichtner  * Wrapper used by the generic adapter layer to notify
165fb578518SFranco Fichtner  * the poller threads. Differently from netmap_rx_irq(), we check
166fb578518SFranco Fichtner  * only IFCAP_NETMAP instead of NAF_NATIVE_ON to enable the irq.
167fb578518SFranco Fichtner  */
168fb578518SFranco Fichtner static int
netmap_generic_irq(struct ifnet * ifp,u_int q,u_int * work_done)169fb578518SFranco Fichtner netmap_generic_irq(struct ifnet *ifp, u_int q, u_int *work_done)
170fb578518SFranco Fichtner {
171fb578518SFranco Fichtner 	if (unlikely(!(ifp->if_capenable & IFCAP_NETMAP)))
172fb578518SFranco Fichtner 		return 0;
173fb578518SFranco Fichtner 
174fb578518SFranco Fichtner         return netmap_common_irq(ifp, q, work_done);
175fb578518SFranco Fichtner }
176fb578518SFranco Fichtner 
177fb578518SFranco Fichtner 
178fb578518SFranco Fichtner /* Enable/disable netmap mode for a generic network interface. */
generic_netmap_register(struct netmap_adapter * na,int enable)179fb578518SFranco Fichtner int generic_netmap_register(struct netmap_adapter *na, int enable)
180fb578518SFranco Fichtner {
181fb578518SFranco Fichtner     struct ifnet *ifp = na->ifp;
182fb578518SFranco Fichtner     struct netmap_generic_adapter *gna = (struct netmap_generic_adapter *)na;
183fb578518SFranco Fichtner     struct mbuf *m;
184fb578518SFranco Fichtner     int error;
185fb578518SFranco Fichtner     int i, r;
186fb578518SFranco Fichtner 
187fb578518SFranco Fichtner #ifdef REG_RESET
188fb578518SFranco Fichtner     error = ifp->netdev_ops->ndo_stop(ifp);
189fb578518SFranco Fichtner     if (error) {
190fb578518SFranco Fichtner         return error;
191fb578518SFranco Fichtner     }
192fb578518SFranco Fichtner #endif /* REG_RESET */
193fb578518SFranco Fichtner 
194fb578518SFranco Fichtner     if (enable) { /* Enable netmap mode. */
195fb578518SFranco Fichtner         /* Initialize the rx queue, as generic_rx_handler() can
196fb578518SFranco Fichtner 	 * be called as soon as netmap_catch_rx() returns.
197fb578518SFranco Fichtner 	 */
198fb578518SFranco Fichtner         for (r=0; r<na->num_rx_rings; r++) {
199fb578518SFranco Fichtner             mbq_safe_init(&na->rx_rings[r].rx_queue);
200fb578518SFranco Fichtner             na->rx_rings[r].nr_ntc = 0;
201fb578518SFranco Fichtner         }
202fb578518SFranco Fichtner 
203fb578518SFranco Fichtner         /* Init the mitigation timer. */
204fb578518SFranco Fichtner         netmap_mitigation_init(gna);
205fb578518SFranco Fichtner 
206fb578518SFranco Fichtner 	/*
207fb578518SFranco Fichtner 	 * Preallocate packet buffers for the tx rings.
208fb578518SFranco Fichtner 	 */
209fb578518SFranco Fichtner         for (r=0; r<na->num_tx_rings; r++) {
210fb578518SFranco Fichtner             na->tx_rings[r].nr_ntc = 0;
211ed9bd855SFranco Fichtner             na->tx_rings[r].tx_pool = kmalloc(na->num_tx_desc * sizeof(struct mbuf *),
212fb578518SFranco Fichtner 				    M_DEVBUF, M_NOWAIT | M_ZERO);
213fb578518SFranco Fichtner             if (!na->tx_rings[r].tx_pool) {
214fb578518SFranco Fichtner                 D("tx_pool allocation failed");
215fb578518SFranco Fichtner                 error = ENOMEM;
216fb578518SFranco Fichtner                 goto free_tx_pool;
217fb578518SFranco Fichtner             }
218fb578518SFranco Fichtner             for (i=0; i<na->num_tx_desc; i++) {
219fb578518SFranco Fichtner                 m = netmap_get_mbuf(GENERIC_BUF_SIZE);
220fb578518SFranco Fichtner                 if (!m) {
221fb578518SFranco Fichtner                     D("tx_pool[%d] allocation failed", i);
222fb578518SFranco Fichtner                     error = ENOMEM;
223fb578518SFranco Fichtner                     goto free_mbufs;
224fb578518SFranco Fichtner                 }
225fb578518SFranco Fichtner                 na->tx_rings[r].tx_pool[i] = m;
226fb578518SFranco Fichtner             }
227fb578518SFranco Fichtner         }
228fb578518SFranco Fichtner         rtnl_lock();
229fb578518SFranco Fichtner 	/* Prepare to intercept incoming traffic. */
230fb578518SFranco Fichtner         error = netmap_catch_rx(na, 1);
231fb578518SFranco Fichtner         if (error) {
232fb578518SFranco Fichtner             D("netdev_rx_handler_register() failed");
233fb578518SFranco Fichtner             goto register_handler;
234fb578518SFranco Fichtner         }
235fb578518SFranco Fichtner         ifp->if_capenable |= IFCAP_NETMAP;
236fb578518SFranco Fichtner 
237fb578518SFranco Fichtner         /* Make netmap control the packet steering. */
238fb578518SFranco Fichtner         netmap_catch_packet_steering(gna, 1);
239fb578518SFranco Fichtner 
240fb578518SFranco Fichtner         rtnl_unlock();
241fb578518SFranco Fichtner 
242fb578518SFranco Fichtner #ifdef RATE
243fb578518SFranco Fichtner         if (rate_ctx.refcount == 0) {
244fb578518SFranco Fichtner             D("setup_timer()");
245fb578518SFranco Fichtner             memset(&rate_ctx, 0, sizeof(rate_ctx));
246fb578518SFranco Fichtner             setup_timer(&rate_ctx.timer, &rate_callback, (unsigned long)&rate_ctx);
247fb578518SFranco Fichtner             if (mod_timer(&rate_ctx.timer, jiffies + msecs_to_jiffies(1500))) {
248fb578518SFranco Fichtner                 D("Error: mod_timer()");
249fb578518SFranco Fichtner             }
250fb578518SFranco Fichtner         }
251fb578518SFranco Fichtner         rate_ctx.refcount++;
252fb578518SFranco Fichtner #endif /* RATE */
253fb578518SFranco Fichtner 
254fb578518SFranco Fichtner     } else { /* Disable netmap mode. */
255fb578518SFranco Fichtner         rtnl_lock();
256fb578518SFranco Fichtner 
257fb578518SFranco Fichtner         ifp->if_capenable &= ~IFCAP_NETMAP;
258fb578518SFranco Fichtner 
259fb578518SFranco Fichtner         /* Release packet steering control. */
260fb578518SFranco Fichtner         netmap_catch_packet_steering(gna, 0);
261fb578518SFranco Fichtner 
262fb578518SFranco Fichtner 	/* Do not intercept packets on the rx path. */
263fb578518SFranco Fichtner         netmap_catch_rx(na, 0);
264fb578518SFranco Fichtner 
265fb578518SFranco Fichtner         rtnl_unlock();
266fb578518SFranco Fichtner 
267fb578518SFranco Fichtner 	/* Free the mbufs going to the netmap rings */
268fb578518SFranco Fichtner         for (r=0; r<na->num_rx_rings; r++) {
269fb578518SFranco Fichtner             mbq_safe_purge(&na->rx_rings[r].rx_queue);
270fb578518SFranco Fichtner             mbq_safe_destroy(&na->rx_rings[r].rx_queue);
271fb578518SFranco Fichtner         }
272fb578518SFranco Fichtner 
273fb578518SFranco Fichtner         netmap_mitigation_cleanup(gna);
274fb578518SFranco Fichtner 
275fb578518SFranco Fichtner         for (r=0; r<na->num_tx_rings; r++) {
276fb578518SFranco Fichtner             for (i=0; i<na->num_tx_desc; i++) {
277fb578518SFranco Fichtner                 m_freem(na->tx_rings[r].tx_pool[i]);
278fb578518SFranco Fichtner             }
279ed9bd855SFranco Fichtner             kfree(na->tx_rings[r].tx_pool, M_DEVBUF);
280fb578518SFranco Fichtner         }
281fb578518SFranco Fichtner 
282fb578518SFranco Fichtner #ifdef RATE
283fb578518SFranco Fichtner         if (--rate_ctx.refcount == 0) {
284fb578518SFranco Fichtner             D("del_timer()");
285fb578518SFranco Fichtner             del_timer(&rate_ctx.timer);
286fb578518SFranco Fichtner         }
287fb578518SFranco Fichtner #endif
288fb578518SFranco Fichtner     }
289fb578518SFranco Fichtner 
290fb578518SFranco Fichtner #ifdef REG_RESET
291fb578518SFranco Fichtner     error = ifp->netdev_ops->ndo_open(ifp);
292fb578518SFranco Fichtner     if (error) {
293fb578518SFranco Fichtner         goto alloc_tx_pool;
294fb578518SFranco Fichtner     }
295fb578518SFranco Fichtner #endif
296fb578518SFranco Fichtner 
297fb578518SFranco Fichtner     return 0;
298fb578518SFranco Fichtner 
299fb578518SFranco Fichtner register_handler:
300fb578518SFranco Fichtner     rtnl_unlock();
301fb578518SFranco Fichtner free_tx_pool:
302fb578518SFranco Fichtner     r--;
303fb578518SFranco Fichtner     i = na->num_tx_desc;  /* Useless, but just to stay safe. */
304fb578518SFranco Fichtner free_mbufs:
305fb578518SFranco Fichtner     i--;
306fb578518SFranco Fichtner     for (; r>=0; r--) {
307fb578518SFranco Fichtner         for (; i>=0; i--) {
308fb578518SFranco Fichtner             m_freem(na->tx_rings[r].tx_pool[i]);
309fb578518SFranco Fichtner         }
310ed9bd855SFranco Fichtner         kfree(na->tx_rings[r].tx_pool, M_DEVBUF);
311fb578518SFranco Fichtner         i = na->num_tx_desc - 1;
312fb578518SFranco Fichtner     }
313fb578518SFranco Fichtner 
314fb578518SFranco Fichtner     return error;
315fb578518SFranco Fichtner }
316fb578518SFranco Fichtner 
317fb578518SFranco Fichtner /*
318fb578518SFranco Fichtner  * Callback invoked when the device driver frees an mbuf used
319fb578518SFranco Fichtner  * by netmap to transmit a packet. This usually happens when
320fb578518SFranco Fichtner  * the NIC notifies the driver that transmission is completed.
321fb578518SFranco Fichtner  */
322fb578518SFranco Fichtner static void
generic_mbuf_destructor(struct mbuf * m)323fb578518SFranco Fichtner generic_mbuf_destructor(struct mbuf *m)
324fb578518SFranco Fichtner {
325fb578518SFranco Fichtner     if (netmap_verbose)
326fb578518SFranco Fichtner 	    D("Tx irq (%p) queue %d", m, MBUF_TXQ(m));
327fb578518SFranco Fichtner     netmap_generic_irq(MBUF_IFP(m), MBUF_TXQ(m), NULL);
328bf9f7c16SFranco Fichtner #if 0
329fb578518SFranco Fichtner     m->m_ext.ext_type = EXT_PACKET;
330bf9f7c16SFranco Fichtner #endif
331fb578518SFranco Fichtner     m->m_ext.ext_free = NULL;
332bf9f7c16SFranco Fichtner #if 0
333fb578518SFranco Fichtner     if (*(m->m_ext.ref_cnt) == 0)
334fb578518SFranco Fichtner 	*(m->m_ext.ref_cnt) = 1;
335fb578518SFranco Fichtner     uma_zfree(zone_pack, m);
336bf9f7c16SFranco Fichtner #endif
337fb578518SFranco Fichtner     IFRATE(rate_ctx.new.txirq++);
338fb578518SFranco Fichtner }
339fb578518SFranco Fichtner 
340fb578518SFranco Fichtner /* Record completed transmissions and update hwavail.
341fb578518SFranco Fichtner  *
342fb578518SFranco Fichtner  * nr_ntc is the oldest tx buffer not yet completed
343fb578518SFranco Fichtner  * (same as nr_hwavail + nr_hwcur + 1),
344fb578518SFranco Fichtner  * nr_hwcur is the first unsent buffer.
345fb578518SFranco Fichtner  * When cleaning, we try to recover buffers between nr_ntc and nr_hwcur.
346fb578518SFranco Fichtner  */
347fb578518SFranco Fichtner static int
generic_netmap_tx_clean(struct netmap_kring * kring)348fb578518SFranco Fichtner generic_netmap_tx_clean(struct netmap_kring *kring)
349fb578518SFranco Fichtner {
350fb578518SFranco Fichtner     u_int num_slots = kring->nkr_num_slots;
351fb578518SFranco Fichtner     u_int ntc = kring->nr_ntc;
352fb578518SFranco Fichtner     u_int hwcur = kring->nr_hwcur;
353fb578518SFranco Fichtner     u_int n = 0;
354fb578518SFranco Fichtner     struct mbuf **tx_pool = kring->tx_pool;
355fb578518SFranco Fichtner 
356fb578518SFranco Fichtner     while (ntc != hwcur) { /* buffers not completed */
357fb578518SFranco Fichtner 	struct mbuf *m = tx_pool[ntc];
358fb578518SFranco Fichtner 
359fb578518SFranco Fichtner         if (unlikely(m == NULL)) {
360fb578518SFranco Fichtner 	    /* try to replenish the entry */
361fb578518SFranco Fichtner             tx_pool[ntc] = m = netmap_get_mbuf(GENERIC_BUF_SIZE);
362fb578518SFranco Fichtner             if (unlikely(m == NULL)) {
363fb578518SFranco Fichtner                 D("mbuf allocation failed, XXX error");
364fb578518SFranco Fichtner 		// XXX how do we proceed ? break ?
365fb578518SFranco Fichtner                 return -ENOMEM;
366fb578518SFranco Fichtner             }
367bf9f7c16SFranco Fichtner #if 0
368fb578518SFranco Fichtner 	} else if (GET_MBUF_REFCNT(m) != 1) {
369fb578518SFranco Fichtner 	    break; /* This mbuf is still busy: its refcnt is 2. */
370bf9f7c16SFranco Fichtner #endif
371fb578518SFranco Fichtner 	}
372fb578518SFranco Fichtner         if (unlikely(++ntc == num_slots)) {
373fb578518SFranco Fichtner             ntc = 0;
374fb578518SFranco Fichtner         }
375fb578518SFranco Fichtner         n++;
376fb578518SFranco Fichtner     }
377fb578518SFranco Fichtner     kring->nr_ntc = ntc;
378fb578518SFranco Fichtner     kring->nr_hwavail += n;
379fb578518SFranco Fichtner     ND("tx completed [%d] -> hwavail %d", n, kring->nr_hwavail);
380fb578518SFranco Fichtner 
381fb578518SFranco Fichtner     return n;
382fb578518SFranco Fichtner }
383fb578518SFranco Fichtner 
384fb578518SFranco Fichtner 
385fb578518SFranco Fichtner /*
386fb578518SFranco Fichtner  * We have pending packets in the driver between nr_ntc and j.
387fb578518SFranco Fichtner  * Compute a position in the middle, to be used to generate
388fb578518SFranco Fichtner  * a notification.
389fb578518SFranco Fichtner  */
390fb578518SFranco Fichtner static inline u_int
generic_tx_event_middle(struct netmap_kring * kring,u_int hwcur)391fb578518SFranco Fichtner generic_tx_event_middle(struct netmap_kring *kring, u_int hwcur)
392fb578518SFranco Fichtner {
393fb578518SFranco Fichtner     u_int n = kring->nkr_num_slots;
394fb578518SFranco Fichtner     u_int ntc = kring->nr_ntc;
395fb578518SFranco Fichtner     u_int e;
396fb578518SFranco Fichtner 
397fb578518SFranco Fichtner     if (hwcur >= ntc) {
398fb578518SFranco Fichtner 	e = (hwcur + ntc) / 2;
399fb578518SFranco Fichtner     } else { /* wrap around */
400fb578518SFranco Fichtner 	e = (hwcur + n + ntc) / 2;
401fb578518SFranco Fichtner 	if (e >= n) {
402fb578518SFranco Fichtner             e -= n;
403fb578518SFranco Fichtner         }
404fb578518SFranco Fichtner     }
405fb578518SFranco Fichtner 
406fb578518SFranco Fichtner     if (unlikely(e >= n)) {
407fb578518SFranco Fichtner         D("This cannot happen");
408fb578518SFranco Fichtner         e = 0;
409fb578518SFranco Fichtner     }
410fb578518SFranco Fichtner 
411fb578518SFranco Fichtner     return e;
412fb578518SFranco Fichtner }
413fb578518SFranco Fichtner 
414fb578518SFranco Fichtner /*
415fb578518SFranco Fichtner  * We have pending packets in the driver between nr_ntc and hwcur.
416fb578518SFranco Fichtner  * Schedule a notification approximately in the middle of the two.
417fb578518SFranco Fichtner  * There is a race but this is only called within txsync which does
418fb578518SFranco Fichtner  * a double check.
419fb578518SFranco Fichtner  */
420fb578518SFranco Fichtner static void
generic_set_tx_event(struct netmap_kring * kring,u_int hwcur)421fb578518SFranco Fichtner generic_set_tx_event(struct netmap_kring *kring, u_int hwcur)
422fb578518SFranco Fichtner {
423fb578518SFranco Fichtner     struct mbuf *m;
424fb578518SFranco Fichtner     u_int e;
425fb578518SFranco Fichtner 
426fb578518SFranco Fichtner     if (kring->nr_ntc == hwcur) {
427fb578518SFranco Fichtner         return;
428fb578518SFranco Fichtner     }
429fb578518SFranco Fichtner     e = generic_tx_event_middle(kring, hwcur);
430fb578518SFranco Fichtner 
431fb578518SFranco Fichtner     m = kring->tx_pool[e];
432fb578518SFranco Fichtner     if (m == NULL) {
433fb578518SFranco Fichtner         /* This can happen if there is already an event on the netmap
434fb578518SFranco Fichtner            slot 'e': There is nothing to do. */
435fb578518SFranco Fichtner         return;
436fb578518SFranco Fichtner     }
437fb578518SFranco Fichtner     ND("Event at %d mbuf %p refcnt %d", e, m, GET_MBUF_REFCNT(m));
438fb578518SFranco Fichtner     kring->tx_pool[e] = NULL;
439fb578518SFranco Fichtner     SET_MBUF_DESTRUCTOR(m, generic_mbuf_destructor);
440fb578518SFranco Fichtner 
441fb578518SFranco Fichtner     // XXX wmb() ?
442fb578518SFranco Fichtner     /* Decrement the refcount an free it if we have the last one. */
443fb578518SFranco Fichtner     m_freem(m);
444fb578518SFranco Fichtner     smp_mb();
445fb578518SFranco Fichtner }
446fb578518SFranco Fichtner 
447fb578518SFranco Fichtner 
448fb578518SFranco Fichtner /*
449fb578518SFranco Fichtner  * generic_netmap_txsync() transforms netmap buffers into mbufs
450fb578518SFranco Fichtner  * and passes them to the standard device driver
451fb578518SFranco Fichtner  * (ndo_start_xmit() or ifp->if_transmit() ).
452fb578518SFranco Fichtner  * On linux this is not done directly, but using dev_queue_xmit(),
453fb578518SFranco Fichtner  * since it implements the TX flow control (and takes some locks).
454fb578518SFranco Fichtner  */
455fb578518SFranco Fichtner static int
generic_netmap_txsync(struct netmap_adapter * na,u_int ring_nr,int flags)456fb578518SFranco Fichtner generic_netmap_txsync(struct netmap_adapter *na, u_int ring_nr, int flags)
457fb578518SFranco Fichtner {
458fb578518SFranco Fichtner     struct ifnet *ifp = na->ifp;
459fb578518SFranco Fichtner     struct netmap_kring *kring = &na->tx_rings[ring_nr];
460fb578518SFranco Fichtner     struct netmap_ring *ring = kring->ring;
461fb578518SFranco Fichtner     u_int j, k, num_slots = kring->nkr_num_slots;
462fb578518SFranco Fichtner     int new_slots, ntx;
463fb578518SFranco Fichtner 
464fb578518SFranco Fichtner     IFRATE(rate_ctx.new.txsync++);
465fb578518SFranco Fichtner 
466fb578518SFranco Fichtner     // TODO: handle the case of mbuf allocation failure
467fb578518SFranco Fichtner     /* first, reclaim completed buffers */
468fb578518SFranco Fichtner     generic_netmap_tx_clean(kring);
469fb578518SFranco Fichtner 
470fb578518SFranco Fichtner     /* Take a copy of ring->cur now, and never read it again. */
471fb578518SFranco Fichtner     k = ring->cur;
472fb578518SFranco Fichtner     if (unlikely(k >= num_slots)) {
473fb578518SFranco Fichtner         return netmap_ring_reinit(kring);
474fb578518SFranco Fichtner     }
475fb578518SFranco Fichtner 
476fb578518SFranco Fichtner     rmb();
477fb578518SFranco Fichtner     j = kring->nr_hwcur;
478fb578518SFranco Fichtner     /*
479fb578518SFranco Fichtner     * 'new_slots' counts how many new slots have been added:
480fb578518SFranco Fichtner      * everything from hwcur to cur, excluding reserved ones, if any.
481fb578518SFranco Fichtner      * nr_hwreserved start from hwcur and counts how many slots were
482fb578518SFranco Fichtner      * not sent to the NIC from the previous round.
483fb578518SFranco Fichtner      */
484fb578518SFranco Fichtner     new_slots = k - j - kring->nr_hwreserved;
485fb578518SFranco Fichtner     if (new_slots < 0) {
486fb578518SFranco Fichtner         new_slots += num_slots;
487fb578518SFranco Fichtner     }
488fb578518SFranco Fichtner     ntx = 0;
489fb578518SFranco Fichtner     if (j != k) {
490fb578518SFranco Fichtner         /* Process new packets to send:
491fb578518SFranco Fichtner 	 * j is the current index in the netmap ring.
492fb578518SFranco Fichtner 	 */
493fb578518SFranco Fichtner         while (j != k) {
494fb578518SFranco Fichtner             struct netmap_slot *slot = &ring->slot[j]; /* Current slot in the netmap ring */
495fb578518SFranco Fichtner             void *addr = NMB(slot);
496fb578518SFranco Fichtner             u_int len = slot->len;
497fb578518SFranco Fichtner             struct mbuf *m;
498fb578518SFranco Fichtner             int tx_ret;
499fb578518SFranco Fichtner 
500fb578518SFranco Fichtner             if (unlikely(addr == netmap_buffer_base || len > NETMAP_BUF_SIZE)) {
501fb578518SFranco Fichtner                 return netmap_ring_reinit(kring);
502fb578518SFranco Fichtner             }
503fb578518SFranco Fichtner             /* Tale a mbuf from the tx pool and copy in the user packet. */
504fb578518SFranco Fichtner             m = kring->tx_pool[j];
505fb578518SFranco Fichtner             if (unlikely(!m)) {
506fb578518SFranco Fichtner                 RD(5, "This should never happen");
507fb578518SFranco Fichtner                 kring->tx_pool[j] = m = netmap_get_mbuf(GENERIC_BUF_SIZE);
508fb578518SFranco Fichtner                 if (unlikely(m == NULL)) {
509fb578518SFranco Fichtner                     D("mbuf allocation failed");
510fb578518SFranco Fichtner                     break;
511fb578518SFranco Fichtner                 }
512fb578518SFranco Fichtner             }
513fb578518SFranco Fichtner             /* XXX we should ask notifications when NS_REPORT is set,
514fb578518SFranco Fichtner              * or roughly every half frame. We can optimize this
515fb578518SFranco Fichtner              * by lazily requesting notifications only when a
516fb578518SFranco Fichtner              * transmission fails. Probably the best way is to
517fb578518SFranco Fichtner              * break on failures and set notifications when
518fb578518SFranco Fichtner              * ring->avail == 0 || j != k
519fb578518SFranco Fichtner              */
520fb578518SFranco Fichtner             tx_ret = generic_xmit_frame(ifp, m, addr, len, ring_nr);
521fb578518SFranco Fichtner             if (unlikely(tx_ret)) {
522fb578518SFranco Fichtner                 RD(5, "start_xmit failed: err %d [%u,%u,%u,%u]",
523fb578518SFranco Fichtner 			tx_ret, kring->nr_ntc, j, k, kring->nr_hwavail);
524fb578518SFranco Fichtner                 /*
525fb578518SFranco Fichtner                  * No room for this mbuf in the device driver.
526fb578518SFranco Fichtner 		 * Request a notification FOR A PREVIOUS MBUF,
527fb578518SFranco Fichtner                  * then call generic_netmap_tx_clean(kring) to do the
528fb578518SFranco Fichtner                  * double check and see if we can free more buffers.
529fb578518SFranco Fichtner                  * If there is space continue, else break;
530fb578518SFranco Fichtner                  * NOTE: the double check is necessary if the problem
531fb578518SFranco Fichtner                  * occurs in the txsync call after selrecord().
532fb578518SFranco Fichtner                  * Also, we need some way to tell the caller that not
533fb578518SFranco Fichtner                  * all buffers were queued onto the device (this was
534fb578518SFranco Fichtner                  * not a problem with native netmap driver where space
535fb578518SFranco Fichtner                  * is preallocated). The bridge has a similar problem
536fb578518SFranco Fichtner                  * and we solve it there by dropping the excess packets.
537fb578518SFranco Fichtner                  */
538fb578518SFranco Fichtner                 generic_set_tx_event(kring, j);
539fb578518SFranco Fichtner                 if (generic_netmap_tx_clean(kring)) { /* space now available */
540fb578518SFranco Fichtner                     continue;
541fb578518SFranco Fichtner                 } else {
542fb578518SFranco Fichtner                     break;
543fb578518SFranco Fichtner                 }
544fb578518SFranco Fichtner             }
545fb578518SFranco Fichtner             slot->flags &= ~(NS_REPORT | NS_BUF_CHANGED);
546fb578518SFranco Fichtner             if (unlikely(++j == num_slots))
547fb578518SFranco Fichtner                 j = 0;
548fb578518SFranco Fichtner             ntx++;
549fb578518SFranco Fichtner         }
550fb578518SFranco Fichtner 
551fb578518SFranco Fichtner         /* Update hwcur to the next slot to transmit. */
552fb578518SFranco Fichtner         kring->nr_hwcur = j;
553fb578518SFranco Fichtner 
554fb578518SFranco Fichtner         /*
555fb578518SFranco Fichtner 	 * Report all new slots as unavailable, even those not sent.
556fb578518SFranco Fichtner          * We account for them with with hwreserved, so that
557fb578518SFranco Fichtner 	 * nr_hwreserved =:= cur - nr_hwcur
558fb578518SFranco Fichtner 	 */
559fb578518SFranco Fichtner         kring->nr_hwavail -= new_slots;
560fb578518SFranco Fichtner         kring->nr_hwreserved = k - j;
561fb578518SFranco Fichtner         if (kring->nr_hwreserved < 0) {
562fb578518SFranco Fichtner             kring->nr_hwreserved += num_slots;
563fb578518SFranco Fichtner         }
564fb578518SFranco Fichtner 
565fb578518SFranco Fichtner         IFRATE(rate_ctx.new.txpkt += ntx);
566fb578518SFranco Fichtner 
567fb578518SFranco Fichtner         if (!kring->nr_hwavail) {
568fb578518SFranco Fichtner             /* No more available slots? Set a notification event
569fb578518SFranco Fichtner              * on a netmap slot that will be cleaned in the future.
570fb578518SFranco Fichtner              * No doublecheck is performed, since txsync() will be
571fb578518SFranco Fichtner              * called twice by netmap_poll().
572fb578518SFranco Fichtner              */
573fb578518SFranco Fichtner             generic_set_tx_event(kring, j);
574fb578518SFranco Fichtner         }
575fb578518SFranco Fichtner         ND("tx #%d, hwavail = %d", n, kring->nr_hwavail);
576fb578518SFranco Fichtner     }
577fb578518SFranco Fichtner 
578fb578518SFranco Fichtner     /* Synchronize the user's view to the kernel view. */
579fb578518SFranco Fichtner     ring->avail = kring->nr_hwavail;
580fb578518SFranco Fichtner     ring->reserved = kring->nr_hwreserved;
581fb578518SFranco Fichtner 
582fb578518SFranco Fichtner     return 0;
583fb578518SFranco Fichtner }
584fb578518SFranco Fichtner 
585fb578518SFranco Fichtner /*
586fb578518SFranco Fichtner  * This handler is registered (through netmap_catch_rx())
587fb578518SFranco Fichtner  * within the attached network interface
588fb578518SFranco Fichtner  * in the RX subsystem, so that every mbuf passed up by
589fb578518SFranco Fichtner  * the driver can be stolen to the network stack.
590fb578518SFranco Fichtner  * Stolen packets are put in a queue where the
591fb578518SFranco Fichtner  * generic_netmap_rxsync() callback can extract them.
592fb578518SFranco Fichtner  */
generic_rx_handler(struct ifnet * ifp,struct mbuf * m,const struct pktinfo * pi,int cpuid)59373029d08SFranco Fichtner void generic_rx_handler(struct ifnet *ifp, struct mbuf *m,
59473029d08SFranco Fichtner     const struct pktinfo *pi, int cpuid)
595fb578518SFranco Fichtner {
596fb578518SFranco Fichtner     struct netmap_adapter *na = NA(ifp);
597fb578518SFranco Fichtner     struct netmap_generic_adapter *gna = (struct netmap_generic_adapter *)na;
598fb578518SFranco Fichtner     u_int work_done;
599fb578518SFranco Fichtner     u_int rr = 0; // receive ring number
600fb578518SFranco Fichtner 
601fb578518SFranco Fichtner     ND("called");
602fb578518SFranco Fichtner     /* limit the size of the queue */
603fb578518SFranco Fichtner     if (unlikely(mbq_len(&na->rx_rings[rr].rx_queue) > 1024)) {
604fb578518SFranco Fichtner         m_freem(m);
605fb578518SFranco Fichtner     } else {
606fb578518SFranco Fichtner         mbq_safe_enqueue(&na->rx_rings[rr].rx_queue, m);
607fb578518SFranco Fichtner     }
608fb578518SFranco Fichtner 
609fb578518SFranco Fichtner     if (netmap_generic_mit < 32768) {
610fb578518SFranco Fichtner         /* no rx mitigation, pass notification up */
611fb578518SFranco Fichtner         netmap_generic_irq(na->ifp, rr, &work_done);
612fb578518SFranco Fichtner         IFRATE(rate_ctx.new.rxirq++);
613fb578518SFranco Fichtner     } else {
614fb578518SFranco Fichtner 	/* same as send combining, filter notification if there is a
615fb578518SFranco Fichtner 	 * pending timer, otherwise pass it up and start a timer.
616fb578518SFranco Fichtner          */
617fb578518SFranco Fichtner         if (likely(netmap_mitigation_active(gna))) {
618fb578518SFranco Fichtner             /* Record that there is some pending work. */
619fb578518SFranco Fichtner             gna->mit_pending = 1;
620fb578518SFranco Fichtner         } else {
621fb578518SFranco Fichtner             netmap_generic_irq(na->ifp, rr, &work_done);
622fb578518SFranco Fichtner             IFRATE(rate_ctx.new.rxirq++);
623fb578518SFranco Fichtner             netmap_mitigation_start(gna);
624fb578518SFranco Fichtner         }
625fb578518SFranco Fichtner     }
626fb578518SFranco Fichtner }
627fb578518SFranco Fichtner 
628fb578518SFranco Fichtner /*
629fb578518SFranco Fichtner  * generic_netmap_rxsync() extracts mbufs from the queue filled by
630fb578518SFranco Fichtner  * generic_netmap_rx_handler() and puts their content in the netmap
631fb578518SFranco Fichtner  * receive ring.
632fb578518SFranco Fichtner  * Access must be protected because the rx handler is asynchronous,
633fb578518SFranco Fichtner  */
634fb578518SFranco Fichtner static int
generic_netmap_rxsync(struct netmap_adapter * na,u_int ring_nr,int flags)635fb578518SFranco Fichtner generic_netmap_rxsync(struct netmap_adapter *na, u_int ring_nr, int flags)
636fb578518SFranco Fichtner {
637fb578518SFranco Fichtner     struct netmap_kring *kring = &na->rx_rings[ring_nr];
638fb578518SFranco Fichtner     struct netmap_ring *ring = kring->ring;
639fb578518SFranco Fichtner     u_int j, n, lim = kring->nkr_num_slots - 1;
640fb578518SFranco Fichtner     int force_update = (flags & NAF_FORCE_READ) || kring->nr_kflags & NKR_PENDINTR;
641fb578518SFranco Fichtner     u_int k, resvd = ring->reserved;
642fb578518SFranco Fichtner 
643fb578518SFranco Fichtner     if (ring->cur > lim)
644fb578518SFranco Fichtner         return netmap_ring_reinit(kring);
645fb578518SFranco Fichtner 
646fb578518SFranco Fichtner     /* Import newly received packets into the netmap ring. */
647fb578518SFranco Fichtner     if (netmap_no_pendintr || force_update) {
648fb578518SFranco Fichtner         uint16_t slot_flags = kring->nkr_slot_flags;
649fb578518SFranco Fichtner         struct mbuf *m;
650fb578518SFranco Fichtner 
651fb578518SFranco Fichtner         n = 0;
652fb578518SFranco Fichtner         j = kring->nr_ntc; /* first empty slot in the receive ring */
653fb578518SFranco Fichtner         /* extract buffers from the rx queue, stop at most one
654fb578518SFranco Fichtner 	 * slot before nr_hwcur (index k)
655fb578518SFranco Fichtner 	 */
656fb578518SFranco Fichtner         k = (kring->nr_hwcur) ? kring->nr_hwcur-1 : lim;
657fb578518SFranco Fichtner         while (j != k) {
658fb578518SFranco Fichtner 	    int len;
659fb578518SFranco Fichtner             void *addr = NMB(&ring->slot[j]);
660fb578518SFranco Fichtner 
661fb578518SFranco Fichtner             if (addr == netmap_buffer_base) { /* Bad buffer */
662fb578518SFranco Fichtner                 return netmap_ring_reinit(kring);
663fb578518SFranco Fichtner             }
664fb578518SFranco Fichtner 	    /*
665fb578518SFranco Fichtner 	     * Call the locked version of the function.
666fb578518SFranco Fichtner 	     *  XXX Ideally we could grab a batch of mbufs at once,
667fb578518SFranco Fichtner 	     * by changing rx_queue into a ring.
668fb578518SFranco Fichtner 	     */
669fb578518SFranco Fichtner             m = mbq_safe_dequeue(&kring->rx_queue);
670fb578518SFranco Fichtner             if (!m)
671fb578518SFranco Fichtner                 break;
672fb578518SFranco Fichtner 	    len = MBUF_LEN(m);
673fb578518SFranco Fichtner             m_copydata(m, 0, len, addr);
674fb578518SFranco Fichtner             ring->slot[j].len = len;
675fb578518SFranco Fichtner             ring->slot[j].flags = slot_flags;
676fb578518SFranco Fichtner             m_freem(m);
677fb578518SFranco Fichtner             if (unlikely(j++ == lim))
678fb578518SFranco Fichtner                 j = 0;
679fb578518SFranco Fichtner             n++;
680fb578518SFranco Fichtner         }
681fb578518SFranco Fichtner         if (n) {
682fb578518SFranco Fichtner             kring->nr_ntc = j;
683fb578518SFranco Fichtner             kring->nr_hwavail += n;
684fb578518SFranco Fichtner             IFRATE(rate_ctx.new.rxpkt += n);
685fb578518SFranco Fichtner         }
686fb578518SFranco Fichtner         kring->nr_kflags &= ~NKR_PENDINTR;
687fb578518SFranco Fichtner     }
688fb578518SFranco Fichtner 
689fb578518SFranco Fichtner     // XXX should we invert the order ?
690fb578518SFranco Fichtner     /* Skip past packets that userspace has released */
691fb578518SFranco Fichtner     j = kring->nr_hwcur;
692fb578518SFranco Fichtner     k = ring->cur;
693fb578518SFranco Fichtner     if (resvd > 0) {
694fb578518SFranco Fichtner         if (resvd + ring->avail >= lim + 1) {
695fb578518SFranco Fichtner             D("XXX invalid reserve/avail %d %d", resvd, ring->avail);
696fb578518SFranco Fichtner             ring->reserved = resvd = 0; // XXX panic...
697fb578518SFranco Fichtner         }
698fb578518SFranco Fichtner         k = (k >= resvd) ? k - resvd : k + lim + 1 - resvd;
699fb578518SFranco Fichtner     }
700fb578518SFranco Fichtner     if (j != k) {
701fb578518SFranco Fichtner         /* Userspace has released some packets. */
702fb578518SFranco Fichtner         for (n = 0; j != k; n++) {
703fb578518SFranco Fichtner             struct netmap_slot *slot = &ring->slot[j];
704fb578518SFranco Fichtner 
705fb578518SFranco Fichtner             slot->flags &= ~NS_BUF_CHANGED;
706fb578518SFranco Fichtner             if (unlikely(j++ == lim))
707fb578518SFranco Fichtner                 j = 0;
708fb578518SFranco Fichtner         }
709fb578518SFranco Fichtner         kring->nr_hwavail -= n;
710fb578518SFranco Fichtner         kring->nr_hwcur = k;
711fb578518SFranco Fichtner     }
712fb578518SFranco Fichtner     /* Tell userspace that there are new packets. */
713fb578518SFranco Fichtner     ring->avail = kring->nr_hwavail - resvd;
714fb578518SFranco Fichtner     IFRATE(rate_ctx.new.rxsync++);
715fb578518SFranco Fichtner 
716fb578518SFranco Fichtner     return 0;
717fb578518SFranco Fichtner }
718fb578518SFranco Fichtner 
719fb578518SFranco Fichtner static void
generic_netmap_dtor(struct netmap_adapter * na)720fb578518SFranco Fichtner generic_netmap_dtor(struct netmap_adapter *na)
721fb578518SFranco Fichtner {
722fb578518SFranco Fichtner     struct ifnet *ifp = na->ifp;
723fb578518SFranco Fichtner     struct netmap_generic_adapter *gna = (struct netmap_generic_adapter*)na;
724fb578518SFranco Fichtner     struct netmap_adapter *prev_na = gna->prev;
725fb578518SFranco Fichtner 
726fb578518SFranco Fichtner     if (prev_na != NULL) {
727fb578518SFranco Fichtner         D("Released generic NA %p", gna);
728bf9f7c16SFranco Fichtner #if 0
729fb578518SFranco Fichtner 	if_rele(na->ifp);
730bf9f7c16SFranco Fichtner #endif
731fb578518SFranco Fichtner         netmap_adapter_put(prev_na);
732fb578518SFranco Fichtner     }
733fb578518SFranco Fichtner     if (ifp != NULL) {
734fb578518SFranco Fichtner         WNA(ifp) = prev_na;
735fb578518SFranco Fichtner         D("Restored native NA %p", prev_na);
736fb578518SFranco Fichtner         na->ifp = NULL;
737fb578518SFranco Fichtner     }
738fb578518SFranco Fichtner }
739fb578518SFranco Fichtner 
740fb578518SFranco Fichtner /*
741fb578518SFranco Fichtner  * generic_netmap_attach() makes it possible to use netmap on
742fb578518SFranco Fichtner  * a device without native netmap support.
743fb578518SFranco Fichtner  * This is less performant than native support but potentially
744fb578518SFranco Fichtner  * faster than raw sockets or similar schemes.
745fb578518SFranco Fichtner  *
746fb578518SFranco Fichtner  * In this "emulated" mode, netmap rings do not necessarily
747fb578518SFranco Fichtner  * have the same size as those in the NIC. We use a default
748fb578518SFranco Fichtner  * value and possibly override it if the OS has ways to fetch the
749fb578518SFranco Fichtner  * actual configuration.
750fb578518SFranco Fichtner  */
751fb578518SFranco Fichtner int
generic_netmap_attach(struct ifnet * ifp)752fb578518SFranco Fichtner generic_netmap_attach(struct ifnet *ifp)
753fb578518SFranco Fichtner {
754fb578518SFranco Fichtner     struct netmap_adapter *na;
755fb578518SFranco Fichtner     struct netmap_generic_adapter *gna;
756fb578518SFranco Fichtner     int retval;
757fb578518SFranco Fichtner     u_int num_tx_desc, num_rx_desc;
758fb578518SFranco Fichtner 
759fb578518SFranco Fichtner     num_tx_desc = num_rx_desc = netmap_generic_ringsize; /* starting point */
760fb578518SFranco Fichtner 
761fb578518SFranco Fichtner     generic_find_num_desc(ifp, &num_tx_desc, &num_rx_desc);
762fb578518SFranco Fichtner     ND("Netmap ring size: TX = %d, RX = %d", num_tx_desc, num_rx_desc);
763fb578518SFranco Fichtner 
764ed9bd855SFranco Fichtner     gna = kmalloc(sizeof(*gna), M_DEVBUF, M_NOWAIT | M_ZERO);
765fb578518SFranco Fichtner     if (gna == NULL) {
766fb578518SFranco Fichtner         D("no memory on attach, give up");
767fb578518SFranco Fichtner         return ENOMEM;
768fb578518SFranco Fichtner     }
769fb578518SFranco Fichtner     na = (struct netmap_adapter *)gna;
770fb578518SFranco Fichtner     na->ifp = ifp;
771fb578518SFranco Fichtner     na->num_tx_desc = num_tx_desc;
772fb578518SFranco Fichtner     na->num_rx_desc = num_rx_desc;
773fb578518SFranco Fichtner     na->nm_register = &generic_netmap_register;
774fb578518SFranco Fichtner     na->nm_txsync = &generic_netmap_txsync;
775fb578518SFranco Fichtner     na->nm_rxsync = &generic_netmap_rxsync;
776fb578518SFranco Fichtner     na->nm_dtor = &generic_netmap_dtor;
777fb578518SFranco Fichtner     /* when using generic, IFCAP_NETMAP is set so we force
778fb578518SFranco Fichtner      * NAF_SKIP_INTR to use the regular interrupt handler
779fb578518SFranco Fichtner      */
780fb578518SFranco Fichtner     na->na_flags = NAF_SKIP_INTR;
781fb578518SFranco Fichtner 
782fb578518SFranco Fichtner     ND("[GNA] num_tx_queues(%d), real_num_tx_queues(%d), len(%lu)",
783fb578518SFranco Fichtner 		ifp->num_tx_queues, ifp->real_num_tx_queues,
784fb578518SFranco Fichtner 		ifp->tx_queue_len);
785fb578518SFranco Fichtner     ND("[GNA] num_rx_queues(%d), real_num_rx_queues(%d)",
786fb578518SFranco Fichtner 		ifp->num_rx_queues, ifp->real_num_rx_queues);
787fb578518SFranco Fichtner 
788fb578518SFranco Fichtner     generic_find_num_queues(ifp, &na->num_tx_rings, &na->num_rx_rings);
789fb578518SFranco Fichtner 
790fb578518SFranco Fichtner     retval = netmap_attach_common(na);
791fb578518SFranco Fichtner     if (retval) {
792ed9bd855SFranco Fichtner         kfree(gna, M_DEVBUF);
793fb578518SFranco Fichtner     }
794fb578518SFranco Fichtner 
795fb578518SFranco Fichtner     return retval;
796fb578518SFranco Fichtner }
797