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