xref: /freebsd-14.2/sys/dev/netmap/netmap.c (revision f4a54f43)
1718cf2ccSPedro F. Giffuni /*-
2718cf2ccSPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3718cf2ccSPedro F. Giffuni  *
437e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2014 Matteo Landi
537e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Luigi Rizzo
637e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Giuseppe Lettieri
737e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Vincenzo Maffione
837e3a6d3SLuigi Rizzo  * All rights reserved.
968b8534bSLuigi Rizzo  *
1068b8534bSLuigi Rizzo  * Redistribution and use in source and binary forms, with or without
1168b8534bSLuigi Rizzo  * modification, are permitted provided that the following conditions
1268b8534bSLuigi Rizzo  * are met:
1368b8534bSLuigi Rizzo  *   1. Redistributions of source code must retain the above copyright
1468b8534bSLuigi Rizzo  *      notice, this list of conditions and the following disclaimer.
1568b8534bSLuigi Rizzo  *   2. Redistributions in binary form must reproduce the above copyright
1668b8534bSLuigi Rizzo  *      notice, this list of conditions and the following disclaimer in the
1768b8534bSLuigi Rizzo  *      documentation and/or other materials provided with the distribution.
1868b8534bSLuigi Rizzo  *
1968b8534bSLuigi Rizzo  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
2068b8534bSLuigi Rizzo  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2168b8534bSLuigi Rizzo  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2268b8534bSLuigi Rizzo  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2368b8534bSLuigi Rizzo  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2468b8534bSLuigi Rizzo  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2568b8534bSLuigi Rizzo  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2668b8534bSLuigi Rizzo  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2768b8534bSLuigi Rizzo  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2868b8534bSLuigi Rizzo  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2968b8534bSLuigi Rizzo  * SUCH DAMAGE.
3068b8534bSLuigi Rizzo  */
3168b8534bSLuigi Rizzo 
32ce3ee1e7SLuigi Rizzo 
3368b8534bSLuigi Rizzo /*
34f9790aebSLuigi Rizzo  * $FreeBSD$
35f9790aebSLuigi Rizzo  *
3668b8534bSLuigi Rizzo  * This module supports memory mapped access to network devices,
3768b8534bSLuigi Rizzo  * see netmap(4).
3868b8534bSLuigi Rizzo  *
3968b8534bSLuigi Rizzo  * The module uses a large, memory pool allocated by the kernel
4068b8534bSLuigi Rizzo  * and accessible as mmapped memory by multiple userspace threads/processes.
4168b8534bSLuigi Rizzo  * The memory pool contains packet buffers and "netmap rings",
4268b8534bSLuigi Rizzo  * i.e. user-accessible copies of the interface's queues.
4368b8534bSLuigi Rizzo  *
4468b8534bSLuigi Rizzo  * Access to the network card works like this:
4568b8534bSLuigi Rizzo  * 1. a process/thread issues one or more open() on /dev/netmap, to create
4668b8534bSLuigi Rizzo  *    select()able file descriptor on which events are reported.
4768b8534bSLuigi Rizzo  * 2. on each descriptor, the process issues an ioctl() to identify
4868b8534bSLuigi Rizzo  *    the interface that should report events to the file descriptor.
4968b8534bSLuigi Rizzo  * 3. on each descriptor, the process issues an mmap() request to
5068b8534bSLuigi Rizzo  *    map the shared memory region within the process' address space.
5168b8534bSLuigi Rizzo  *    The list of interesting queues is indicated by a location in
5268b8534bSLuigi Rizzo  *    the shared memory region.
5368b8534bSLuigi Rizzo  * 4. using the functions in the netmap(4) userspace API, a process
5468b8534bSLuigi Rizzo  *    can look up the occupation state of a queue, access memory buffers,
5568b8534bSLuigi Rizzo  *    and retrieve received packets or enqueue packets to transmit.
5668b8534bSLuigi Rizzo  * 5. using some ioctl()s the process can synchronize the userspace view
5768b8534bSLuigi Rizzo  *    of the queue with the actual status in the kernel. This includes both
5868b8534bSLuigi Rizzo  *    receiving the notification of new packets, and transmitting new
5968b8534bSLuigi Rizzo  *    packets on the output interface.
6068b8534bSLuigi Rizzo  * 6. select() or poll() can be used to wait for events on individual
6168b8534bSLuigi Rizzo  *    transmit or receive queues (or all queues for a given interface).
62ce3ee1e7SLuigi Rizzo  *
63ce3ee1e7SLuigi Rizzo 
64ce3ee1e7SLuigi Rizzo 		SYNCHRONIZATION (USER)
65ce3ee1e7SLuigi Rizzo 
66ce3ee1e7SLuigi Rizzo The netmap rings and data structures may be shared among multiple
67ce3ee1e7SLuigi Rizzo user threads or even independent processes.
68ce3ee1e7SLuigi Rizzo Any synchronization among those threads/processes is delegated
69ce3ee1e7SLuigi Rizzo to the threads themselves. Only one thread at a time can be in
70ce3ee1e7SLuigi Rizzo a system call on the same netmap ring. The OS does not enforce
71ce3ee1e7SLuigi Rizzo this and only guarantees against system crashes in case of
72ce3ee1e7SLuigi Rizzo invalid usage.
73ce3ee1e7SLuigi Rizzo 
74ce3ee1e7SLuigi Rizzo 		LOCKING (INTERNAL)
75ce3ee1e7SLuigi Rizzo 
76ce3ee1e7SLuigi Rizzo Within the kernel, access to the netmap rings is protected as follows:
77ce3ee1e7SLuigi Rizzo 
78ce3ee1e7SLuigi Rizzo - a spinlock on each ring, to handle producer/consumer races on
79ce3ee1e7SLuigi Rizzo   RX rings attached to the host stack (against multiple host
80ce3ee1e7SLuigi Rizzo   threads writing from the host stack to the same ring),
81ce3ee1e7SLuigi Rizzo   and on 'destination' rings attached to a VALE switch
82ce3ee1e7SLuigi Rizzo   (i.e. RX rings in VALE ports, and TX rings in NIC/host ports)
83ce3ee1e7SLuigi Rizzo   protecting multiple active senders for the same destination)
84ce3ee1e7SLuigi Rizzo 
85ce3ee1e7SLuigi Rizzo - an atomic variable to guarantee that there is at most one
86ce3ee1e7SLuigi Rizzo   instance of *_*xsync() on the ring at any time.
87ce3ee1e7SLuigi Rizzo   For rings connected to user file
88ce3ee1e7SLuigi Rizzo   descriptors, an atomic_test_and_set() protects this, and the
89ce3ee1e7SLuigi Rizzo   lock on the ring is not actually used.
90ce3ee1e7SLuigi Rizzo   For NIC RX rings connected to a VALE switch, an atomic_test_and_set()
91ce3ee1e7SLuigi Rizzo   is also used to prevent multiple executions (the driver might indeed
92ce3ee1e7SLuigi Rizzo   already guarantee this).
93ce3ee1e7SLuigi Rizzo   For NIC TX rings connected to a VALE switch, the lock arbitrates
94ce3ee1e7SLuigi Rizzo   access to the queue (both when allocating buffers and when pushing
95ce3ee1e7SLuigi Rizzo   them out).
96ce3ee1e7SLuigi Rizzo 
97ce3ee1e7SLuigi Rizzo - *xsync() should be protected against initializations of the card.
98ce3ee1e7SLuigi Rizzo   On FreeBSD most devices have the reset routine protected by
99ce3ee1e7SLuigi Rizzo   a RING lock (ixgbe, igb, em) or core lock (re). lem is missing
100ce3ee1e7SLuigi Rizzo   the RING protection on rx_reset(), this should be added.
101ce3ee1e7SLuigi Rizzo 
102ce3ee1e7SLuigi Rizzo   On linux there is an external lock on the tx path, which probably
103ce3ee1e7SLuigi Rizzo   also arbitrates access to the reset routine. XXX to be revised
104ce3ee1e7SLuigi Rizzo 
105ce3ee1e7SLuigi Rizzo - a per-interface core_lock protecting access from the host stack
106ce3ee1e7SLuigi Rizzo   while interfaces may be detached from netmap mode.
107ce3ee1e7SLuigi Rizzo   XXX there should be no need for this lock if we detach the interfaces
108ce3ee1e7SLuigi Rizzo   only while they are down.
109ce3ee1e7SLuigi Rizzo 
110ce3ee1e7SLuigi Rizzo 
111ce3ee1e7SLuigi Rizzo --- VALE SWITCH ---
112ce3ee1e7SLuigi Rizzo 
113ce3ee1e7SLuigi Rizzo NMG_LOCK() serializes all modifications to switches and ports.
114ce3ee1e7SLuigi Rizzo A switch cannot be deleted until all ports are gone.
115ce3ee1e7SLuigi Rizzo 
116ce3ee1e7SLuigi Rizzo For each switch, an SX lock (RWlock on linux) protects
117ce3ee1e7SLuigi Rizzo deletion of ports. When configuring or deleting a new port, the
118ce3ee1e7SLuigi Rizzo lock is acquired in exclusive mode (after holding NMG_LOCK).
119ce3ee1e7SLuigi Rizzo When forwarding, the lock is acquired in shared mode (without NMG_LOCK).
120ce3ee1e7SLuigi Rizzo The lock is held throughout the entire forwarding cycle,
121ce3ee1e7SLuigi Rizzo during which the thread may incur in a page fault.
122ce3ee1e7SLuigi Rizzo Hence it is important that sleepable shared locks are used.
123ce3ee1e7SLuigi Rizzo 
124ce3ee1e7SLuigi Rizzo On the rx ring, the per-port lock is grabbed initially to reserve
125ce3ee1e7SLuigi Rizzo a number of slot in the ring, then the lock is released,
126ce3ee1e7SLuigi Rizzo packets are copied from source to destination, and then
127ce3ee1e7SLuigi Rizzo the lock is acquired again and the receive ring is updated.
128ce3ee1e7SLuigi Rizzo (A similar thing is done on the tx ring for NIC and host stack
129ce3ee1e7SLuigi Rizzo ports attached to the switch)
130ce3ee1e7SLuigi Rizzo 
13168b8534bSLuigi Rizzo  */
13268b8534bSLuigi Rizzo 
1334bf50f18SLuigi Rizzo 
1344bf50f18SLuigi Rizzo /* --- internals ----
1354bf50f18SLuigi Rizzo  *
1364bf50f18SLuigi Rizzo  * Roadmap to the code that implements the above.
1374bf50f18SLuigi Rizzo  *
1384bf50f18SLuigi Rizzo  * > 1. a process/thread issues one or more open() on /dev/netmap, to create
1394bf50f18SLuigi Rizzo  * >    select()able file descriptor on which events are reported.
1404bf50f18SLuigi Rizzo  *
1414bf50f18SLuigi Rizzo  *  	Internally, we allocate a netmap_priv_d structure, that will be
14237e3a6d3SLuigi Rizzo  *  	initialized on ioctl(NIOCREGIF). There is one netmap_priv_d
14337e3a6d3SLuigi Rizzo  *  	structure for each open().
1444bf50f18SLuigi Rizzo  *
1454bf50f18SLuigi Rizzo  *      os-specific:
14637e3a6d3SLuigi Rizzo  *  	    FreeBSD: see netmap_open() (netmap_freebsd.c)
14737e3a6d3SLuigi Rizzo  *  	    linux:   see linux_netmap_open() (netmap_linux.c)
1484bf50f18SLuigi Rizzo  *
1494bf50f18SLuigi Rizzo  * > 2. on each descriptor, the process issues an ioctl() to identify
1504bf50f18SLuigi Rizzo  * >    the interface that should report events to the file descriptor.
1514bf50f18SLuigi Rizzo  *
1524bf50f18SLuigi Rizzo  * 	Implemented by netmap_ioctl(), NIOCREGIF case, with nmr->nr_cmd==0.
1534bf50f18SLuigi Rizzo  * 	Most important things happen in netmap_get_na() and
1544bf50f18SLuigi Rizzo  * 	netmap_do_regif(), called from there. Additional details can be
1554bf50f18SLuigi Rizzo  * 	found in the comments above those functions.
1564bf50f18SLuigi Rizzo  *
1574bf50f18SLuigi Rizzo  * 	In all cases, this action creates/takes-a-reference-to a
1584bf50f18SLuigi Rizzo  * 	netmap_*_adapter describing the port, and allocates a netmap_if
1594bf50f18SLuigi Rizzo  * 	and all necessary netmap rings, filling them with netmap buffers.
1604bf50f18SLuigi Rizzo  *
1614bf50f18SLuigi Rizzo  *      In this phase, the sync callbacks for each ring are set (these are used
1624bf50f18SLuigi Rizzo  *      in steps 5 and 6 below).  The callbacks depend on the type of adapter.
1634bf50f18SLuigi Rizzo  *      The adapter creation/initialization code puts them in the
1644bf50f18SLuigi Rizzo  * 	netmap_adapter (fields na->nm_txsync and na->nm_rxsync).  Then, they
1654bf50f18SLuigi Rizzo  * 	are copied from there to the netmap_kring's during netmap_do_regif(), by
1664bf50f18SLuigi Rizzo  * 	the nm_krings_create() callback.  All the nm_krings_create callbacks
1674bf50f18SLuigi Rizzo  * 	actually call netmap_krings_create() to perform this and the other
1684bf50f18SLuigi Rizzo  * 	common stuff. netmap_krings_create() also takes care of the host rings,
1694bf50f18SLuigi Rizzo  * 	if needed, by setting their sync callbacks appropriately.
1704bf50f18SLuigi Rizzo  *
1714bf50f18SLuigi Rizzo  * 	Additional actions depend on the kind of netmap_adapter that has been
1724bf50f18SLuigi Rizzo  * 	registered:
1734bf50f18SLuigi Rizzo  *
1744bf50f18SLuigi Rizzo  * 	- netmap_hw_adapter:  	     [netmap.c]
1754bf50f18SLuigi Rizzo  * 	     This is a system netdev/ifp with native netmap support.
1764bf50f18SLuigi Rizzo  * 	     The ifp is detached from the host stack by redirecting:
1774bf50f18SLuigi Rizzo  * 	       - transmissions (from the network stack) to netmap_transmit()
1784bf50f18SLuigi Rizzo  * 	       - receive notifications to the nm_notify() callback for
1794bf50f18SLuigi Rizzo  * 	         this adapter. The callback is normally netmap_notify(), unless
1804bf50f18SLuigi Rizzo  * 	         the ifp is attached to a bridge using bwrap, in which case it
1814bf50f18SLuigi Rizzo  * 	         is netmap_bwrap_intr_notify().
1824bf50f18SLuigi Rizzo  *
1834bf50f18SLuigi Rizzo  * 	- netmap_generic_adapter:      [netmap_generic.c]
1844bf50f18SLuigi Rizzo  * 	      A system netdev/ifp without native netmap support.
1854bf50f18SLuigi Rizzo  *
1864bf50f18SLuigi Rizzo  * 	(the decision about native/non native support is taken in
1874bf50f18SLuigi Rizzo  * 	 netmap_get_hw_na(), called by netmap_get_na())
1884bf50f18SLuigi Rizzo  *
1894bf50f18SLuigi Rizzo  * 	- netmap_vp_adapter 		[netmap_vale.c]
1904bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_bdg_na().
1914bf50f18SLuigi Rizzo  * 	      This is a persistent or ephemeral VALE port. Ephemeral ports
1924bf50f18SLuigi Rizzo  * 	      are created on the fly if they don't already exist, and are
1934bf50f18SLuigi Rizzo  * 	      always attached to a bridge.
194453130d9SPedro F. Giffuni  * 	      Persistent VALE ports must must be created separately, and i
1954bf50f18SLuigi Rizzo  * 	      then attached like normal NICs. The NIOCREGIF we are examining
19645c67e8fSVincenzo Maffione  * 	      will find them only if they had previously been created and
1974bf50f18SLuigi Rizzo  * 	      attached (see VALE_CTL below).
1984bf50f18SLuigi Rizzo  *
1994bf50f18SLuigi Rizzo  * 	- netmap_pipe_adapter 	      [netmap_pipe.c]
2004bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_pipe_na().
2014bf50f18SLuigi Rizzo  * 	      Both pipe ends are created, if they didn't already exist.
2024bf50f18SLuigi Rizzo  *
2034bf50f18SLuigi Rizzo  * 	- netmap_monitor_adapter      [netmap_monitor.c]
2044bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_monitor_na().
2054bf50f18SLuigi Rizzo  * 	      If successful, the nm_sync callbacks of the monitored adapter
2064bf50f18SLuigi Rizzo  * 	      will be intercepted by the returned monitor.
2074bf50f18SLuigi Rizzo  *
2084bf50f18SLuigi Rizzo  * 	- netmap_bwrap_adapter	      [netmap_vale.c]
2094bf50f18SLuigi Rizzo  * 	      Cannot be obtained in this way, see VALE_CTL below
2104bf50f18SLuigi Rizzo  *
2114bf50f18SLuigi Rizzo  *
2124bf50f18SLuigi Rizzo  * 	os-specific:
2134bf50f18SLuigi Rizzo  * 	    linux: we first go through linux_netmap_ioctl() to
2144bf50f18SLuigi Rizzo  * 	           adapt the FreeBSD interface to the linux one.
2154bf50f18SLuigi Rizzo  *
2164bf50f18SLuigi Rizzo  *
2174bf50f18SLuigi Rizzo  * > 3. on each descriptor, the process issues an mmap() request to
2184bf50f18SLuigi Rizzo  * >    map the shared memory region within the process' address space.
2194bf50f18SLuigi Rizzo  * >    The list of interesting queues is indicated by a location in
2204bf50f18SLuigi Rizzo  * >    the shared memory region.
2214bf50f18SLuigi Rizzo  *
2224bf50f18SLuigi Rizzo  *      os-specific:
2234bf50f18SLuigi Rizzo  *  	    FreeBSD: netmap_mmap_single (netmap_freebsd.c).
2244bf50f18SLuigi Rizzo  *  	    linux:   linux_netmap_mmap (netmap_linux.c).
2254bf50f18SLuigi Rizzo  *
2264bf50f18SLuigi Rizzo  * > 4. using the functions in the netmap(4) userspace API, a process
2274bf50f18SLuigi Rizzo  * >    can look up the occupation state of a queue, access memory buffers,
2284bf50f18SLuigi Rizzo  * >    and retrieve received packets or enqueue packets to transmit.
2294bf50f18SLuigi Rizzo  *
2304bf50f18SLuigi Rizzo  * 	these actions do not involve the kernel.
2314bf50f18SLuigi Rizzo  *
2324bf50f18SLuigi Rizzo  * > 5. using some ioctl()s the process can synchronize the userspace view
2334bf50f18SLuigi Rizzo  * >    of the queue with the actual status in the kernel. This includes both
2344bf50f18SLuigi Rizzo  * >    receiving the notification of new packets, and transmitting new
2354bf50f18SLuigi Rizzo  * >    packets on the output interface.
2364bf50f18SLuigi Rizzo  *
2374bf50f18SLuigi Rizzo  * 	These are implemented in netmap_ioctl(), NIOCTXSYNC and NIOCRXSYNC
2384bf50f18SLuigi Rizzo  * 	cases. They invoke the nm_sync callbacks on the netmap_kring
2394bf50f18SLuigi Rizzo  * 	structures, as initialized in step 2 and maybe later modified
2404bf50f18SLuigi Rizzo  * 	by a monitor. Monitors, however, will always call the original
2414bf50f18SLuigi Rizzo  * 	callback before doing anything else.
2424bf50f18SLuigi Rizzo  *
2434bf50f18SLuigi Rizzo  *
2444bf50f18SLuigi Rizzo  * > 6. select() or poll() can be used to wait for events on individual
2454bf50f18SLuigi Rizzo  * >    transmit or receive queues (or all queues for a given interface).
2464bf50f18SLuigi Rizzo  *
2474bf50f18SLuigi Rizzo  * 	Implemented in netmap_poll(). This will call the same nm_sync()
2484bf50f18SLuigi Rizzo  * 	callbacks as in step 5 above.
2494bf50f18SLuigi Rizzo  *
2504bf50f18SLuigi Rizzo  * 	os-specific:
2514bf50f18SLuigi Rizzo  * 		linux: we first go through linux_netmap_poll() to adapt
2524bf50f18SLuigi Rizzo  * 		       the FreeBSD interface to the linux one.
2534bf50f18SLuigi Rizzo  *
2544bf50f18SLuigi Rizzo  *
2554bf50f18SLuigi Rizzo  *  ----  VALE_CTL -----
2564bf50f18SLuigi Rizzo  *
2574bf50f18SLuigi Rizzo  *  VALE switches are controlled by issuing a NIOCREGIF with a non-null
2584bf50f18SLuigi Rizzo  *  nr_cmd in the nmreq structure. These subcommands are handled by
2594bf50f18SLuigi Rizzo  *  netmap_bdg_ctl() in netmap_vale.c. Persistent VALE ports are created
2604bf50f18SLuigi Rizzo  *  and destroyed by issuing the NETMAP_BDG_NEWIF and NETMAP_BDG_DELIF
2614bf50f18SLuigi Rizzo  *  subcommands, respectively.
2624bf50f18SLuigi Rizzo  *
2634bf50f18SLuigi Rizzo  *  Any network interface known to the system (including a persistent VALE
2644bf50f18SLuigi Rizzo  *  port) can be attached to a VALE switch by issuing the
2652ff91c17SVincenzo Maffione  *  NETMAP_REQ_VALE_ATTACH command. After the attachment, persistent VALE ports
2664bf50f18SLuigi Rizzo  *  look exactly like ephemeral VALE ports (as created in step 2 above).  The
2674bf50f18SLuigi Rizzo  *  attachment of other interfaces, instead, requires the creation of a
2684bf50f18SLuigi Rizzo  *  netmap_bwrap_adapter.  Moreover, the attached interface must be put in
2694bf50f18SLuigi Rizzo  *  netmap mode. This may require the creation of a netmap_generic_adapter if
2704bf50f18SLuigi Rizzo  *  we have no native support for the interface, or if generic adapters have
2714bf50f18SLuigi Rizzo  *  been forced by sysctl.
2724bf50f18SLuigi Rizzo  *
2734bf50f18SLuigi Rizzo  *  Both persistent VALE ports and bwraps are handled by netmap_get_bdg_na(),
2744bf50f18SLuigi Rizzo  *  called by nm_bdg_ctl_attach(), and discriminated by the nm_bdg_attach()
2754bf50f18SLuigi Rizzo  *  callback.  In the case of the bwrap, the callback creates the
2764bf50f18SLuigi Rizzo  *  netmap_bwrap_adapter.  The initialization of the bwrap is then
2774bf50f18SLuigi Rizzo  *  completed by calling netmap_do_regif() on it, in the nm_bdg_ctl()
2784bf50f18SLuigi Rizzo  *  callback (netmap_bwrap_bdg_ctl in netmap_vale.c).
2794bf50f18SLuigi Rizzo  *  A generic adapter for the wrapped ifp will be created if needed, when
2804bf50f18SLuigi Rizzo  *  netmap_get_bdg_na() calls netmap_get_hw_na().
2814bf50f18SLuigi Rizzo  *
2824bf50f18SLuigi Rizzo  *
2834bf50f18SLuigi Rizzo  *  ---- DATAPATHS -----
2844bf50f18SLuigi Rizzo  *
2854bf50f18SLuigi Rizzo  *              -= SYSTEM DEVICE WITH NATIVE SUPPORT =-
2864bf50f18SLuigi Rizzo  *
2874bf50f18SLuigi Rizzo  *    na == NA(ifp) == netmap_hw_adapter created in DEVICE_netmap_attach()
2884bf50f18SLuigi Rizzo  *
2894bf50f18SLuigi Rizzo  *    - tx from netmap userspace:
2904bf50f18SLuigi Rizzo  *	 concurrently:
2914bf50f18SLuigi Rizzo  *           1) ioctl(NIOCTXSYNC)/netmap_poll() in process context
2924bf50f18SLuigi Rizzo  *                kring->nm_sync() == DEVICE_netmap_txsync()
2934bf50f18SLuigi Rizzo  *           2) device interrupt handler
2944bf50f18SLuigi Rizzo  *                na->nm_notify()  == netmap_notify()
2954bf50f18SLuigi Rizzo  *    - rx from netmap userspace:
2964bf50f18SLuigi Rizzo  *       concurrently:
2974bf50f18SLuigi Rizzo  *           1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
2984bf50f18SLuigi Rizzo  *                kring->nm_sync() == DEVICE_netmap_rxsync()
2994bf50f18SLuigi Rizzo  *           2) device interrupt handler
3004bf50f18SLuigi Rizzo  *                na->nm_notify()  == netmap_notify()
301847bf383SLuigi Rizzo  *    - rx from host stack
3024bf50f18SLuigi Rizzo  *       concurrently:
3034bf50f18SLuigi Rizzo  *           1) host stack
3044bf50f18SLuigi Rizzo  *                netmap_transmit()
3054bf50f18SLuigi Rizzo  *                  na->nm_notify  == netmap_notify()
3064bf50f18SLuigi Rizzo  *           2) ioctl(NIOCRXSYNC)/netmap_poll() in process context
30737e3a6d3SLuigi Rizzo  *                kring->nm_sync() == netmap_rxsync_from_host
3084bf50f18SLuigi Rizzo  *                  netmap_rxsync_from_host(na, NULL, NULL)
3094bf50f18SLuigi Rizzo  *    - tx to host stack
3104bf50f18SLuigi Rizzo  *           ioctl(NIOCTXSYNC)/netmap_poll() in process context
31137e3a6d3SLuigi Rizzo  *             kring->nm_sync() == netmap_txsync_to_host
3124bf50f18SLuigi Rizzo  *               netmap_txsync_to_host(na)
31337e3a6d3SLuigi Rizzo  *                 nm_os_send_up()
31437e3a6d3SLuigi Rizzo  *                   FreeBSD: na->if_input() == ether_input()
3154bf50f18SLuigi Rizzo  *                   linux: netif_rx() with NM_MAGIC_PRIORITY_RX
3164bf50f18SLuigi Rizzo  *
3174bf50f18SLuigi Rizzo  *
3184bf50f18SLuigi Rizzo  *               -= SYSTEM DEVICE WITH GENERIC SUPPORT =-
3194bf50f18SLuigi Rizzo  *
320847bf383SLuigi Rizzo  *    na == NA(ifp) == generic_netmap_adapter created in generic_netmap_attach()
321847bf383SLuigi Rizzo  *
322847bf383SLuigi Rizzo  *    - tx from netmap userspace:
323847bf383SLuigi Rizzo  *       concurrently:
324847bf383SLuigi Rizzo  *           1) ioctl(NIOCTXSYNC)/netmap_poll() in process context
325847bf383SLuigi Rizzo  *               kring->nm_sync() == generic_netmap_txsync()
32637e3a6d3SLuigi Rizzo  *                   nm_os_generic_xmit_frame()
327847bf383SLuigi Rizzo  *                       linux:   dev_queue_xmit() with NM_MAGIC_PRIORITY_TX
32837e3a6d3SLuigi Rizzo  *                           ifp->ndo_start_xmit == generic_ndo_start_xmit()
32937e3a6d3SLuigi Rizzo  *                               gna->save_start_xmit == orig. dev. start_xmit
330847bf383SLuigi Rizzo  *                       FreeBSD: na->if_transmit() == orig. dev if_transmit
331847bf383SLuigi Rizzo  *           2) generic_mbuf_destructor()
332847bf383SLuigi Rizzo  *                   na->nm_notify() == netmap_notify()
333847bf383SLuigi Rizzo  *    - rx from netmap userspace:
334847bf383SLuigi Rizzo  *           1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
335847bf383SLuigi Rizzo  *               kring->nm_sync() == generic_netmap_rxsync()
336847bf383SLuigi Rizzo  *                   mbq_safe_dequeue()
337847bf383SLuigi Rizzo  *           2) device driver
338847bf383SLuigi Rizzo  *               generic_rx_handler()
339847bf383SLuigi Rizzo  *                   mbq_safe_enqueue()
340847bf383SLuigi Rizzo  *                   na->nm_notify() == netmap_notify()
34137e3a6d3SLuigi Rizzo  *    - rx from host stack
34237e3a6d3SLuigi Rizzo  *        FreeBSD: same as native
34337e3a6d3SLuigi Rizzo  *        Linux: same as native except:
344847bf383SLuigi Rizzo  *           1) host stack
34537e3a6d3SLuigi Rizzo  *               dev_queue_xmit() without NM_MAGIC_PRIORITY_TX
34637e3a6d3SLuigi Rizzo  *                   ifp->ndo_start_xmit == generic_ndo_start_xmit()
347847bf383SLuigi Rizzo  *                       netmap_transmit()
348847bf383SLuigi Rizzo  *                           na->nm_notify() == netmap_notify()
34937e3a6d3SLuigi Rizzo  *    - tx to host stack (same as native):
3504bf50f18SLuigi Rizzo  *
3514bf50f18SLuigi Rizzo  *
352847bf383SLuigi Rizzo  *                           -= VALE =-
3534bf50f18SLuigi Rizzo  *
354847bf383SLuigi Rizzo  *   INCOMING:
3554bf50f18SLuigi Rizzo  *
356847bf383SLuigi Rizzo  *      - VALE ports:
357847bf383SLuigi Rizzo  *          ioctl(NIOCTXSYNC)/netmap_poll() in process context
358847bf383SLuigi Rizzo  *              kring->nm_sync() == netmap_vp_txsync()
3594bf50f18SLuigi Rizzo  *
360847bf383SLuigi Rizzo  *      - system device with native support:
361847bf383SLuigi Rizzo  *         from cable:
362847bf383SLuigi Rizzo  *             interrupt
363847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr != host ring)
364847bf383SLuigi Rizzo  *                     kring->nm_sync() == DEVICE_netmap_rxsync()
365847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
366847bf383SLuigi Rizzo  *                     kring->nm_sync() == DEVICE_netmap_rxsync()
367847bf383SLuigi Rizzo  *         from host stack:
368847bf383SLuigi Rizzo  *             netmap_transmit()
369847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr == host ring)
37037e3a6d3SLuigi Rizzo  *                     kring->nm_sync() == netmap_rxsync_from_host()
371847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
3724bf50f18SLuigi Rizzo  *
373847bf383SLuigi Rizzo  *      - system device with generic support:
374847bf383SLuigi Rizzo  *         from device driver:
375847bf383SLuigi Rizzo  *            generic_rx_handler()
376847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr != host ring)
377847bf383SLuigi Rizzo  *                     kring->nm_sync() == generic_netmap_rxsync()
378847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
379847bf383SLuigi Rizzo  *                     kring->nm_sync() == generic_netmap_rxsync()
380847bf383SLuigi Rizzo  *         from host stack:
381847bf383SLuigi Rizzo  *            netmap_transmit()
382847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr == host ring)
38337e3a6d3SLuigi Rizzo  *                     kring->nm_sync() == netmap_rxsync_from_host()
384847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
3854bf50f18SLuigi Rizzo  *
386847bf383SLuigi Rizzo  *   (all cases) --> nm_bdg_flush()
387847bf383SLuigi Rizzo  *                      dest_na->nm_notify() == (see below)
3884bf50f18SLuigi Rizzo  *
389847bf383SLuigi Rizzo  *   OUTGOING:
3904bf50f18SLuigi Rizzo  *
391847bf383SLuigi Rizzo  *      - VALE ports:
392847bf383SLuigi Rizzo  *         concurrently:
393c3e9b4dbSLuiz Otavio O Souza  *             1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
394847bf383SLuigi Rizzo  *                    kring->nm_sync() == netmap_vp_rxsync()
395847bf383SLuigi Rizzo  *             2) from nm_bdg_flush()
396847bf383SLuigi Rizzo  *                    na->nm_notify() == netmap_notify()
3974bf50f18SLuigi Rizzo  *
398847bf383SLuigi Rizzo  *      - system device with native support:
399847bf383SLuigi Rizzo  *          to cable:
400847bf383SLuigi Rizzo  *             na->nm_notify() == netmap_bwrap_notify()
401847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
402847bf383SLuigi Rizzo  *                 kring->nm_sync() == DEVICE_netmap_txsync()
403847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
404847bf383SLuigi Rizzo  *          to host stack:
405847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
40637e3a6d3SLuigi Rizzo  *                 kring->nm_sync() == netmap_txsync_to_host
407847bf383SLuigi Rizzo  *                 netmap_vp_rxsync_locked()
4084bf50f18SLuigi Rizzo  *
409847bf383SLuigi Rizzo  *      - system device with generic adapter:
410847bf383SLuigi Rizzo  *          to device driver:
411847bf383SLuigi Rizzo  *             na->nm_notify() == netmap_bwrap_notify()
412847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
413847bf383SLuigi Rizzo  *                 kring->nm_sync() == generic_netmap_txsync()
414847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
415847bf383SLuigi Rizzo  *          to host stack:
416847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
41737e3a6d3SLuigi Rizzo  *                 kring->nm_sync() == netmap_txsync_to_host
418847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
4194bf50f18SLuigi Rizzo  *
4204bf50f18SLuigi Rizzo  */
4214bf50f18SLuigi Rizzo 
422ce3ee1e7SLuigi Rizzo /*
423ce3ee1e7SLuigi Rizzo  * OS-specific code that is used only within this file.
424ce3ee1e7SLuigi Rizzo  * Other OS-specific code that must be accessed by drivers
425ce3ee1e7SLuigi Rizzo  * is present in netmap_kern.h
426ce3ee1e7SLuigi Rizzo  */
42701c7d25fSLuigi Rizzo 
428ce3ee1e7SLuigi Rizzo #if defined(__FreeBSD__)
42968b8534bSLuigi Rizzo #include <sys/cdefs.h> /* prerequisite */
43068b8534bSLuigi Rizzo #include <sys/types.h>
43168b8534bSLuigi Rizzo #include <sys/errno.h>
43268b8534bSLuigi Rizzo #include <sys/param.h>	/* defines used in kernel.h */
43368b8534bSLuigi Rizzo #include <sys/kernel.h>	/* types used in module initialization */
434f9790aebSLuigi Rizzo #include <sys/conf.h>	/* cdevsw struct, UID, GID */
43589e3fd52SLuigi Rizzo #include <sys/filio.h>	/* FIONBIO */
43668b8534bSLuigi Rizzo #include <sys/sockio.h>
43768b8534bSLuigi Rizzo #include <sys/socketvar.h>	/* struct socket */
43868b8534bSLuigi Rizzo #include <sys/malloc.h>
43968b8534bSLuigi Rizzo #include <sys/poll.h>
440a4470078SGleb Smirnoff #include <sys/proc.h>
44189f6b863SAttilio Rao #include <sys/rwlock.h>
44268b8534bSLuigi Rizzo #include <sys/socket.h> /* sockaddrs */
44368b8534bSLuigi Rizzo #include <sys/selinfo.h>
44468b8534bSLuigi Rizzo #include <sys/sysctl.h>
445339f59c0SGleb Smirnoff #include <sys/jail.h>
446a4470078SGleb Smirnoff #include <sys/epoch.h>
447339f59c0SGleb Smirnoff #include <net/vnet.h>
44868b8534bSLuigi Rizzo #include <net/if.h>
44976039bc8SGleb Smirnoff #include <net/if_var.h>
45068b8534bSLuigi Rizzo #include <net/bpf.h>		/* BIOCIMMEDIATE */
45168b8534bSLuigi Rizzo #include <machine/bus.h>	/* bus_dmamap_* */
452ce3ee1e7SLuigi Rizzo #include <sys/endian.h>
453ce3ee1e7SLuigi Rizzo #include <sys/refcount.h>
45489a9a5b5SVincenzo Maffione #include <net/ethernet.h>	/* ETHER_BPF_MTAP */
45568b8534bSLuigi Rizzo 
45668b8534bSLuigi Rizzo 
457ce3ee1e7SLuigi Rizzo #elif defined(linux)
458ce3ee1e7SLuigi Rizzo 
459ce3ee1e7SLuigi Rizzo #include "bsd_glue.h"
460ce3ee1e7SLuigi Rizzo 
461ce3ee1e7SLuigi Rizzo #elif defined(__APPLE__)
462ce3ee1e7SLuigi Rizzo 
463ce3ee1e7SLuigi Rizzo #warning OSX support is only partial
464ce3ee1e7SLuigi Rizzo #include "osx_glue.h"
465ce3ee1e7SLuigi Rizzo 
46637e3a6d3SLuigi Rizzo #elif defined (_WIN32)
46737e3a6d3SLuigi Rizzo 
46837e3a6d3SLuigi Rizzo #include "win_glue.h"
46937e3a6d3SLuigi Rizzo 
470ce3ee1e7SLuigi Rizzo #else
471ce3ee1e7SLuigi Rizzo 
472ce3ee1e7SLuigi Rizzo #error	Unsupported platform
473ce3ee1e7SLuigi Rizzo 
474ce3ee1e7SLuigi Rizzo #endif /* unsupported */
475ce3ee1e7SLuigi Rizzo 
476ce3ee1e7SLuigi Rizzo /*
477ce3ee1e7SLuigi Rizzo  * common headers
478ce3ee1e7SLuigi Rizzo  */
4790b8ed8e0SLuigi Rizzo #include <net/netmap.h>
4800b8ed8e0SLuigi Rizzo #include <dev/netmap/netmap_kern.h>
481ce3ee1e7SLuigi Rizzo #include <dev/netmap/netmap_mem2.h>
4820b8ed8e0SLuigi Rizzo 
483ce3ee1e7SLuigi Rizzo 
4845819da83SLuigi Rizzo /* user-controlled variables */
4855819da83SLuigi Rizzo int netmap_verbose;
486b6e66be2SVincenzo Maffione #ifdef CONFIG_NETMAP_DEBUG
487b6e66be2SVincenzo Maffione int netmap_debug;
488b6e66be2SVincenzo Maffione #endif /* CONFIG_NETMAP_DEBUG */
4895819da83SLuigi Rizzo 
4905819da83SLuigi Rizzo static int netmap_no_timestamp; /* don't timestamp on rxsync */
491c85cb1a0SLuigi Rizzo int netmap_no_pendintr = 1;
492f18be576SLuigi Rizzo int netmap_txsync_retry = 2;
493c3e9b4dbSLuiz Otavio O Souza static int netmap_fwd = 0;	/* force transparent forwarding */
494f196ce38SLuigi Rizzo 
495f9790aebSLuigi Rizzo /*
496f9790aebSLuigi Rizzo  * netmap_admode selects the netmap mode to use.
497f9790aebSLuigi Rizzo  * Invalid values are reset to NETMAP_ADMODE_BEST
498f9790aebSLuigi Rizzo  */
499f9790aebSLuigi Rizzo enum {	NETMAP_ADMODE_BEST = 0,	/* use native, fallback to generic */
500f9790aebSLuigi Rizzo 	NETMAP_ADMODE_NATIVE,	/* either native or none */
501f9790aebSLuigi Rizzo 	NETMAP_ADMODE_GENERIC,	/* force generic */
502f9790aebSLuigi Rizzo 	NETMAP_ADMODE_LAST };
503f9790aebSLuigi Rizzo static int netmap_admode = NETMAP_ADMODE_BEST;
504f9790aebSLuigi Rizzo 
50537e3a6d3SLuigi Rizzo /* netmap_generic_mit controls mitigation of RX notifications for
50637e3a6d3SLuigi Rizzo  * the generic netmap adapter. The value is a time interval in
50737e3a6d3SLuigi Rizzo  * nanoseconds. */
50837e3a6d3SLuigi Rizzo int netmap_generic_mit = 100*1000;
50937e3a6d3SLuigi Rizzo 
51037e3a6d3SLuigi Rizzo /* We use by default netmap-aware qdiscs with generic netmap adapters,
51137e3a6d3SLuigi Rizzo  * even if there can be a little performance hit with hardware NICs.
51237e3a6d3SLuigi Rizzo  * However, using the qdisc is the safer approach, for two reasons:
51337e3a6d3SLuigi Rizzo  * 1) it prevents non-fifo qdiscs to break the TX notification
51437e3a6d3SLuigi Rizzo  *    scheme, which is based on mbuf destructors when txqdisc is
51537e3a6d3SLuigi Rizzo  *    not used.
51637e3a6d3SLuigi Rizzo  * 2) it makes it possible to transmit over software devices that
51737e3a6d3SLuigi Rizzo  *    change skb->dev, like bridge, veth, ...
51837e3a6d3SLuigi Rizzo  *
51937e3a6d3SLuigi Rizzo  * Anyway users looking for the best performance should
52037e3a6d3SLuigi Rizzo  * use native adapters.
52137e3a6d3SLuigi Rizzo  */
5224f80b14cSVincenzo Maffione #ifdef linux
52337e3a6d3SLuigi Rizzo int netmap_generic_txqdisc = 1;
5244f80b14cSVincenzo Maffione #endif
52537e3a6d3SLuigi Rizzo 
52637e3a6d3SLuigi Rizzo /* Default number of slots and queues for generic adapters. */
52737e3a6d3SLuigi Rizzo int netmap_generic_ringsize = 1024;
52837e3a6d3SLuigi Rizzo int netmap_generic_rings = 1;
52937e3a6d3SLuigi Rizzo 
5302a7db7a6SVincenzo Maffione /* Non-zero to enable checksum offloading in NIC drivers */
5312a7db7a6SVincenzo Maffione int netmap_generic_hwcsum = 0;
5322a7db7a6SVincenzo Maffione 
53337e3a6d3SLuigi Rizzo /* Non-zero if ptnet devices are allowed to use virtio-net headers. */
53437e3a6d3SLuigi Rizzo int ptnet_vnet_hdr = 1;
53537e3a6d3SLuigi Rizzo 
53637e3a6d3SLuigi Rizzo /*
53737e3a6d3SLuigi Rizzo  * SYSCTL calls are grouped between SYSBEGIN and SYSEND to be emulated
53837e3a6d3SLuigi Rizzo  * in some other operating systems
53937e3a6d3SLuigi Rizzo  */
54037e3a6d3SLuigi Rizzo SYSBEGIN(main_init);
54137e3a6d3SLuigi Rizzo 
54237e3a6d3SLuigi Rizzo SYSCTL_DECL(_dev_netmap);
5437029da5cSPawel Biernacki SYSCTL_NODE(_dev, OID_AUTO, netmap, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
5447029da5cSPawel Biernacki     "Netmap args");
54537e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, verbose,
54637e3a6d3SLuigi Rizzo 		CTLFLAG_RW, &netmap_verbose, 0, "Verbose mode");
547b6e66be2SVincenzo Maffione #ifdef CONFIG_NETMAP_DEBUG
548b6e66be2SVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, debug,
549b6e66be2SVincenzo Maffione 		CTLFLAG_RW, &netmap_debug, 0, "Debug messages");
550b6e66be2SVincenzo Maffione #endif /* CONFIG_NETMAP_DEBUG */
55137e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, no_timestamp,
55237e3a6d3SLuigi Rizzo 		CTLFLAG_RW, &netmap_no_timestamp, 0, "no_timestamp");
5534f80b14cSVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, no_pendintr, CTLFLAG_RW, &netmap_no_pendintr,
5544f80b14cSVincenzo Maffione 		0, "Always look for new received packets.");
55537e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, txsync_retry, CTLFLAG_RW,
55637e3a6d3SLuigi Rizzo 		&netmap_txsync_retry, 0, "Number of txsync loops in bridge's flush.");
557f9790aebSLuigi Rizzo 
5584f80b14cSVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, fwd, CTLFLAG_RW, &netmap_fwd, 0,
5594f80b14cSVincenzo Maffione 		"Force NR_FORWARD mode");
5604f80b14cSVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, admode, CTLFLAG_RW, &netmap_admode, 0,
5614f80b14cSVincenzo Maffione 		"Adapter mode. 0 selects the best option available,"
5624f80b14cSVincenzo Maffione 		"1 forces native adapter, 2 forces emulated adapter");
5632a7db7a6SVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, generic_hwcsum, CTLFLAG_RW, &netmap_generic_hwcsum,
5642a7db7a6SVincenzo Maffione 		0, "Hardware checksums. 0 to disable checksum generation by the NIC (default),"
5652a7db7a6SVincenzo Maffione 		"1 to enable checksum generation by the NIC");
5664f80b14cSVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, generic_mit, CTLFLAG_RW, &netmap_generic_mit,
5674f80b14cSVincenzo Maffione 		0, "RX notification interval in nanoseconds");
5684f80b14cSVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, generic_ringsize, CTLFLAG_RW,
5694f80b14cSVincenzo Maffione 		&netmap_generic_ringsize, 0,
5704f80b14cSVincenzo Maffione 		"Number of per-ring slots for emulated netmap mode");
5714f80b14cSVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, generic_rings, CTLFLAG_RW,
5724f80b14cSVincenzo Maffione 		&netmap_generic_rings, 0,
5734f80b14cSVincenzo Maffione 		"Number of TX/RX queues for emulated netmap adapters");
5744f80b14cSVincenzo Maffione #ifdef linux
5754f80b14cSVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, generic_txqdisc, CTLFLAG_RW,
5764f80b14cSVincenzo Maffione 		&netmap_generic_txqdisc, 0, "Use qdisc for generic adapters");
5774f80b14cSVincenzo Maffione #endif
5784f80b14cSVincenzo Maffione SYSCTL_INT(_dev_netmap, OID_AUTO, ptnet_vnet_hdr, CTLFLAG_RW, &ptnet_vnet_hdr,
5794f80b14cSVincenzo Maffione 		0, "Allow ptnet devices to use virtio-net headers");
58037e3a6d3SLuigi Rizzo 
58137e3a6d3SLuigi Rizzo SYSEND;
582f196ce38SLuigi Rizzo 
583ce3ee1e7SLuigi Rizzo NMG_LOCK_T	netmap_global_lock;
584ce3ee1e7SLuigi Rizzo 
58517885a7bSLuigi Rizzo /*
58617885a7bSLuigi Rizzo  * mark the ring as stopped, and run through the locks
58717885a7bSLuigi Rizzo  * to make sure other users get to see it.
58837e3a6d3SLuigi Rizzo  * stopped must be either NR_KR_STOPPED (for unbounded stop)
58937e3a6d3SLuigi Rizzo  * of NR_KR_LOCKED (brief stop for mutual exclusion purposes)
59017885a7bSLuigi Rizzo  */
5914bf50f18SLuigi Rizzo static void
59237e3a6d3SLuigi Rizzo netmap_disable_ring(struct netmap_kring *kr, int stopped)
593ce3ee1e7SLuigi Rizzo {
59437e3a6d3SLuigi Rizzo 	nm_kr_stop(kr, stopped);
59537e3a6d3SLuigi Rizzo 	// XXX check if nm_kr_stop is sufficient
596ce3ee1e7SLuigi Rizzo 	mtx_lock(&kr->q_lock);
597ce3ee1e7SLuigi Rizzo 	mtx_unlock(&kr->q_lock);
598ce3ee1e7SLuigi Rizzo 	nm_kr_put(kr);
599ce3ee1e7SLuigi Rizzo }
600ce3ee1e7SLuigi Rizzo 
601847bf383SLuigi Rizzo /* stop or enable a single ring */
6024bf50f18SLuigi Rizzo void
603847bf383SLuigi Rizzo netmap_set_ring(struct netmap_adapter *na, u_int ring_id, enum txrx t, int stopped)
6044bf50f18SLuigi Rizzo {
6054bf50f18SLuigi Rizzo 	if (stopped)
6062ff91c17SVincenzo Maffione 		netmap_disable_ring(NMR(na, t)[ring_id], stopped);
6074bf50f18SLuigi Rizzo 	else
6082ff91c17SVincenzo Maffione 		NMR(na, t)[ring_id]->nkr_stopped = 0;
6094bf50f18SLuigi Rizzo }
6104bf50f18SLuigi Rizzo 
611f9790aebSLuigi Rizzo 
61289cc2556SLuigi Rizzo /* stop or enable all the rings of na */
6134bf50f18SLuigi Rizzo void
6144bf50f18SLuigi Rizzo netmap_set_all_rings(struct netmap_adapter *na, int stopped)
615ce3ee1e7SLuigi Rizzo {
616ce3ee1e7SLuigi Rizzo 	int i;
617847bf383SLuigi Rizzo 	enum txrx t;
618ce3ee1e7SLuigi Rizzo 
6194bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na))
620ce3ee1e7SLuigi Rizzo 		return;
621ce3ee1e7SLuigi Rizzo 
622bb714db6SVincenzo Maffione 	if (netmap_verbose) {
623bb714db6SVincenzo Maffione 		nm_prinf("%s: %sable all rings", na->name,
624bb714db6SVincenzo Maffione 		    (stopped ? "dis" : "en"));
625bb714db6SVincenzo Maffione 	}
626847bf383SLuigi Rizzo 	for_rx_tx(t) {
627847bf383SLuigi Rizzo 		for (i = 0; i < netmap_real_rings(na, t); i++) {
628847bf383SLuigi Rizzo 			netmap_set_ring(na, i, t, stopped);
629ce3ee1e7SLuigi Rizzo 		}
630ce3ee1e7SLuigi Rizzo 	}
631ce3ee1e7SLuigi Rizzo }
632ce3ee1e7SLuigi Rizzo 
63389cc2556SLuigi Rizzo /*
63489cc2556SLuigi Rizzo  * Convenience function used in drivers.  Waits for current txsync()s/rxsync()s
63589cc2556SLuigi Rizzo  * to finish and prevents any new one from starting.  Call this before turning
636ddb13598SKevin Lo  * netmap mode off, or before removing the hardware rings (e.g., on module
63737e3a6d3SLuigi Rizzo  * onload).
63889cc2556SLuigi Rizzo  */
639f9790aebSLuigi Rizzo void
640f9790aebSLuigi Rizzo netmap_disable_all_rings(struct ifnet *ifp)
641f9790aebSLuigi Rizzo {
64237e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
64355f0ad5fSVincenzo Maffione 		netmap_set_all_rings(NA(ifp), NM_KR_LOCKED);
64437e3a6d3SLuigi Rizzo 	}
645f9790aebSLuigi Rizzo }
646f9790aebSLuigi Rizzo 
64789cc2556SLuigi Rizzo /*
64889cc2556SLuigi Rizzo  * Convenience function used in drivers.  Re-enables rxsync and txsync on the
64989cc2556SLuigi Rizzo  * adapter's rings In linux drivers, this should be placed near each
65089cc2556SLuigi Rizzo  * napi_enable().
65189cc2556SLuigi Rizzo  */
652f9790aebSLuigi Rizzo void
653f9790aebSLuigi Rizzo netmap_enable_all_rings(struct ifnet *ifp)
654f9790aebSLuigi Rizzo {
65537e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
6564bf50f18SLuigi Rizzo 		netmap_set_all_rings(NA(ifp), 0 /* enabled */);
657f9790aebSLuigi Rizzo 	}
65837e3a6d3SLuigi Rizzo }
659f9790aebSLuigi Rizzo 
66037e3a6d3SLuigi Rizzo void
66137e3a6d3SLuigi Rizzo netmap_make_zombie(struct ifnet *ifp)
66237e3a6d3SLuigi Rizzo {
66337e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
66437e3a6d3SLuigi Rizzo 		struct netmap_adapter *na = NA(ifp);
66537e3a6d3SLuigi Rizzo 		netmap_set_all_rings(na, NM_KR_LOCKED);
66637e3a6d3SLuigi Rizzo 		na->na_flags |= NAF_ZOMBIE;
66737e3a6d3SLuigi Rizzo 		netmap_set_all_rings(na, 0);
66837e3a6d3SLuigi Rizzo 	}
66937e3a6d3SLuigi Rizzo }
67037e3a6d3SLuigi Rizzo 
67137e3a6d3SLuigi Rizzo void
67237e3a6d3SLuigi Rizzo netmap_undo_zombie(struct ifnet *ifp)
67337e3a6d3SLuigi Rizzo {
67437e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
67537e3a6d3SLuigi Rizzo 		struct netmap_adapter *na = NA(ifp);
67637e3a6d3SLuigi Rizzo 		if (na->na_flags & NAF_ZOMBIE) {
67737e3a6d3SLuigi Rizzo 			netmap_set_all_rings(na, NM_KR_LOCKED);
67837e3a6d3SLuigi Rizzo 			na->na_flags &= ~NAF_ZOMBIE;
67937e3a6d3SLuigi Rizzo 			netmap_set_all_rings(na, 0);
68037e3a6d3SLuigi Rizzo 		}
68137e3a6d3SLuigi Rizzo 	}
68237e3a6d3SLuigi Rizzo }
683f9790aebSLuigi Rizzo 
684ce3ee1e7SLuigi Rizzo /*
685ce3ee1e7SLuigi Rizzo  * generic bound_checking function
686ce3ee1e7SLuigi Rizzo  */
687ce3ee1e7SLuigi Rizzo u_int
688ce3ee1e7SLuigi Rizzo nm_bound_var(u_int *v, u_int dflt, u_int lo, u_int hi, const char *msg)
689ce3ee1e7SLuigi Rizzo {
690ce3ee1e7SLuigi Rizzo 	u_int oldv = *v;
691ce3ee1e7SLuigi Rizzo 	const char *op = NULL;
692ce3ee1e7SLuigi Rizzo 
693ce3ee1e7SLuigi Rizzo 	if (dflt < lo)
694ce3ee1e7SLuigi Rizzo 		dflt = lo;
695ce3ee1e7SLuigi Rizzo 	if (dflt > hi)
696ce3ee1e7SLuigi Rizzo 		dflt = hi;
697ce3ee1e7SLuigi Rizzo 	if (oldv < lo) {
698ce3ee1e7SLuigi Rizzo 		*v = dflt;
699ce3ee1e7SLuigi Rizzo 		op = "Bump";
700ce3ee1e7SLuigi Rizzo 	} else if (oldv > hi) {
701ce3ee1e7SLuigi Rizzo 		*v = hi;
702ce3ee1e7SLuigi Rizzo 		op = "Clamp";
703ce3ee1e7SLuigi Rizzo 	}
704ce3ee1e7SLuigi Rizzo 	if (op && msg)
705b6e66be2SVincenzo Maffione 		nm_prinf("%s %s to %d (was %d)", op, msg, *v, oldv);
706ce3ee1e7SLuigi Rizzo 	return *v;
707ce3ee1e7SLuigi Rizzo }
708ce3ee1e7SLuigi Rizzo 
709f9790aebSLuigi Rizzo 
710ce3ee1e7SLuigi Rizzo /*
711ce3ee1e7SLuigi Rizzo  * packet-dump function, user-supplied or static buffer.
712ce3ee1e7SLuigi Rizzo  * The destination buffer must be at least 30+4*len
713ce3ee1e7SLuigi Rizzo  */
714ce3ee1e7SLuigi Rizzo const char *
715ce3ee1e7SLuigi Rizzo nm_dump_buf(char *p, int len, int lim, char *dst)
716ce3ee1e7SLuigi Rizzo {
717ce3ee1e7SLuigi Rizzo 	static char _dst[8192];
718ce3ee1e7SLuigi Rizzo 	int i, j, i0;
719ce3ee1e7SLuigi Rizzo 	static char hex[] ="0123456789abcdef";
720ce3ee1e7SLuigi Rizzo 	char *o;	/* output position */
721ce3ee1e7SLuigi Rizzo 
722ce3ee1e7SLuigi Rizzo #define P_HI(x)	hex[((x) & 0xf0)>>4]
723ce3ee1e7SLuigi Rizzo #define P_LO(x)	hex[((x) & 0xf)]
724ce3ee1e7SLuigi Rizzo #define P_C(x)	((x) >= 0x20 && (x) <= 0x7e ? (x) : '.')
725ce3ee1e7SLuigi Rizzo 	if (!dst)
726ce3ee1e7SLuigi Rizzo 		dst = _dst;
727ce3ee1e7SLuigi Rizzo 	if (lim <= 0 || lim > len)
728ce3ee1e7SLuigi Rizzo 		lim = len;
729ce3ee1e7SLuigi Rizzo 	o = dst;
730ce3ee1e7SLuigi Rizzo 	sprintf(o, "buf 0x%p len %d lim %d\n", p, len, lim);
731ce3ee1e7SLuigi Rizzo 	o += strlen(o);
732ce3ee1e7SLuigi Rizzo 	/* hexdump routine */
733ce3ee1e7SLuigi Rizzo 	for (i = 0; i < lim; ) {
734ce3ee1e7SLuigi Rizzo 		sprintf(o, "%5d: ", i);
735ce3ee1e7SLuigi Rizzo 		o += strlen(o);
736ce3ee1e7SLuigi Rizzo 		memset(o, ' ', 48);
737ce3ee1e7SLuigi Rizzo 		i0 = i;
738ce3ee1e7SLuigi Rizzo 		for (j=0; j < 16 && i < lim; i++, j++) {
739ce3ee1e7SLuigi Rizzo 			o[j*3] = P_HI(p[i]);
740ce3ee1e7SLuigi Rizzo 			o[j*3+1] = P_LO(p[i]);
741ce3ee1e7SLuigi Rizzo 		}
742ce3ee1e7SLuigi Rizzo 		i = i0;
743ce3ee1e7SLuigi Rizzo 		for (j=0; j < 16 && i < lim; i++, j++)
744ce3ee1e7SLuigi Rizzo 			o[j + 48] = P_C(p[i]);
745ce3ee1e7SLuigi Rizzo 		o[j+48] = '\n';
746ce3ee1e7SLuigi Rizzo 		o += j+49;
747ce3ee1e7SLuigi Rizzo 	}
748ce3ee1e7SLuigi Rizzo 	*o = '\0';
749ce3ee1e7SLuigi Rizzo #undef P_HI
750ce3ee1e7SLuigi Rizzo #undef P_LO
751ce3ee1e7SLuigi Rizzo #undef P_C
752ce3ee1e7SLuigi Rizzo 	return dst;
753ce3ee1e7SLuigi Rizzo }
754f196ce38SLuigi Rizzo 
755f18be576SLuigi Rizzo 
756ae10d1afSLuigi Rizzo /*
757ae10d1afSLuigi Rizzo  * Fetch configuration from the device, to cope with dynamic
758ae10d1afSLuigi Rizzo  * reconfigurations after loading the module.
759ae10d1afSLuigi Rizzo  */
76089cc2556SLuigi Rizzo /* call with NMG_LOCK held */
761f9790aebSLuigi Rizzo int
762ae10d1afSLuigi Rizzo netmap_update_config(struct netmap_adapter *na)
763ae10d1afSLuigi Rizzo {
7642ff91c17SVincenzo Maffione 	struct nm_config_info info;
765ae10d1afSLuigi Rizzo 
7662ff91c17SVincenzo Maffione 	bzero(&info, sizeof(info));
7676641c68bSLuigi Rizzo 	if (na->nm_config == NULL ||
7682ff91c17SVincenzo Maffione 	    na->nm_config(na, &info)) {
769ae10d1afSLuigi Rizzo 		/* take whatever we had at init time */
7702ff91c17SVincenzo Maffione 		info.num_tx_rings = na->num_tx_rings;
7712ff91c17SVincenzo Maffione 		info.num_tx_descs = na->num_tx_desc;
7722ff91c17SVincenzo Maffione 		info.num_rx_rings = na->num_rx_rings;
7732ff91c17SVincenzo Maffione 		info.num_rx_descs = na->num_rx_desc;
7742ff91c17SVincenzo Maffione 		info.rx_buf_maxsize = na->rx_buf_maxsize;
775ae10d1afSLuigi Rizzo 	}
776ae10d1afSLuigi Rizzo 
7772ff91c17SVincenzo Maffione 	if (na->num_tx_rings == info.num_tx_rings &&
7782ff91c17SVincenzo Maffione 	    na->num_tx_desc == info.num_tx_descs &&
7792ff91c17SVincenzo Maffione 	    na->num_rx_rings == info.num_rx_rings &&
7802ff91c17SVincenzo Maffione 	    na->num_rx_desc == info.num_rx_descs &&
7812ff91c17SVincenzo Maffione 	    na->rx_buf_maxsize == info.rx_buf_maxsize)
782ae10d1afSLuigi Rizzo 		return 0; /* nothing changed */
783f9790aebSLuigi Rizzo 	if (na->active_fds == 0) {
7842ff91c17SVincenzo Maffione 		na->num_tx_rings = info.num_tx_rings;
7852ff91c17SVincenzo Maffione 		na->num_tx_desc = info.num_tx_descs;
7862ff91c17SVincenzo Maffione 		na->num_rx_rings = info.num_rx_rings;
7872ff91c17SVincenzo Maffione 		na->num_rx_desc = info.num_rx_descs;
7882ff91c17SVincenzo Maffione 		na->rx_buf_maxsize = info.rx_buf_maxsize;
789b6e66be2SVincenzo Maffione 		if (netmap_verbose)
790b6e66be2SVincenzo Maffione 			nm_prinf("configuration changed for %s: txring %d x %d, "
791cfa866f6SMatt Macy 				"rxring %d x %d, rxbufsz %d",
792cfa866f6SMatt Macy 				na->name, na->num_tx_rings, na->num_tx_desc,
793cfa866f6SMatt Macy 				na->num_rx_rings, na->num_rx_desc, na->rx_buf_maxsize);
794ae10d1afSLuigi Rizzo 		return 0;
795ae10d1afSLuigi Rizzo 	}
796b6e66be2SVincenzo Maffione 	nm_prerr("WARNING: configuration changed for %s while active: "
7972ff91c17SVincenzo Maffione 		"txring %d x %d, rxring %d x %d, rxbufsz %d",
7982ff91c17SVincenzo Maffione 		na->name, info.num_tx_rings, info.num_tx_descs,
7992ff91c17SVincenzo Maffione 		info.num_rx_rings, info.num_rx_descs,
8002ff91c17SVincenzo Maffione 		info.rx_buf_maxsize);
801ae10d1afSLuigi Rizzo 	return 1;
802ae10d1afSLuigi Rizzo }
803ae10d1afSLuigi Rizzo 
80437e3a6d3SLuigi Rizzo /* nm_sync callbacks for the host rings */
80537e3a6d3SLuigi Rizzo static int netmap_txsync_to_host(struct netmap_kring *kring, int flags);
80637e3a6d3SLuigi Rizzo static int netmap_rxsync_from_host(struct netmap_kring *kring, int flags);
807f0ea3689SLuigi Rizzo 
808a6d768d8SVincenzo Maffione static int
809a6d768d8SVincenzo Maffione netmap_default_bufcfg(struct netmap_kring *kring, uint64_t target)
810a6d768d8SVincenzo Maffione {
811a6d768d8SVincenzo Maffione 	kring->hwbuf_len = target;
812a6d768d8SVincenzo Maffione 	kring->buf_align = 0; /* no alignment */
813a6d768d8SVincenzo Maffione 	return 0;
814a6d768d8SVincenzo Maffione }
815a6d768d8SVincenzo Maffione 
816f0ea3689SLuigi Rizzo /* create the krings array and initialize the fields common to all adapters.
817f0ea3689SLuigi Rizzo  * The array layout is this:
818f0ea3689SLuigi Rizzo  *
819f0ea3689SLuigi Rizzo  *                    +----------+
820f0ea3689SLuigi Rizzo  * na->tx_rings ----->|          | \
821f0ea3689SLuigi Rizzo  *                    |          |  } na->num_tx_ring
822f0ea3689SLuigi Rizzo  *                    |          | /
823f0ea3689SLuigi Rizzo  *                    +----------+
824f0ea3689SLuigi Rizzo  *                    |          |    host tx kring
825f0ea3689SLuigi Rizzo  * na->rx_rings ----> +----------+
826f0ea3689SLuigi Rizzo  *                    |          | \
827f0ea3689SLuigi Rizzo  *                    |          |  } na->num_rx_rings
828f0ea3689SLuigi Rizzo  *                    |          | /
829f0ea3689SLuigi Rizzo  *                    +----------+
830f0ea3689SLuigi Rizzo  *                    |          |    host rx kring
831f0ea3689SLuigi Rizzo  *                    +----------+
832f0ea3689SLuigi Rizzo  * na->tailroom ----->|          | \
833f0ea3689SLuigi Rizzo  *                    |          |  } tailroom bytes
834f0ea3689SLuigi Rizzo  *                    |          | /
835f0ea3689SLuigi Rizzo  *                    +----------+
836f0ea3689SLuigi Rizzo  *
837f0ea3689SLuigi Rizzo  * Note: for compatibility, host krings are created even when not needed.
838f0ea3689SLuigi Rizzo  * The tailroom space is currently used by vale ports for allocating leases.
839f0ea3689SLuigi Rizzo  */
84089cc2556SLuigi Rizzo /* call with NMG_LOCK held */
841f9790aebSLuigi Rizzo int
842f0ea3689SLuigi Rizzo netmap_krings_create(struct netmap_adapter *na, u_int tailroom)
843f9790aebSLuigi Rizzo {
844f9790aebSLuigi Rizzo 	u_int i, len, ndesc;
845f9790aebSLuigi Rizzo 	struct netmap_kring *kring;
846847bf383SLuigi Rizzo 	u_int n[NR_TXRX];
847847bf383SLuigi Rizzo 	enum txrx t;
84819c4ec08SVincenzo Maffione 	int err = 0;
849f9790aebSLuigi Rizzo 
850c3e9b4dbSLuiz Otavio O Souza 	if (na->tx_rings != NULL) {
851b6e66be2SVincenzo Maffione 		if (netmap_debug & NM_DEBUG_ON)
852b6e66be2SVincenzo Maffione 			nm_prerr("warning: krings were already created");
853c3e9b4dbSLuiz Otavio O Souza 		return 0;
854c3e9b4dbSLuiz Otavio O Souza 	}
855c3e9b4dbSLuiz Otavio O Souza 
856f0ea3689SLuigi Rizzo 	/* account for the (possibly fake) host rings */
8572a7db7a6SVincenzo Maffione 	n[NR_TX] = netmap_all_rings(na, NR_TX);
8582a7db7a6SVincenzo Maffione 	n[NR_RX] = netmap_all_rings(na, NR_RX);
859f0ea3689SLuigi Rizzo 
8602ff91c17SVincenzo Maffione 	len = (n[NR_TX] + n[NR_RX]) *
8612ff91c17SVincenzo Maffione 		(sizeof(struct netmap_kring) + sizeof(struct netmap_kring *))
8622ff91c17SVincenzo Maffione 		+ tailroom;
863f9790aebSLuigi Rizzo 
864c3e9b4dbSLuiz Otavio O Souza 	na->tx_rings = nm_os_malloc((size_t)len);
865f9790aebSLuigi Rizzo 	if (na->tx_rings == NULL) {
866b6e66be2SVincenzo Maffione 		nm_prerr("Cannot allocate krings");
867f9790aebSLuigi Rizzo 		return ENOMEM;
868f9790aebSLuigi Rizzo 	}
869847bf383SLuigi Rizzo 	na->rx_rings = na->tx_rings + n[NR_TX];
8702ff91c17SVincenzo Maffione 	na->tailroom = na->rx_rings + n[NR_RX];
8712ff91c17SVincenzo Maffione 
8722ff91c17SVincenzo Maffione 	/* link the krings in the krings array */
8732ff91c17SVincenzo Maffione 	kring = (struct netmap_kring *)((char *)na->tailroom + tailroom);
8742ff91c17SVincenzo Maffione 	for (i = 0; i < n[NR_TX] + n[NR_RX]; i++) {
8752ff91c17SVincenzo Maffione 		na->tx_rings[i] = kring;
8762ff91c17SVincenzo Maffione 		kring++;
8772ff91c17SVincenzo Maffione 	}
878f9790aebSLuigi Rizzo 
87917885a7bSLuigi Rizzo 	/*
88017885a7bSLuigi Rizzo 	 * All fields in krings are 0 except the one initialized below.
88117885a7bSLuigi Rizzo 	 * but better be explicit on important kring fields.
88217885a7bSLuigi Rizzo 	 */
883847bf383SLuigi Rizzo 	for_rx_tx(t) {
884847bf383SLuigi Rizzo 		ndesc = nma_get_ndesc(na, t);
885847bf383SLuigi Rizzo 		for (i = 0; i < n[t]; i++) {
8862ff91c17SVincenzo Maffione 			kring = NMR(na, t)[i];
887f9790aebSLuigi Rizzo 			bzero(kring, sizeof(*kring));
8882ff91c17SVincenzo Maffione 			kring->notify_na = na;
88917885a7bSLuigi Rizzo 			kring->ring_id = i;
890847bf383SLuigi Rizzo 			kring->tx = t;
891f9790aebSLuigi Rizzo 			kring->nkr_num_slots = ndesc;
89237e3a6d3SLuigi Rizzo 			kring->nr_mode = NKR_NETMAP_OFF;
89337e3a6d3SLuigi Rizzo 			kring->nr_pending_mode = NKR_NETMAP_OFF;
894847bf383SLuigi Rizzo 			if (i < nma_get_nrings(na, t)) {
895847bf383SLuigi Rizzo 				kring->nm_sync = (t == NR_TX ? na->nm_txsync : na->nm_rxsync);
896a6d768d8SVincenzo Maffione 				kring->nm_bufcfg = na->nm_bufcfg;
897a6d768d8SVincenzo Maffione 				if (kring->nm_bufcfg == NULL)
898a6d768d8SVincenzo Maffione 					kring->nm_bufcfg = netmap_default_bufcfg;
89937e3a6d3SLuigi Rizzo 			} else {
9002ff91c17SVincenzo Maffione 				if (!(na->na_flags & NAF_HOST_RINGS))
9012ff91c17SVincenzo Maffione 					kring->nr_kflags |= NKR_FAKERING;
902847bf383SLuigi Rizzo 				kring->nm_sync = (t == NR_TX ?
90337e3a6d3SLuigi Rizzo 						netmap_txsync_to_host:
90437e3a6d3SLuigi Rizzo 						netmap_rxsync_from_host);
905a6d768d8SVincenzo Maffione 				kring->nm_bufcfg = netmap_default_bufcfg;
906f0ea3689SLuigi Rizzo 			}
907847bf383SLuigi Rizzo 			kring->nm_notify = na->nm_notify;
908847bf383SLuigi Rizzo 			kring->rhead = kring->rcur = kring->nr_hwcur = 0;
909f9790aebSLuigi Rizzo 			/*
91017885a7bSLuigi Rizzo 			 * IMPORTANT: Always keep one slot empty.
911f9790aebSLuigi Rizzo 			 */
912847bf383SLuigi Rizzo 			kring->rtail = kring->nr_hwtail = (t == NR_TX ? ndesc - 1 : 0);
913847bf383SLuigi Rizzo 			snprintf(kring->name, sizeof(kring->name) - 1, "%s %s%d", na->name,
914847bf383SLuigi Rizzo 					nm_txrx2str(t), i);
91575f4f3edSVincenzo Maffione 			nm_prdis("ktx %s h %d c %d t %d",
916f0ea3689SLuigi Rizzo 				kring->name, kring->rhead, kring->rcur, kring->rtail);
91719c4ec08SVincenzo Maffione 			err = nm_os_selinfo_init(&kring->si, kring->name);
91819c4ec08SVincenzo Maffione 			if (err) {
91919c4ec08SVincenzo Maffione 				netmap_krings_delete(na);
92019c4ec08SVincenzo Maffione 				return err;
92119c4ec08SVincenzo Maffione 			}
922847bf383SLuigi Rizzo 			mtx_init(&kring->q_lock, (t == NR_TX ? "nm_txq_lock" : "nm_rxq_lock"), NULL, MTX_DEF);
92319c4ec08SVincenzo Maffione 			kring->na = na;	/* setting this field marks the mutex as initialized */
924f9790aebSLuigi Rizzo 		}
92519c4ec08SVincenzo Maffione 		err = nm_os_selinfo_init(&na->si[t], na->name);
92619c4ec08SVincenzo Maffione 		if (err) {
92719c4ec08SVincenzo Maffione 			netmap_krings_delete(na);
92819c4ec08SVincenzo Maffione 			return err;
929f0ea3689SLuigi Rizzo 		}
93019c4ec08SVincenzo Maffione 	}
931f9790aebSLuigi Rizzo 
932f9790aebSLuigi Rizzo 	return 0;
933f9790aebSLuigi Rizzo }
934f9790aebSLuigi Rizzo 
935f9790aebSLuigi Rizzo 
936f0ea3689SLuigi Rizzo /* undo the actions performed by netmap_krings_create */
93789cc2556SLuigi Rizzo /* call with NMG_LOCK held */
938f9790aebSLuigi Rizzo void
939f9790aebSLuigi Rizzo netmap_krings_delete(struct netmap_adapter *na)
940f9790aebSLuigi Rizzo {
9412ff91c17SVincenzo Maffione 	struct netmap_kring **kring = na->tx_rings;
942847bf383SLuigi Rizzo 	enum txrx t;
943847bf383SLuigi Rizzo 
944c3e9b4dbSLuiz Otavio O Souza 	if (na->tx_rings == NULL) {
945b6e66be2SVincenzo Maffione 		if (netmap_debug & NM_DEBUG_ON)
946b6e66be2SVincenzo Maffione 			nm_prerr("warning: krings were already deleted");
947c3e9b4dbSLuiz Otavio O Souza 		return;
948c3e9b4dbSLuiz Otavio O Souza 	}
949c3e9b4dbSLuiz Otavio O Souza 
950847bf383SLuigi Rizzo 	for_rx_tx(t)
95137e3a6d3SLuigi Rizzo 		nm_os_selinfo_uninit(&na->si[t]);
952f9790aebSLuigi Rizzo 
953f0ea3689SLuigi Rizzo 	/* we rely on the krings layout described above */
954f0ea3689SLuigi Rizzo 	for ( ; kring != na->tailroom; kring++) {
95519c4ec08SVincenzo Maffione 		if ((*kring)->na != NULL)
9562ff91c17SVincenzo Maffione 			mtx_destroy(&(*kring)->q_lock);
9572ff91c17SVincenzo Maffione 		nm_os_selinfo_uninit(&(*kring)->si);
958f9790aebSLuigi Rizzo 	}
959c3e9b4dbSLuiz Otavio O Souza 	nm_os_free(na->tx_rings);
960f9790aebSLuigi Rizzo 	na->tx_rings = na->rx_rings = na->tailroom = NULL;
961f9790aebSLuigi Rizzo }
962f9790aebSLuigi Rizzo 
963f9790aebSLuigi Rizzo 
96417885a7bSLuigi Rizzo /*
96517885a7bSLuigi Rizzo  * Destructor for NIC ports. They also have an mbuf queue
96617885a7bSLuigi Rizzo  * on the rings connected to the host so we need to purge
96717885a7bSLuigi Rizzo  * them first.
96817885a7bSLuigi Rizzo  */
96989cc2556SLuigi Rizzo /* call with NMG_LOCK held */
97037e3a6d3SLuigi Rizzo void
97117885a7bSLuigi Rizzo netmap_hw_krings_delete(struct netmap_adapter *na)
97217885a7bSLuigi Rizzo {
9732a7db7a6SVincenzo Maffione 	u_int lim = netmap_real_rings(na, NR_RX), i;
97417885a7bSLuigi Rizzo 
9752a7db7a6SVincenzo Maffione 	for (i = nma_get_nrings(na, NR_RX); i < lim; i++) {
9762a7db7a6SVincenzo Maffione 		struct mbq *q = &NMR(na, NR_RX)[i]->rx_queue;
97775f4f3edSVincenzo Maffione 		nm_prdis("destroy sw mbq with len %d", mbq_len(q));
97817885a7bSLuigi Rizzo 		mbq_purge(q);
97937e3a6d3SLuigi Rizzo 		mbq_safe_fini(q);
9802a7db7a6SVincenzo Maffione 	}
98117885a7bSLuigi Rizzo 	netmap_krings_delete(na);
98217885a7bSLuigi Rizzo }
98317885a7bSLuigi Rizzo 
984a6d768d8SVincenzo Maffione void
985a6d768d8SVincenzo Maffione netmap_mem_restore(struct netmap_adapter *na)
9864f80b14cSVincenzo Maffione {
987a6d768d8SVincenzo Maffione 	if (na->nm_mem_prev) {
9884f80b14cSVincenzo Maffione 		netmap_mem_put(na->nm_mem);
9894f80b14cSVincenzo Maffione 		na->nm_mem = na->nm_mem_prev;
9904f80b14cSVincenzo Maffione 		na->nm_mem_prev = NULL;
9914f80b14cSVincenzo Maffione 	}
9924f80b14cSVincenzo Maffione }
993f9790aebSLuigi Rizzo 
994a6d768d8SVincenzo Maffione static void
995a6d768d8SVincenzo Maffione netmap_mem_drop(struct netmap_adapter *na)
996a6d768d8SVincenzo Maffione {
99745c67e8fSVincenzo Maffione 	/* if the native allocator had been overridden on regif,
998a6d768d8SVincenzo Maffione 	 * restore it now and drop the temporary one
999a6d768d8SVincenzo Maffione 	 */
1000a6d768d8SVincenzo Maffione 	if (netmap_mem_deref(na->nm_mem, na)) {
1001a6d768d8SVincenzo Maffione 		netmap_mem_restore(na);
1002a6d768d8SVincenzo Maffione 	}
1003a6d768d8SVincenzo Maffione }
1004a6d768d8SVincenzo Maffione 
100568b8534bSLuigi Rizzo /*
1006847bf383SLuigi Rizzo  * Undo everything that was done in netmap_do_regif(). In particular,
1007847bf383SLuigi Rizzo  * call nm_register(ifp,0) to stop netmap mode on the interface and
10084bf50f18SLuigi Rizzo  * revert to normal operation.
100968b8534bSLuigi Rizzo  */
1010ce3ee1e7SLuigi Rizzo /* call with NMG_LOCK held */
1011847bf383SLuigi Rizzo static void netmap_unset_ringid(struct netmap_priv_d *);
101237e3a6d3SLuigi Rizzo static void netmap_krings_put(struct netmap_priv_d *);
101337e3a6d3SLuigi Rizzo void
1014847bf383SLuigi Rizzo netmap_do_unregif(struct netmap_priv_d *priv)
101568b8534bSLuigi Rizzo {
1016f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
101768b8534bSLuigi Rizzo 
1018ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
1019f9790aebSLuigi Rizzo 	na->active_fds--;
102037e3a6d3SLuigi Rizzo 	/* unset nr_pending_mode and possibly release exclusive mode */
102137e3a6d3SLuigi Rizzo 	netmap_krings_put(priv);
1022847bf383SLuigi Rizzo 
1023847bf383SLuigi Rizzo #ifdef	WITH_MONITOR
102437e3a6d3SLuigi Rizzo 	/* XXX check whether we have to do something with monitor
102537e3a6d3SLuigi Rizzo 	 * when rings change nr_mode. */
102637e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0) {
1027847bf383SLuigi Rizzo 		/* walk through all the rings and tell any monitor
1028847bf383SLuigi Rizzo 		 * that the port is going to exit netmap mode
1029847bf383SLuigi Rizzo 		 */
1030847bf383SLuigi Rizzo 		netmap_monitor_stop(na);
103137e3a6d3SLuigi Rizzo 	}
1032847bf383SLuigi Rizzo #endif
103337e3a6d3SLuigi Rizzo 
103437e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0 || nm_kring_pending(priv)) {
103537e3a6d3SLuigi Rizzo 		na->nm_register(na, 0);
103637e3a6d3SLuigi Rizzo 	}
103737e3a6d3SLuigi Rizzo 
103837e3a6d3SLuigi Rizzo 	/* delete rings and buffers that are no longer needed */
103937e3a6d3SLuigi Rizzo 	netmap_mem_rings_delete(na);
104037e3a6d3SLuigi Rizzo 
104137e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0) {	/* last instance */
104268b8534bSLuigi Rizzo 		/*
104337e3a6d3SLuigi Rizzo 		 * (TO CHECK) We enter here
1044f18be576SLuigi Rizzo 		 * when the last reference to this file descriptor goes
1045f18be576SLuigi Rizzo 		 * away. This means we cannot have any pending poll()
1046f18be576SLuigi Rizzo 		 * or interrupt routine operating on the structure.
1047ce3ee1e7SLuigi Rizzo 		 * XXX The file may be closed in a thread while
1048ce3ee1e7SLuigi Rizzo 		 * another thread is using it.
1049ce3ee1e7SLuigi Rizzo 		 * Linux keeps the file opened until the last reference
1050ce3ee1e7SLuigi Rizzo 		 * by any outstanding ioctl/poll or mmap is gone.
1051ce3ee1e7SLuigi Rizzo 		 * FreeBSD does not track mmap()s (but we do) and
1052ce3ee1e7SLuigi Rizzo 		 * wakes up any sleeping poll(). Need to check what
1053ce3ee1e7SLuigi Rizzo 		 * happens if the close() occurs while a concurrent
1054ce3ee1e7SLuigi Rizzo 		 * syscall is running.
105568b8534bSLuigi Rizzo 		 */
1056b6e66be2SVincenzo Maffione 		if (netmap_debug & NM_DEBUG_ON)
1057b6e66be2SVincenzo Maffione 			nm_prinf("deleting last instance for %s", na->name);
105837e3a6d3SLuigi Rizzo 
105937e3a6d3SLuigi Rizzo 		if (nm_netmap_on(na)) {
1060b6e66be2SVincenzo Maffione 			nm_prerr("BUG: netmap on while going to delete the krings");
106137e3a6d3SLuigi Rizzo 		}
106237e3a6d3SLuigi Rizzo 
1063f9790aebSLuigi Rizzo 		na->nm_krings_delete(na);
1064d12354a5SVincenzo Maffione 
1065d12354a5SVincenzo Maffione 		/* restore the default number of host tx and rx rings */
1066253b2ec1SVincenzo Maffione 		if (na->na_flags & NAF_HOST_RINGS) {
1067d12354a5SVincenzo Maffione 			na->num_host_tx_rings = 1;
1068d12354a5SVincenzo Maffione 			na->num_host_rx_rings = 1;
1069253b2ec1SVincenzo Maffione 		} else {
1070253b2ec1SVincenzo Maffione 			na->num_host_tx_rings = 0;
1071253b2ec1SVincenzo Maffione 			na->num_host_rx_rings = 0;
1072253b2ec1SVincenzo Maffione 		}
107368b8534bSLuigi Rizzo 	}
107437e3a6d3SLuigi Rizzo 
107545c67e8fSVincenzo Maffione 	/* possibly decrement counter of tx_si/rx_si users */
1076847bf383SLuigi Rizzo 	netmap_unset_ringid(priv);
1077f9790aebSLuigi Rizzo 	/* delete the nifp */
1078847bf383SLuigi Rizzo 	netmap_mem_if_delete(na, priv->np_nifp);
1079847bf383SLuigi Rizzo 	/* drop the allocator */
10804f80b14cSVincenzo Maffione 	netmap_mem_drop(na);
1081847bf383SLuigi Rizzo 	/* mark the priv as unregistered */
1082847bf383SLuigi Rizzo 	priv->np_na = NULL;
1083847bf383SLuigi Rizzo 	priv->np_nifp = NULL;
10845819da83SLuigi Rizzo }
108568b8534bSLuigi Rizzo 
108637e3a6d3SLuigi Rizzo struct netmap_priv_d*
108737e3a6d3SLuigi Rizzo netmap_priv_new(void)
108837e3a6d3SLuigi Rizzo {
108937e3a6d3SLuigi Rizzo 	struct netmap_priv_d *priv;
109037e3a6d3SLuigi Rizzo 
1091c3e9b4dbSLuiz Otavio O Souza 	priv = nm_os_malloc(sizeof(struct netmap_priv_d));
109237e3a6d3SLuigi Rizzo 	if (priv == NULL)
109337e3a6d3SLuigi Rizzo 		return NULL;
109437e3a6d3SLuigi Rizzo 	priv->np_refs = 1;
109537e3a6d3SLuigi Rizzo 	nm_os_get_module();
109637e3a6d3SLuigi Rizzo 	return priv;
109737e3a6d3SLuigi Rizzo }
109837e3a6d3SLuigi Rizzo 
1099ce3ee1e7SLuigi Rizzo /*
11008fd44c93SLuigi Rizzo  * Destructor of the netmap_priv_d, called when the fd is closed
11018fd44c93SLuigi Rizzo  * Action: undo all the things done by NIOCREGIF,
11028fd44c93SLuigi Rizzo  * On FreeBSD we need to track whether there are active mmap()s,
11038fd44c93SLuigi Rizzo  * and we use np_active_mmaps for that. On linux, the field is always 0.
11048fd44c93SLuigi Rizzo  * Return: 1 if we can free priv, 0 otherwise.
110589cc2556SLuigi Rizzo  *
1106ce3ee1e7SLuigi Rizzo  */
110789cc2556SLuigi Rizzo /* call with NMG_LOCK held */
110837e3a6d3SLuigi Rizzo void
110937e3a6d3SLuigi Rizzo netmap_priv_delete(struct netmap_priv_d *priv)
1110ce3ee1e7SLuigi Rizzo {
1111f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1112ce3ee1e7SLuigi Rizzo 
1113847adfb7SLuigi Rizzo 	/* number of active references to this fd */
11148fd44c93SLuigi Rizzo 	if (--priv->np_refs > 0) {
111537e3a6d3SLuigi Rizzo 		return;
1116ce3ee1e7SLuigi Rizzo 	}
111737e3a6d3SLuigi Rizzo 	nm_os_put_module();
111837e3a6d3SLuigi Rizzo 	if (na) {
1119847bf383SLuigi Rizzo 		netmap_do_unregif(priv);
112037e3a6d3SLuigi Rizzo 	}
112137e3a6d3SLuigi Rizzo 	netmap_unget_na(na, priv->np_ifp);
112237e3a6d3SLuigi Rizzo 	bzero(priv, sizeof(*priv));	/* for safety */
1123c3e9b4dbSLuiz Otavio O Souza 	nm_os_free(priv);
1124f196ce38SLuigi Rizzo }
11255819da83SLuigi Rizzo 
1126f9790aebSLuigi Rizzo 
112789cc2556SLuigi Rizzo /* call with NMG_LOCK *not* held */
1128f9790aebSLuigi Rizzo void
11295819da83SLuigi Rizzo netmap_dtor(void *data)
11305819da83SLuigi Rizzo {
11315819da83SLuigi Rizzo 	struct netmap_priv_d *priv = data;
11325819da83SLuigi Rizzo 
1133ce3ee1e7SLuigi Rizzo 	NMG_LOCK();
113437e3a6d3SLuigi Rizzo 	netmap_priv_delete(priv);
1135ce3ee1e7SLuigi Rizzo 	NMG_UNLOCK();
1136ce3ee1e7SLuigi Rizzo }
113768b8534bSLuigi Rizzo 
1138f18be576SLuigi Rizzo 
113968b8534bSLuigi Rizzo /*
1140c3e9b4dbSLuiz Otavio O Souza  * Handlers for synchronization of the rings from/to the host stack.
1141c3e9b4dbSLuiz Otavio O Souza  * These are associated to a network interface and are just another
1142c3e9b4dbSLuiz Otavio O Souza  * ring pair managed by userspace.
1143c3e9b4dbSLuiz Otavio O Souza  *
1144c3e9b4dbSLuiz Otavio O Souza  * Netmap also supports transparent forwarding (NS_FORWARD and NR_FORWARD
1145c3e9b4dbSLuiz Otavio O Souza  * flags):
1146c3e9b4dbSLuiz Otavio O Souza  *
1147c3e9b4dbSLuiz Otavio O Souza  * - Before releasing buffers on hw RX rings, the application can mark
1148c3e9b4dbSLuiz Otavio O Souza  *   them with the NS_FORWARD flag. During the next RXSYNC or poll(), they
1149c3e9b4dbSLuiz Otavio O Souza  *   will be forwarded to the host stack, similarly to what happened if
1150c3e9b4dbSLuiz Otavio O Souza  *   the application moved them to the host TX ring.
1151c3e9b4dbSLuiz Otavio O Souza  *
1152c3e9b4dbSLuiz Otavio O Souza  * - Before releasing buffers on the host RX ring, the application can
1153c3e9b4dbSLuiz Otavio O Souza  *   mark them with the NS_FORWARD flag. During the next RXSYNC or poll(),
1154c3e9b4dbSLuiz Otavio O Souza  *   they will be forwarded to the hw TX rings, saving the application
1155c3e9b4dbSLuiz Otavio O Souza  *   from doing the same task in user-space.
1156c3e9b4dbSLuiz Otavio O Souza  *
115745c67e8fSVincenzo Maffione  * Transparent forwarding can be enabled per-ring, by setting the NR_FORWARD
1158c3e9b4dbSLuiz Otavio O Souza  * flag, or globally with the netmap_fwd sysctl.
1159c3e9b4dbSLuiz Otavio O Souza  *
1160091fd0abSLuigi Rizzo  * The transfer NIC --> host is relatively easy, just encapsulate
1161091fd0abSLuigi Rizzo  * into mbufs and we are done. The host --> NIC side is slightly
1162091fd0abSLuigi Rizzo  * harder because there might not be room in the tx ring so it
1163091fd0abSLuigi Rizzo  * might take a while before releasing the buffer.
1164091fd0abSLuigi Rizzo  */
1165091fd0abSLuigi Rizzo 
1166f18be576SLuigi Rizzo 
1167091fd0abSLuigi Rizzo /*
1168c3e9b4dbSLuiz Otavio O Souza  * Pass a whole queue of mbufs to the host stack as coming from 'dst'
116917885a7bSLuigi Rizzo  * We do not need to lock because the queue is private.
1170c3e9b4dbSLuiz Otavio O Souza  * After this call the queue is empty.
1171091fd0abSLuigi Rizzo  */
1172091fd0abSLuigi Rizzo static void
1173f9790aebSLuigi Rizzo netmap_send_up(struct ifnet *dst, struct mbq *q)
1174091fd0abSLuigi Rizzo {
1175091fd0abSLuigi Rizzo 	struct mbuf *m;
117637e3a6d3SLuigi Rizzo 	struct mbuf *head = NULL, *prev = NULL;
1177b7d69138SVincenzo Maffione #ifdef __FreeBSD__
1178b7d69138SVincenzo Maffione 	struct epoch_tracker et;
1179091fd0abSLuigi Rizzo 
1180a4470078SGleb Smirnoff 	NET_EPOCH_ENTER(et);
1181b7d69138SVincenzo Maffione #endif /* __FreeBSD__ */
1182c3e9b4dbSLuiz Otavio O Souza 	/* Send packets up, outside the lock; head/prev machinery
1183c3e9b4dbSLuiz Otavio O Souza 	 * is only useful for Windows. */
1184f9790aebSLuigi Rizzo 	while ((m = mbq_dequeue(q)) != NULL) {
1185b6e66be2SVincenzo Maffione 		if (netmap_debug & NM_DEBUG_HOST)
1186b6e66be2SVincenzo Maffione 			nm_prinf("sending up pkt %p size %d", m, MBUF_LEN(m));
118737e3a6d3SLuigi Rizzo 		prev = nm_os_send_up(dst, m, prev);
118837e3a6d3SLuigi Rizzo 		if (head == NULL)
118937e3a6d3SLuigi Rizzo 			head = prev;
1190091fd0abSLuigi Rizzo 	}
119137e3a6d3SLuigi Rizzo 	if (head)
119237e3a6d3SLuigi Rizzo 		nm_os_send_up(dst, NULL, head);
1193b7d69138SVincenzo Maffione #ifdef __FreeBSD__
1194a4470078SGleb Smirnoff 	NET_EPOCH_EXIT(et);
1195b7d69138SVincenzo Maffione #endif /* __FreeBSD__ */
119637e3a6d3SLuigi Rizzo 	mbq_fini(q);
1197091fd0abSLuigi Rizzo }
1198091fd0abSLuigi Rizzo 
1199f18be576SLuigi Rizzo 
1200091fd0abSLuigi Rizzo /*
1201c3e9b4dbSLuiz Otavio O Souza  * Scan the buffers from hwcur to ring->head, and put a copy of those
1202c3e9b4dbSLuiz Otavio O Souza  * marked NS_FORWARD (or all of them if forced) into a queue of mbufs.
1203c3e9b4dbSLuiz Otavio O Souza  * Drop remaining packets in the unlikely event
120417885a7bSLuigi Rizzo  * of an mbuf shortage.
1205091fd0abSLuigi Rizzo  */
1206091fd0abSLuigi Rizzo static void
1207091fd0abSLuigi Rizzo netmap_grab_packets(struct netmap_kring *kring, struct mbq *q, int force)
1208091fd0abSLuigi Rizzo {
120917885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1210847bf383SLuigi Rizzo 	u_int const head = kring->rhead;
121117885a7bSLuigi Rizzo 	u_int n;
1212f9790aebSLuigi Rizzo 	struct netmap_adapter *na = kring->na;
1213091fd0abSLuigi Rizzo 
121417885a7bSLuigi Rizzo 	for (n = kring->nr_hwcur; n != head; n = nm_next(n, lim)) {
121517885a7bSLuigi Rizzo 		struct mbuf *m;
1216091fd0abSLuigi Rizzo 		struct netmap_slot *slot = &kring->ring->slot[n];
1217091fd0abSLuigi Rizzo 
1218091fd0abSLuigi Rizzo 		if ((slot->flags & NS_FORWARD) == 0 && !force)
1219091fd0abSLuigi Rizzo 			continue;
12204bf50f18SLuigi Rizzo 		if (slot->len < 14 || slot->len > NETMAP_BUF_SIZE(na)) {
122175f4f3edSVincenzo Maffione 			nm_prlim(5, "bad pkt at %d len %d", n, slot->len);
1222091fd0abSLuigi Rizzo 			continue;
1223091fd0abSLuigi Rizzo 		}
1224091fd0abSLuigi Rizzo 		slot->flags &= ~NS_FORWARD; // XXX needed ?
122517885a7bSLuigi Rizzo 		/* XXX TODO: adapt to the case of a multisegment packet */
12264bf50f18SLuigi Rizzo 		m = m_devget(NMB(na, slot), slot->len, 0, na->ifp, NULL);
1227091fd0abSLuigi Rizzo 
1228091fd0abSLuigi Rizzo 		if (m == NULL)
1229091fd0abSLuigi Rizzo 			break;
1230f9790aebSLuigi Rizzo 		mbq_enqueue(q, m);
1231091fd0abSLuigi Rizzo 	}
1232091fd0abSLuigi Rizzo }
1233091fd0abSLuigi Rizzo 
123437e3a6d3SLuigi Rizzo static inline int
123537e3a6d3SLuigi Rizzo _nm_may_forward(struct netmap_kring *kring)
123637e3a6d3SLuigi Rizzo {
123737e3a6d3SLuigi Rizzo 	return	((netmap_fwd || kring->ring->flags & NR_FORWARD) &&
123837e3a6d3SLuigi Rizzo 		 kring->na->na_flags & NAF_HOST_RINGS &&
123937e3a6d3SLuigi Rizzo 		 kring->tx == NR_RX);
124037e3a6d3SLuigi Rizzo }
124137e3a6d3SLuigi Rizzo 
124237e3a6d3SLuigi Rizzo static inline int
124337e3a6d3SLuigi Rizzo nm_may_forward_up(struct netmap_kring *kring)
124437e3a6d3SLuigi Rizzo {
124537e3a6d3SLuigi Rizzo 	return	_nm_may_forward(kring) &&
124637e3a6d3SLuigi Rizzo 		 kring->ring_id != kring->na->num_rx_rings;
124737e3a6d3SLuigi Rizzo }
124837e3a6d3SLuigi Rizzo 
124937e3a6d3SLuigi Rizzo static inline int
1250c3e9b4dbSLuiz Otavio O Souza nm_may_forward_down(struct netmap_kring *kring, int sync_flags)
125137e3a6d3SLuigi Rizzo {
125237e3a6d3SLuigi Rizzo 	return	_nm_may_forward(kring) &&
1253c3e9b4dbSLuiz Otavio O Souza 		 (sync_flags & NAF_CAN_FORWARD_DOWN) &&
125437e3a6d3SLuigi Rizzo 		 kring->ring_id == kring->na->num_rx_rings;
125537e3a6d3SLuigi Rizzo }
1256f18be576SLuigi Rizzo 
1257091fd0abSLuigi Rizzo /*
125817885a7bSLuigi Rizzo  * Send to the NIC rings packets marked NS_FORWARD between
1259c3e9b4dbSLuiz Otavio O Souza  * kring->nr_hwcur and kring->rhead.
1260c3e9b4dbSLuiz Otavio O Souza  * Called under kring->rx_queue.lock on the sw rx ring.
1261c3e9b4dbSLuiz Otavio O Souza  *
1262c3e9b4dbSLuiz Otavio O Souza  * It can only be called if the user opened all the TX hw rings,
1263c3e9b4dbSLuiz Otavio O Souza  * see NAF_CAN_FORWARD_DOWN flag.
1264c3e9b4dbSLuiz Otavio O Souza  * We can touch the TX netmap rings (slots, head and cur) since
1265c3e9b4dbSLuiz Otavio O Souza  * we are in poll/ioctl system call context, and the application
1266c3e9b4dbSLuiz Otavio O Souza  * is not supposed to touch the ring (using a different thread)
1267c3e9b4dbSLuiz Otavio O Souza  * during the execution of the system call.
1268091fd0abSLuigi Rizzo  */
126917885a7bSLuigi Rizzo static u_int
1270091fd0abSLuigi Rizzo netmap_sw_to_nic(struct netmap_adapter *na)
1271091fd0abSLuigi Rizzo {
12722ff91c17SVincenzo Maffione 	struct netmap_kring *kring = na->rx_rings[na->num_rx_rings];
127317885a7bSLuigi Rizzo 	struct netmap_slot *rxslot = kring->ring->slot;
127417885a7bSLuigi Rizzo 	u_int i, rxcur = kring->nr_hwcur;
127517885a7bSLuigi Rizzo 	u_int const head = kring->rhead;
127617885a7bSLuigi Rizzo 	u_int const src_lim = kring->nkr_num_slots - 1;
127717885a7bSLuigi Rizzo 	u_int sent = 0;
1278ce3ee1e7SLuigi Rizzo 
127917885a7bSLuigi Rizzo 	/* scan rings to find space, then fill as much as possible */
128017885a7bSLuigi Rizzo 	for (i = 0; i < na->num_tx_rings; i++) {
12812ff91c17SVincenzo Maffione 		struct netmap_kring *kdst = na->tx_rings[i];
128217885a7bSLuigi Rizzo 		struct netmap_ring *rdst = kdst->ring;
128317885a7bSLuigi Rizzo 		u_int const dst_lim = kdst->nkr_num_slots - 1;
1284ce3ee1e7SLuigi Rizzo 
128517885a7bSLuigi Rizzo 		/* XXX do we trust ring or kring->rcur,rtail ? */
128617885a7bSLuigi Rizzo 		for (; rxcur != head && !nm_ring_empty(rdst);
128717885a7bSLuigi Rizzo 		     rxcur = nm_next(rxcur, src_lim) ) {
1288091fd0abSLuigi Rizzo 			struct netmap_slot *src, *dst, tmp;
128937e3a6d3SLuigi Rizzo 			u_int dst_head = rdst->head;
129017885a7bSLuigi Rizzo 
129117885a7bSLuigi Rizzo 			src = &rxslot[rxcur];
129217885a7bSLuigi Rizzo 			if ((src->flags & NS_FORWARD) == 0 && !netmap_fwd)
129317885a7bSLuigi Rizzo 				continue;
129417885a7bSLuigi Rizzo 
129517885a7bSLuigi Rizzo 			sent++;
129617885a7bSLuigi Rizzo 
129737e3a6d3SLuigi Rizzo 			dst = &rdst->slot[dst_head];
129817885a7bSLuigi Rizzo 
1299091fd0abSLuigi Rizzo 			tmp = *src;
130017885a7bSLuigi Rizzo 
1301091fd0abSLuigi Rizzo 			src->buf_idx = dst->buf_idx;
1302091fd0abSLuigi Rizzo 			src->flags = NS_BUF_CHANGED;
1303091fd0abSLuigi Rizzo 
1304091fd0abSLuigi Rizzo 			dst->buf_idx = tmp.buf_idx;
1305091fd0abSLuigi Rizzo 			dst->len = tmp.len;
1306091fd0abSLuigi Rizzo 			dst->flags = NS_BUF_CHANGED;
1307091fd0abSLuigi Rizzo 
130837e3a6d3SLuigi Rizzo 			rdst->head = rdst->cur = nm_next(dst_head, dst_lim);
1309091fd0abSLuigi Rizzo 		}
1310c3e9b4dbSLuiz Otavio O Souza 		/* if (sent) XXX txsync ? it would be just an optimization */
1311091fd0abSLuigi Rizzo 	}
131217885a7bSLuigi Rizzo 	return sent;
1313091fd0abSLuigi Rizzo }
1314091fd0abSLuigi Rizzo 
1315f18be576SLuigi Rizzo 
1316091fd0abSLuigi Rizzo /*
1317ce3ee1e7SLuigi Rizzo  * netmap_txsync_to_host() passes packets up. We are called from a
131802ad4083SLuigi Rizzo  * system call in user process context, and the only contention
131902ad4083SLuigi Rizzo  * can be among multiple user threads erroneously calling
1320091fd0abSLuigi Rizzo  * this routine concurrently.
132168b8534bSLuigi Rizzo  */
132237e3a6d3SLuigi Rizzo static int
132337e3a6d3SLuigi Rizzo netmap_txsync_to_host(struct netmap_kring *kring, int flags)
132468b8534bSLuigi Rizzo {
132537e3a6d3SLuigi Rizzo 	struct netmap_adapter *na = kring->na;
132617885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1327f0ea3689SLuigi Rizzo 	u_int const head = kring->rhead;
1328f9790aebSLuigi Rizzo 	struct mbq q;
132968b8534bSLuigi Rizzo 
133017885a7bSLuigi Rizzo 	/* Take packets from hwcur to head and pass them up.
1331c3e9b4dbSLuiz Otavio O Souza 	 * Force hwcur = head since netmap_grab_packets() stops at head
133268b8534bSLuigi Rizzo 	 */
1333f9790aebSLuigi Rizzo 	mbq_init(&q);
133417885a7bSLuigi Rizzo 	netmap_grab_packets(kring, &q, 1 /* force */);
133575f4f3edSVincenzo Maffione 	nm_prdis("have %d pkts in queue", mbq_len(&q));
133617885a7bSLuigi Rizzo 	kring->nr_hwcur = head;
133717885a7bSLuigi Rizzo 	kring->nr_hwtail = head + lim;
133817885a7bSLuigi Rizzo 	if (kring->nr_hwtail > lim)
133917885a7bSLuigi Rizzo 		kring->nr_hwtail -= lim + 1;
134068b8534bSLuigi Rizzo 
1341f9790aebSLuigi Rizzo 	netmap_send_up(na->ifp, &q);
134237e3a6d3SLuigi Rizzo 	return 0;
1343f18be576SLuigi Rizzo }
1344f18be576SLuigi Rizzo 
1345f18be576SLuigi Rizzo 
134668b8534bSLuigi Rizzo /*
134702ad4083SLuigi Rizzo  * rxsync backend for packets coming from the host stack.
134817885a7bSLuigi Rizzo  * They have been put in kring->rx_queue by netmap_transmit().
134917885a7bSLuigi Rizzo  * We protect access to the kring using kring->rx_queue.lock
135002ad4083SLuigi Rizzo  *
1351c3e9b4dbSLuiz Otavio O Souza  * also moves to the nic hw rings any packet the user has marked
1352c3e9b4dbSLuiz Otavio O Souza  * for transparent-mode forwarding, then sets the NR_FORWARD
1353c3e9b4dbSLuiz Otavio O Souza  * flag in the kring to let the caller push them out
135468b8534bSLuigi Rizzo  */
13558fd44c93SLuigi Rizzo static int
135637e3a6d3SLuigi Rizzo netmap_rxsync_from_host(struct netmap_kring *kring, int flags)
135768b8534bSLuigi Rizzo {
135837e3a6d3SLuigi Rizzo 	struct netmap_adapter *na = kring->na;
135968b8534bSLuigi Rizzo 	struct netmap_ring *ring = kring->ring;
136017885a7bSLuigi Rizzo 	u_int nm_i, n;
136117885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1362f0ea3689SLuigi Rizzo 	u_int const head = kring->rhead;
136317885a7bSLuigi Rizzo 	int ret = 0;
1364847bf383SLuigi Rizzo 	struct mbq *q = &kring->rx_queue, fq;
136568b8534bSLuigi Rizzo 
1366847bf383SLuigi Rizzo 	mbq_init(&fq); /* fq holds packets to be freed */
1367847bf383SLuigi Rizzo 
1368997b054cSLuigi Rizzo 	mbq_lock(q);
136917885a7bSLuigi Rizzo 
137017885a7bSLuigi Rizzo 	/* First part: import newly received packets */
137117885a7bSLuigi Rizzo 	n = mbq_len(q);
137217885a7bSLuigi Rizzo 	if (n) { /* grab packets from the queue */
137317885a7bSLuigi Rizzo 		struct mbuf *m;
137417885a7bSLuigi Rizzo 		uint32_t stop_i;
137517885a7bSLuigi Rizzo 
137617885a7bSLuigi Rizzo 		nm_i = kring->nr_hwtail;
1377c3e9b4dbSLuiz Otavio O Souza 		stop_i = nm_prev(kring->nr_hwcur, lim);
137817885a7bSLuigi Rizzo 		while ( nm_i != stop_i && (m = mbq_dequeue(q)) != NULL ) {
137917885a7bSLuigi Rizzo 			int len = MBUF_LEN(m);
138017885a7bSLuigi Rizzo 			struct netmap_slot *slot = &ring->slot[nm_i];
138117885a7bSLuigi Rizzo 
13824bf50f18SLuigi Rizzo 			m_copydata(m, 0, len, NMB(na, slot));
138375f4f3edSVincenzo Maffione 			nm_prdis("nm %d len %d", nm_i, len);
1384b6e66be2SVincenzo Maffione 			if (netmap_debug & NM_DEBUG_HOST)
1385b6e66be2SVincenzo Maffione 				nm_prinf("%s", nm_dump_buf(NMB(na, slot),len, 128, NULL));
138617885a7bSLuigi Rizzo 
138717885a7bSLuigi Rizzo 			slot->len = len;
13884f80b14cSVincenzo Maffione 			slot->flags = 0;
138917885a7bSLuigi Rizzo 			nm_i = nm_next(nm_i, lim);
1390847bf383SLuigi Rizzo 			mbq_enqueue(&fq, m);
139164ae02c3SLuigi Rizzo 		}
139217885a7bSLuigi Rizzo 		kring->nr_hwtail = nm_i;
139364ae02c3SLuigi Rizzo 	}
139417885a7bSLuigi Rizzo 
139517885a7bSLuigi Rizzo 	/*
139617885a7bSLuigi Rizzo 	 * Second part: skip past packets that userspace has released.
139717885a7bSLuigi Rizzo 	 */
139817885a7bSLuigi Rizzo 	nm_i = kring->nr_hwcur;
139917885a7bSLuigi Rizzo 	if (nm_i != head) { /* something was released */
1400c3e9b4dbSLuiz Otavio O Souza 		if (nm_may_forward_down(kring, flags)) {
140117885a7bSLuigi Rizzo 			ret = netmap_sw_to_nic(na);
140237e3a6d3SLuigi Rizzo 			if (ret > 0) {
140337e3a6d3SLuigi Rizzo 				kring->nr_kflags |= NR_FORWARD;
140437e3a6d3SLuigi Rizzo 				ret = 0;
140537e3a6d3SLuigi Rizzo 			}
140637e3a6d3SLuigi Rizzo 		}
140717885a7bSLuigi Rizzo 		kring->nr_hwcur = head;
140864ae02c3SLuigi Rizzo 	}
140917885a7bSLuigi Rizzo 
1410997b054cSLuigi Rizzo 	mbq_unlock(q);
1411847bf383SLuigi Rizzo 
1412847bf383SLuigi Rizzo 	mbq_purge(&fq);
141337e3a6d3SLuigi Rizzo 	mbq_fini(&fq);
1414847bf383SLuigi Rizzo 
141517885a7bSLuigi Rizzo 	return ret;
141668b8534bSLuigi Rizzo }
141768b8534bSLuigi Rizzo 
141868b8534bSLuigi Rizzo 
1419f9790aebSLuigi Rizzo /* Get a netmap adapter for the port.
1420f9790aebSLuigi Rizzo  *
1421f9790aebSLuigi Rizzo  * If it is possible to satisfy the request, return 0
1422f9790aebSLuigi Rizzo  * with *na containing the netmap adapter found.
1423f9790aebSLuigi Rizzo  * Otherwise return an error code, with *na containing NULL.
1424f9790aebSLuigi Rizzo  *
1425f9790aebSLuigi Rizzo  * When the port is attached to a bridge, we always return
1426f9790aebSLuigi Rizzo  * EBUSY.
1427f9790aebSLuigi Rizzo  * Otherwise, if the port is already bound to a file descriptor,
1428f9790aebSLuigi Rizzo  * then we unconditionally return the existing adapter into *na.
1429f9790aebSLuigi Rizzo  * In all the other cases, we return (into *na) either native,
1430f9790aebSLuigi Rizzo  * generic or NULL, according to the following table:
1431f9790aebSLuigi Rizzo  *
1432f9790aebSLuigi Rizzo  *					native_support
1433f9790aebSLuigi Rizzo  * active_fds   dev.netmap.admode         YES     NO
1434f9790aebSLuigi Rizzo  * -------------------------------------------------------
1435f9790aebSLuigi Rizzo  *    >0              *                 NA(ifp) NA(ifp)
1436f9790aebSLuigi Rizzo  *
1437f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_BEST      NATIVE  GENERIC
1438f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_NATIVE    NATIVE   NULL
1439f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_GENERIC   GENERIC GENERIC
1440f9790aebSLuigi Rizzo  *
1441f9790aebSLuigi Rizzo  */
144237e3a6d3SLuigi Rizzo static void netmap_hw_dtor(struct netmap_adapter *); /* needed by NM_IS_NATIVE() */
1443f9790aebSLuigi Rizzo int
1444c3e9b4dbSLuiz Otavio O Souza netmap_get_hw_na(struct ifnet *ifp, struct netmap_mem_d *nmd, struct netmap_adapter **na)
1445f9790aebSLuigi Rizzo {
1446f9790aebSLuigi Rizzo 	/* generic support */
1447f9790aebSLuigi Rizzo 	int i = netmap_admode;	/* Take a snapshot. */
1448f9790aebSLuigi Rizzo 	struct netmap_adapter *prev_na;
1449847bf383SLuigi Rizzo 	int error = 0;
1450f9790aebSLuigi Rizzo 
1451f9790aebSLuigi Rizzo 	*na = NULL; /* default */
1452f9790aebSLuigi Rizzo 
1453f9790aebSLuigi Rizzo 	/* reset in case of invalid value */
1454f9790aebSLuigi Rizzo 	if (i < NETMAP_ADMODE_BEST || i >= NETMAP_ADMODE_LAST)
1455f9790aebSLuigi Rizzo 		i = netmap_admode = NETMAP_ADMODE_BEST;
1456f9790aebSLuigi Rizzo 
145737e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
14584bf50f18SLuigi Rizzo 		prev_na = NA(ifp);
1459f9790aebSLuigi Rizzo 		/* If an adapter already exists, return it if
1460f9790aebSLuigi Rizzo 		 * there are active file descriptors or if
1461f9790aebSLuigi Rizzo 		 * netmap is not forced to use generic
1462f9790aebSLuigi Rizzo 		 * adapters.
1463f9790aebSLuigi Rizzo 		 */
14644bf50f18SLuigi Rizzo 		if (NETMAP_OWNED_BY_ANY(prev_na)
14654bf50f18SLuigi Rizzo 			|| i != NETMAP_ADMODE_GENERIC
14664bf50f18SLuigi Rizzo 			|| prev_na->na_flags & NAF_FORCE_NATIVE
14674bf50f18SLuigi Rizzo #ifdef WITH_PIPES
14684bf50f18SLuigi Rizzo 			/* ugly, but we cannot allow an adapter switch
14694bf50f18SLuigi Rizzo 			 * if some pipe is referring to this one
14704bf50f18SLuigi Rizzo 			 */
14714bf50f18SLuigi Rizzo 			|| prev_na->na_next_pipe > 0
14724bf50f18SLuigi Rizzo #endif
14734bf50f18SLuigi Rizzo 		) {
14744bf50f18SLuigi Rizzo 			*na = prev_na;
1475c3e9b4dbSLuiz Otavio O Souza 			goto assign_mem;
1476f9790aebSLuigi Rizzo 		}
1477f9790aebSLuigi Rizzo 	}
1478f9790aebSLuigi Rizzo 
1479f9790aebSLuigi Rizzo 	/* If there isn't native support and netmap is not allowed
1480f9790aebSLuigi Rizzo 	 * to use generic adapters, we cannot satisfy the request.
1481f9790aebSLuigi Rizzo 	 */
148237e3a6d3SLuigi Rizzo 	if (!NM_IS_NATIVE(ifp) && i == NETMAP_ADMODE_NATIVE)
1483f2637526SLuigi Rizzo 		return EOPNOTSUPP;
1484f9790aebSLuigi Rizzo 
1485f9790aebSLuigi Rizzo 	/* Otherwise, create a generic adapter and return it,
1486f9790aebSLuigi Rizzo 	 * saving the previously used netmap adapter, if any.
1487f9790aebSLuigi Rizzo 	 *
1488f9790aebSLuigi Rizzo 	 * Note that here 'prev_na', if not NULL, MUST be a
1489f9790aebSLuigi Rizzo 	 * native adapter, and CANNOT be a generic one. This is
1490f9790aebSLuigi Rizzo 	 * true because generic adapters are created on demand, and
1491f9790aebSLuigi Rizzo 	 * destroyed when not used anymore. Therefore, if the adapter
1492f9790aebSLuigi Rizzo 	 * currently attached to an interface 'ifp' is generic, it
1493f9790aebSLuigi Rizzo 	 * must be that
1494f9790aebSLuigi Rizzo 	 * (NA(ifp)->active_fds > 0 || NETMAP_OWNED_BY_KERN(NA(ifp))).
1495f9790aebSLuigi Rizzo 	 * Consequently, if NA(ifp) is generic, we will enter one of
1496f9790aebSLuigi Rizzo 	 * the branches above. This ensures that we never override
1497f9790aebSLuigi Rizzo 	 * a generic adapter with another generic adapter.
1498f9790aebSLuigi Rizzo 	 */
1499f9790aebSLuigi Rizzo 	error = generic_netmap_attach(ifp);
1500f9790aebSLuigi Rizzo 	if (error)
1501f9790aebSLuigi Rizzo 		return error;
1502f9790aebSLuigi Rizzo 
1503f9790aebSLuigi Rizzo 	*na = NA(ifp);
1504c3e9b4dbSLuiz Otavio O Souza 
1505c3e9b4dbSLuiz Otavio O Souza assign_mem:
1506c3e9b4dbSLuiz Otavio O Souza 	if (nmd != NULL && !((*na)->na_flags & NAF_MEM_OWNER) &&
1507c3e9b4dbSLuiz Otavio O Souza 	    (*na)->active_fds == 0 && ((*na)->nm_mem != nmd)) {
15084f80b14cSVincenzo Maffione 		(*na)->nm_mem_prev = (*na)->nm_mem;
1509c3e9b4dbSLuiz Otavio O Souza 		(*na)->nm_mem = netmap_mem_get(nmd);
1510f9790aebSLuigi Rizzo 	}
1511f9790aebSLuigi Rizzo 
1512c3e9b4dbSLuiz Otavio O Souza 	return 0;
1513c3e9b4dbSLuiz Otavio O Souza }
1514f9790aebSLuigi Rizzo 
151568b8534bSLuigi Rizzo /*
1516ce3ee1e7SLuigi Rizzo  * MUST BE CALLED UNDER NMG_LOCK()
1517ce3ee1e7SLuigi Rizzo  *
1518f2637526SLuigi Rizzo  * Get a refcounted reference to a netmap adapter attached
15192ff91c17SVincenzo Maffione  * to the interface specified by req.
1520ce3ee1e7SLuigi Rizzo  * This is always called in the execution of an ioctl().
1521ce3ee1e7SLuigi Rizzo  *
1522f2637526SLuigi Rizzo  * Return ENXIO if the interface specified by the request does
1523f2637526SLuigi Rizzo  * not exist, ENOTSUP if netmap is not supported by the interface,
1524f2637526SLuigi Rizzo  * EBUSY if the interface is already attached to a bridge,
1525f2637526SLuigi Rizzo  * EINVAL if parameters are invalid, ENOMEM if needed resources
1526f2637526SLuigi Rizzo  * could not be allocated.
1527f2637526SLuigi Rizzo  * If successful, hold a reference to the netmap adapter.
1528f18be576SLuigi Rizzo  *
15292ff91c17SVincenzo Maffione  * If the interface specified by req is a system one, also keep
153037e3a6d3SLuigi Rizzo  * a reference to it and return a valid *ifp.
153168b8534bSLuigi Rizzo  */
1532f9790aebSLuigi Rizzo int
15332ff91c17SVincenzo Maffione netmap_get_na(struct nmreq_header *hdr,
15342ff91c17SVincenzo Maffione 	      struct netmap_adapter **na, struct ifnet **ifp,
15352ff91c17SVincenzo Maffione 	      struct netmap_mem_d *nmd, int create)
153668b8534bSLuigi Rizzo {
1537cfa866f6SMatt Macy 	struct nmreq_register *req = (struct nmreq_register *)(uintptr_t)hdr->nr_body;
1538f9790aebSLuigi Rizzo 	int error = 0;
1539f0ea3689SLuigi Rizzo 	struct netmap_adapter *ret = NULL;
1540c3e9b4dbSLuiz Otavio O Souza 	int nmd_ref = 0;
1541f9790aebSLuigi Rizzo 
1542f9790aebSLuigi Rizzo 	*na = NULL;     /* default return value */
154337e3a6d3SLuigi Rizzo 	*ifp = NULL;
1544f196ce38SLuigi Rizzo 
15452ff91c17SVincenzo Maffione 	if (hdr->nr_reqtype != NETMAP_REQ_REGISTER) {
15462ff91c17SVincenzo Maffione 		return EINVAL;
15472ff91c17SVincenzo Maffione 	}
15482ff91c17SVincenzo Maffione 
15492ff91c17SVincenzo Maffione 	if (req->nr_mode == NR_REG_PIPE_MASTER ||
15502ff91c17SVincenzo Maffione 			req->nr_mode == NR_REG_PIPE_SLAVE) {
15512ff91c17SVincenzo Maffione 		/* Do not accept deprecated pipe modes. */
1552b6e66be2SVincenzo Maffione 		nm_prerr("Deprecated pipe nr_mode, use xx{yy or xx}yy syntax");
15532ff91c17SVincenzo Maffione 		return EINVAL;
15542ff91c17SVincenzo Maffione 	}
15552ff91c17SVincenzo Maffione 
1556ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
1557ce3ee1e7SLuigi Rizzo 
1558c3e9b4dbSLuiz Otavio O Souza 	/* if the request contain a memid, try to find the
1559c3e9b4dbSLuiz Otavio O Souza 	 * corresponding memory region
1560c3e9b4dbSLuiz Otavio O Souza 	 */
15612ff91c17SVincenzo Maffione 	if (nmd == NULL && req->nr_mem_id) {
15622ff91c17SVincenzo Maffione 		nmd = netmap_mem_find(req->nr_mem_id);
1563c3e9b4dbSLuiz Otavio O Souza 		if (nmd == NULL)
1564c3e9b4dbSLuiz Otavio O Souza 			return EINVAL;
1565c3e9b4dbSLuiz Otavio O Souza 		/* keep the rereference */
1566c3e9b4dbSLuiz Otavio O Souza 		nmd_ref = 1;
1567c3e9b4dbSLuiz Otavio O Souza 	}
1568c3e9b4dbSLuiz Otavio O Souza 
156937e3a6d3SLuigi Rizzo 	/* We cascade through all possible types of netmap adapter.
15704bf50f18SLuigi Rizzo 	 * All netmap_get_*_na() functions return an error and an na,
15714bf50f18SLuigi Rizzo 	 * with the following combinations:
15724bf50f18SLuigi Rizzo 	 *
15734bf50f18SLuigi Rizzo 	 * error    na
15744bf50f18SLuigi Rizzo 	 *   0	   NULL		type doesn't match
15754bf50f18SLuigi Rizzo 	 *  !0	   NULL		type matches, but na creation/lookup failed
15764bf50f18SLuigi Rizzo 	 *   0	  !NULL		type matches and na created/found
15774bf50f18SLuigi Rizzo 	 *  !0    !NULL		impossible
15784bf50f18SLuigi Rizzo 	 */
1579b6e66be2SVincenzo Maffione 	error = netmap_get_null_na(hdr, na, nmd, create);
158037e3a6d3SLuigi Rizzo 	if (error || *na != NULL)
1581c3e9b4dbSLuiz Otavio O Souza 		goto out;
158237e3a6d3SLuigi Rizzo 
15834bf50f18SLuigi Rizzo 	/* try to see if this is a monitor port */
15842ff91c17SVincenzo Maffione 	error = netmap_get_monitor_na(hdr, na, nmd, create);
15854bf50f18SLuigi Rizzo 	if (error || *na != NULL)
1586c3e9b4dbSLuiz Otavio O Souza 		goto out;
15874bf50f18SLuigi Rizzo 
15884bf50f18SLuigi Rizzo 	/* try to see if this is a pipe port */
15892ff91c17SVincenzo Maffione 	error = netmap_get_pipe_na(hdr, na, nmd, create);
1590f0ea3689SLuigi Rizzo 	if (error || *na != NULL)
1591c3e9b4dbSLuiz Otavio O Souza 		goto out;
1592ce3ee1e7SLuigi Rizzo 
1593a6d768d8SVincenzo Maffione 	/* try to see if this is a vale port */
15942a7db7a6SVincenzo Maffione 	error = netmap_get_vale_na(hdr, na, nmd, create);
1595f0ea3689SLuigi Rizzo 	if (error)
1596c3e9b4dbSLuiz Otavio O Souza 		goto out;
1597f0ea3689SLuigi Rizzo 
1598f0ea3689SLuigi Rizzo 	if (*na != NULL) /* valid match in netmap_get_bdg_na() */
1599847bf383SLuigi Rizzo 		goto out;
1600f0ea3689SLuigi Rizzo 
160189cc2556SLuigi Rizzo 	/*
160289cc2556SLuigi Rizzo 	 * This must be a hardware na, lookup the name in the system.
160389cc2556SLuigi Rizzo 	 * Note that by hardware we actually mean "it shows up in ifconfig".
160489cc2556SLuigi Rizzo 	 * This may still be a tap, a veth/epair, or even a
160589cc2556SLuigi Rizzo 	 * persistent VALE port.
160689cc2556SLuigi Rizzo 	 */
16072ff91c17SVincenzo Maffione 	*ifp = ifunit_ref(hdr->nr_name);
160837e3a6d3SLuigi Rizzo 	if (*ifp == NULL) {
1609c3e9b4dbSLuiz Otavio O Souza 		error = ENXIO;
1610c3e9b4dbSLuiz Otavio O Souza 		goto out;
1611f196ce38SLuigi Rizzo 	}
1612ce3ee1e7SLuigi Rizzo 
1613c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_hw_na(*ifp, nmd, &ret);
1614f9790aebSLuigi Rizzo 	if (error)
1615f9790aebSLuigi Rizzo 		goto out;
1616f18be576SLuigi Rizzo 
1617f9790aebSLuigi Rizzo 	*na = ret;
1618f9790aebSLuigi Rizzo 	netmap_adapter_get(ret);
1619f0ea3689SLuigi Rizzo 
1620d12354a5SVincenzo Maffione 	/*
162145c67e8fSVincenzo Maffione 	 * if the adapter supports the host rings and it is not already open,
1622d12354a5SVincenzo Maffione 	 * try to set the number of host rings as requested by the user
1623d12354a5SVincenzo Maffione 	 */
1624d12354a5SVincenzo Maffione 	if (((*na)->na_flags & NAF_HOST_RINGS) && (*na)->active_fds == 0) {
1625d12354a5SVincenzo Maffione 		if (req->nr_host_tx_rings)
1626d12354a5SVincenzo Maffione 			(*na)->num_host_tx_rings = req->nr_host_tx_rings;
1627d12354a5SVincenzo Maffione 		if (req->nr_host_rx_rings)
1628d12354a5SVincenzo Maffione 			(*na)->num_host_rx_rings = req->nr_host_rx_rings;
1629d12354a5SVincenzo Maffione 	}
1630d12354a5SVincenzo Maffione 	nm_prdis("%s: host tx %d rx %u", (*na)->name, (*na)->num_host_tx_rings,
1631d12354a5SVincenzo Maffione 			(*na)->num_host_rx_rings);
1632d12354a5SVincenzo Maffione 
1633f9790aebSLuigi Rizzo out:
163437e3a6d3SLuigi Rizzo 	if (error) {
163537e3a6d3SLuigi Rizzo 		if (ret)
1636f0ea3689SLuigi Rizzo 			netmap_adapter_put(ret);
163737e3a6d3SLuigi Rizzo 		if (*ifp) {
163837e3a6d3SLuigi Rizzo 			if_rele(*ifp);
163937e3a6d3SLuigi Rizzo 			*ifp = NULL;
164037e3a6d3SLuigi Rizzo 		}
164137e3a6d3SLuigi Rizzo 	}
1642c3e9b4dbSLuiz Otavio O Souza 	if (nmd_ref)
1643c3e9b4dbSLuiz Otavio O Souza 		netmap_mem_put(nmd);
1644f18be576SLuigi Rizzo 
16455ab0d24dSLuigi Rizzo 	return error;
16465ab0d24dSLuigi Rizzo }
1647ce3ee1e7SLuigi Rizzo 
164837e3a6d3SLuigi Rizzo /* undo netmap_get_na() */
164937e3a6d3SLuigi Rizzo void
165037e3a6d3SLuigi Rizzo netmap_unget_na(struct netmap_adapter *na, struct ifnet *ifp)
165137e3a6d3SLuigi Rizzo {
165237e3a6d3SLuigi Rizzo 	if (ifp)
165337e3a6d3SLuigi Rizzo 		if_rele(ifp);
165437e3a6d3SLuigi Rizzo 	if (na)
165537e3a6d3SLuigi Rizzo 		netmap_adapter_put(na);
165637e3a6d3SLuigi Rizzo }
165737e3a6d3SLuigi Rizzo 
165837e3a6d3SLuigi Rizzo 
165937e3a6d3SLuigi Rizzo #define NM_FAIL_ON(t) do {						\
166037e3a6d3SLuigi Rizzo 	if (unlikely(t)) {						\
166175f4f3edSVincenzo Maffione 		nm_prlim(5, "%s: fail '" #t "' "				\
166237e3a6d3SLuigi Rizzo 			"h %d c %d t %d "				\
166337e3a6d3SLuigi Rizzo 			"rh %d rc %d rt %d "				\
166437e3a6d3SLuigi Rizzo 			"hc %d ht %d",					\
166537e3a6d3SLuigi Rizzo 			kring->name,					\
166637e3a6d3SLuigi Rizzo 			head, cur, ring->tail,				\
166737e3a6d3SLuigi Rizzo 			kring->rhead, kring->rcur, kring->rtail,	\
166837e3a6d3SLuigi Rizzo 			kring->nr_hwcur, kring->nr_hwtail);		\
166937e3a6d3SLuigi Rizzo 		return kring->nkr_num_slots;				\
167037e3a6d3SLuigi Rizzo 	}								\
167137e3a6d3SLuigi Rizzo } while (0)
1672ce3ee1e7SLuigi Rizzo 
1673f9790aebSLuigi Rizzo /*
1674f9790aebSLuigi Rizzo  * validate parameters on entry for *_txsync()
1675f9790aebSLuigi Rizzo  * Returns ring->cur if ok, or something >= kring->nkr_num_slots
167617885a7bSLuigi Rizzo  * in case of error.
1677f9790aebSLuigi Rizzo  *
167817885a7bSLuigi Rizzo  * rhead, rcur and rtail=hwtail are stored from previous round.
167917885a7bSLuigi Rizzo  * hwcur is the next packet to send to the ring.
1680f9790aebSLuigi Rizzo  *
168117885a7bSLuigi Rizzo  * We want
168217885a7bSLuigi Rizzo  *    hwcur <= *rhead <= head <= cur <= tail = *rtail <= hwtail
1683f9790aebSLuigi Rizzo  *
168417885a7bSLuigi Rizzo  * hwcur, rhead, rtail and hwtail are reliable
1685f9790aebSLuigi Rizzo  */
168637e3a6d3SLuigi Rizzo u_int
168737e3a6d3SLuigi Rizzo nm_txsync_prologue(struct netmap_kring *kring, struct netmap_ring *ring)
1688f9790aebSLuigi Rizzo {
168917885a7bSLuigi Rizzo 	u_int head = ring->head; /* read only once */
1690f9790aebSLuigi Rizzo 	u_int cur = ring->cur; /* read only once */
1691f9790aebSLuigi Rizzo 	u_int n = kring->nkr_num_slots;
1692ce3ee1e7SLuigi Rizzo 
169375f4f3edSVincenzo Maffione 	nm_prdis(5, "%s kcur %d ktail %d head %d cur %d tail %d",
169417885a7bSLuigi Rizzo 		kring->name,
169517885a7bSLuigi Rizzo 		kring->nr_hwcur, kring->nr_hwtail,
169617885a7bSLuigi Rizzo 		ring->head, ring->cur, ring->tail);
169717885a7bSLuigi Rizzo #if 1 /* kernel sanity checks; but we can trust the kring. */
169837e3a6d3SLuigi Rizzo 	NM_FAIL_ON(kring->nr_hwcur >= n || kring->rhead >= n ||
169937e3a6d3SLuigi Rizzo 	    kring->rtail >= n ||  kring->nr_hwtail >= n);
1700f9790aebSLuigi Rizzo #endif /* kernel sanity checks */
170117885a7bSLuigi Rizzo 	/*
170237e3a6d3SLuigi Rizzo 	 * user sanity checks. We only use head,
170337e3a6d3SLuigi Rizzo 	 * A, B, ... are possible positions for head:
170417885a7bSLuigi Rizzo 	 *
170537e3a6d3SLuigi Rizzo 	 *  0    A  rhead   B  rtail   C  n-1
170637e3a6d3SLuigi Rizzo 	 *  0    D  rtail   E  rhead   F  n-1
170717885a7bSLuigi Rizzo 	 *
170817885a7bSLuigi Rizzo 	 * B, F, D are valid. A, C, E are wrong
170917885a7bSLuigi Rizzo 	 */
171017885a7bSLuigi Rizzo 	if (kring->rtail >= kring->rhead) {
171117885a7bSLuigi Rizzo 		/* want rhead <= head <= rtail */
171237e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->rhead || head > kring->rtail);
171317885a7bSLuigi Rizzo 		/* and also head <= cur <= rtail */
171437e3a6d3SLuigi Rizzo 		NM_FAIL_ON(cur < head || cur > kring->rtail);
171517885a7bSLuigi Rizzo 	} else { /* here rtail < rhead */
171617885a7bSLuigi Rizzo 		/* we need head outside rtail .. rhead */
171737e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head > kring->rtail && head < kring->rhead);
171817885a7bSLuigi Rizzo 
171917885a7bSLuigi Rizzo 		/* two cases now: head <= rtail or head >= rhead  */
172017885a7bSLuigi Rizzo 		if (head <= kring->rtail) {
172117885a7bSLuigi Rizzo 			/* want head <= cur <= rtail */
172237e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head || cur > kring->rtail);
172317885a7bSLuigi Rizzo 		} else { /* head >= rhead */
172417885a7bSLuigi Rizzo 			/* cur must be outside rtail..head */
172537e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur > kring->rtail && cur < head);
1726f18be576SLuigi Rizzo 		}
1727f9790aebSLuigi Rizzo 	}
172817885a7bSLuigi Rizzo 	if (ring->tail != kring->rtail) {
172975f4f3edSVincenzo Maffione 		nm_prlim(5, "%s tail overwritten was %d need %d", kring->name,
173017885a7bSLuigi Rizzo 			ring->tail, kring->rtail);
173117885a7bSLuigi Rizzo 		ring->tail = kring->rtail;
173217885a7bSLuigi Rizzo 	}
173317885a7bSLuigi Rizzo 	kring->rhead = head;
173417885a7bSLuigi Rizzo 	kring->rcur = cur;
173517885a7bSLuigi Rizzo 	return head;
173668b8534bSLuigi Rizzo }
173768b8534bSLuigi Rizzo 
173868b8534bSLuigi Rizzo 
173968b8534bSLuigi Rizzo /*
1740f9790aebSLuigi Rizzo  * validate parameters on entry for *_rxsync()
174117885a7bSLuigi Rizzo  * Returns ring->head if ok, kring->nkr_num_slots on error.
1742f9790aebSLuigi Rizzo  *
174317885a7bSLuigi Rizzo  * For a valid configuration,
174417885a7bSLuigi Rizzo  * hwcur <= head <= cur <= tail <= hwtail
1745f9790aebSLuigi Rizzo  *
174617885a7bSLuigi Rizzo  * We only consider head and cur.
174717885a7bSLuigi Rizzo  * hwcur and hwtail are reliable.
1748f9790aebSLuigi Rizzo  *
1749f9790aebSLuigi Rizzo  */
175037e3a6d3SLuigi Rizzo u_int
175137e3a6d3SLuigi Rizzo nm_rxsync_prologue(struct netmap_kring *kring, struct netmap_ring *ring)
1752f9790aebSLuigi Rizzo {
175317885a7bSLuigi Rizzo 	uint32_t const n = kring->nkr_num_slots;
175417885a7bSLuigi Rizzo 	uint32_t head, cur;
1755f9790aebSLuigi Rizzo 
175675f4f3edSVincenzo Maffione 	nm_prdis(5,"%s kc %d kt %d h %d c %d t %d",
175717885a7bSLuigi Rizzo 		kring->name,
175817885a7bSLuigi Rizzo 		kring->nr_hwcur, kring->nr_hwtail,
175917885a7bSLuigi Rizzo 		ring->head, ring->cur, ring->tail);
176017885a7bSLuigi Rizzo 	/*
176117885a7bSLuigi Rizzo 	 * Before storing the new values, we should check they do not
176217885a7bSLuigi Rizzo 	 * move backwards. However:
176317885a7bSLuigi Rizzo 	 * - head is not an issue because the previous value is hwcur;
176417885a7bSLuigi Rizzo 	 * - cur could in principle go back, however it does not matter
176517885a7bSLuigi Rizzo 	 *   because we are processing a brand new rxsync()
176617885a7bSLuigi Rizzo 	 */
176717885a7bSLuigi Rizzo 	cur = kring->rcur = ring->cur;	/* read only once */
176817885a7bSLuigi Rizzo 	head = kring->rhead = ring->head;	/* read only once */
1769f9790aebSLuigi Rizzo #if 1 /* kernel sanity checks */
177037e3a6d3SLuigi Rizzo 	NM_FAIL_ON(kring->nr_hwcur >= n || kring->nr_hwtail >= n);
1771f9790aebSLuigi Rizzo #endif /* kernel sanity checks */
1772f9790aebSLuigi Rizzo 	/* user sanity checks */
177317885a7bSLuigi Rizzo 	if (kring->nr_hwtail >= kring->nr_hwcur) {
177417885a7bSLuigi Rizzo 		/* want hwcur <= rhead <= hwtail */
177537e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->nr_hwcur || head > kring->nr_hwtail);
177617885a7bSLuigi Rizzo 		/* and also rhead <= rcur <= hwtail */
177737e3a6d3SLuigi Rizzo 		NM_FAIL_ON(cur < head || cur > kring->nr_hwtail);
1778f9790aebSLuigi Rizzo 	} else {
177917885a7bSLuigi Rizzo 		/* we need rhead outside hwtail..hwcur */
178037e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->nr_hwcur && head > kring->nr_hwtail);
178117885a7bSLuigi Rizzo 		/* two cases now: head <= hwtail or head >= hwcur  */
178217885a7bSLuigi Rizzo 		if (head <= kring->nr_hwtail) {
178317885a7bSLuigi Rizzo 			/* want head <= cur <= hwtail */
178437e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head || cur > kring->nr_hwtail);
178517885a7bSLuigi Rizzo 		} else {
178617885a7bSLuigi Rizzo 			/* cur must be outside hwtail..head */
178737e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head && cur > kring->nr_hwtail);
1788f9790aebSLuigi Rizzo 		}
1789f9790aebSLuigi Rizzo 	}
179017885a7bSLuigi Rizzo 	if (ring->tail != kring->rtail) {
179175f4f3edSVincenzo Maffione 		nm_prlim(5, "%s tail overwritten was %d need %d",
179217885a7bSLuigi Rizzo 			kring->name,
179317885a7bSLuigi Rizzo 			ring->tail, kring->rtail);
179417885a7bSLuigi Rizzo 		ring->tail = kring->rtail;
179517885a7bSLuigi Rizzo 	}
179617885a7bSLuigi Rizzo 	return head;
1797f9790aebSLuigi Rizzo }
1798f9790aebSLuigi Rizzo 
179917885a7bSLuigi Rizzo 
1800f9790aebSLuigi Rizzo /*
180168b8534bSLuigi Rizzo  * Error routine called when txsync/rxsync detects an error.
180217885a7bSLuigi Rizzo  * Can't do much more than resetting head = cur = hwcur, tail = hwtail
180368b8534bSLuigi Rizzo  * Return 1 on reinit.
1804506cc70cSLuigi Rizzo  *
1805506cc70cSLuigi Rizzo  * This routine is only called by the upper half of the kernel.
1806506cc70cSLuigi Rizzo  * It only reads hwcur (which is changed only by the upper half, too)
180717885a7bSLuigi Rizzo  * and hwtail (which may be changed by the lower half, but only on
1808506cc70cSLuigi Rizzo  * a tx ring and only to increase it, so any error will be recovered
1809506cc70cSLuigi Rizzo  * on the next call). For the above, we don't strictly need to call
1810506cc70cSLuigi Rizzo  * it under lock.
181168b8534bSLuigi Rizzo  */
181268b8534bSLuigi Rizzo int
181368b8534bSLuigi Rizzo netmap_ring_reinit(struct netmap_kring *kring)
181468b8534bSLuigi Rizzo {
181568b8534bSLuigi Rizzo 	struct netmap_ring *ring = kring->ring;
181668b8534bSLuigi Rizzo 	u_int i, lim = kring->nkr_num_slots - 1;
181768b8534bSLuigi Rizzo 	int errors = 0;
181868b8534bSLuigi Rizzo 
1819ce3ee1e7SLuigi Rizzo 	// XXX KASSERT nm_kr_tryget
182075f4f3edSVincenzo Maffione 	nm_prlim(10, "called for %s", kring->name);
182117885a7bSLuigi Rizzo 	// XXX probably wrong to trust userspace
182217885a7bSLuigi Rizzo 	kring->rhead = ring->head;
182317885a7bSLuigi Rizzo 	kring->rcur  = ring->cur;
182417885a7bSLuigi Rizzo 	kring->rtail = ring->tail;
182517885a7bSLuigi Rizzo 
182668b8534bSLuigi Rizzo 	if (ring->cur > lim)
182768b8534bSLuigi Rizzo 		errors++;
182817885a7bSLuigi Rizzo 	if (ring->head > lim)
182917885a7bSLuigi Rizzo 		errors++;
183017885a7bSLuigi Rizzo 	if (ring->tail > lim)
183117885a7bSLuigi Rizzo 		errors++;
183268b8534bSLuigi Rizzo 	for (i = 0; i <= lim; i++) {
183368b8534bSLuigi Rizzo 		u_int idx = ring->slot[i].buf_idx;
183468b8534bSLuigi Rizzo 		u_int len = ring->slot[i].len;
1835847bf383SLuigi Rizzo 		if (idx < 2 || idx >= kring->na->na_lut.objtotal) {
183675f4f3edSVincenzo Maffione 			nm_prlim(5, "bad index at slot %d idx %d len %d ", i, idx, len);
183768b8534bSLuigi Rizzo 			ring->slot[i].buf_idx = 0;
183868b8534bSLuigi Rizzo 			ring->slot[i].len = 0;
18394bf50f18SLuigi Rizzo 		} else if (len > NETMAP_BUF_SIZE(kring->na)) {
184068b8534bSLuigi Rizzo 			ring->slot[i].len = 0;
184175f4f3edSVincenzo Maffione 			nm_prlim(5, "bad len at slot %d idx %d len %d", i, idx, len);
184268b8534bSLuigi Rizzo 		}
184368b8534bSLuigi Rizzo 	}
184468b8534bSLuigi Rizzo 	if (errors) {
184575f4f3edSVincenzo Maffione 		nm_prlim(10, "total %d errors", errors);
184675f4f3edSVincenzo Maffione 		nm_prlim(10, "%s reinit, cur %d -> %d tail %d -> %d",
184717885a7bSLuigi Rizzo 			kring->name,
184868b8534bSLuigi Rizzo 			ring->cur, kring->nr_hwcur,
184917885a7bSLuigi Rizzo 			ring->tail, kring->nr_hwtail);
185017885a7bSLuigi Rizzo 		ring->head = kring->rhead = kring->nr_hwcur;
185117885a7bSLuigi Rizzo 		ring->cur  = kring->rcur  = kring->nr_hwcur;
185217885a7bSLuigi Rizzo 		ring->tail = kring->rtail = kring->nr_hwtail;
185368b8534bSLuigi Rizzo 	}
185468b8534bSLuigi Rizzo 	return (errors ? 1 : 0);
185568b8534bSLuigi Rizzo }
185668b8534bSLuigi Rizzo 
18574bf50f18SLuigi Rizzo /* interpret the ringid and flags fields of an nmreq, by translating them
18584bf50f18SLuigi Rizzo  * into a pair of intervals of ring indices:
18594bf50f18SLuigi Rizzo  *
18604bf50f18SLuigi Rizzo  * [priv->np_txqfirst, priv->np_txqlast) and
18614bf50f18SLuigi Rizzo  * [priv->np_rxqfirst, priv->np_rxqlast)
18624bf50f18SLuigi Rizzo  *
186368b8534bSLuigi Rizzo  */
18644bf50f18SLuigi Rizzo int
1865ee0005f1SVincenzo Maffione netmap_interp_ringid(struct netmap_priv_d *priv, struct nmreq_header *hdr)
186668b8534bSLuigi Rizzo {
1867f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1868ee0005f1SVincenzo Maffione 	struct nmreq_register *reg = (struct nmreq_register *)hdr->nr_body;
186937e3a6d3SLuigi Rizzo 	int excluded_direction[] = { NR_TX_RINGS_ONLY, NR_RX_RINGS_ONLY };
1870847bf383SLuigi Rizzo 	enum txrx t;
18712ff91c17SVincenzo Maffione 	u_int j;
1872ee0005f1SVincenzo Maffione 	u_int nr_flags = reg->nr_flags, nr_mode = reg->nr_mode,
1873ee0005f1SVincenzo Maffione 	      nr_ringid = reg->nr_ringid;
187468b8534bSLuigi Rizzo 
187537e3a6d3SLuigi Rizzo 	for_rx_tx(t) {
18762ff91c17SVincenzo Maffione 		if (nr_flags & excluded_direction[t]) {
187737e3a6d3SLuigi Rizzo 			priv->np_qfirst[t] = priv->np_qlast[t] = 0;
187837e3a6d3SLuigi Rizzo 			continue;
187937e3a6d3SLuigi Rizzo 		}
18802ff91c17SVincenzo Maffione 		switch (nr_mode) {
1881f0ea3689SLuigi Rizzo 		case NR_REG_ALL_NIC:
1882b6e66be2SVincenzo Maffione 		case NR_REG_NULL:
1883847bf383SLuigi Rizzo 			priv->np_qfirst[t] = 0;
1884847bf383SLuigi Rizzo 			priv->np_qlast[t] = nma_get_nrings(na, t);
188575f4f3edSVincenzo Maffione 			nm_prdis("ALL/PIPE: %s %d %d", nm_txrx2str(t),
188637e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1887f0ea3689SLuigi Rizzo 			break;
1888f0ea3689SLuigi Rizzo 		case NR_REG_SW:
1889f0ea3689SLuigi Rizzo 		case NR_REG_NIC_SW:
1890f0ea3689SLuigi Rizzo 			if (!(na->na_flags & NAF_HOST_RINGS)) {
1891b6e66be2SVincenzo Maffione 				nm_prerr("host rings not supported");
1892f0ea3689SLuigi Rizzo 				return EINVAL;
1893f0ea3689SLuigi Rizzo 			}
18942ff91c17SVincenzo Maffione 			priv->np_qfirst[t] = (nr_mode == NR_REG_SW ?
1895847bf383SLuigi Rizzo 				nma_get_nrings(na, t) : 0);
18962a7db7a6SVincenzo Maffione 			priv->np_qlast[t] = netmap_all_rings(na, t);
189775f4f3edSVincenzo Maffione 			nm_prdis("%s: %s %d %d", nr_mode == NR_REG_SW ? "SW" : "NIC+SW",
189837e3a6d3SLuigi Rizzo 				nm_txrx2str(t),
189937e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1900f0ea3689SLuigi Rizzo 			break;
1901f0ea3689SLuigi Rizzo 		case NR_REG_ONE_NIC:
19022ff91c17SVincenzo Maffione 			if (nr_ringid >= na->num_tx_rings &&
19032ff91c17SVincenzo Maffione 					nr_ringid >= na->num_rx_rings) {
1904b6e66be2SVincenzo Maffione 				nm_prerr("invalid ring id %d", nr_ringid);
1905f0ea3689SLuigi Rizzo 				return EINVAL;
1906f0ea3689SLuigi Rizzo 			}
1907f0ea3689SLuigi Rizzo 			/* if not enough rings, use the first one */
19082ff91c17SVincenzo Maffione 			j = nr_ringid;
1909847bf383SLuigi Rizzo 			if (j >= nma_get_nrings(na, t))
1910f0ea3689SLuigi Rizzo 				j = 0;
1911847bf383SLuigi Rizzo 			priv->np_qfirst[t] = j;
1912847bf383SLuigi Rizzo 			priv->np_qlast[t] = j + 1;
191375f4f3edSVincenzo Maffione 			nm_prdis("ONE_NIC: %s %d %d", nm_txrx2str(t),
191437e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1915f0ea3689SLuigi Rizzo 			break;
1916d12354a5SVincenzo Maffione 		case NR_REG_ONE_SW:
1917d12354a5SVincenzo Maffione 			if (!(na->na_flags & NAF_HOST_RINGS)) {
1918d12354a5SVincenzo Maffione 				nm_prerr("host rings not supported");
1919d12354a5SVincenzo Maffione 				return EINVAL;
1920d12354a5SVincenzo Maffione 			}
1921d12354a5SVincenzo Maffione 			if (nr_ringid >= na->num_host_tx_rings &&
1922d12354a5SVincenzo Maffione 					nr_ringid >= na->num_host_rx_rings) {
1923d12354a5SVincenzo Maffione 				nm_prerr("invalid ring id %d", nr_ringid);
1924d12354a5SVincenzo Maffione 				return EINVAL;
1925d12354a5SVincenzo Maffione 			}
1926d12354a5SVincenzo Maffione 			/* if not enough rings, use the first one */
1927d12354a5SVincenzo Maffione 			j = nr_ringid;
1928d12354a5SVincenzo Maffione 			if (j >= nma_get_host_nrings(na, t))
1929d12354a5SVincenzo Maffione 				j = 0;
1930d12354a5SVincenzo Maffione 			priv->np_qfirst[t] = nma_get_nrings(na, t) + j;
1931d12354a5SVincenzo Maffione 			priv->np_qlast[t] = nma_get_nrings(na, t) + j + 1;
1932d12354a5SVincenzo Maffione 			nm_prdis("ONE_SW: %s %d %d", nm_txrx2str(t),
1933d12354a5SVincenzo Maffione 				priv->np_qfirst[t], priv->np_qlast[t]);
1934d12354a5SVincenzo Maffione 			break;
1935f0ea3689SLuigi Rizzo 		default:
1936b6e66be2SVincenzo Maffione 			nm_prerr("invalid regif type %d", nr_mode);
1937f0ea3689SLuigi Rizzo 			return EINVAL;
193868b8534bSLuigi Rizzo 		}
193937e3a6d3SLuigi Rizzo 	}
1940b6e66be2SVincenzo Maffione 	priv->np_flags = nr_flags;
19414bf50f18SLuigi Rizzo 
1942c3e9b4dbSLuiz Otavio O Souza 	/* Allow transparent forwarding mode in the host --> nic
1943c3e9b4dbSLuiz Otavio O Souza 	 * direction only if all the TX hw rings have been opened. */
1944c3e9b4dbSLuiz Otavio O Souza 	if (priv->np_qfirst[NR_TX] == 0 &&
1945c3e9b4dbSLuiz Otavio O Souza 			priv->np_qlast[NR_TX] >= na->num_tx_rings) {
1946c3e9b4dbSLuiz Otavio O Souza 		priv->np_sync_flags |= NAF_CAN_FORWARD_DOWN;
1947c3e9b4dbSLuiz Otavio O Souza 	}
1948c3e9b4dbSLuiz Otavio O Souza 
1949ae10d1afSLuigi Rizzo 	if (netmap_verbose) {
1950b6e66be2SVincenzo Maffione 		nm_prinf("%s: tx [%d,%d) rx [%d,%d) id %d",
19514bf50f18SLuigi Rizzo 			na->name,
1952847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
1953847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
1954847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
1955847bf383SLuigi Rizzo 			priv->np_qlast[NR_RX],
19562ff91c17SVincenzo Maffione 			nr_ringid);
1957ae10d1afSLuigi Rizzo 	}
195868b8534bSLuigi Rizzo 	return 0;
195968b8534bSLuigi Rizzo }
196068b8534bSLuigi Rizzo 
19614bf50f18SLuigi Rizzo 
19624bf50f18SLuigi Rizzo /*
19634bf50f18SLuigi Rizzo  * Set the ring ID. For devices with a single queue, a request
19644bf50f18SLuigi Rizzo  * for all rings is the same as a single ring.
19654bf50f18SLuigi Rizzo  */
19664bf50f18SLuigi Rizzo static int
1967ee0005f1SVincenzo Maffione netmap_set_ringid(struct netmap_priv_d *priv, struct nmreq_header *hdr)
19684bf50f18SLuigi Rizzo {
19694bf50f18SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1970ee0005f1SVincenzo Maffione 	struct nmreq_register *reg = (struct nmreq_register *)hdr->nr_body;
19714bf50f18SLuigi Rizzo 	int error;
1972847bf383SLuigi Rizzo 	enum txrx t;
19734bf50f18SLuigi Rizzo 
1974ee0005f1SVincenzo Maffione 	error = netmap_interp_ringid(priv, hdr);
19754bf50f18SLuigi Rizzo 	if (error) {
19764bf50f18SLuigi Rizzo 		return error;
19774bf50f18SLuigi Rizzo 	}
19784bf50f18SLuigi Rizzo 
1979ee0005f1SVincenzo Maffione 	priv->np_txpoll = (reg->nr_flags & NR_NO_TX_POLL) ? 0 : 1;
19804bf50f18SLuigi Rizzo 
19814bf50f18SLuigi Rizzo 	/* optimization: count the users registered for more than
19824bf50f18SLuigi Rizzo 	 * one ring, which are the ones sleeping on the global queue.
19834bf50f18SLuigi Rizzo 	 * The default netmap_notify() callback will then
19844bf50f18SLuigi Rizzo 	 * avoid signaling the global queue if nobody is using it
19854bf50f18SLuigi Rizzo 	 */
1986847bf383SLuigi Rizzo 	for_rx_tx(t) {
1987847bf383SLuigi Rizzo 		if (nm_si_user(priv, t))
1988847bf383SLuigi Rizzo 			na->si_users[t]++;
1989847bf383SLuigi Rizzo 	}
19904bf50f18SLuigi Rizzo 	return 0;
19914bf50f18SLuigi Rizzo }
19924bf50f18SLuigi Rizzo 
1993847bf383SLuigi Rizzo static void
1994847bf383SLuigi Rizzo netmap_unset_ringid(struct netmap_priv_d *priv)
1995847bf383SLuigi Rizzo {
1996847bf383SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1997847bf383SLuigi Rizzo 	enum txrx t;
1998847bf383SLuigi Rizzo 
1999847bf383SLuigi Rizzo 	for_rx_tx(t) {
2000847bf383SLuigi Rizzo 		if (nm_si_user(priv, t))
2001847bf383SLuigi Rizzo 			na->si_users[t]--;
2002847bf383SLuigi Rizzo 		priv->np_qfirst[t] = priv->np_qlast[t] = 0;
2003847bf383SLuigi Rizzo 	}
2004847bf383SLuigi Rizzo 	priv->np_flags = 0;
2005847bf383SLuigi Rizzo 	priv->np_txpoll = 0;
2006b6e66be2SVincenzo Maffione 	priv->np_kloop_state = 0;
2007847bf383SLuigi Rizzo }
2008847bf383SLuigi Rizzo 
2009ee0005f1SVincenzo Maffione #define within_sel(p_, t_, i_)					  	  \
2010ee0005f1SVincenzo Maffione 	((i_) < (p_)->np_qlast[(t_)])
2011ee0005f1SVincenzo Maffione #define nonempty_sel(p_, t_)						  \
2012ee0005f1SVincenzo Maffione 	(within_sel((p_), (t_), (p_)->np_qfirst[(t_)]))
2013ee0005f1SVincenzo Maffione #define foreach_selected_ring(p_, t_, i_, kring_)			  \
2014ee0005f1SVincenzo Maffione 	for ((t_) = nonempty_sel((p_), NR_RX) ? NR_RX : NR_TX,		  \
2015ee0005f1SVincenzo Maffione 	     (i_) = (p_)->np_qfirst[(t_)];				  \
2016ee0005f1SVincenzo Maffione 	     (t_ == NR_RX ||						  \
2017ee0005f1SVincenzo Maffione 	      (t == NR_TX && within_sel((p_), (t_), (i_)))) &&     	  \
2018ee0005f1SVincenzo Maffione 	      ((kring_) = NMR((p_)->np_na, (t_))[(i_)]); 		  \
2019ee0005f1SVincenzo Maffione 	     (i_) = within_sel((p_), (t_), (i_) + 1) ? (i_) + 1 :         \
2020ee0005f1SVincenzo Maffione 		(++(t_) < NR_TXRX ? (p_)->np_qfirst[(t_)] : (i_)))
2021ee0005f1SVincenzo Maffione 
2022847bf383SLuigi Rizzo 
202337e3a6d3SLuigi Rizzo /* Set the nr_pending_mode for the requested rings.
202437e3a6d3SLuigi Rizzo  * If requested, also try to get exclusive access to the rings, provided
202537e3a6d3SLuigi Rizzo  * the rings we want to bind are not exclusively owned by a previous bind.
2026847bf383SLuigi Rizzo  */
2027847bf383SLuigi Rizzo static int
202837e3a6d3SLuigi Rizzo netmap_krings_get(struct netmap_priv_d *priv)
2029847bf383SLuigi Rizzo {
2030847bf383SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
2031847bf383SLuigi Rizzo 	u_int i;
2032847bf383SLuigi Rizzo 	struct netmap_kring *kring;
2033847bf383SLuigi Rizzo 	int excl = (priv->np_flags & NR_EXCLUSIVE);
2034847bf383SLuigi Rizzo 	enum txrx t;
2035847bf383SLuigi Rizzo 
2036b6e66be2SVincenzo Maffione 	if (netmap_debug & NM_DEBUG_ON)
2037b6e66be2SVincenzo Maffione 		nm_prinf("%s: grabbing tx [%d, %d) rx [%d, %d)",
2038847bf383SLuigi Rizzo 			na->name,
2039847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
2040847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
2041847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
2042847bf383SLuigi Rizzo 			priv->np_qlast[NR_RX]);
2043847bf383SLuigi Rizzo 
2044847bf383SLuigi Rizzo 	/* first round: check that all the requested rings
204545c67e8fSVincenzo Maffione 	 * are neither already exclusively owned, nor we
2046847bf383SLuigi Rizzo 	 * want exclusive ownership when they are already in use
2047847bf383SLuigi Rizzo 	 */
2048ee0005f1SVincenzo Maffione 	foreach_selected_ring(priv, t, i, kring) {
2049847bf383SLuigi Rizzo 		if ((kring->nr_kflags & NKR_EXCLUSIVE) ||
2050847bf383SLuigi Rizzo 		    (kring->users && excl))
2051847bf383SLuigi Rizzo 		{
205275f4f3edSVincenzo Maffione 			nm_prdis("ring %s busy", kring->name);
2053847bf383SLuigi Rizzo 			return EBUSY;
2054847bf383SLuigi Rizzo 		}
2055847bf383SLuigi Rizzo 	}
2056847bf383SLuigi Rizzo 
205737e3a6d3SLuigi Rizzo 	/* second round: increment usage count (possibly marking them
205837e3a6d3SLuigi Rizzo 	 * as exclusive) and set the nr_pending_mode
2059847bf383SLuigi Rizzo 	 */
2060ee0005f1SVincenzo Maffione 	foreach_selected_ring(priv, t, i, kring) {
2061847bf383SLuigi Rizzo 		kring->users++;
2062847bf383SLuigi Rizzo 		if (excl)
2063847bf383SLuigi Rizzo 			kring->nr_kflags |= NKR_EXCLUSIVE;
206437e3a6d3SLuigi Rizzo 		kring->nr_pending_mode = NKR_NETMAP_ON;
2065847bf383SLuigi Rizzo 	}
2066847bf383SLuigi Rizzo 
2067847bf383SLuigi Rizzo 	return 0;
2068847bf383SLuigi Rizzo 
2069847bf383SLuigi Rizzo }
2070847bf383SLuigi Rizzo 
207137e3a6d3SLuigi Rizzo /* Undo netmap_krings_get(). This is done by clearing the exclusive mode
207237e3a6d3SLuigi Rizzo  * if was asked on regif, and unset the nr_pending_mode if we are the
207337e3a6d3SLuigi Rizzo  * last users of the involved rings. */
2074847bf383SLuigi Rizzo static void
207537e3a6d3SLuigi Rizzo netmap_krings_put(struct netmap_priv_d *priv)
2076847bf383SLuigi Rizzo {
2077847bf383SLuigi Rizzo 	u_int i;
2078847bf383SLuigi Rizzo 	struct netmap_kring *kring;
2079847bf383SLuigi Rizzo 	int excl = (priv->np_flags & NR_EXCLUSIVE);
2080847bf383SLuigi Rizzo 	enum txrx t;
2081847bf383SLuigi Rizzo 
208275f4f3edSVincenzo Maffione 	nm_prdis("%s: releasing tx [%d, %d) rx [%d, %d)",
2083847bf383SLuigi Rizzo 			na->name,
2084847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
2085847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
2086847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
2087847bf383SLuigi Rizzo 			priv->np_qlast[MR_RX]);
2088847bf383SLuigi Rizzo 
2089ee0005f1SVincenzo Maffione 	foreach_selected_ring(priv, t, i, kring) {
2090847bf383SLuigi Rizzo 		if (excl)
2091847bf383SLuigi Rizzo 			kring->nr_kflags &= ~NKR_EXCLUSIVE;
2092847bf383SLuigi Rizzo 		kring->users--;
209337e3a6d3SLuigi Rizzo 		if (kring->users == 0)
209437e3a6d3SLuigi Rizzo 			kring->nr_pending_mode = NKR_NETMAP_OFF;
2095847bf383SLuigi Rizzo 	}
2096847bf383SLuigi Rizzo }
2097847bf383SLuigi Rizzo 
20982ff91c17SVincenzo Maffione static int
20992ff91c17SVincenzo Maffione nm_priv_rx_enabled(struct netmap_priv_d *priv)
21002ff91c17SVincenzo Maffione {
21012ff91c17SVincenzo Maffione 	return (priv->np_qfirst[NR_RX] != priv->np_qlast[NR_RX]);
21022ff91c17SVincenzo Maffione }
21032ff91c17SVincenzo Maffione 
2104b6e66be2SVincenzo Maffione /* Validate the CSB entries for both directions (atok and ktoa).
2105b6e66be2SVincenzo Maffione  * To be called under NMG_LOCK(). */
2106b6e66be2SVincenzo Maffione static int
2107b6e66be2SVincenzo Maffione netmap_csb_validate(struct netmap_priv_d *priv, struct nmreq_opt_csb *csbo)
2108b6e66be2SVincenzo Maffione {
2109b6e66be2SVincenzo Maffione 	struct nm_csb_atok *csb_atok_base =
2110b6e66be2SVincenzo Maffione 		(struct nm_csb_atok *)(uintptr_t)csbo->csb_atok;
2111b6e66be2SVincenzo Maffione 	struct nm_csb_ktoa *csb_ktoa_base =
2112b6e66be2SVincenzo Maffione 		(struct nm_csb_ktoa *)(uintptr_t)csbo->csb_ktoa;
2113b6e66be2SVincenzo Maffione 	enum txrx t;
2114b6e66be2SVincenzo Maffione 	int num_rings[NR_TXRX], tot_rings;
2115b6e66be2SVincenzo Maffione 	size_t entry_size[2];
2116b6e66be2SVincenzo Maffione 	void *csb_start[2];
2117b6e66be2SVincenzo Maffione 	int i;
2118b6e66be2SVincenzo Maffione 
2119b6e66be2SVincenzo Maffione 	if (priv->np_kloop_state & NM_SYNC_KLOOP_RUNNING) {
2120b6e66be2SVincenzo Maffione 		nm_prerr("Cannot update CSB while kloop is running");
2121b6e66be2SVincenzo Maffione 		return EBUSY;
2122b6e66be2SVincenzo Maffione 	}
2123b6e66be2SVincenzo Maffione 
2124b6e66be2SVincenzo Maffione 	tot_rings = 0;
2125b6e66be2SVincenzo Maffione 	for_rx_tx(t) {
2126b6e66be2SVincenzo Maffione 		num_rings[t] = priv->np_qlast[t] - priv->np_qfirst[t];
2127b6e66be2SVincenzo Maffione 		tot_rings += num_rings[t];
2128b6e66be2SVincenzo Maffione 	}
2129b6e66be2SVincenzo Maffione 	if (tot_rings <= 0)
2130b6e66be2SVincenzo Maffione 		return 0;
2131b6e66be2SVincenzo Maffione 
2132b6e66be2SVincenzo Maffione 	if (!(priv->np_flags & NR_EXCLUSIVE)) {
2133b6e66be2SVincenzo Maffione 		nm_prerr("CSB mode requires NR_EXCLUSIVE");
2134b6e66be2SVincenzo Maffione 		return EINVAL;
2135b6e66be2SVincenzo Maffione 	}
2136b6e66be2SVincenzo Maffione 
2137b6e66be2SVincenzo Maffione 	entry_size[0] = sizeof(*csb_atok_base);
2138b6e66be2SVincenzo Maffione 	entry_size[1] = sizeof(*csb_ktoa_base);
2139b6e66be2SVincenzo Maffione 	csb_start[0] = (void *)csb_atok_base;
2140b6e66be2SVincenzo Maffione 	csb_start[1] = (void *)csb_ktoa_base;
2141b6e66be2SVincenzo Maffione 
2142b6e66be2SVincenzo Maffione 	for (i = 0; i < 2; i++) {
2143b6e66be2SVincenzo Maffione 		/* On Linux we could use access_ok() to simplify
2144b6e66be2SVincenzo Maffione 		 * the validation. However, the advantage of
2145b6e66be2SVincenzo Maffione 		 * this approach is that it works also on
2146b6e66be2SVincenzo Maffione 		 * FreeBSD. */
2147b6e66be2SVincenzo Maffione 		size_t csb_size = tot_rings * entry_size[i];
2148b6e66be2SVincenzo Maffione 		void *tmp;
2149b6e66be2SVincenzo Maffione 		int err;
2150b6e66be2SVincenzo Maffione 
2151b6e66be2SVincenzo Maffione 		if ((uintptr_t)csb_start[i] & (entry_size[i]-1)) {
2152b6e66be2SVincenzo Maffione 			nm_prerr("Unaligned CSB address");
2153b6e66be2SVincenzo Maffione 			return EINVAL;
2154b6e66be2SVincenzo Maffione 		}
2155b6e66be2SVincenzo Maffione 
2156b6e66be2SVincenzo Maffione 		tmp = nm_os_malloc(csb_size);
2157b6e66be2SVincenzo Maffione 		if (!tmp)
2158b6e66be2SVincenzo Maffione 			return ENOMEM;
2159b6e66be2SVincenzo Maffione 		if (i == 0) {
2160b6e66be2SVincenzo Maffione 			/* Application --> kernel direction. */
2161b6e66be2SVincenzo Maffione 			err = copyin(csb_start[i], tmp, csb_size);
2162b6e66be2SVincenzo Maffione 		} else {
2163b6e66be2SVincenzo Maffione 			/* Kernel --> application direction. */
2164b6e66be2SVincenzo Maffione 			memset(tmp, 0, csb_size);
2165b6e66be2SVincenzo Maffione 			err = copyout(tmp, csb_start[i], csb_size);
2166b6e66be2SVincenzo Maffione 		}
2167b6e66be2SVincenzo Maffione 		nm_os_free(tmp);
2168b6e66be2SVincenzo Maffione 		if (err) {
2169b6e66be2SVincenzo Maffione 			nm_prerr("Invalid CSB address");
2170b6e66be2SVincenzo Maffione 			return err;
2171b6e66be2SVincenzo Maffione 		}
2172b6e66be2SVincenzo Maffione 	}
2173b6e66be2SVincenzo Maffione 
2174b6e66be2SVincenzo Maffione 	priv->np_csb_atok_base = csb_atok_base;
2175b6e66be2SVincenzo Maffione 	priv->np_csb_ktoa_base = csb_ktoa_base;
2176b6e66be2SVincenzo Maffione 
2177b6e66be2SVincenzo Maffione 	/* Initialize the CSB. */
2178b6e66be2SVincenzo Maffione 	for_rx_tx(t) {
2179b6e66be2SVincenzo Maffione 		for (i = 0; i < num_rings[t]; i++) {
2180b6e66be2SVincenzo Maffione 			struct netmap_kring *kring =
2181b6e66be2SVincenzo Maffione 				NMR(priv->np_na, t)[i + priv->np_qfirst[t]];
2182b6e66be2SVincenzo Maffione 			struct nm_csb_atok *csb_atok = csb_atok_base + i;
2183b6e66be2SVincenzo Maffione 			struct nm_csb_ktoa *csb_ktoa = csb_ktoa_base + i;
2184b6e66be2SVincenzo Maffione 
2185b6e66be2SVincenzo Maffione 			if (t == NR_RX) {
2186b6e66be2SVincenzo Maffione 				csb_atok += num_rings[NR_TX];
2187b6e66be2SVincenzo Maffione 				csb_ktoa += num_rings[NR_TX];
2188b6e66be2SVincenzo Maffione 			}
2189b6e66be2SVincenzo Maffione 
2190b6e66be2SVincenzo Maffione 			CSB_WRITE(csb_atok, head, kring->rhead);
2191b6e66be2SVincenzo Maffione 			CSB_WRITE(csb_atok, cur, kring->rcur);
2192b6e66be2SVincenzo Maffione 			CSB_WRITE(csb_atok, appl_need_kick, 1);
2193b6e66be2SVincenzo Maffione 			CSB_WRITE(csb_atok, sync_flags, 1);
2194b6e66be2SVincenzo Maffione 			CSB_WRITE(csb_ktoa, hwcur, kring->nr_hwcur);
2195b6e66be2SVincenzo Maffione 			CSB_WRITE(csb_ktoa, hwtail, kring->nr_hwtail);
2196b6e66be2SVincenzo Maffione 			CSB_WRITE(csb_ktoa, kern_need_kick, 1);
2197b6e66be2SVincenzo Maffione 
2198b6e66be2SVincenzo Maffione 			nm_prinf("csb_init for kring %s: head %u, cur %u, "
2199b6e66be2SVincenzo Maffione 				"hwcur %u, hwtail %u", kring->name,
2200b6e66be2SVincenzo Maffione 				kring->rhead, kring->rcur, kring->nr_hwcur,
2201b6e66be2SVincenzo Maffione 				kring->nr_hwtail);
2202b6e66be2SVincenzo Maffione 		}
2203b6e66be2SVincenzo Maffione 	}
2204b6e66be2SVincenzo Maffione 
2205b6e66be2SVincenzo Maffione 	return 0;
2206b6e66be2SVincenzo Maffione }
2207b6e66be2SVincenzo Maffione 
220877a2baf5SVincenzo Maffione /* Ensure that the netmap adapter can support the given MTU.
220977a2baf5SVincenzo Maffione  * @return EINVAL if the na cannot be set to mtu, 0 otherwise.
221077a2baf5SVincenzo Maffione  */
221177a2baf5SVincenzo Maffione int
221277a2baf5SVincenzo Maffione netmap_buf_size_validate(const struct netmap_adapter *na, unsigned mtu) {
221377a2baf5SVincenzo Maffione 	unsigned nbs = NETMAP_BUF_SIZE(na);
221477a2baf5SVincenzo Maffione 
221577a2baf5SVincenzo Maffione 	if (mtu <= na->rx_buf_maxsize) {
221677a2baf5SVincenzo Maffione 		/* The MTU fits a single NIC slot. We only
221777a2baf5SVincenzo Maffione 		 * Need to check that netmap buffers are
221877a2baf5SVincenzo Maffione 		 * large enough to hold an MTU. NS_MOREFRAG
221977a2baf5SVincenzo Maffione 		 * cannot be used in this case. */
222077a2baf5SVincenzo Maffione 		if (nbs < mtu) {
222177a2baf5SVincenzo Maffione 			nm_prerr("error: netmap buf size (%u) "
222277a2baf5SVincenzo Maffione 				 "< device MTU (%u)", nbs, mtu);
222377a2baf5SVincenzo Maffione 			return EINVAL;
222477a2baf5SVincenzo Maffione 		}
222577a2baf5SVincenzo Maffione 	} else {
222677a2baf5SVincenzo Maffione 		/* More NIC slots may be needed to receive
222777a2baf5SVincenzo Maffione 		 * or transmit a single packet. Check that
222877a2baf5SVincenzo Maffione 		 * the adapter supports NS_MOREFRAG and that
222977a2baf5SVincenzo Maffione 		 * netmap buffers are large enough to hold
223077a2baf5SVincenzo Maffione 		 * the maximum per-slot size. */
223177a2baf5SVincenzo Maffione 		if (!(na->na_flags & NAF_MOREFRAG)) {
223277a2baf5SVincenzo Maffione 			nm_prerr("error: large MTU (%d) needed "
223377a2baf5SVincenzo Maffione 				 "but %s does not support "
223477a2baf5SVincenzo Maffione 				 "NS_MOREFRAG", mtu,
223577a2baf5SVincenzo Maffione 				 na->ifp->if_xname);
223677a2baf5SVincenzo Maffione 			return EINVAL;
223777a2baf5SVincenzo Maffione 		} else if (nbs < na->rx_buf_maxsize) {
223877a2baf5SVincenzo Maffione 			nm_prerr("error: using NS_MOREFRAG on "
223977a2baf5SVincenzo Maffione 				 "%s requires netmap buf size "
224077a2baf5SVincenzo Maffione 				 ">= %u", na->ifp->if_xname,
224177a2baf5SVincenzo Maffione 				 na->rx_buf_maxsize);
224277a2baf5SVincenzo Maffione 			return EINVAL;
224377a2baf5SVincenzo Maffione 		} else {
224477a2baf5SVincenzo Maffione 			nm_prinf("info: netmap application on "
224577a2baf5SVincenzo Maffione 				 "%s needs to support "
224677a2baf5SVincenzo Maffione 				 "NS_MOREFRAG "
224777a2baf5SVincenzo Maffione 				 "(MTU=%u,netmap_buf_size=%u)",
224877a2baf5SVincenzo Maffione 				 na->ifp->if_xname, mtu, nbs);
224977a2baf5SVincenzo Maffione 		}
225077a2baf5SVincenzo Maffione 	}
225177a2baf5SVincenzo Maffione 	return 0;
225277a2baf5SVincenzo Maffione }
225377a2baf5SVincenzo Maffione 
2254a6d768d8SVincenzo Maffione /* Handle the offset option, if present in the hdr.
2255a6d768d8SVincenzo Maffione  * Returns 0 on success, or an error.
2256a6d768d8SVincenzo Maffione  */
2257a6d768d8SVincenzo Maffione static int
2258a6d768d8SVincenzo Maffione netmap_offsets_init(struct netmap_priv_d *priv, struct nmreq_header *hdr)
2259a6d768d8SVincenzo Maffione {
2260a6d768d8SVincenzo Maffione 	struct nmreq_opt_offsets *opt;
2261a6d768d8SVincenzo Maffione 	struct netmap_adapter *na = priv->np_na;
2262a6d768d8SVincenzo Maffione 	struct netmap_kring *kring;
2263a6d768d8SVincenzo Maffione 	uint64_t mask = 0, bits = 0, maxbits = sizeof(uint64_t) * 8,
2264a6d768d8SVincenzo Maffione 		 max_offset = 0, initial_offset = 0, min_gap = 0;
2265a6d768d8SVincenzo Maffione 	u_int i;
2266a6d768d8SVincenzo Maffione 	enum txrx t;
2267a6d768d8SVincenzo Maffione 	int error = 0;
2268a6d768d8SVincenzo Maffione 
2269a6d768d8SVincenzo Maffione 	opt = (struct nmreq_opt_offsets *)
2270a6d768d8SVincenzo Maffione 		nmreq_getoption(hdr, NETMAP_REQ_OPT_OFFSETS);
2271a6d768d8SVincenzo Maffione 	if (opt == NULL)
2272a6d768d8SVincenzo Maffione 		return 0;
2273a6d768d8SVincenzo Maffione 
2274a6d768d8SVincenzo Maffione 	if (!(na->na_flags & NAF_OFFSETS)) {
2275a6d768d8SVincenzo Maffione 		if (netmap_verbose)
2276a6d768d8SVincenzo Maffione 			nm_prerr("%s does not support offsets",
2277a6d768d8SVincenzo Maffione 				na->name);
2278a6d768d8SVincenzo Maffione 		error = EOPNOTSUPP;
2279a6d768d8SVincenzo Maffione 		goto out;
2280a6d768d8SVincenzo Maffione 	}
2281a6d768d8SVincenzo Maffione 
2282a6d768d8SVincenzo Maffione 	/* check sanity of the opt values */
2283a6d768d8SVincenzo Maffione 	max_offset = opt->nro_max_offset;
2284a6d768d8SVincenzo Maffione 	min_gap = opt->nro_min_gap;
2285a6d768d8SVincenzo Maffione 	initial_offset = opt->nro_initial_offset;
2286a6d768d8SVincenzo Maffione 	bits = opt->nro_offset_bits;
2287a6d768d8SVincenzo Maffione 
2288a6d768d8SVincenzo Maffione 	if (bits > maxbits) {
2289a6d768d8SVincenzo Maffione 		if (netmap_verbose)
2290a6d768d8SVincenzo Maffione 			nm_prerr("bits: %llu too large (max %llu)",
2291a6d768d8SVincenzo Maffione 				(unsigned long long)bits,
2292a6d768d8SVincenzo Maffione 				(unsigned long long)maxbits);
2293a6d768d8SVincenzo Maffione 		error = EINVAL;
2294a6d768d8SVincenzo Maffione 		goto out;
2295a6d768d8SVincenzo Maffione 	}
2296a6d768d8SVincenzo Maffione 	/* we take bits == 0 as a request to use the entire field */
2297a6d768d8SVincenzo Maffione 	if (bits == 0 || bits == maxbits) {
2298a6d768d8SVincenzo Maffione 		/* shifting a type by sizeof(type) is undefined */
2299a6d768d8SVincenzo Maffione 		bits = maxbits;
2300a6d768d8SVincenzo Maffione 		mask = 0xffffffffffffffff;
2301a6d768d8SVincenzo Maffione 	} else {
2302a6d768d8SVincenzo Maffione 		mask = (1ULL << bits) - 1;
2303a6d768d8SVincenzo Maffione 	}
2304a6d768d8SVincenzo Maffione 	if (max_offset > NETMAP_BUF_SIZE(na)) {
2305a6d768d8SVincenzo Maffione 		if (netmap_verbose)
2306a6d768d8SVincenzo Maffione 			nm_prerr("max offset %llu > buf size %u",
2307a6d768d8SVincenzo Maffione 				(unsigned long long)max_offset, NETMAP_BUF_SIZE(na));
2308a6d768d8SVincenzo Maffione 		error = EINVAL;
2309a6d768d8SVincenzo Maffione 		goto out;
2310a6d768d8SVincenzo Maffione 	}
2311a6d768d8SVincenzo Maffione 	if ((max_offset & mask) != max_offset) {
2312a6d768d8SVincenzo Maffione 		if (netmap_verbose)
2313a6d768d8SVincenzo Maffione 			nm_prerr("max offset %llu to large for %llu bits",
2314a6d768d8SVincenzo Maffione 				(unsigned long long)max_offset,
2315a6d768d8SVincenzo Maffione 				(unsigned long long)bits);
2316a6d768d8SVincenzo Maffione 		error = EINVAL;
2317a6d768d8SVincenzo Maffione 		goto out;
2318a6d768d8SVincenzo Maffione 	}
2319a6d768d8SVincenzo Maffione 	if (initial_offset > max_offset) {
2320a6d768d8SVincenzo Maffione 		if (netmap_verbose)
2321a6d768d8SVincenzo Maffione 			nm_prerr("initial offset %llu > max offset %llu",
2322a6d768d8SVincenzo Maffione 				(unsigned long long)initial_offset,
2323a6d768d8SVincenzo Maffione 				(unsigned long long)max_offset);
2324a6d768d8SVincenzo Maffione 		error = EINVAL;
2325a6d768d8SVincenzo Maffione 		goto out;
2326a6d768d8SVincenzo Maffione 	}
2327a6d768d8SVincenzo Maffione 
2328a6d768d8SVincenzo Maffione 	/* initialize the kring and ring fields. */
2329a6d768d8SVincenzo Maffione 	foreach_selected_ring(priv, t, i, kring) {
2330a6d768d8SVincenzo Maffione 		struct netmap_kring *kring = NMR(na, t)[i];
2331a6d768d8SVincenzo Maffione 		struct netmap_ring *ring = kring->ring;
2332a6d768d8SVincenzo Maffione 		u_int j;
2333a6d768d8SVincenzo Maffione 
2334a6d768d8SVincenzo Maffione 		/* it the ring is already in use we check that the
2335a6d768d8SVincenzo Maffione 		 * new request is compatible with the existing one
2336a6d768d8SVincenzo Maffione 		 */
2337a6d768d8SVincenzo Maffione 		if (kring->offset_mask) {
2338a6d768d8SVincenzo Maffione 			if ((kring->offset_mask & mask) != mask ||
2339a6d768d8SVincenzo Maffione 			     kring->offset_max < max_offset) {
2340a6d768d8SVincenzo Maffione 				if (netmap_verbose)
2341a6d768d8SVincenzo Maffione 					nm_prinf("%s: cannot increase"
2342a6d768d8SVincenzo Maffione 						 "offset mask and/or max"
2343a6d768d8SVincenzo Maffione 						 "(current: mask=%llx,max=%llu",
2344a6d768d8SVincenzo Maffione 							kring->name,
2345a6d768d8SVincenzo Maffione 							(unsigned long long)kring->offset_mask,
2346a6d768d8SVincenzo Maffione 							(unsigned long long)kring->offset_max);
2347a6d768d8SVincenzo Maffione 				error = EBUSY;
2348a6d768d8SVincenzo Maffione 				goto out;
2349a6d768d8SVincenzo Maffione 			}
2350a6d768d8SVincenzo Maffione 			mask = kring->offset_mask;
2351a6d768d8SVincenzo Maffione 			max_offset = kring->offset_max;
2352a6d768d8SVincenzo Maffione 		} else {
2353a6d768d8SVincenzo Maffione 			kring->offset_mask = mask;
2354a6d768d8SVincenzo Maffione 			*(uint64_t *)(uintptr_t)&ring->offset_mask = mask;
2355a6d768d8SVincenzo Maffione 			kring->offset_max = max_offset;
2356a6d768d8SVincenzo Maffione 			kring->offset_gap = min_gap;
2357a6d768d8SVincenzo Maffione 		}
2358a6d768d8SVincenzo Maffione 
2359a6d768d8SVincenzo Maffione 		/* if there is an initial offset, put it into
2360a6d768d8SVincenzo Maffione 		 * all the slots
2361a6d768d8SVincenzo Maffione 		 *
2362a6d768d8SVincenzo Maffione 		 * Note: we cannot change the offsets if the
2363a6d768d8SVincenzo Maffione 		 * ring is already in use.
2364a6d768d8SVincenzo Maffione 		 */
2365a6d768d8SVincenzo Maffione 		if (!initial_offset || kring->users > 1)
2366a6d768d8SVincenzo Maffione 			continue;
2367a6d768d8SVincenzo Maffione 
2368a6d768d8SVincenzo Maffione 		for (j = 0; j < kring->nkr_num_slots; j++) {
2369a6d768d8SVincenzo Maffione 			struct netmap_slot *slot = ring->slot + j;
2370a6d768d8SVincenzo Maffione 
2371a6d768d8SVincenzo Maffione 			nm_write_offset(kring, slot, initial_offset);
2372a6d768d8SVincenzo Maffione 		}
2373a6d768d8SVincenzo Maffione 	}
2374a6d768d8SVincenzo Maffione 
2375a6d768d8SVincenzo Maffione out:
2376a6d768d8SVincenzo Maffione 	opt->nro_opt.nro_status = error;
2377a6d768d8SVincenzo Maffione 	if (!error) {
2378a6d768d8SVincenzo Maffione 		opt->nro_max_offset = max_offset;
2379a6d768d8SVincenzo Maffione 	}
2380a6d768d8SVincenzo Maffione 	return error;
2381a6d768d8SVincenzo Maffione 
2382a6d768d8SVincenzo Maffione }
2383a6d768d8SVincenzo Maffione 
2384*f4a54f43SVincenzo Maffione 
2385*f4a54f43SVincenzo Maffione /* set the hardware buffer length in each one of the newly opened rings
2386*f4a54f43SVincenzo Maffione  * (hwbuf_len field in the kring struct). The purpose it to select
2387*f4a54f43SVincenzo Maffione  * the maximum supported input buffer lenght that will not cause writes
2388*f4a54f43SVincenzo Maffione  * outside of the available space, even when offsets are in use.
2389*f4a54f43SVincenzo Maffione  */
2390a6d768d8SVincenzo Maffione static int
2391a6d768d8SVincenzo Maffione netmap_compute_buf_len(struct netmap_priv_d *priv)
2392a6d768d8SVincenzo Maffione {
2393a6d768d8SVincenzo Maffione 	enum txrx t;
2394a6d768d8SVincenzo Maffione 	u_int i;
2395a6d768d8SVincenzo Maffione 	struct netmap_kring *kring;
2396a6d768d8SVincenzo Maffione 	int error = 0;
2397a6d768d8SVincenzo Maffione 	unsigned mtu = 0;
2398a6d768d8SVincenzo Maffione 	struct netmap_adapter *na = priv->np_na;
2399*f4a54f43SVincenzo Maffione 	uint64_t target;
2400a6d768d8SVincenzo Maffione 
2401a6d768d8SVincenzo Maffione 	foreach_selected_ring(priv, t, i, kring) {
2402*f4a54f43SVincenzo Maffione 		/* rings that are already active have their hwbuf_len
2403*f4a54f43SVincenzo Maffione 		 * already set and we cannot change it.
2404*f4a54f43SVincenzo Maffione 		 */
2405a6d768d8SVincenzo Maffione 		if (kring->users > 1)
2406a6d768d8SVincenzo Maffione 			continue;
2407a6d768d8SVincenzo Maffione 
2408*f4a54f43SVincenzo Maffione 		/* For netmap buffers which are not shared among several ring
2409*f4a54f43SVincenzo Maffione 		 * slots (the normal case), the available space is the buf size
2410*f4a54f43SVincenzo Maffione 		 * minus the max offset declared by the user at open time.  If
2411*f4a54f43SVincenzo Maffione 		 * the user plans to have several slots pointing to different
2412*f4a54f43SVincenzo Maffione 		 * offsets into the same large buffer, she must also declare a
2413*f4a54f43SVincenzo Maffione 		 * "minimum gap" between two such consecutive offsets. In this
2414*f4a54f43SVincenzo Maffione 		 * case the user-declared 'offset_gap' is taken as the
2415*f4a54f43SVincenzo Maffione 		 * available space and offset_max is ignored.
2416*f4a54f43SVincenzo Maffione 		 */
2417*f4a54f43SVincenzo Maffione 
2418*f4a54f43SVincenzo Maffione 		/* start with the normal case (unshared buffers) */
2419a6d768d8SVincenzo Maffione 		target = NETMAP_BUF_SIZE(kring->na) -
2420a6d768d8SVincenzo Maffione 			kring->offset_max;
2421*f4a54f43SVincenzo Maffione 		/* if offset_gap is zero, the user does not intend to use
2422*f4a54f43SVincenzo Maffione 		 * shared buffers. In this case the minimum gap between
2423*f4a54f43SVincenzo Maffione 		 * two consective offsets into the same buffer can be
2424*f4a54f43SVincenzo Maffione 		 * assumed to be equal to the buffer size. In this way
2425*f4a54f43SVincenzo Maffione 		 * offset_gap always contains the available space ignoring
2426*f4a54f43SVincenzo Maffione 		 * offset_max. This may be used by drivers of NICs that
2427*f4a54f43SVincenzo Maffione 		 * are guaranteed to never write more than MTU bytes, even
2428*f4a54f43SVincenzo Maffione 		 * if the input buffer is larger: if the MTU is less
2429*f4a54f43SVincenzo Maffione 		 * than the target they can set hwbuf_len to offset_gap.
2430*f4a54f43SVincenzo Maffione 		 */
2431a6d768d8SVincenzo Maffione 		if (!kring->offset_gap)
2432a6d768d8SVincenzo Maffione 			kring->offset_gap =
2433a6d768d8SVincenzo Maffione 				NETMAP_BUF_SIZE(kring->na);
2434*f4a54f43SVincenzo Maffione 
2435a6d768d8SVincenzo Maffione 		if (kring->offset_gap < target)
2436a6d768d8SVincenzo Maffione 			target = kring->offset_gap;
2437a6d768d8SVincenzo Maffione 		error = kring->nm_bufcfg(kring, target);
2438a6d768d8SVincenzo Maffione 		if (error)
2439a6d768d8SVincenzo Maffione 			goto out;
2440a6d768d8SVincenzo Maffione 
2441a6d768d8SVincenzo Maffione 		*(uint64_t *)(uintptr_t)&kring->ring->buf_align = kring->buf_align;
2442a6d768d8SVincenzo Maffione 
2443a6d768d8SVincenzo Maffione 		if (mtu && t == NR_RX && kring->hwbuf_len < mtu) {
2444a6d768d8SVincenzo Maffione 			if (!(na->na_flags & NAF_MOREFRAG)) {
2445a6d768d8SVincenzo Maffione 				nm_prerr("error: large MTU (%d) needed "
2446a6d768d8SVincenzo Maffione 					 "but %s does not support "
2447a6d768d8SVincenzo Maffione 					 "NS_MOREFRAG", mtu,
2448a6d768d8SVincenzo Maffione 					 na->name);
2449a6d768d8SVincenzo Maffione 				error = EINVAL;
2450a6d768d8SVincenzo Maffione 				goto out;
2451a6d768d8SVincenzo Maffione 			} else {
2452a6d768d8SVincenzo Maffione 				nm_prinf("info: netmap application on "
2453a6d768d8SVincenzo Maffione 					 "%s needs to support "
2454a6d768d8SVincenzo Maffione 					 "NS_MOREFRAG "
2455a6d768d8SVincenzo Maffione 					 "(MTU=%u,buf_size=%llu)",
2456a6d768d8SVincenzo Maffione 					 kring->name, mtu,
2457a6d768d8SVincenzo Maffione 					 (unsigned long long)kring->hwbuf_len);
2458a6d768d8SVincenzo Maffione 			}
2459a6d768d8SVincenzo Maffione 		}
2460a6d768d8SVincenzo Maffione 	}
2461a6d768d8SVincenzo Maffione out:
2462a6d768d8SVincenzo Maffione 	return error;
2463a6d768d8SVincenzo Maffione }
246477a2baf5SVincenzo Maffione 
2465f18be576SLuigi Rizzo /*
2466f18be576SLuigi Rizzo  * possibly move the interface to netmap-mode.
2467f18be576SLuigi Rizzo  * If success it returns a pointer to netmap_if, otherwise NULL.
2468ce3ee1e7SLuigi Rizzo  * This must be called with NMG_LOCK held.
24694bf50f18SLuigi Rizzo  *
24704bf50f18SLuigi Rizzo  * The following na callbacks are called in the process:
24714bf50f18SLuigi Rizzo  *
24724bf50f18SLuigi Rizzo  * na->nm_config()			[by netmap_update_config]
24734bf50f18SLuigi Rizzo  * (get current number and size of rings)
24744bf50f18SLuigi Rizzo  *
24754bf50f18SLuigi Rizzo  *  	We have a generic one for linux (netmap_linux_config).
24764bf50f18SLuigi Rizzo  *  	The bwrap has to override this, since it has to forward
24774bf50f18SLuigi Rizzo  *  	the request to the wrapped adapter (netmap_bwrap_config).
24784bf50f18SLuigi Rizzo  *
24794bf50f18SLuigi Rizzo  *
2480847bf383SLuigi Rizzo  * na->nm_krings_create()
24814bf50f18SLuigi Rizzo  * (create and init the krings array)
24824bf50f18SLuigi Rizzo  *
24834bf50f18SLuigi Rizzo  * 	One of the following:
24844bf50f18SLuigi Rizzo  *
24854bf50f18SLuigi Rizzo  *	* netmap_hw_krings_create, 			(hw ports)
24864bf50f18SLuigi Rizzo  *		creates the standard layout for the krings
24874bf50f18SLuigi Rizzo  * 		and adds the mbq (used for the host rings).
24884bf50f18SLuigi Rizzo  *
24894bf50f18SLuigi Rizzo  * 	* netmap_vp_krings_create			(VALE ports)
24904bf50f18SLuigi Rizzo  * 		add leases and scratchpads
24914bf50f18SLuigi Rizzo  *
24924bf50f18SLuigi Rizzo  * 	* netmap_pipe_krings_create			(pipes)
24934bf50f18SLuigi Rizzo  * 		create the krings and rings of both ends and
24944bf50f18SLuigi Rizzo  * 		cross-link them
24954bf50f18SLuigi Rizzo  *
24964bf50f18SLuigi Rizzo  *      * netmap_monitor_krings_create 			(monitors)
24974bf50f18SLuigi Rizzo  *      	avoid allocating the mbq
24984bf50f18SLuigi Rizzo  *
24994bf50f18SLuigi Rizzo  *      * netmap_bwrap_krings_create			(bwraps)
25004bf50f18SLuigi Rizzo  *      	create both the brap krings array,
25014bf50f18SLuigi Rizzo  *      	the krings array of the wrapped adapter, and
25024bf50f18SLuigi Rizzo  *      	(if needed) the fake array for the host adapter
25034bf50f18SLuigi Rizzo  *
25044bf50f18SLuigi Rizzo  * na->nm_register(, 1)
25054bf50f18SLuigi Rizzo  * (put the adapter in netmap mode)
25064bf50f18SLuigi Rizzo  *
25074bf50f18SLuigi Rizzo  * 	This may be one of the following:
25084bf50f18SLuigi Rizzo  *
250937e3a6d3SLuigi Rizzo  * 	* netmap_hw_reg				        (hw ports)
25104bf50f18SLuigi Rizzo  * 		checks that the ifp is still there, then calls
25114bf50f18SLuigi Rizzo  * 		the hardware specific callback;
25124bf50f18SLuigi Rizzo  *
25134bf50f18SLuigi Rizzo  * 	* netmap_vp_reg					(VALE ports)
25144bf50f18SLuigi Rizzo  *		If the port is connected to a bridge,
25154bf50f18SLuigi Rizzo  *		set the NAF_NETMAP_ON flag under the
25164bf50f18SLuigi Rizzo  *		bridge write lock.
25174bf50f18SLuigi Rizzo  *
25184bf50f18SLuigi Rizzo  *	* netmap_pipe_reg				(pipes)
25194bf50f18SLuigi Rizzo  *		inform the other pipe end that it is no
2520453130d9SPedro F. Giffuni  *		longer responsible for the lifetime of this
25214bf50f18SLuigi Rizzo  *		pipe end
25224bf50f18SLuigi Rizzo  *
25234bf50f18SLuigi Rizzo  *	* netmap_monitor_reg				(monitors)
25244bf50f18SLuigi Rizzo  *		intercept the sync callbacks of the monitored
25254bf50f18SLuigi Rizzo  *		rings
25264bf50f18SLuigi Rizzo  *
252737e3a6d3SLuigi Rizzo  *	* netmap_bwrap_reg				(bwraps)
25284bf50f18SLuigi Rizzo  *		cross-link the bwrap and hwna rings,
25294bf50f18SLuigi Rizzo  *		forward the request to the hwna, override
25304bf50f18SLuigi Rizzo  *		the hwna notify callback (to get the frames
25314bf50f18SLuigi Rizzo  *		coming from outside go through the bridge).
25324bf50f18SLuigi Rizzo  *
25334bf50f18SLuigi Rizzo  *
2534f18be576SLuigi Rizzo  */
2535847bf383SLuigi Rizzo int
2536f9790aebSLuigi Rizzo netmap_do_regif(struct netmap_priv_d *priv, struct netmap_adapter *na,
2537ee0005f1SVincenzo Maffione 	struct nmreq_header *hdr)
2538f18be576SLuigi Rizzo {
2539f18be576SLuigi Rizzo 	struct netmap_if *nifp = NULL;
2540847bf383SLuigi Rizzo 	int error;
2541f18be576SLuigi Rizzo 
2542ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
2543f9790aebSLuigi Rizzo 	priv->np_na = na;     /* store the reference */
2544847bf383SLuigi Rizzo 	error = netmap_mem_finalize(na->nm_mem, na);
2545ce3ee1e7SLuigi Rizzo 	if (error)
2546847bf383SLuigi Rizzo 		goto err;
2547847bf383SLuigi Rizzo 
2548847bf383SLuigi Rizzo 	if (na->active_fds == 0) {
25492ff91c17SVincenzo Maffione 
25502ff91c17SVincenzo Maffione 		/* cache the allocator info in the na */
25512ff91c17SVincenzo Maffione 		error = netmap_mem_get_lut(na->nm_mem, &na->na_lut);
25522ff91c17SVincenzo Maffione 		if (error)
25532ff91c17SVincenzo Maffione 			goto err_drop_mem;
255475f4f3edSVincenzo Maffione 		nm_prdis("lut %p bufs %u size %u", na->na_lut.lut, na->na_lut.objtotal,
25552ff91c17SVincenzo Maffione 					    na->na_lut.objsize);
25562ff91c17SVincenzo Maffione 
25572ff91c17SVincenzo Maffione 		/* ring configuration may have changed, fetch from the card */
25582ff91c17SVincenzo Maffione 		netmap_update_config(na);
2559cfa866f6SMatt Macy 	}
25602ff91c17SVincenzo Maffione 
2561cfa866f6SMatt Macy 	/* compute the range of tx and rx rings to monitor */
2562ee0005f1SVincenzo Maffione 	error = netmap_set_ringid(priv, hdr);
2563cfa866f6SMatt Macy 	if (error)
2564cfa866f6SMatt Macy 		goto err_put_lut;
2565cfa866f6SMatt Macy 
2566cfa866f6SMatt Macy 	if (na->active_fds == 0) {
2567847bf383SLuigi Rizzo 		/*
2568847bf383SLuigi Rizzo 		 * If this is the first registration of the adapter,
25694f80b14cSVincenzo Maffione 		 * perform sanity checks and create the in-kernel view
25704f80b14cSVincenzo Maffione 		 * of the netmap rings (the netmap krings).
2571847bf383SLuigi Rizzo 		 */
25722ff91c17SVincenzo Maffione 		if (na->ifp && nm_priv_rx_enabled(priv)) {
25734f80b14cSVincenzo Maffione 			/* This netmap adapter is attached to an ifnet. */
25744f80b14cSVincenzo Maffione 			unsigned mtu = nm_os_ifnet_mtu(na->ifp);
25754f80b14cSVincenzo Maffione 
257675f4f3edSVincenzo Maffione 			nm_prdis("%s: mtu %d rx_buf_maxsize %d netmap_buf_size %d",
257777a2baf5SVincenzo Maffione 				na->name, mtu, na->rx_buf_maxsize, NETMAP_BUF_SIZE(na));
2578cfa866f6SMatt Macy 
2579cfa866f6SMatt Macy 			if (na->rx_buf_maxsize == 0) {
2580b6e66be2SVincenzo Maffione 				nm_prerr("%s: error: rx_buf_maxsize == 0", na->name);
2581cfa866f6SMatt Macy 				error = EIO;
2582cfa866f6SMatt Macy 				goto err_drop_mem;
2583cfa866f6SMatt Macy 			}
25842ff91c17SVincenzo Maffione 
258577a2baf5SVincenzo Maffione 			error = netmap_buf_size_validate(na, mtu);
258677a2baf5SVincenzo Maffione 			if (error)
25874f80b14cSVincenzo Maffione 				goto err_drop_mem;
25884f80b14cSVincenzo Maffione 		}
2589847bf383SLuigi Rizzo 
2590847bf383SLuigi Rizzo 		/*
2591847bf383SLuigi Rizzo 		 * Depending on the adapter, this may also create
2592847bf383SLuigi Rizzo 		 * the netmap rings themselves
2593847bf383SLuigi Rizzo 		 */
2594847bf383SLuigi Rizzo 		error = na->nm_krings_create(na);
2595847bf383SLuigi Rizzo 		if (error)
25962ff91c17SVincenzo Maffione 			goto err_put_lut;
2597847bf383SLuigi Rizzo 
2598ce3ee1e7SLuigi Rizzo 	}
2599847bf383SLuigi Rizzo 
260037e3a6d3SLuigi Rizzo 	/* now the krings must exist and we can check whether some
260137e3a6d3SLuigi Rizzo 	 * previous bind has exclusive ownership on them, and set
260237e3a6d3SLuigi Rizzo 	 * nr_pending_mode
2603847bf383SLuigi Rizzo 	 */
260437e3a6d3SLuigi Rizzo 	error = netmap_krings_get(priv);
2605847bf383SLuigi Rizzo 	if (error)
260637e3a6d3SLuigi Rizzo 		goto err_del_krings;
260737e3a6d3SLuigi Rizzo 
260837e3a6d3SLuigi Rizzo 	/* create all needed missing netmap rings */
260937e3a6d3SLuigi Rizzo 	error = netmap_mem_rings_create(na);
261037e3a6d3SLuigi Rizzo 	if (error)
261137e3a6d3SLuigi Rizzo 		goto err_rel_excl;
2612847bf383SLuigi Rizzo 
2613a6d768d8SVincenzo Maffione 	/* initialize offsets if requested */
2614a6d768d8SVincenzo Maffione 	error = netmap_offsets_init(priv, hdr);
2615a6d768d8SVincenzo Maffione 	if (error)
2616a6d768d8SVincenzo Maffione 		goto err_rel_excl;
2617a6d768d8SVincenzo Maffione 
261845c67e8fSVincenzo Maffione 	/* compute and validate the buf lengths */
2619a6d768d8SVincenzo Maffione 	error = netmap_compute_buf_len(priv);
2620a6d768d8SVincenzo Maffione 	if (error)
2621a6d768d8SVincenzo Maffione 		goto err_rel_excl;
2622a6d768d8SVincenzo Maffione 
2623847bf383SLuigi Rizzo 	/* in all cases, create a new netmap if */
2624c3e9b4dbSLuiz Otavio O Souza 	nifp = netmap_mem_if_new(na, priv);
2625847bf383SLuigi Rizzo 	if (nifp == NULL) {
2626f18be576SLuigi Rizzo 		error = ENOMEM;
2627cfa866f6SMatt Macy 		goto err_rel_excl;
2628ce3ee1e7SLuigi Rizzo 	}
2629847bf383SLuigi Rizzo 
263037e3a6d3SLuigi Rizzo 	if (nm_kring_pending(priv)) {
263137e3a6d3SLuigi Rizzo 		/* Some kring is switching mode, tell the adapter to
263237e3a6d3SLuigi Rizzo 		 * react on this. */
263337e3a6d3SLuigi Rizzo 		error = na->nm_register(na, 1);
263437e3a6d3SLuigi Rizzo 		if (error)
26352ff91c17SVincenzo Maffione 			goto err_del_if;
263637e3a6d3SLuigi Rizzo 	}
263737e3a6d3SLuigi Rizzo 
263837e3a6d3SLuigi Rizzo 	/* Commit the reference. */
263937e3a6d3SLuigi Rizzo 	na->active_fds++;
264037e3a6d3SLuigi Rizzo 
2641ce3ee1e7SLuigi Rizzo 	/*
2642847bf383SLuigi Rizzo 	 * advertise that the interface is ready by setting np_nifp.
2643847bf383SLuigi Rizzo 	 * The barrier is needed because readers (poll, *SYNC and mmap)
2644ce3ee1e7SLuigi Rizzo 	 * check for priv->np_nifp != NULL without locking
2645ce3ee1e7SLuigi Rizzo 	 */
2646847bf383SLuigi Rizzo 	mb(); /* make sure previous writes are visible to all CPUs */
2647ce3ee1e7SLuigi Rizzo 	priv->np_nifp = nifp;
2648847bf383SLuigi Rizzo 
2649847bf383SLuigi Rizzo 	return 0;
2650847bf383SLuigi Rizzo 
265137e3a6d3SLuigi Rizzo err_del_if:
2652847bf383SLuigi Rizzo 	netmap_mem_if_delete(na, nifp);
26534f80b14cSVincenzo Maffione err_rel_excl:
26544f80b14cSVincenzo Maffione 	netmap_krings_put(priv);
2655cfa866f6SMatt Macy 	netmap_mem_rings_delete(na);
2656847bf383SLuigi Rizzo err_del_krings:
2657847bf383SLuigi Rizzo 	if (na->active_fds == 0)
2658847bf383SLuigi Rizzo 		na->nm_krings_delete(na);
26592ff91c17SVincenzo Maffione err_put_lut:
26602ff91c17SVincenzo Maffione 	if (na->active_fds == 0)
26612ff91c17SVincenzo Maffione 		memset(&na->na_lut, 0, sizeof(na->na_lut));
2662847bf383SLuigi Rizzo err_drop_mem:
26634f80b14cSVincenzo Maffione 	netmap_mem_drop(na);
2664847bf383SLuigi Rizzo err:
2665847bf383SLuigi Rizzo 	priv->np_na = NULL;
2666847bf383SLuigi Rizzo 	return error;
2667ce3ee1e7SLuigi Rizzo }
2668847bf383SLuigi Rizzo 
2669847bf383SLuigi Rizzo 
2670847bf383SLuigi Rizzo /*
267137e3a6d3SLuigi Rizzo  * update kring and ring at the end of rxsync/txsync.
2672847bf383SLuigi Rizzo  */
2673847bf383SLuigi Rizzo static inline void
267437e3a6d3SLuigi Rizzo nm_sync_finalize(struct netmap_kring *kring)
2675847bf383SLuigi Rizzo {
267637e3a6d3SLuigi Rizzo 	/*
267737e3a6d3SLuigi Rizzo 	 * Update ring tail to what the kernel knows
267837e3a6d3SLuigi Rizzo 	 * After txsync: head/rhead/hwcur might be behind cur/rcur
267937e3a6d3SLuigi Rizzo 	 * if no carrier.
268037e3a6d3SLuigi Rizzo 	 */
2681847bf383SLuigi Rizzo 	kring->ring->tail = kring->rtail = kring->nr_hwtail;
2682847bf383SLuigi Rizzo 
268375f4f3edSVincenzo Maffione 	nm_prdis(5, "%s now hwcur %d hwtail %d head %d cur %d tail %d",
2684847bf383SLuigi Rizzo 		kring->name, kring->nr_hwcur, kring->nr_hwtail,
2685847bf383SLuigi Rizzo 		kring->rhead, kring->rcur, kring->rtail);
2686847bf383SLuigi Rizzo }
2687847bf383SLuigi Rizzo 
2688c3e9b4dbSLuiz Otavio O Souza /* set ring timestamp */
2689c3e9b4dbSLuiz Otavio O Souza static inline void
2690c3e9b4dbSLuiz Otavio O Souza ring_timestamp_set(struct netmap_ring *ring)
2691c3e9b4dbSLuiz Otavio O Souza {
2692c3e9b4dbSLuiz Otavio O Souza 	if (netmap_no_timestamp == 0 || ring->flags & NR_TIMESTAMP) {
2693c3e9b4dbSLuiz Otavio O Souza 		microtime(&ring->ts);
2694c3e9b4dbSLuiz Otavio O Souza 	}
2695c3e9b4dbSLuiz Otavio O Souza }
2696c3e9b4dbSLuiz Otavio O Souza 
26972ff91c17SVincenzo Maffione static int nmreq_copyin(struct nmreq_header *, int);
26982ff91c17SVincenzo Maffione static int nmreq_copyout(struct nmreq_header *, int);
26992ff91c17SVincenzo Maffione static int nmreq_checkoptions(struct nmreq_header *);
2700c3e9b4dbSLuiz Otavio O Souza 
270168b8534bSLuigi Rizzo /*
270268b8534bSLuigi Rizzo  * ioctl(2) support for the "netmap" device.
270368b8534bSLuigi Rizzo  *
270468b8534bSLuigi Rizzo  * Following a list of accepted commands:
27052ff91c17SVincenzo Maffione  * - NIOCCTRL		device control API
27062ff91c17SVincenzo Maffione  * - NIOCTXSYNC		sync TX rings
27072ff91c17SVincenzo Maffione  * - NIOCRXSYNC		sync RX rings
270868b8534bSLuigi Rizzo  * - SIOCGIFADDR	just for convenience
27092ff91c17SVincenzo Maffione  * - NIOCGINFO		deprecated (legacy API)
27102ff91c17SVincenzo Maffione  * - NIOCREGIF		deprecated (legacy API)
271168b8534bSLuigi Rizzo  *
271268b8534bSLuigi Rizzo  * Return 0 on success, errno otherwise.
271368b8534bSLuigi Rizzo  */
2714f9790aebSLuigi Rizzo int
27152ff91c17SVincenzo Maffione netmap_ioctl(struct netmap_priv_d *priv, u_long cmd, caddr_t data,
27162ff91c17SVincenzo Maffione 		struct thread *td, int nr_body_is_user)
271768b8534bSLuigi Rizzo {
2718c3e9b4dbSLuiz Otavio O Souza 	struct mbq q;	/* packets from RX hw queues to host stack */
2719ce3ee1e7SLuigi Rizzo 	struct netmap_adapter *na = NULL;
2720c3e9b4dbSLuiz Otavio O Souza 	struct netmap_mem_d *nmd = NULL;
272137e3a6d3SLuigi Rizzo 	struct ifnet *ifp = NULL;
272237e3a6d3SLuigi Rizzo 	int error = 0;
2723f0ea3689SLuigi Rizzo 	u_int i, qfirst, qlast;
27242ff91c17SVincenzo Maffione 	struct netmap_kring **krings;
2725c3e9b4dbSLuiz Otavio O Souza 	int sync_flags;
2726847bf383SLuigi Rizzo 	enum txrx t;
272768b8534bSLuigi Rizzo 
27282ff91c17SVincenzo Maffione 	switch (cmd) {
27292ff91c17SVincenzo Maffione 	case NIOCCTRL: {
27302ff91c17SVincenzo Maffione 		struct nmreq_header *hdr = (struct nmreq_header *)data;
27312ff91c17SVincenzo Maffione 
27322ff91c17SVincenzo Maffione 		if (hdr->nr_version < NETMAP_MIN_API ||
27332ff91c17SVincenzo Maffione 		    hdr->nr_version > NETMAP_MAX_API) {
2734b6e66be2SVincenzo Maffione 			nm_prerr("API mismatch: got %d need %d",
2735b6e66be2SVincenzo Maffione 				hdr->nr_version, NETMAP_API);
273617885a7bSLuigi Rizzo 			return EINVAL;
273717885a7bSLuigi Rizzo 		}
273868b8534bSLuigi Rizzo 
27392ff91c17SVincenzo Maffione 		/* Make a kernel-space copy of the user-space nr_body.
274045c67e8fSVincenzo Maffione 		 * For convenience, the nr_body pointer and the pointers
27412ff91c17SVincenzo Maffione 		 * in the options list will be replaced with their
27422ff91c17SVincenzo Maffione 		 * kernel-space counterparts. The original pointers are
27432ff91c17SVincenzo Maffione 		 * saved internally and later restored by nmreq_copyout
27442ff91c17SVincenzo Maffione 		 */
27452ff91c17SVincenzo Maffione 		error = nmreq_copyin(hdr, nr_body_is_user);
274637e3a6d3SLuigi Rizzo 		if (error) {
27472ff91c17SVincenzo Maffione 			return error;
2748ce3ee1e7SLuigi Rizzo 		}
2749ce3ee1e7SLuigi Rizzo 
27502ff91c17SVincenzo Maffione 		/* Sanitize hdr->nr_name. */
27512ff91c17SVincenzo Maffione 		hdr->nr_name[sizeof(hdr->nr_name) - 1] = '\0';
275268b8534bSLuigi Rizzo 
27532ff91c17SVincenzo Maffione 		switch (hdr->nr_reqtype) {
27542ff91c17SVincenzo Maffione 		case NETMAP_REQ_REGISTER: {
27552ff91c17SVincenzo Maffione 			struct nmreq_register *req =
2756cfa866f6SMatt Macy 				(struct nmreq_register *)(uintptr_t)hdr->nr_body;
2757b6e66be2SVincenzo Maffione 			struct netmap_if *nifp;
2758b6e66be2SVincenzo Maffione 
27592ff91c17SVincenzo Maffione 			/* Protect access to priv from concurrent requests. */
2760ce3ee1e7SLuigi Rizzo 			NMG_LOCK();
2761ce3ee1e7SLuigi Rizzo 			do {
27622ff91c17SVincenzo Maffione 				struct nmreq_option *opt;
2763b6e66be2SVincenzo Maffione 				u_int memflags;
2764ce3ee1e7SLuigi Rizzo 
2765847bf383SLuigi Rizzo 				if (priv->np_nifp != NULL) {	/* thread already registered */
2766f0ea3689SLuigi Rizzo 					error = EBUSY;
2767506cc70cSLuigi Rizzo 					break;
2768506cc70cSLuigi Rizzo 				}
2769c3e9b4dbSLuiz Otavio O Souza 
27702ff91c17SVincenzo Maffione #ifdef WITH_EXTMEM
2771253b2ec1SVincenzo Maffione 				opt = nmreq_getoption(hdr, NETMAP_REQ_OPT_EXTMEM);
27722ff91c17SVincenzo Maffione 				if (opt != NULL) {
27732ff91c17SVincenzo Maffione 					struct nmreq_opt_extmem *e =
27742ff91c17SVincenzo Maffione 						(struct nmreq_opt_extmem *)opt;
27752ff91c17SVincenzo Maffione 
27762ff91c17SVincenzo Maffione 					nmd = netmap_mem_ext_create(e->nro_usrptr,
27772ff91c17SVincenzo Maffione 							&e->nro_info, &error);
27782ff91c17SVincenzo Maffione 					opt->nro_status = error;
27792ff91c17SVincenzo Maffione 					if (nmd == NULL)
27802ff91c17SVincenzo Maffione 						break;
27812ff91c17SVincenzo Maffione 				}
27822ff91c17SVincenzo Maffione #endif /* WITH_EXTMEM */
27832ff91c17SVincenzo Maffione 
27842ff91c17SVincenzo Maffione 				if (nmd == NULL && req->nr_mem_id) {
2785c3e9b4dbSLuiz Otavio O Souza 					/* find the allocator and get a reference */
27862ff91c17SVincenzo Maffione 					nmd = netmap_mem_find(req->nr_mem_id);
2787c3e9b4dbSLuiz Otavio O Souza 					if (nmd == NULL) {
2788b6e66be2SVincenzo Maffione 						if (netmap_verbose) {
2789b6e66be2SVincenzo Maffione 							nm_prerr("%s: failed to find mem_id %u",
2790b6e66be2SVincenzo Maffione 									hdr->nr_name, req->nr_mem_id);
2791b6e66be2SVincenzo Maffione 						}
2792c3e9b4dbSLuiz Otavio O Souza 						error = EINVAL;
2793c3e9b4dbSLuiz Otavio O Souza 						break;
2794c3e9b4dbSLuiz Otavio O Souza 					}
2795c3e9b4dbSLuiz Otavio O Souza 				}
279668b8534bSLuigi Rizzo 				/* find the interface and a reference */
27972ff91c17SVincenzo Maffione 				error = netmap_get_na(hdr, &na, &ifp, nmd,
279837e3a6d3SLuigi Rizzo 						      1 /* create */); /* keep reference */
279968b8534bSLuigi Rizzo 				if (error)
2800ce3ee1e7SLuigi Rizzo 					break;
2801f9790aebSLuigi Rizzo 				if (NETMAP_OWNED_BY_KERN(na)) {
2802ce3ee1e7SLuigi Rizzo 					error = EBUSY;
2803ce3ee1e7SLuigi Rizzo 					break;
2804f196ce38SLuigi Rizzo 				}
280537e3a6d3SLuigi Rizzo 
28062ff91c17SVincenzo Maffione 				if (na->virt_hdr_len && !(req->nr_flags & NR_ACCEPT_VNET_HDR)) {
2807b6e66be2SVincenzo Maffione 					nm_prerr("virt_hdr_len=%d, but application does "
2808b6e66be2SVincenzo Maffione 						"not accept it", na->virt_hdr_len);
280937e3a6d3SLuigi Rizzo 					error = EIO;
281037e3a6d3SLuigi Rizzo 					break;
281137e3a6d3SLuigi Rizzo 				}
281237e3a6d3SLuigi Rizzo 
2813ee0005f1SVincenzo Maffione 				error = netmap_do_regif(priv, na, hdr);
2814847bf383SLuigi Rizzo 				if (error) {    /* reg. failed, release priv and ref */
2815ce3ee1e7SLuigi Rizzo 					break;
281668b8534bSLuigi Rizzo 				}
2817b6e66be2SVincenzo Maffione 
2818253b2ec1SVincenzo Maffione 				opt = nmreq_getoption(hdr, NETMAP_REQ_OPT_CSB);
2819b6e66be2SVincenzo Maffione 				if (opt != NULL) {
2820b6e66be2SVincenzo Maffione 					struct nmreq_opt_csb *csbo =
2821b6e66be2SVincenzo Maffione 						(struct nmreq_opt_csb *)opt;
2822b6e66be2SVincenzo Maffione 					error = netmap_csb_validate(priv, csbo);
2823b6e66be2SVincenzo Maffione 					opt->nro_status = error;
2824b6e66be2SVincenzo Maffione 					if (error) {
2825b6e66be2SVincenzo Maffione 						netmap_do_unregif(priv);
2826b6e66be2SVincenzo Maffione 						break;
2827b6e66be2SVincenzo Maffione 					}
2828b6e66be2SVincenzo Maffione 				}
2829b6e66be2SVincenzo Maffione 
2830847bf383SLuigi Rizzo 				nifp = priv->np_nifp;
283168b8534bSLuigi Rizzo 
283268b8534bSLuigi Rizzo 				/* return the offset of the netmap_if object */
28332ff91c17SVincenzo Maffione 				req->nr_rx_rings = na->num_rx_rings;
28342ff91c17SVincenzo Maffione 				req->nr_tx_rings = na->num_tx_rings;
28352ff91c17SVincenzo Maffione 				req->nr_rx_slots = na->num_rx_desc;
28362ff91c17SVincenzo Maffione 				req->nr_tx_slots = na->num_tx_desc;
2837d12354a5SVincenzo Maffione 				req->nr_host_tx_rings = na->num_host_tx_rings;
2838d12354a5SVincenzo Maffione 				req->nr_host_rx_rings = na->num_host_rx_rings;
28392ff91c17SVincenzo Maffione 				error = netmap_mem_get_info(na->nm_mem, &req->nr_memsize, &memflags,
28402ff91c17SVincenzo Maffione 					&req->nr_mem_id);
2841ce3ee1e7SLuigi Rizzo 				if (error) {
2842847bf383SLuigi Rizzo 					netmap_do_unregif(priv);
2843ce3ee1e7SLuigi Rizzo 					break;
2844ce3ee1e7SLuigi Rizzo 				}
2845ce3ee1e7SLuigi Rizzo 				if (memflags & NETMAP_MEM_PRIVATE) {
28463d819cb6SLuigi Rizzo 					*(uint32_t *)(uintptr_t)&nifp->ni_flags |= NI_PRIV_MEM;
2847ce3ee1e7SLuigi Rizzo 				}
2848847bf383SLuigi Rizzo 				for_rx_tx(t) {
2849847bf383SLuigi Rizzo 					priv->np_si[t] = nm_si_user(priv, t) ?
28502ff91c17SVincenzo Maffione 						&na->si[t] : &NMR(na, t)[priv->np_qfirst[t]]->si;
2851847bf383SLuigi Rizzo 				}
2852f0ea3689SLuigi Rizzo 
28532ff91c17SVincenzo Maffione 				if (req->nr_extra_bufs) {
285437e3a6d3SLuigi Rizzo 					if (netmap_verbose)
2855b6e66be2SVincenzo Maffione 						nm_prinf("requested %d extra buffers",
28562ff91c17SVincenzo Maffione 							req->nr_extra_bufs);
28572ff91c17SVincenzo Maffione 					req->nr_extra_bufs = netmap_extra_alloc(na,
28582ff91c17SVincenzo Maffione 						&nifp->ni_bufs_head, req->nr_extra_bufs);
285937e3a6d3SLuigi Rizzo 					if (netmap_verbose)
2860b6e66be2SVincenzo Maffione 						nm_prinf("got %d extra buffers", req->nr_extra_bufs);
2861f0ea3689SLuigi Rizzo 				}
28622ff91c17SVincenzo Maffione 				req->nr_offset = netmap_mem_if_offset(na->nm_mem, nifp);
28632ff91c17SVincenzo Maffione 
28642ff91c17SVincenzo Maffione 				error = nmreq_checkoptions(hdr);
28652ff91c17SVincenzo Maffione 				if (error) {
28662ff91c17SVincenzo Maffione 					netmap_do_unregif(priv);
28672ff91c17SVincenzo Maffione 					break;
28682ff91c17SVincenzo Maffione 				}
286937e3a6d3SLuigi Rizzo 
287037e3a6d3SLuigi Rizzo 				/* store ifp reference so that priv destructor may release it */
287137e3a6d3SLuigi Rizzo 				priv->np_ifp = ifp;
2872ce3ee1e7SLuigi Rizzo 			} while (0);
2873c3e9b4dbSLuiz Otavio O Souza 			if (error) {
2874c3e9b4dbSLuiz Otavio O Souza 				netmap_unget_na(na, ifp);
2875c3e9b4dbSLuiz Otavio O Souza 			}
2876c3e9b4dbSLuiz Otavio O Souza 			/* release the reference from netmap_mem_find() or
2877c3e9b4dbSLuiz Otavio O Souza 			 * netmap_mem_ext_create()
2878c3e9b4dbSLuiz Otavio O Souza 			 */
2879c3e9b4dbSLuiz Otavio O Souza 			if (nmd)
2880c3e9b4dbSLuiz Otavio O Souza 				netmap_mem_put(nmd);
2881ce3ee1e7SLuigi Rizzo 			NMG_UNLOCK();
288268b8534bSLuigi Rizzo 			break;
28832ff91c17SVincenzo Maffione 		}
28842ff91c17SVincenzo Maffione 
28852ff91c17SVincenzo Maffione 		case NETMAP_REQ_PORT_INFO_GET: {
28862ff91c17SVincenzo Maffione 			struct nmreq_port_info_get *req =
2887cfa866f6SMatt Macy 				(struct nmreq_port_info_get *)(uintptr_t)hdr->nr_body;
28880ab5902eSVincenzo Maffione 			int nmd_ref = 0;
28892ff91c17SVincenzo Maffione 
28902ff91c17SVincenzo Maffione 			NMG_LOCK();
28912ff91c17SVincenzo Maffione 			do {
28922ff91c17SVincenzo Maffione 				u_int memflags;
28932ff91c17SVincenzo Maffione 
28942ff91c17SVincenzo Maffione 				if (hdr->nr_name[0] != '\0') {
28952ff91c17SVincenzo Maffione 					/* Build a nmreq_register out of the nmreq_port_info_get,
28962ff91c17SVincenzo Maffione 					 * so that we can call netmap_get_na(). */
28972ff91c17SVincenzo Maffione 					struct nmreq_register regreq;
28982ff91c17SVincenzo Maffione 					bzero(&regreq, sizeof(regreq));
2899b6e66be2SVincenzo Maffione 					regreq.nr_mode = NR_REG_ALL_NIC;
29002ff91c17SVincenzo Maffione 					regreq.nr_tx_slots = req->nr_tx_slots;
29012ff91c17SVincenzo Maffione 					regreq.nr_rx_slots = req->nr_rx_slots;
29022ff91c17SVincenzo Maffione 					regreq.nr_tx_rings = req->nr_tx_rings;
29032ff91c17SVincenzo Maffione 					regreq.nr_rx_rings = req->nr_rx_rings;
2904d12354a5SVincenzo Maffione 					regreq.nr_host_tx_rings = req->nr_host_tx_rings;
2905d12354a5SVincenzo Maffione 					regreq.nr_host_rx_rings = req->nr_host_rx_rings;
29062ff91c17SVincenzo Maffione 					regreq.nr_mem_id = req->nr_mem_id;
29072ff91c17SVincenzo Maffione 
29082ff91c17SVincenzo Maffione 					/* get a refcount */
29092ff91c17SVincenzo Maffione 					hdr->nr_reqtype = NETMAP_REQ_REGISTER;
2910cfa866f6SMatt Macy 					hdr->nr_body = (uintptr_t)&regreq;
29112ff91c17SVincenzo Maffione 					error = netmap_get_na(hdr, &na, &ifp, NULL, 1 /* create */);
29122ff91c17SVincenzo Maffione 					hdr->nr_reqtype = NETMAP_REQ_PORT_INFO_GET; /* reset type */
2913cfa866f6SMatt Macy 					hdr->nr_body = (uintptr_t)req; /* reset nr_body */
29142ff91c17SVincenzo Maffione 					if (error) {
29152ff91c17SVincenzo Maffione 						na = NULL;
29162ff91c17SVincenzo Maffione 						ifp = NULL;
29172ff91c17SVincenzo Maffione 						break;
29182ff91c17SVincenzo Maffione 					}
29192ff91c17SVincenzo Maffione 					nmd = na->nm_mem; /* get memory allocator */
29202ff91c17SVincenzo Maffione 				} else {
29212ff91c17SVincenzo Maffione 					nmd = netmap_mem_find(req->nr_mem_id ? req->nr_mem_id : 1);
29222ff91c17SVincenzo Maffione 					if (nmd == NULL) {
2923b6e66be2SVincenzo Maffione 						if (netmap_verbose)
2924b6e66be2SVincenzo Maffione 							nm_prerr("%s: failed to find mem_id %u",
2925b6e66be2SVincenzo Maffione 									hdr->nr_name,
2926b6e66be2SVincenzo Maffione 									req->nr_mem_id ? req->nr_mem_id : 1);
29272ff91c17SVincenzo Maffione 						error = EINVAL;
29282ff91c17SVincenzo Maffione 						break;
29292ff91c17SVincenzo Maffione 					}
29300ab5902eSVincenzo Maffione 					nmd_ref = 1;
29312ff91c17SVincenzo Maffione 				}
29322ff91c17SVincenzo Maffione 
29332ff91c17SVincenzo Maffione 				error = netmap_mem_get_info(nmd, &req->nr_memsize, &memflags,
29342ff91c17SVincenzo Maffione 					&req->nr_mem_id);
29352ff91c17SVincenzo Maffione 				if (error)
29362ff91c17SVincenzo Maffione 					break;
29372ff91c17SVincenzo Maffione 				if (na == NULL) /* only memory info */
29382ff91c17SVincenzo Maffione 					break;
29392ff91c17SVincenzo Maffione 				netmap_update_config(na);
29402ff91c17SVincenzo Maffione 				req->nr_rx_rings = na->num_rx_rings;
29412ff91c17SVincenzo Maffione 				req->nr_tx_rings = na->num_tx_rings;
29422ff91c17SVincenzo Maffione 				req->nr_rx_slots = na->num_rx_desc;
29432ff91c17SVincenzo Maffione 				req->nr_tx_slots = na->num_tx_desc;
2944d12354a5SVincenzo Maffione 				req->nr_host_tx_rings = na->num_host_tx_rings;
2945d12354a5SVincenzo Maffione 				req->nr_host_rx_rings = na->num_host_rx_rings;
29462ff91c17SVincenzo Maffione 			} while (0);
29472ff91c17SVincenzo Maffione 			netmap_unget_na(na, ifp);
29480ab5902eSVincenzo Maffione 			if (nmd_ref)
29490ab5902eSVincenzo Maffione 				netmap_mem_put(nmd);
29502ff91c17SVincenzo Maffione 			NMG_UNLOCK();
29512ff91c17SVincenzo Maffione 			break;
29522ff91c17SVincenzo Maffione 		}
29532ff91c17SVincenzo Maffione #ifdef WITH_VALE
29542ff91c17SVincenzo Maffione 		case NETMAP_REQ_VALE_ATTACH: {
2955a6d768d8SVincenzo Maffione 			error = netmap_bdg_attach(hdr, NULL /* userspace request */);
29562ff91c17SVincenzo Maffione 			break;
29572ff91c17SVincenzo Maffione 		}
29582ff91c17SVincenzo Maffione 
29592ff91c17SVincenzo Maffione 		case NETMAP_REQ_VALE_DETACH: {
2960a6d768d8SVincenzo Maffione 			error = netmap_bdg_detach(hdr, NULL /* userspace request */);
29612ff91c17SVincenzo Maffione 			break;
29622ff91c17SVincenzo Maffione 		}
29632ff91c17SVincenzo Maffione 
29642ff91c17SVincenzo Maffione 		case NETMAP_REQ_PORT_HDR_SET: {
29652ff91c17SVincenzo Maffione 			struct nmreq_port_hdr *req =
2966cfa866f6SMatt Macy 				(struct nmreq_port_hdr *)(uintptr_t)hdr->nr_body;
29672ff91c17SVincenzo Maffione 			/* Build a nmreq_register out of the nmreq_port_hdr,
29682ff91c17SVincenzo Maffione 			 * so that we can call netmap_get_bdg_na(). */
29692ff91c17SVincenzo Maffione 			struct nmreq_register regreq;
29702ff91c17SVincenzo Maffione 			bzero(&regreq, sizeof(regreq));
2971b6e66be2SVincenzo Maffione 			regreq.nr_mode = NR_REG_ALL_NIC;
2972b6e66be2SVincenzo Maffione 
29732ff91c17SVincenzo Maffione 			/* For now we only support virtio-net headers, and only for
29742ff91c17SVincenzo Maffione 			 * VALE ports, but this may change in future. Valid lengths
29752ff91c17SVincenzo Maffione 			 * for the virtio-net header are 0 (no header), 10 and 12. */
29762ff91c17SVincenzo Maffione 			if (req->nr_hdr_len != 0 &&
29772ff91c17SVincenzo Maffione 				req->nr_hdr_len != sizeof(struct nm_vnet_hdr) &&
29782ff91c17SVincenzo Maffione 					req->nr_hdr_len != 12) {
2979b6e66be2SVincenzo Maffione 				if (netmap_verbose)
2980b6e66be2SVincenzo Maffione 					nm_prerr("invalid hdr_len %u", req->nr_hdr_len);
29812ff91c17SVincenzo Maffione 				error = EINVAL;
29822ff91c17SVincenzo Maffione 				break;
29832ff91c17SVincenzo Maffione 			}
29842ff91c17SVincenzo Maffione 			NMG_LOCK();
29852ff91c17SVincenzo Maffione 			hdr->nr_reqtype = NETMAP_REQ_REGISTER;
2986cfa866f6SMatt Macy 			hdr->nr_body = (uintptr_t)&regreq;
29872a7db7a6SVincenzo Maffione 			error = netmap_get_vale_na(hdr, &na, NULL, 0);
29882ff91c17SVincenzo Maffione 			hdr->nr_reqtype = NETMAP_REQ_PORT_HDR_SET;
2989cfa866f6SMatt Macy 			hdr->nr_body = (uintptr_t)req;
29902ff91c17SVincenzo Maffione 			if (na && !error) {
29912ff91c17SVincenzo Maffione 				struct netmap_vp_adapter *vpna =
29922ff91c17SVincenzo Maffione 					(struct netmap_vp_adapter *)na;
29932ff91c17SVincenzo Maffione 				na->virt_hdr_len = req->nr_hdr_len;
29942ff91c17SVincenzo Maffione 				if (na->virt_hdr_len) {
29952ff91c17SVincenzo Maffione 					vpna->mfs = NETMAP_BUF_SIZE(na);
29962ff91c17SVincenzo Maffione 				}
2997b6e66be2SVincenzo Maffione 				if (netmap_verbose)
2998b6e66be2SVincenzo Maffione 					nm_prinf("Using vnet_hdr_len %d for %p", na->virt_hdr_len, na);
29992ff91c17SVincenzo Maffione 				netmap_adapter_put(na);
30002ff91c17SVincenzo Maffione 			} else if (!na) {
30012ff91c17SVincenzo Maffione 				error = ENXIO;
30022ff91c17SVincenzo Maffione 			}
30032ff91c17SVincenzo Maffione 			NMG_UNLOCK();
30042ff91c17SVincenzo Maffione 			break;
30052ff91c17SVincenzo Maffione 		}
30062ff91c17SVincenzo Maffione 
30072ff91c17SVincenzo Maffione 		case NETMAP_REQ_PORT_HDR_GET: {
30082ff91c17SVincenzo Maffione 			/* Get vnet-header length for this netmap port */
30092ff91c17SVincenzo Maffione 			struct nmreq_port_hdr *req =
3010cfa866f6SMatt Macy 				(struct nmreq_port_hdr *)(uintptr_t)hdr->nr_body;
30112ff91c17SVincenzo Maffione 			/* Build a nmreq_register out of the nmreq_port_hdr,
30122ff91c17SVincenzo Maffione 			 * so that we can call netmap_get_bdg_na(). */
30132ff91c17SVincenzo Maffione 			struct nmreq_register regreq;
30142ff91c17SVincenzo Maffione 			struct ifnet *ifp;
30152ff91c17SVincenzo Maffione 
30162ff91c17SVincenzo Maffione 			bzero(&regreq, sizeof(regreq));
3017b6e66be2SVincenzo Maffione 			regreq.nr_mode = NR_REG_ALL_NIC;
30182ff91c17SVincenzo Maffione 			NMG_LOCK();
30192ff91c17SVincenzo Maffione 			hdr->nr_reqtype = NETMAP_REQ_REGISTER;
3020cfa866f6SMatt Macy 			hdr->nr_body = (uintptr_t)&regreq;
30212ff91c17SVincenzo Maffione 			error = netmap_get_na(hdr, &na, &ifp, NULL, 0);
30222ff91c17SVincenzo Maffione 			hdr->nr_reqtype = NETMAP_REQ_PORT_HDR_GET;
3023cfa866f6SMatt Macy 			hdr->nr_body = (uintptr_t)req;
30242ff91c17SVincenzo Maffione 			if (na && !error) {
30252ff91c17SVincenzo Maffione 				req->nr_hdr_len = na->virt_hdr_len;
30262ff91c17SVincenzo Maffione 			}
30272ff91c17SVincenzo Maffione 			netmap_unget_na(na, ifp);
30282ff91c17SVincenzo Maffione 			NMG_UNLOCK();
30292ff91c17SVincenzo Maffione 			break;
30302ff91c17SVincenzo Maffione 		}
30312ff91c17SVincenzo Maffione 
3032a6d768d8SVincenzo Maffione 		case NETMAP_REQ_VALE_LIST: {
3033a6d768d8SVincenzo Maffione 			error = netmap_vale_list(hdr);
3034a6d768d8SVincenzo Maffione 			break;
3035a6d768d8SVincenzo Maffione 		}
3036a6d768d8SVincenzo Maffione 
30372ff91c17SVincenzo Maffione 		case NETMAP_REQ_VALE_NEWIF: {
30382ff91c17SVincenzo Maffione 			error = nm_vi_create(hdr);
30392ff91c17SVincenzo Maffione 			break;
30402ff91c17SVincenzo Maffione 		}
30412ff91c17SVincenzo Maffione 
30422ff91c17SVincenzo Maffione 		case NETMAP_REQ_VALE_DELIF: {
30432ff91c17SVincenzo Maffione 			error = nm_vi_destroy(hdr->nr_name);
30442ff91c17SVincenzo Maffione 			break;
30452ff91c17SVincenzo Maffione 		}
3046a6d768d8SVincenzo Maffione #endif  /* WITH_VALE */
30472ff91c17SVincenzo Maffione 
30482ff91c17SVincenzo Maffione 		case NETMAP_REQ_VALE_POLLING_ENABLE:
30492ff91c17SVincenzo Maffione 		case NETMAP_REQ_VALE_POLLING_DISABLE: {
30502ff91c17SVincenzo Maffione 			error = nm_bdg_polling(hdr);
30512ff91c17SVincenzo Maffione 			break;
30522ff91c17SVincenzo Maffione 		}
30532ff91c17SVincenzo Maffione 		case NETMAP_REQ_POOLS_INFO_GET: {
3054b6e66be2SVincenzo Maffione 			/* Get information from the memory allocator used for
3055b6e66be2SVincenzo Maffione 			 * hdr->nr_name. */
30562ff91c17SVincenzo Maffione 			struct nmreq_pools_info *req =
3057cfa866f6SMatt Macy 				(struct nmreq_pools_info *)(uintptr_t)hdr->nr_body;
30582ff91c17SVincenzo Maffione 			NMG_LOCK();
3059b6e66be2SVincenzo Maffione 			do {
3060b6e66be2SVincenzo Maffione 				/* Build a nmreq_register out of the nmreq_pools_info,
3061b6e66be2SVincenzo Maffione 				 * so that we can call netmap_get_na(). */
3062b6e66be2SVincenzo Maffione 				struct nmreq_register regreq;
3063b6e66be2SVincenzo Maffione 				bzero(&regreq, sizeof(regreq));
3064b6e66be2SVincenzo Maffione 				regreq.nr_mem_id = req->nr_mem_id;
3065b6e66be2SVincenzo Maffione 				regreq.nr_mode = NR_REG_ALL_NIC;
3066b6e66be2SVincenzo Maffione 
3067b6e66be2SVincenzo Maffione 				hdr->nr_reqtype = NETMAP_REQ_REGISTER;
3068b6e66be2SVincenzo Maffione 				hdr->nr_body = (uintptr_t)&regreq;
3069b6e66be2SVincenzo Maffione 				error = netmap_get_na(hdr, &na, &ifp, NULL, 1 /* create */);
3070b6e66be2SVincenzo Maffione 				hdr->nr_reqtype = NETMAP_REQ_POOLS_INFO_GET; /* reset type */
3071b6e66be2SVincenzo Maffione 				hdr->nr_body = (uintptr_t)req; /* reset nr_body */
3072b6e66be2SVincenzo Maffione 				if (error) {
3073b6e66be2SVincenzo Maffione 					na = NULL;
3074b6e66be2SVincenzo Maffione 					ifp = NULL;
3075b6e66be2SVincenzo Maffione 					break;
30762ff91c17SVincenzo Maffione 				}
3077b6e66be2SVincenzo Maffione 				nmd = na->nm_mem; /* grab the memory allocator */
3078b6e66be2SVincenzo Maffione 				if (nmd == NULL) {
3079b6e66be2SVincenzo Maffione 					error = EINVAL;
3080b6e66be2SVincenzo Maffione 					break;
3081b6e66be2SVincenzo Maffione 				}
3082b6e66be2SVincenzo Maffione 
3083b6e66be2SVincenzo Maffione 				/* Finalize the memory allocator, get the pools
3084b6e66be2SVincenzo Maffione 				 * information and release the allocator. */
3085b6e66be2SVincenzo Maffione 				error = netmap_mem_finalize(nmd, na);
3086b6e66be2SVincenzo Maffione 				if (error) {
3087b6e66be2SVincenzo Maffione 					break;
3088b6e66be2SVincenzo Maffione 				}
3089b6e66be2SVincenzo Maffione 				error = netmap_mem_pools_info_get(req, nmd);
3090b6e66be2SVincenzo Maffione 				netmap_mem_drop(na);
3091b6e66be2SVincenzo Maffione 			} while (0);
3092b6e66be2SVincenzo Maffione 			netmap_unget_na(na, ifp);
30932ff91c17SVincenzo Maffione 			NMG_UNLOCK();
30942ff91c17SVincenzo Maffione 			break;
30952ff91c17SVincenzo Maffione 		}
30962ff91c17SVincenzo Maffione 
3097b6e66be2SVincenzo Maffione 		case NETMAP_REQ_CSB_ENABLE: {
3098b6e66be2SVincenzo Maffione 			struct nmreq_option *opt;
3099b6e66be2SVincenzo Maffione 
3100253b2ec1SVincenzo Maffione 			opt = nmreq_getoption(hdr, NETMAP_REQ_OPT_CSB);
3101b6e66be2SVincenzo Maffione 			if (opt == NULL) {
3102b6e66be2SVincenzo Maffione 				error = EINVAL;
3103b6e66be2SVincenzo Maffione 			} else {
3104b6e66be2SVincenzo Maffione 				struct nmreq_opt_csb *csbo =
3105b6e66be2SVincenzo Maffione 					(struct nmreq_opt_csb *)opt;
3106b6e66be2SVincenzo Maffione 				NMG_LOCK();
3107b6e66be2SVincenzo Maffione 				error = netmap_csb_validate(priv, csbo);
3108b6e66be2SVincenzo Maffione 				NMG_UNLOCK();
3109b6e66be2SVincenzo Maffione 				opt->nro_status = error;
3110b6e66be2SVincenzo Maffione 			}
3111b6e66be2SVincenzo Maffione 			break;
3112b6e66be2SVincenzo Maffione 		}
3113b6e66be2SVincenzo Maffione 
3114b6e66be2SVincenzo Maffione 		case NETMAP_REQ_SYNC_KLOOP_START: {
3115b6e66be2SVincenzo Maffione 			error = netmap_sync_kloop(priv, hdr);
3116b6e66be2SVincenzo Maffione 			break;
3117b6e66be2SVincenzo Maffione 		}
3118b6e66be2SVincenzo Maffione 
3119b6e66be2SVincenzo Maffione 		case NETMAP_REQ_SYNC_KLOOP_STOP: {
3120b6e66be2SVincenzo Maffione 			error = netmap_sync_kloop_stop(priv);
3121b6e66be2SVincenzo Maffione 			break;
3122b6e66be2SVincenzo Maffione 		}
3123b6e66be2SVincenzo Maffione 
31242ff91c17SVincenzo Maffione 		default: {
31252ff91c17SVincenzo Maffione 			error = EINVAL;
31262ff91c17SVincenzo Maffione 			break;
31272ff91c17SVincenzo Maffione 		}
31282ff91c17SVincenzo Maffione 		}
31292ff91c17SVincenzo Maffione 		/* Write back request body to userspace and reset the
31302ff91c17SVincenzo Maffione 		 * user-space pointer. */
31312ff91c17SVincenzo Maffione 		error = nmreq_copyout(hdr, error);
31322ff91c17SVincenzo Maffione 		break;
31332ff91c17SVincenzo Maffione 	}
313468b8534bSLuigi Rizzo 
313568b8534bSLuigi Rizzo 	case NIOCTXSYNC:
31362ff91c17SVincenzo Maffione 	case NIOCRXSYNC: {
3137b6e66be2SVincenzo Maffione 		if (unlikely(priv->np_nifp == NULL)) {
3138506cc70cSLuigi Rizzo 			error = ENXIO;
3139506cc70cSLuigi Rizzo 			break;
3140506cc70cSLuigi Rizzo 		}
31416641c68bSLuigi Rizzo 		mb(); /* make sure following reads are not from cache */
31428241616dSLuigi Rizzo 
3143b6e66be2SVincenzo Maffione 		if (unlikely(priv->np_csb_atok_base)) {
3144b6e66be2SVincenzo Maffione 			nm_prerr("Invalid sync in CSB mode");
3145b6e66be2SVincenzo Maffione 			error = EBUSY;
31468241616dSLuigi Rizzo 			break;
31478241616dSLuigi Rizzo 		}
31488241616dSLuigi Rizzo 
3149b6e66be2SVincenzo Maffione 		na = priv->np_na;      /* we have a reference */
3150b6e66be2SVincenzo Maffione 
3151c3e9b4dbSLuiz Otavio O Souza 		mbq_init(&q);
3152847bf383SLuigi Rizzo 		t = (cmd == NIOCTXSYNC ? NR_TX : NR_RX);
3153847bf383SLuigi Rizzo 		krings = NMR(na, t);
3154847bf383SLuigi Rizzo 		qfirst = priv->np_qfirst[t];
3155847bf383SLuigi Rizzo 		qlast = priv->np_qlast[t];
3156c3e9b4dbSLuiz Otavio O Souza 		sync_flags = priv->np_sync_flags;
315768b8534bSLuigi Rizzo 
3158f0ea3689SLuigi Rizzo 		for (i = qfirst; i < qlast; i++) {
31592ff91c17SVincenzo Maffione 			struct netmap_kring *kring = krings[i];
316037e3a6d3SLuigi Rizzo 			struct netmap_ring *ring = kring->ring;
316137e3a6d3SLuigi Rizzo 
316237e3a6d3SLuigi Rizzo 			if (unlikely(nm_kr_tryget(kring, 1, &error))) {
316337e3a6d3SLuigi Rizzo 				error = (error ? EIO : 0);
316437e3a6d3SLuigi Rizzo 				continue;
3165ce3ee1e7SLuigi Rizzo 			}
316637e3a6d3SLuigi Rizzo 
316768b8534bSLuigi Rizzo 			if (cmd == NIOCTXSYNC) {
3168b6e66be2SVincenzo Maffione 				if (netmap_debug & NM_DEBUG_TXSYNC)
3169b6e66be2SVincenzo Maffione 					nm_prinf("pre txsync ring %d cur %d hwcur %d",
317037e3a6d3SLuigi Rizzo 					    i, ring->cur,
317168b8534bSLuigi Rizzo 					    kring->nr_hwcur);
317237e3a6d3SLuigi Rizzo 				if (nm_txsync_prologue(kring, ring) >= kring->nkr_num_slots) {
317317885a7bSLuigi Rizzo 					netmap_ring_reinit(kring);
3174c3e9b4dbSLuiz Otavio O Souza 				} else if (kring->nm_sync(kring, sync_flags | NAF_FORCE_RECLAIM) == 0) {
317537e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
317617885a7bSLuigi Rizzo 				}
3177b6e66be2SVincenzo Maffione 				if (netmap_debug & NM_DEBUG_TXSYNC)
3178b6e66be2SVincenzo Maffione 					nm_prinf("post txsync ring %d cur %d hwcur %d",
317937e3a6d3SLuigi Rizzo 					    i, ring->cur,
318068b8534bSLuigi Rizzo 					    kring->nr_hwcur);
318168b8534bSLuigi Rizzo 			} else {
318237e3a6d3SLuigi Rizzo 				if (nm_rxsync_prologue(kring, ring) >= kring->nkr_num_slots) {
3183847bf383SLuigi Rizzo 					netmap_ring_reinit(kring);
3184c3e9b4dbSLuiz Otavio O Souza 				}
3185c3e9b4dbSLuiz Otavio O Souza 				if (nm_may_forward_up(kring)) {
3186c3e9b4dbSLuiz Otavio O Souza 					/* transparent forwarding, see netmap_poll() */
3187c3e9b4dbSLuiz Otavio O Souza 					netmap_grab_packets(kring, &q, netmap_fwd);
3188c3e9b4dbSLuiz Otavio O Souza 				}
3189c3e9b4dbSLuiz Otavio O Souza 				if (kring->nm_sync(kring, sync_flags | NAF_FORCE_READ) == 0) {
319037e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
3191847bf383SLuigi Rizzo 				}
3192c3e9b4dbSLuiz Otavio O Souza 				ring_timestamp_set(ring);
319368b8534bSLuigi Rizzo 			}
3194ce3ee1e7SLuigi Rizzo 			nm_kr_put(kring);
319568b8534bSLuigi Rizzo 		}
319668b8534bSLuigi Rizzo 
3197c3e9b4dbSLuiz Otavio O Souza 		if (mbq_peek(&q)) {
3198c3e9b4dbSLuiz Otavio O Souza 			netmap_send_up(na->ifp, &q);
3199c3e9b4dbSLuiz Otavio O Souza 		}
3200c3e9b4dbSLuiz Otavio O Souza 
320168b8534bSLuigi Rizzo 		break;
320268b8534bSLuigi Rizzo 	}
3203f196ce38SLuigi Rizzo 
32042ff91c17SVincenzo Maffione 	default: {
32052ff91c17SVincenzo Maffione 		return netmap_ioctl_legacy(priv, cmd, data, td);
32062ff91c17SVincenzo Maffione 		break;
32072ff91c17SVincenzo Maffione 	}
320868b8534bSLuigi Rizzo 	}
320968b8534bSLuigi Rizzo 
321068b8534bSLuigi Rizzo 	return (error);
321168b8534bSLuigi Rizzo }
321268b8534bSLuigi Rizzo 
32132ff91c17SVincenzo Maffione size_t
32142ff91c17SVincenzo Maffione nmreq_size_by_type(uint16_t nr_reqtype)
32152ff91c17SVincenzo Maffione {
32162ff91c17SVincenzo Maffione 	switch (nr_reqtype) {
32172ff91c17SVincenzo Maffione 	case NETMAP_REQ_REGISTER:
32182ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_register);
32192ff91c17SVincenzo Maffione 	case NETMAP_REQ_PORT_INFO_GET:
32202ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_port_info_get);
32212ff91c17SVincenzo Maffione 	case NETMAP_REQ_VALE_ATTACH:
32222ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_vale_attach);
32232ff91c17SVincenzo Maffione 	case NETMAP_REQ_VALE_DETACH:
32242ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_vale_detach);
32252ff91c17SVincenzo Maffione 	case NETMAP_REQ_VALE_LIST:
32262ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_vale_list);
32272ff91c17SVincenzo Maffione 	case NETMAP_REQ_PORT_HDR_SET:
32282ff91c17SVincenzo Maffione 	case NETMAP_REQ_PORT_HDR_GET:
32292ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_port_hdr);
32302ff91c17SVincenzo Maffione 	case NETMAP_REQ_VALE_NEWIF:
32312ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_vale_newif);
32322ff91c17SVincenzo Maffione 	case NETMAP_REQ_VALE_DELIF:
3233b6e66be2SVincenzo Maffione 	case NETMAP_REQ_SYNC_KLOOP_STOP:
3234b6e66be2SVincenzo Maffione 	case NETMAP_REQ_CSB_ENABLE:
32352ff91c17SVincenzo Maffione 		return 0;
32362ff91c17SVincenzo Maffione 	case NETMAP_REQ_VALE_POLLING_ENABLE:
32372ff91c17SVincenzo Maffione 	case NETMAP_REQ_VALE_POLLING_DISABLE:
32382ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_vale_polling);
32392ff91c17SVincenzo Maffione 	case NETMAP_REQ_POOLS_INFO_GET:
32402ff91c17SVincenzo Maffione 		return sizeof(struct nmreq_pools_info);
3241b6e66be2SVincenzo Maffione 	case NETMAP_REQ_SYNC_KLOOP_START:
3242b6e66be2SVincenzo Maffione 		return sizeof(struct nmreq_sync_kloop_start);
32432ff91c17SVincenzo Maffione 	}
32442ff91c17SVincenzo Maffione 	return 0;
32452ff91c17SVincenzo Maffione }
32462ff91c17SVincenzo Maffione 
32472ff91c17SVincenzo Maffione static size_t
3248b6e66be2SVincenzo Maffione nmreq_opt_size_by_type(uint32_t nro_reqtype, uint64_t nro_size)
32492ff91c17SVincenzo Maffione {
32502ff91c17SVincenzo Maffione 	size_t rv = sizeof(struct nmreq_option);
32512ff91c17SVincenzo Maffione #ifdef NETMAP_REQ_OPT_DEBUG
32522ff91c17SVincenzo Maffione 	if (nro_reqtype & NETMAP_REQ_OPT_DEBUG)
32532ff91c17SVincenzo Maffione 		return (nro_reqtype & ~NETMAP_REQ_OPT_DEBUG);
32542ff91c17SVincenzo Maffione #endif /* NETMAP_REQ_OPT_DEBUG */
32552ff91c17SVincenzo Maffione 	switch (nro_reqtype) {
32562ff91c17SVincenzo Maffione #ifdef WITH_EXTMEM
32572ff91c17SVincenzo Maffione 	case NETMAP_REQ_OPT_EXTMEM:
32582ff91c17SVincenzo Maffione 		rv = sizeof(struct nmreq_opt_extmem);
32592ff91c17SVincenzo Maffione 		break;
32602ff91c17SVincenzo Maffione #endif /* WITH_EXTMEM */
3261b6e66be2SVincenzo Maffione 	case NETMAP_REQ_OPT_SYNC_KLOOP_EVENTFDS:
3262b6e66be2SVincenzo Maffione 		if (nro_size >= rv)
3263b6e66be2SVincenzo Maffione 			rv = nro_size;
3264b6e66be2SVincenzo Maffione 		break;
3265b6e66be2SVincenzo Maffione 	case NETMAP_REQ_OPT_CSB:
3266b6e66be2SVincenzo Maffione 		rv = sizeof(struct nmreq_opt_csb);
3267b6e66be2SVincenzo Maffione 		break;
32685faab778SVincenzo Maffione 	case NETMAP_REQ_OPT_SYNC_KLOOP_MODE:
32695faab778SVincenzo Maffione 		rv = sizeof(struct nmreq_opt_sync_kloop_mode);
32705faab778SVincenzo Maffione 		break;
3271a6d768d8SVincenzo Maffione 	case NETMAP_REQ_OPT_OFFSETS:
3272a6d768d8SVincenzo Maffione 		rv = sizeof(struct nmreq_opt_offsets);
3273a6d768d8SVincenzo Maffione 		break;
32742ff91c17SVincenzo Maffione 	}
32752ff91c17SVincenzo Maffione 	/* subtract the common header */
32762ff91c17SVincenzo Maffione 	return rv - sizeof(struct nmreq_option);
32772ff91c17SVincenzo Maffione }
32782ff91c17SVincenzo Maffione 
3279253b2ec1SVincenzo Maffione /*
3280253b2ec1SVincenzo Maffione  * nmreq_copyin: create an in-kernel version of the request.
3281253b2ec1SVincenzo Maffione  *
3282253b2ec1SVincenzo Maffione  * We build the following data structure:
3283253b2ec1SVincenzo Maffione  *
3284253b2ec1SVincenzo Maffione  * hdr -> +-------+                buf
3285253b2ec1SVincenzo Maffione  *        |       |          +---------------+
3286253b2ec1SVincenzo Maffione  *        +-------+          |usr body ptr   |
3287253b2ec1SVincenzo Maffione  *        |options|-.        +---------------+
3288253b2ec1SVincenzo Maffione  *        +-------+ |        |usr options ptr|
3289253b2ec1SVincenzo Maffione  *        |body   |--------->+---------------+
3290253b2ec1SVincenzo Maffione  *        +-------+ |        |               |
3291253b2ec1SVincenzo Maffione  *                  |        |  copy of body |
3292253b2ec1SVincenzo Maffione  *                  |        |               |
3293253b2ec1SVincenzo Maffione  *                  |        +---------------+
3294253b2ec1SVincenzo Maffione  *                  |        |    NULL       |
3295253b2ec1SVincenzo Maffione  *                  |        +---------------+
3296253b2ec1SVincenzo Maffione  *                  |    .---|               |\
3297253b2ec1SVincenzo Maffione  *                  |    |   +---------------+ |
3298253b2ec1SVincenzo Maffione  *                  | .------|               | |
3299253b2ec1SVincenzo Maffione  *                  | |  |   +---------------+  \ option table
3300253b2ec1SVincenzo Maffione  *                  | |  |   |      ...      |  / indexed by option
3301253b2ec1SVincenzo Maffione  *                  | |  |   +---------------+ |  type
3302253b2ec1SVincenzo Maffione  *                  | |  |   |               | |
3303253b2ec1SVincenzo Maffione  *                  | |  |   +---------------+/
3304253b2ec1SVincenzo Maffione  *                  | |  |   |usr next ptr 1 |
3305253b2ec1SVincenzo Maffione  *                  `-|----->+---------------+
3306253b2ec1SVincenzo Maffione  *                    |  |   | copy of opt 1 |
3307253b2ec1SVincenzo Maffione  *                    |  |   |               |
3308253b2ec1SVincenzo Maffione  *                    |  | .-| nro_next      |
3309253b2ec1SVincenzo Maffione  *                    |  | | +---------------+
3310253b2ec1SVincenzo Maffione  *                    |  | | |usr next ptr 2 |
3311253b2ec1SVincenzo Maffione  *                    |  `-`>+---------------+
3312253b2ec1SVincenzo Maffione  *                    |      | copy of opt 2 |
3313253b2ec1SVincenzo Maffione  *                    |      |               |
3314253b2ec1SVincenzo Maffione  *                    |    .-| nro_next      |
3315253b2ec1SVincenzo Maffione  *                    |    | +---------------+
3316253b2ec1SVincenzo Maffione  *                    |    | |               |
3317253b2ec1SVincenzo Maffione  *                    ~    ~ ~      ...      ~
3318253b2ec1SVincenzo Maffione  *                    |    .-|               |
3319253b2ec1SVincenzo Maffione  *                    `----->+---------------+
3320253b2ec1SVincenzo Maffione  *                         | |usr next ptr n |
3321253b2ec1SVincenzo Maffione  *                         `>+---------------+
3322253b2ec1SVincenzo Maffione  *                           | copy of opt n |
3323253b2ec1SVincenzo Maffione  *                           |               |
3324253b2ec1SVincenzo Maffione  *                           | nro_next(NULL)|
3325253b2ec1SVincenzo Maffione  *                           +---------------+
3326253b2ec1SVincenzo Maffione  *
3327253b2ec1SVincenzo Maffione  * The options and body fields of the hdr structure are overwritten
3328253b2ec1SVincenzo Maffione  * with in-kernel valid pointers inside the buf. The original user
3329253b2ec1SVincenzo Maffione  * pointers are saved in the buf and restored on copyout.
3330253b2ec1SVincenzo Maffione  * The list of options is copied and the pointers adjusted. The
3331253b2ec1SVincenzo Maffione  * original pointers are saved before the option they belonged.
3332253b2ec1SVincenzo Maffione  *
333345c67e8fSVincenzo Maffione  * The option table has an entry for every available option.  Entries
3334253b2ec1SVincenzo Maffione  * for options that have not been passed contain NULL.
3335253b2ec1SVincenzo Maffione  *
3336253b2ec1SVincenzo Maffione  */
3337253b2ec1SVincenzo Maffione 
33382ff91c17SVincenzo Maffione int
33392ff91c17SVincenzo Maffione nmreq_copyin(struct nmreq_header *hdr, int nr_body_is_user)
33402ff91c17SVincenzo Maffione {
33412ff91c17SVincenzo Maffione 	size_t rqsz, optsz, bufsz;
3342253b2ec1SVincenzo Maffione 	int error = 0;
33432ff91c17SVincenzo Maffione 	char *ker = NULL, *p;
3344253b2ec1SVincenzo Maffione 	struct nmreq_option **next, *src, **opt_tab;
33452ff91c17SVincenzo Maffione 	struct nmreq_option buf;
33462ff91c17SVincenzo Maffione 	uint64_t *ptrs;
33472ff91c17SVincenzo Maffione 
3348b6e66be2SVincenzo Maffione 	if (hdr->nr_reserved) {
3349b6e66be2SVincenzo Maffione 		if (netmap_verbose)
3350b6e66be2SVincenzo Maffione 			nm_prerr("nr_reserved must be zero");
33512ff91c17SVincenzo Maffione 		return EINVAL;
3352b6e66be2SVincenzo Maffione 	}
33532ff91c17SVincenzo Maffione 
33542ff91c17SVincenzo Maffione 	if (!nr_body_is_user)
33552ff91c17SVincenzo Maffione 		return 0;
33562ff91c17SVincenzo Maffione 
33572ff91c17SVincenzo Maffione 	hdr->nr_reserved = nr_body_is_user;
33582ff91c17SVincenzo Maffione 
33592ff91c17SVincenzo Maffione 	/* compute the total size of the buffer */
33602ff91c17SVincenzo Maffione 	rqsz = nmreq_size_by_type(hdr->nr_reqtype);
33612ff91c17SVincenzo Maffione 	if (rqsz > NETMAP_REQ_MAXSIZE) {
33622ff91c17SVincenzo Maffione 		error = EMSGSIZE;
33632ff91c17SVincenzo Maffione 		goto out_err;
33642ff91c17SVincenzo Maffione 	}
3365cfa866f6SMatt Macy 	if ((rqsz && hdr->nr_body == (uintptr_t)NULL) ||
3366cfa866f6SMatt Macy 		(!rqsz && hdr->nr_body != (uintptr_t)NULL)) {
33672ff91c17SVincenzo Maffione 		/* Request body expected, but not found; or
33682ff91c17SVincenzo Maffione 		 * request body found but unexpected. */
3369b6e66be2SVincenzo Maffione 		if (netmap_verbose)
3370b6e66be2SVincenzo Maffione 			nm_prerr("nr_body expected but not found, or vice versa");
33712ff91c17SVincenzo Maffione 		error = EINVAL;
33722ff91c17SVincenzo Maffione 		goto out_err;
33732ff91c17SVincenzo Maffione 	}
33742ff91c17SVincenzo Maffione 
3375253b2ec1SVincenzo Maffione 	bufsz = 2 * sizeof(void *) + rqsz +
3376253b2ec1SVincenzo Maffione 		NETMAP_REQ_OPT_MAX * sizeof(opt_tab);
3377253b2ec1SVincenzo Maffione 	/* compute the size of the buf below the option table.
3378253b2ec1SVincenzo Maffione 	 * It must contain a copy of every received option structure.
3379253b2ec1SVincenzo Maffione 	 * For every option we also need to store a copy of the user
3380253b2ec1SVincenzo Maffione 	 * list pointer.
3381253b2ec1SVincenzo Maffione 	 */
33822ff91c17SVincenzo Maffione 	optsz = 0;
3383cfa866f6SMatt Macy 	for (src = (struct nmreq_option *)(uintptr_t)hdr->nr_options; src;
3384cfa866f6SMatt Macy 	     src = (struct nmreq_option *)(uintptr_t)buf.nro_next)
33852ff91c17SVincenzo Maffione 	{
33862ff91c17SVincenzo Maffione 		error = copyin(src, &buf, sizeof(*src));
33872ff91c17SVincenzo Maffione 		if (error)
33882ff91c17SVincenzo Maffione 			goto out_err;
33892ff91c17SVincenzo Maffione 		optsz += sizeof(*src);
3390b6e66be2SVincenzo Maffione 		optsz += nmreq_opt_size_by_type(buf.nro_reqtype, buf.nro_size);
33912ff91c17SVincenzo Maffione 		if (rqsz + optsz > NETMAP_REQ_MAXSIZE) {
33922ff91c17SVincenzo Maffione 			error = EMSGSIZE;
33932ff91c17SVincenzo Maffione 			goto out_err;
33942ff91c17SVincenzo Maffione 		}
3395253b2ec1SVincenzo Maffione 		bufsz += sizeof(void *);
33962ff91c17SVincenzo Maffione 	}
3397253b2ec1SVincenzo Maffione 	bufsz += optsz;
33982ff91c17SVincenzo Maffione 
33992ff91c17SVincenzo Maffione 	ker = nm_os_malloc(bufsz);
34002ff91c17SVincenzo Maffione 	if (ker == NULL) {
34012ff91c17SVincenzo Maffione 		error = ENOMEM;
34022ff91c17SVincenzo Maffione 		goto out_err;
34032ff91c17SVincenzo Maffione 	}
3404253b2ec1SVincenzo Maffione 	p = ker;	/* write pointer into the buffer */
34052ff91c17SVincenzo Maffione 
34062ff91c17SVincenzo Maffione 	/* make a copy of the user pointers */
34072ff91c17SVincenzo Maffione 	ptrs = (uint64_t*)p;
34082ff91c17SVincenzo Maffione 	*ptrs++ = hdr->nr_body;
34092ff91c17SVincenzo Maffione 	*ptrs++ = hdr->nr_options;
34102ff91c17SVincenzo Maffione 	p = (char *)ptrs;
34112ff91c17SVincenzo Maffione 
34122ff91c17SVincenzo Maffione 	/* copy the body */
3413cfa866f6SMatt Macy 	error = copyin((void *)(uintptr_t)hdr->nr_body, p, rqsz);
34142ff91c17SVincenzo Maffione 	if (error)
34152ff91c17SVincenzo Maffione 		goto out_restore;
34162ff91c17SVincenzo Maffione 	/* overwrite the user pointer with the in-kernel one */
3417cfa866f6SMatt Macy 	hdr->nr_body = (uintptr_t)p;
34182ff91c17SVincenzo Maffione 	p += rqsz;
3419253b2ec1SVincenzo Maffione 	/* start of the options table */
3420253b2ec1SVincenzo Maffione 	opt_tab = (struct nmreq_option **)p;
3421253b2ec1SVincenzo Maffione 	p += sizeof(opt_tab) * NETMAP_REQ_OPT_MAX;
34222ff91c17SVincenzo Maffione 
34232ff91c17SVincenzo Maffione 	/* copy the options */
34242ff91c17SVincenzo Maffione 	next = (struct nmreq_option **)&hdr->nr_options;
34252ff91c17SVincenzo Maffione 	src = *next;
34262ff91c17SVincenzo Maffione 	while (src) {
34272ff91c17SVincenzo Maffione 		struct nmreq_option *opt;
34282ff91c17SVincenzo Maffione 
34292ff91c17SVincenzo Maffione 		/* copy the option header */
34302ff91c17SVincenzo Maffione 		ptrs = (uint64_t *)p;
34312ff91c17SVincenzo Maffione 		opt = (struct nmreq_option *)(ptrs + 1);
34322ff91c17SVincenzo Maffione 		error = copyin(src, opt, sizeof(*src));
34332ff91c17SVincenzo Maffione 		if (error)
34342ff91c17SVincenzo Maffione 			goto out_restore;
34352ff91c17SVincenzo Maffione 		/* make a copy of the user next pointer */
34362ff91c17SVincenzo Maffione 		*ptrs = opt->nro_next;
34372ff91c17SVincenzo Maffione 		/* overwrite the user pointer with the in-kernel one */
34382ff91c17SVincenzo Maffione 		*next = opt;
34392ff91c17SVincenzo Maffione 
34402ff91c17SVincenzo Maffione 		/* initialize the option as not supported.
34412ff91c17SVincenzo Maffione 		 * Recognized options will update this field.
34422ff91c17SVincenzo Maffione 		 */
34432ff91c17SVincenzo Maffione 		opt->nro_status = EOPNOTSUPP;
34442ff91c17SVincenzo Maffione 
3445253b2ec1SVincenzo Maffione 		/* check for invalid types */
3446253b2ec1SVincenzo Maffione 		if (opt->nro_reqtype < 1) {
3447253b2ec1SVincenzo Maffione 			if (netmap_verbose)
3448253b2ec1SVincenzo Maffione 				nm_prinf("invalid option type: %u", opt->nro_reqtype);
3449253b2ec1SVincenzo Maffione 			opt->nro_status = EINVAL;
3450253b2ec1SVincenzo Maffione 			error = EINVAL;
3451253b2ec1SVincenzo Maffione 			goto next;
3452253b2ec1SVincenzo Maffione 		}
3453253b2ec1SVincenzo Maffione 
3454253b2ec1SVincenzo Maffione 		if (opt->nro_reqtype >= NETMAP_REQ_OPT_MAX) {
3455253b2ec1SVincenzo Maffione 			/* opt->nro_status is already EOPNOTSUPP */
3456253b2ec1SVincenzo Maffione 			error = EOPNOTSUPP;
3457253b2ec1SVincenzo Maffione 			goto next;
3458253b2ec1SVincenzo Maffione 		}
3459253b2ec1SVincenzo Maffione 
3460253b2ec1SVincenzo Maffione 		/* if the type is valid, index the option in the table
3461253b2ec1SVincenzo Maffione 		 * unless it is a duplicate.
3462253b2ec1SVincenzo Maffione 		 */
3463253b2ec1SVincenzo Maffione 		if (opt_tab[opt->nro_reqtype] != NULL) {
3464253b2ec1SVincenzo Maffione 			if (netmap_verbose)
3465253b2ec1SVincenzo Maffione 				nm_prinf("duplicate option: %u", opt->nro_reqtype);
3466253b2ec1SVincenzo Maffione 			opt->nro_status = EINVAL;
3467253b2ec1SVincenzo Maffione 			opt_tab[opt->nro_reqtype]->nro_status = EINVAL;
3468253b2ec1SVincenzo Maffione 			error = EINVAL;
3469253b2ec1SVincenzo Maffione 			goto next;
3470253b2ec1SVincenzo Maffione 		}
3471253b2ec1SVincenzo Maffione 		opt_tab[opt->nro_reqtype] = opt;
3472253b2ec1SVincenzo Maffione 
34732ff91c17SVincenzo Maffione 		p = (char *)(opt + 1);
34742ff91c17SVincenzo Maffione 
34752ff91c17SVincenzo Maffione 		/* copy the option body */
3476b6e66be2SVincenzo Maffione 		optsz = nmreq_opt_size_by_type(opt->nro_reqtype,
3477b6e66be2SVincenzo Maffione 						opt->nro_size);
34782ff91c17SVincenzo Maffione 		if (optsz) {
34792ff91c17SVincenzo Maffione 			/* the option body follows the option header */
34802ff91c17SVincenzo Maffione 			error = copyin(src + 1, p, optsz);
34812ff91c17SVincenzo Maffione 			if (error)
34822ff91c17SVincenzo Maffione 				goto out_restore;
34832ff91c17SVincenzo Maffione 			p += optsz;
34842ff91c17SVincenzo Maffione 		}
34852ff91c17SVincenzo Maffione 
3486253b2ec1SVincenzo Maffione 	next:
34872ff91c17SVincenzo Maffione 		/* move to next option */
34882ff91c17SVincenzo Maffione 		next = (struct nmreq_option **)&opt->nro_next;
34892ff91c17SVincenzo Maffione 		src = *next;
34902ff91c17SVincenzo Maffione 	}
3491253b2ec1SVincenzo Maffione 	if (error)
3492253b2ec1SVincenzo Maffione 		nmreq_copyout(hdr, error);
3493253b2ec1SVincenzo Maffione 	return error;
34942ff91c17SVincenzo Maffione 
34952ff91c17SVincenzo Maffione out_restore:
34962ff91c17SVincenzo Maffione 	ptrs = (uint64_t *)ker;
34972ff91c17SVincenzo Maffione 	hdr->nr_body = *ptrs++;
34982ff91c17SVincenzo Maffione 	hdr->nr_options = *ptrs++;
34992ff91c17SVincenzo Maffione 	hdr->nr_reserved = 0;
35002ff91c17SVincenzo Maffione 	nm_os_free(ker);
35012ff91c17SVincenzo Maffione out_err:
35022ff91c17SVincenzo Maffione 	return error;
35032ff91c17SVincenzo Maffione }
35042ff91c17SVincenzo Maffione 
35052ff91c17SVincenzo Maffione static int
35062ff91c17SVincenzo Maffione nmreq_copyout(struct nmreq_header *hdr, int rerror)
35072ff91c17SVincenzo Maffione {
35082ff91c17SVincenzo Maffione 	struct nmreq_option *src, *dst;
3509cfa866f6SMatt Macy 	void *ker = (void *)(uintptr_t)hdr->nr_body, *bufstart;
35102ff91c17SVincenzo Maffione 	uint64_t *ptrs;
35112ff91c17SVincenzo Maffione 	size_t bodysz;
35122ff91c17SVincenzo Maffione 	int error;
35132ff91c17SVincenzo Maffione 
35142ff91c17SVincenzo Maffione 	if (!hdr->nr_reserved)
35152ff91c17SVincenzo Maffione 		return rerror;
35162ff91c17SVincenzo Maffione 
35172ff91c17SVincenzo Maffione 	/* restore the user pointers in the header */
35182ff91c17SVincenzo Maffione 	ptrs = (uint64_t *)ker - 2;
35192ff91c17SVincenzo Maffione 	bufstart = ptrs;
35202ff91c17SVincenzo Maffione 	hdr->nr_body = *ptrs++;
3521cfa866f6SMatt Macy 	src = (struct nmreq_option *)(uintptr_t)hdr->nr_options;
35222ff91c17SVincenzo Maffione 	hdr->nr_options = *ptrs;
35232ff91c17SVincenzo Maffione 
35242ff91c17SVincenzo Maffione 	if (!rerror) {
35252ff91c17SVincenzo Maffione 		/* copy the body */
35262ff91c17SVincenzo Maffione 		bodysz = nmreq_size_by_type(hdr->nr_reqtype);
3527cfa866f6SMatt Macy 		error = copyout(ker, (void *)(uintptr_t)hdr->nr_body, bodysz);
35282ff91c17SVincenzo Maffione 		if (error) {
35292ff91c17SVincenzo Maffione 			rerror = error;
35302ff91c17SVincenzo Maffione 			goto out;
35312ff91c17SVincenzo Maffione 		}
35322ff91c17SVincenzo Maffione 	}
35332ff91c17SVincenzo Maffione 
35342ff91c17SVincenzo Maffione 	/* copy the options */
3535cfa866f6SMatt Macy 	dst = (struct nmreq_option *)(uintptr_t)hdr->nr_options;
35362ff91c17SVincenzo Maffione 	while (src) {
35372ff91c17SVincenzo Maffione 		size_t optsz;
35382ff91c17SVincenzo Maffione 		uint64_t next;
35392ff91c17SVincenzo Maffione 
35402ff91c17SVincenzo Maffione 		/* restore the user pointer */
35412ff91c17SVincenzo Maffione 		next = src->nro_next;
35422ff91c17SVincenzo Maffione 		ptrs = (uint64_t *)src - 1;
35432ff91c17SVincenzo Maffione 		src->nro_next = *ptrs;
35442ff91c17SVincenzo Maffione 
35452ff91c17SVincenzo Maffione 		/* always copy the option header */
35462ff91c17SVincenzo Maffione 		error = copyout(src, dst, sizeof(*src));
35472ff91c17SVincenzo Maffione 		if (error) {
35482ff91c17SVincenzo Maffione 			rerror = error;
35492ff91c17SVincenzo Maffione 			goto out;
35502ff91c17SVincenzo Maffione 		}
35512ff91c17SVincenzo Maffione 
35522ff91c17SVincenzo Maffione 		/* copy the option body only if there was no error */
35532ff91c17SVincenzo Maffione 		if (!rerror && !src->nro_status) {
3554b6e66be2SVincenzo Maffione 			optsz = nmreq_opt_size_by_type(src->nro_reqtype,
3555b6e66be2SVincenzo Maffione 							src->nro_size);
35562ff91c17SVincenzo Maffione 			if (optsz) {
35572ff91c17SVincenzo Maffione 				error = copyout(src + 1, dst + 1, optsz);
35582ff91c17SVincenzo Maffione 				if (error) {
35592ff91c17SVincenzo Maffione 					rerror = error;
35602ff91c17SVincenzo Maffione 					goto out;
35612ff91c17SVincenzo Maffione 				}
35622ff91c17SVincenzo Maffione 			}
35632ff91c17SVincenzo Maffione 		}
3564cfa866f6SMatt Macy 		src = (struct nmreq_option *)(uintptr_t)next;
3565cfa866f6SMatt Macy 		dst = (struct nmreq_option *)(uintptr_t)*ptrs;
35662ff91c17SVincenzo Maffione 	}
35672ff91c17SVincenzo Maffione 
35682ff91c17SVincenzo Maffione 
35692ff91c17SVincenzo Maffione out:
35702ff91c17SVincenzo Maffione 	hdr->nr_reserved = 0;
35712ff91c17SVincenzo Maffione 	nm_os_free(bufstart);
35722ff91c17SVincenzo Maffione 	return rerror;
35732ff91c17SVincenzo Maffione }
35742ff91c17SVincenzo Maffione 
35752ff91c17SVincenzo Maffione struct nmreq_option *
3576253b2ec1SVincenzo Maffione nmreq_getoption(struct nmreq_header *hdr, uint16_t reqtype)
35772ff91c17SVincenzo Maffione {
3578253b2ec1SVincenzo Maffione 	struct nmreq_option **opt_tab;
3579253b2ec1SVincenzo Maffione 
3580253b2ec1SVincenzo Maffione 	if (!hdr->nr_options)
35812ff91c17SVincenzo Maffione 		return NULL;
35822ff91c17SVincenzo Maffione 
3583760fa2abSVincenzo Maffione 	opt_tab = (struct nmreq_option **)((uintptr_t)hdr->nr_options) -
3584760fa2abSVincenzo Maffione 	    (NETMAP_REQ_OPT_MAX + 1);
3585253b2ec1SVincenzo Maffione 	return opt_tab[reqtype];
35862ff91c17SVincenzo Maffione }
35872ff91c17SVincenzo Maffione 
35882ff91c17SVincenzo Maffione static int
35892ff91c17SVincenzo Maffione nmreq_checkoptions(struct nmreq_header *hdr)
35902ff91c17SVincenzo Maffione {
35912ff91c17SVincenzo Maffione 	struct nmreq_option *opt;
35922ff91c17SVincenzo Maffione 	/* return error if there is still any option
35932ff91c17SVincenzo Maffione 	 * marked as not supported
35942ff91c17SVincenzo Maffione 	 */
35952ff91c17SVincenzo Maffione 
3596cfa866f6SMatt Macy 	for (opt = (struct nmreq_option *)(uintptr_t)hdr->nr_options; opt;
3597cfa866f6SMatt Macy 	     opt = (struct nmreq_option *)(uintptr_t)opt->nro_next)
35982ff91c17SVincenzo Maffione 		if (opt->nro_status == EOPNOTSUPP)
35992ff91c17SVincenzo Maffione 			return EOPNOTSUPP;
36002ff91c17SVincenzo Maffione 
36012ff91c17SVincenzo Maffione 	return 0;
36022ff91c17SVincenzo Maffione }
360368b8534bSLuigi Rizzo 
360468b8534bSLuigi Rizzo /*
360568b8534bSLuigi Rizzo  * select(2) and poll(2) handlers for the "netmap" device.
360668b8534bSLuigi Rizzo  *
360768b8534bSLuigi Rizzo  * Can be called for one or more queues.
360868b8534bSLuigi Rizzo  * Return true the event mask corresponding to ready events.
36098c9874f5SVincenzo Maffione  * If there are no ready events (and 'sr' is not NULL), do a
36108c9874f5SVincenzo Maffione  * selrecord on either individual selinfo or on the global one.
361168b8534bSLuigi Rizzo  * Device-dependent parts (locking and sync of tx/rx rings)
361268b8534bSLuigi Rizzo  * are done through callbacks.
3613f196ce38SLuigi Rizzo  *
361401c7d25fSLuigi Rizzo  * On linux, arguments are really pwait, the poll table, and 'td' is struct file *
361501c7d25fSLuigi Rizzo  * The first one is remapped to pwait as selrecord() uses the name as an
361601c7d25fSLuigi Rizzo  * hidden argument.
361768b8534bSLuigi Rizzo  */
3618f9790aebSLuigi Rizzo int
361937e3a6d3SLuigi Rizzo netmap_poll(struct netmap_priv_d *priv, int events, NM_SELRECORD_T *sr)
362068b8534bSLuigi Rizzo {
362168b8534bSLuigi Rizzo 	struct netmap_adapter *na;
362268b8534bSLuigi Rizzo 	struct netmap_kring *kring;
362337e3a6d3SLuigi Rizzo 	struct netmap_ring *ring;
3624b6e66be2SVincenzo Maffione 	u_int i, want[NR_TXRX], revents = 0;
3625b6e66be2SVincenzo Maffione 	NM_SELINFO_T *si[NR_TXRX];
3626847bf383SLuigi Rizzo #define want_tx want[NR_TX]
3627847bf383SLuigi Rizzo #define want_rx want[NR_RX]
3628c3e9b4dbSLuiz Otavio O Souza 	struct mbq q;	/* packets from RX hw queues to host stack */
362901c7d25fSLuigi Rizzo 
3630f9790aebSLuigi Rizzo 	/*
3631f9790aebSLuigi Rizzo 	 * In order to avoid nested locks, we need to "double check"
3632f9790aebSLuigi Rizzo 	 * txsync and rxsync if we decide to do a selrecord().
3633f9790aebSLuigi Rizzo 	 * retry_tx (and retry_rx, later) prevent looping forever.
3634f9790aebSLuigi Rizzo 	 */
363517885a7bSLuigi Rizzo 	int retry_tx = 1, retry_rx = 1;
3636ce3ee1e7SLuigi Rizzo 
3637c3e9b4dbSLuiz Otavio O Souza 	/* Transparent mode: send_down is 1 if we have found some
3638c3e9b4dbSLuiz Otavio O Souza 	 * packets to forward (host RX ring --> NIC) during the rx
3639c3e9b4dbSLuiz Otavio O Souza 	 * scan and we have not sent them down to the NIC yet.
3640c3e9b4dbSLuiz Otavio O Souza 	 * Transparent mode requires to bind all rings to a single
3641c3e9b4dbSLuiz Otavio O Souza 	 * file descriptor.
3642f0ea3689SLuigi Rizzo 	 */
364337e3a6d3SLuigi Rizzo 	int send_down = 0;
3644c3e9b4dbSLuiz Otavio O Souza 	int sync_flags = priv->np_sync_flags;
364537e3a6d3SLuigi Rizzo 
364637e3a6d3SLuigi Rizzo 	mbq_init(&q);
364768b8534bSLuigi Rizzo 
3648b6e66be2SVincenzo Maffione 	if (unlikely(priv->np_nifp == NULL)) {
36498241616dSLuigi Rizzo 		return POLLERR;
36508241616dSLuigi Rizzo 	}
3651847bf383SLuigi Rizzo 	mb(); /* make sure following reads are not from cache */
36528241616dSLuigi Rizzo 
3653f9790aebSLuigi Rizzo 	na = priv->np_na;
3654f9790aebSLuigi Rizzo 
3655b6e66be2SVincenzo Maffione 	if (unlikely(!nm_netmap_on(na)))
365668b8534bSLuigi Rizzo 		return POLLERR;
365768b8534bSLuigi Rizzo 
3658b6e66be2SVincenzo Maffione 	if (unlikely(priv->np_csb_atok_base)) {
3659b6e66be2SVincenzo Maffione 		nm_prerr("Invalid poll in CSB mode");
3660b6e66be2SVincenzo Maffione 		return POLLERR;
3661b6e66be2SVincenzo Maffione 	}
3662b6e66be2SVincenzo Maffione 
3663b6e66be2SVincenzo Maffione 	if (netmap_debug & NM_DEBUG_ON)
3664b6e66be2SVincenzo Maffione 		nm_prinf("device %s events 0x%x", na->name, events);
366568b8534bSLuigi Rizzo 	want_tx = events & (POLLOUT | POLLWRNORM);
366668b8534bSLuigi Rizzo 	want_rx = events & (POLLIN | POLLRDNORM);
366768b8534bSLuigi Rizzo 
366868b8534bSLuigi Rizzo 	/*
3669b6e66be2SVincenzo Maffione 	 * If the card has more than one queue AND the file descriptor is
3670b6e66be2SVincenzo Maffione 	 * bound to all of them, we sleep on the "global" selinfo, otherwise
3671b6e66be2SVincenzo Maffione 	 * we sleep on individual selinfo (FreeBSD only allows two selinfo's
3672b6e66be2SVincenzo Maffione 	 * per file descriptor).
3673ce3ee1e7SLuigi Rizzo 	 * The interrupt routine in the driver wake one or the other
3674ce3ee1e7SLuigi Rizzo 	 * (or both) depending on which clients are active.
367568b8534bSLuigi Rizzo 	 *
367668b8534bSLuigi Rizzo 	 * rxsync() is only called if we run out of buffers on a POLLIN.
367768b8534bSLuigi Rizzo 	 * txsync() is called if we run out of buffers on POLLOUT, or
367868b8534bSLuigi Rizzo 	 * there are pending packets to send. The latter can be disabled
367968b8534bSLuigi Rizzo 	 * passing NETMAP_NO_TX_POLL in the NIOCREG call.
368068b8534bSLuigi Rizzo 	 */
36815faab778SVincenzo Maffione 	si[NR_RX] = priv->np_si[NR_RX];
36825faab778SVincenzo Maffione 	si[NR_TX] = priv->np_si[NR_TX];
368364ae02c3SLuigi Rizzo 
36844f80b14cSVincenzo Maffione #ifdef __FreeBSD__
368568b8534bSLuigi Rizzo 	/*
3686f9790aebSLuigi Rizzo 	 * We start with a lock free round which is cheap if we have
3687f9790aebSLuigi Rizzo 	 * slots available. If this fails, then lock and call the sync
36884f80b14cSVincenzo Maffione 	 * routines. We can't do this on Linux, as the contract says
36894f80b14cSVincenzo Maffione 	 * that we must call nm_os_selrecord() unconditionally.
369068b8534bSLuigi Rizzo 	 */
369137e3a6d3SLuigi Rizzo 	if (want_tx) {
369258e18542SVincenzo Maffione 		const enum txrx t = NR_TX;
369358e18542SVincenzo Maffione 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
36942ff91c17SVincenzo Maffione 			kring = NMR(na, t)[i];
369558e18542SVincenzo Maffione 			if (kring->ring->cur != kring->ring->tail) {
369658e18542SVincenzo Maffione 				/* Some unseen TX space is available, so what
369758e18542SVincenzo Maffione 				 * we don't need to run txsync. */
369837e3a6d3SLuigi Rizzo 				revents |= want[t];
369958e18542SVincenzo Maffione 				want[t] = 0;
370058e18542SVincenzo Maffione 				break;
370137e3a6d3SLuigi Rizzo 			}
370237e3a6d3SLuigi Rizzo 		}
370337e3a6d3SLuigi Rizzo 	}
370437e3a6d3SLuigi Rizzo 	if (want_rx) {
370558e18542SVincenzo Maffione 		const enum txrx t = NR_RX;
3706e1ed1fbdSVincenzo Maffione 		int rxsync_needed = 0;
3707e1ed1fbdSVincenzo Maffione 
370837e3a6d3SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
37092ff91c17SVincenzo Maffione 			kring = NMR(na, t)[i];
371058e18542SVincenzo Maffione 			if (kring->ring->cur == kring->ring->tail
371158e18542SVincenzo Maffione 				|| kring->rhead != kring->ring->head) {
371258e18542SVincenzo Maffione 				/* There are no unseen packets on this ring,
371358e18542SVincenzo Maffione 				 * or there are some buffers to be returned
371458e18542SVincenzo Maffione 				 * to the netmap port. We therefore go ahead
371558e18542SVincenzo Maffione 				 * and run rxsync. */
3716e1ed1fbdSVincenzo Maffione 				rxsync_needed = 1;
3717e1ed1fbdSVincenzo Maffione 				break;
371837e3a6d3SLuigi Rizzo 			}
371937e3a6d3SLuigi Rizzo 		}
372058e18542SVincenzo Maffione 		if (!rxsync_needed) {
372158e18542SVincenzo Maffione 			revents |= want_rx;
372258e18542SVincenzo Maffione 			want_rx = 0;
372358e18542SVincenzo Maffione 		}
372437e3a6d3SLuigi Rizzo 	}
37254f80b14cSVincenzo Maffione #endif
37264f80b14cSVincenzo Maffione 
37274f80b14cSVincenzo Maffione #ifdef linux
37284f80b14cSVincenzo Maffione 	/* The selrecord must be unconditional on linux. */
3729b6e66be2SVincenzo Maffione 	nm_os_selrecord(sr, si[NR_RX]);
3730b6e66be2SVincenzo Maffione 	nm_os_selrecord(sr, si[NR_TX]);
37314f80b14cSVincenzo Maffione #endif /* linux */
373268b8534bSLuigi Rizzo 
373368b8534bSLuigi Rizzo 	/*
373417885a7bSLuigi Rizzo 	 * If we want to push packets out (priv->np_txpoll) or
373517885a7bSLuigi Rizzo 	 * want_tx is still set, we must issue txsync calls
373617885a7bSLuigi Rizzo 	 * (on all rings, to avoid that the tx rings stall).
3737f9790aebSLuigi Rizzo 	 * Fortunately, normal tx mode has np_txpoll set.
373868b8534bSLuigi Rizzo 	 */
373968b8534bSLuigi Rizzo 	if (priv->np_txpoll || want_tx) {
374017885a7bSLuigi Rizzo 		/*
374117885a7bSLuigi Rizzo 		 * The first round checks if anyone is ready, if not
374217885a7bSLuigi Rizzo 		 * do a selrecord and another round to handle races.
374317885a7bSLuigi Rizzo 		 * want_tx goes to 0 if any space is found, and is
374417885a7bSLuigi Rizzo 		 * used to skip rings with no pending transmissions.
3745ce3ee1e7SLuigi Rizzo 		 */
3746091fd0abSLuigi Rizzo flush_tx:
374737e3a6d3SLuigi Rizzo 		for (i = priv->np_qfirst[NR_TX]; i < priv->np_qlast[NR_TX]; i++) {
374817885a7bSLuigi Rizzo 			int found = 0;
374917885a7bSLuigi Rizzo 
37502ff91c17SVincenzo Maffione 			kring = na->tx_rings[i];
375137e3a6d3SLuigi Rizzo 			ring = kring->ring;
375237e3a6d3SLuigi Rizzo 
37534f80b14cSVincenzo Maffione 			/*
37544f80b14cSVincenzo Maffione 			 * Don't try to txsync this TX ring if we already found some
37554f80b14cSVincenzo Maffione 			 * space in some of the TX rings (want_tx == 0) and there are no
37564f80b14cSVincenzo Maffione 			 * TX slots in this ring that need to be flushed to the NIC
37572ff91c17SVincenzo Maffione 			 * (head == hwcur).
37584f80b14cSVincenzo Maffione 			 */
37592ff91c17SVincenzo Maffione 			if (!send_down && !want_tx && ring->head == kring->nr_hwcur)
376068b8534bSLuigi Rizzo 				continue;
376137e3a6d3SLuigi Rizzo 
376237e3a6d3SLuigi Rizzo 			if (nm_kr_tryget(kring, 1, &revents))
376317885a7bSLuigi Rizzo 				continue;
376437e3a6d3SLuigi Rizzo 
376537e3a6d3SLuigi Rizzo 			if (nm_txsync_prologue(kring, ring) >= kring->nkr_num_slots) {
376617885a7bSLuigi Rizzo 				netmap_ring_reinit(kring);
376717885a7bSLuigi Rizzo 				revents |= POLLERR;
376817885a7bSLuigi Rizzo 			} else {
3769c3e9b4dbSLuiz Otavio O Souza 				if (kring->nm_sync(kring, sync_flags))
377068b8534bSLuigi Rizzo 					revents |= POLLERR;
3771847bf383SLuigi Rizzo 				else
377237e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
377317885a7bSLuigi Rizzo 			}
377468b8534bSLuigi Rizzo 
377517885a7bSLuigi Rizzo 			/*
377617885a7bSLuigi Rizzo 			 * If we found new slots, notify potential
377717885a7bSLuigi Rizzo 			 * listeners on the same ring.
377817885a7bSLuigi Rizzo 			 * Since we just did a txsync, look at the copies
377917885a7bSLuigi Rizzo 			 * of cur,tail in the kring.
3780f9790aebSLuigi Rizzo 			 */
378117885a7bSLuigi Rizzo 			found = kring->rcur != kring->rtail;
378217885a7bSLuigi Rizzo 			nm_kr_put(kring);
378317885a7bSLuigi Rizzo 			if (found) { /* notify other listeners */
378468b8534bSLuigi Rizzo 				revents |= want_tx;
378568b8534bSLuigi Rizzo 				want_tx = 0;
37864f80b14cSVincenzo Maffione #ifndef linux
3787847bf383SLuigi Rizzo 				kring->nm_notify(kring, 0);
37884f80b14cSVincenzo Maffione #endif /* linux */
378968b8534bSLuigi Rizzo 			}
3790ce3ee1e7SLuigi Rizzo 		}
379137e3a6d3SLuigi Rizzo 		/* if there were any packet to forward we must have handled them by now */
379237e3a6d3SLuigi Rizzo 		send_down = 0;
379337e3a6d3SLuigi Rizzo 		if (want_tx && retry_tx && sr) {
37944f80b14cSVincenzo Maffione #ifndef linux
3795b6e66be2SVincenzo Maffione 			nm_os_selrecord(sr, si[NR_TX]);
37964f80b14cSVincenzo Maffione #endif /* !linux */
3797ce3ee1e7SLuigi Rizzo 			retry_tx = 0;
3798ce3ee1e7SLuigi Rizzo 			goto flush_tx;
379968b8534bSLuigi Rizzo 		}
380068b8534bSLuigi Rizzo 	}
380168b8534bSLuigi Rizzo 
380268b8534bSLuigi Rizzo 	/*
380317885a7bSLuigi Rizzo 	 * If want_rx is still set scan receive rings.
380468b8534bSLuigi Rizzo 	 * Do it on all rings because otherwise we starve.
380568b8534bSLuigi Rizzo 	 */
380668b8534bSLuigi Rizzo 	if (want_rx) {
380789cc2556SLuigi Rizzo 		/* two rounds here for race avoidance */
3808ce3ee1e7SLuigi Rizzo do_retry_rx:
3809847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[NR_RX]; i < priv->np_qlast[NR_RX]; i++) {
381017885a7bSLuigi Rizzo 			int found = 0;
381117885a7bSLuigi Rizzo 
38122ff91c17SVincenzo Maffione 			kring = na->rx_rings[i];
381337e3a6d3SLuigi Rizzo 			ring = kring->ring;
3814ce3ee1e7SLuigi Rizzo 
381537e3a6d3SLuigi Rizzo 			if (unlikely(nm_kr_tryget(kring, 1, &revents)))
381617885a7bSLuigi Rizzo 				continue;
3817ce3ee1e7SLuigi Rizzo 
381837e3a6d3SLuigi Rizzo 			if (nm_rxsync_prologue(kring, ring) >= kring->nkr_num_slots) {
3819847bf383SLuigi Rizzo 				netmap_ring_reinit(kring);
3820847bf383SLuigi Rizzo 				revents |= POLLERR;
3821847bf383SLuigi Rizzo 			}
3822847bf383SLuigi Rizzo 			/* now we can use kring->rcur, rtail */
3823847bf383SLuigi Rizzo 
382417885a7bSLuigi Rizzo 			/*
3825c3e9b4dbSLuiz Otavio O Souza 			 * transparent mode support: collect packets from
3826c3e9b4dbSLuiz Otavio O Souza 			 * hw rxring(s) that have been released by the user
3827ce3ee1e7SLuigi Rizzo 			 */
382837e3a6d3SLuigi Rizzo 			if (nm_may_forward_up(kring)) {
3829091fd0abSLuigi Rizzo 				netmap_grab_packets(kring, &q, netmap_fwd);
3830091fd0abSLuigi Rizzo 			}
383168b8534bSLuigi Rizzo 
3832c3e9b4dbSLuiz Otavio O Souza 			/* Clear the NR_FORWARD flag anyway, it may be set by
3833c3e9b4dbSLuiz Otavio O Souza 			 * the nm_sync() below only on for the host RX ring (see
3834c3e9b4dbSLuiz Otavio O Souza 			 * netmap_rxsync_from_host()). */
383537e3a6d3SLuigi Rizzo 			kring->nr_kflags &= ~NR_FORWARD;
3836c3e9b4dbSLuiz Otavio O Souza 			if (kring->nm_sync(kring, sync_flags))
383768b8534bSLuigi Rizzo 				revents |= POLLERR;
3838847bf383SLuigi Rizzo 			else
383937e3a6d3SLuigi Rizzo 				nm_sync_finalize(kring);
3840c3e9b4dbSLuiz Otavio O Souza 			send_down |= (kring->nr_kflags & NR_FORWARD);
3841c3e9b4dbSLuiz Otavio O Souza 			ring_timestamp_set(ring);
384217885a7bSLuigi Rizzo 			found = kring->rcur != kring->rtail;
384317885a7bSLuigi Rizzo 			nm_kr_put(kring);
384417885a7bSLuigi Rizzo 			if (found) {
384568b8534bSLuigi Rizzo 				revents |= want_rx;
3846ce3ee1e7SLuigi Rizzo 				retry_rx = 0;
38474f80b14cSVincenzo Maffione #ifndef linux
3848847bf383SLuigi Rizzo 				kring->nm_notify(kring, 0);
38494f80b14cSVincenzo Maffione #endif /* linux */
385068b8534bSLuigi Rizzo 			}
385168b8534bSLuigi Rizzo 		}
385217885a7bSLuigi Rizzo 
38534f80b14cSVincenzo Maffione #ifndef linux
385437e3a6d3SLuigi Rizzo 		if (retry_rx && sr) {
3855b6e66be2SVincenzo Maffione 			nm_os_selrecord(sr, si[NR_RX]);
385637e3a6d3SLuigi Rizzo 		}
38574f80b14cSVincenzo Maffione #endif /* !linux */
3858c3e9b4dbSLuiz Otavio O Souza 		if (send_down || retry_rx) {
385917885a7bSLuigi Rizzo 			retry_rx = 0;
386017885a7bSLuigi Rizzo 			if (send_down)
386117885a7bSLuigi Rizzo 				goto flush_tx; /* and retry_rx */
386217885a7bSLuigi Rizzo 			else
3863ce3ee1e7SLuigi Rizzo 				goto do_retry_rx;
3864ce3ee1e7SLuigi Rizzo 		}
386568b8534bSLuigi Rizzo 	}
3866091fd0abSLuigi Rizzo 
386717885a7bSLuigi Rizzo 	/*
3868c3e9b4dbSLuiz Otavio O Souza 	 * Transparent mode: released bufs (i.e. between kring->nr_hwcur and
3869c3e9b4dbSLuiz Otavio O Souza 	 * ring->head) marked with NS_FORWARD on hw rx rings are passed up
3870c3e9b4dbSLuiz Otavio O Souza 	 * to the host stack.
3871ce3ee1e7SLuigi Rizzo 	 */
3872091fd0abSLuigi Rizzo 
3873c3e9b4dbSLuiz Otavio O Souza 	if (mbq_peek(&q)) {
3874f9790aebSLuigi Rizzo 		netmap_send_up(na->ifp, &q);
387537e3a6d3SLuigi Rizzo 	}
387668b8534bSLuigi Rizzo 
387768b8534bSLuigi Rizzo 	return (revents);
3878847bf383SLuigi Rizzo #undef want_tx
3879847bf383SLuigi Rizzo #undef want_rx
388068b8534bSLuigi Rizzo }
388168b8534bSLuigi Rizzo 
38824f80b14cSVincenzo Maffione int
38834f80b14cSVincenzo Maffione nma_intr_enable(struct netmap_adapter *na, int onoff)
38844f80b14cSVincenzo Maffione {
38854f80b14cSVincenzo Maffione 	bool changed = false;
38864f80b14cSVincenzo Maffione 	enum txrx t;
38874f80b14cSVincenzo Maffione 	int i;
38884f80b14cSVincenzo Maffione 
38894f80b14cSVincenzo Maffione 	for_rx_tx(t) {
38904f80b14cSVincenzo Maffione 		for (i = 0; i < nma_get_nrings(na, t); i++) {
38912ff91c17SVincenzo Maffione 			struct netmap_kring *kring = NMR(na, t)[i];
38924f80b14cSVincenzo Maffione 			int on = !(kring->nr_kflags & NKR_NOINTR);
38934f80b14cSVincenzo Maffione 
38944f80b14cSVincenzo Maffione 			if (!!onoff != !!on) {
38954f80b14cSVincenzo Maffione 				changed = true;
38964f80b14cSVincenzo Maffione 			}
38974f80b14cSVincenzo Maffione 			if (onoff) {
38984f80b14cSVincenzo Maffione 				kring->nr_kflags &= ~NKR_NOINTR;
38994f80b14cSVincenzo Maffione 			} else {
39004f80b14cSVincenzo Maffione 				kring->nr_kflags |= NKR_NOINTR;
39014f80b14cSVincenzo Maffione 			}
39024f80b14cSVincenzo Maffione 		}
39034f80b14cSVincenzo Maffione 	}
39044f80b14cSVincenzo Maffione 
39054f80b14cSVincenzo Maffione 	if (!changed) {
39064f80b14cSVincenzo Maffione 		return 0; /* nothing to do */
39074f80b14cSVincenzo Maffione 	}
39084f80b14cSVincenzo Maffione 
39094f80b14cSVincenzo Maffione 	if (!na->nm_intr) {
3910b6e66be2SVincenzo Maffione 		nm_prerr("Cannot %s interrupts for %s", onoff ? "enable" : "disable",
39114f80b14cSVincenzo Maffione 		  na->name);
39124f80b14cSVincenzo Maffione 		return -1;
39134f80b14cSVincenzo Maffione 	}
39144f80b14cSVincenzo Maffione 
39154f80b14cSVincenzo Maffione 	na->nm_intr(na, onoff);
39164f80b14cSVincenzo Maffione 
39174f80b14cSVincenzo Maffione 	return 0;
39184f80b14cSVincenzo Maffione }
39194f80b14cSVincenzo Maffione 
392017885a7bSLuigi Rizzo 
392117885a7bSLuigi Rizzo /*-------------------- driver support routines -------------------*/
392268b8534bSLuigi Rizzo 
392389cc2556SLuigi Rizzo /* default notify callback */
3924f9790aebSLuigi Rizzo static int
3925847bf383SLuigi Rizzo netmap_notify(struct netmap_kring *kring, int flags)
3926f9790aebSLuigi Rizzo {
39272ff91c17SVincenzo Maffione 	struct netmap_adapter *na = kring->notify_na;
3928847bf383SLuigi Rizzo 	enum txrx t = kring->tx;
3929f9790aebSLuigi Rizzo 
393037e3a6d3SLuigi Rizzo 	nm_os_selwakeup(&kring->si);
393189cc2556SLuigi Rizzo 	/* optimization: avoid a wake up on the global
393289cc2556SLuigi Rizzo 	 * queue if nobody has registered for more
393389cc2556SLuigi Rizzo 	 * than one ring
393489cc2556SLuigi Rizzo 	 */
3935847bf383SLuigi Rizzo 	if (na->si_users[t] > 0)
393637e3a6d3SLuigi Rizzo 		nm_os_selwakeup(&na->si[t]);
3937847bf383SLuigi Rizzo 
393837e3a6d3SLuigi Rizzo 	return NM_IRQ_COMPLETED;
3939f9790aebSLuigi Rizzo }
3940f9790aebSLuigi Rizzo 
394189cc2556SLuigi Rizzo /* called by all routines that create netmap_adapters.
394237e3a6d3SLuigi Rizzo  * provide some defaults and get a reference to the
394337e3a6d3SLuigi Rizzo  * memory allocator
394489cc2556SLuigi Rizzo  */
3945f9790aebSLuigi Rizzo int
3946f9790aebSLuigi Rizzo netmap_attach_common(struct netmap_adapter *na)
3947f9790aebSLuigi Rizzo {
39482ff91c17SVincenzo Maffione 	if (!na->rx_buf_maxsize) {
39492ff91c17SVincenzo Maffione 		/* Set a conservative default (larger is safer). */
39502ff91c17SVincenzo Maffione 		na->rx_buf_maxsize = PAGE_SIZE;
39512ff91c17SVincenzo Maffione 	}
39522ff91c17SVincenzo Maffione 
395317885a7bSLuigi Rizzo #ifdef __FreeBSD__
395437e3a6d3SLuigi Rizzo 	if (na->na_flags & NAF_HOST_RINGS && na->ifp) {
395537e3a6d3SLuigi Rizzo 		na->if_input = na->ifp->if_input; /* for netmap_send_up */
39564bf50f18SLuigi Rizzo 	}
39574f80b14cSVincenzo Maffione 	na->pdev = na; /* make sure netmap_mem_map() is called */
395837e3a6d3SLuigi Rizzo #endif /* __FreeBSD__ */
39592a7db7a6SVincenzo Maffione 	if (na->na_flags & NAF_HOST_RINGS) {
39602a7db7a6SVincenzo Maffione 		if (na->num_host_rx_rings == 0)
39612a7db7a6SVincenzo Maffione 			na->num_host_rx_rings = 1;
39622a7db7a6SVincenzo Maffione 		if (na->num_host_tx_rings == 0)
39632a7db7a6SVincenzo Maffione 			na->num_host_tx_rings = 1;
39642a7db7a6SVincenzo Maffione 	}
3965f9790aebSLuigi Rizzo 	if (na->nm_krings_create == NULL) {
396689cc2556SLuigi Rizzo 		/* we assume that we have been called by a driver,
396789cc2556SLuigi Rizzo 		 * since other port types all provide their own
396889cc2556SLuigi Rizzo 		 * nm_krings_create
396989cc2556SLuigi Rizzo 		 */
3970f9790aebSLuigi Rizzo 		na->nm_krings_create = netmap_hw_krings_create;
397117885a7bSLuigi Rizzo 		na->nm_krings_delete = netmap_hw_krings_delete;
3972f9790aebSLuigi Rizzo 	}
3973f9790aebSLuigi Rizzo 	if (na->nm_notify == NULL)
3974f9790aebSLuigi Rizzo 		na->nm_notify = netmap_notify;
3975f9790aebSLuigi Rizzo 	na->active_fds = 0;
3976f9790aebSLuigi Rizzo 
3977c3e9b4dbSLuiz Otavio O Souza 	if (na->nm_mem == NULL) {
3978a6d768d8SVincenzo Maffione 		/* use iommu or global allocator */
3979a6d768d8SVincenzo Maffione 		na->nm_mem = netmap_mem_get_iommu(na);
3980c3e9b4dbSLuiz Otavio O Souza 	}
39814bf50f18SLuigi Rizzo 	if (na->nm_bdg_attach == NULL)
39824bf50f18SLuigi Rizzo 		/* no special nm_bdg_attach callback. On VALE
39834bf50f18SLuigi Rizzo 		 * attach, we need to interpose a bwrap
39844bf50f18SLuigi Rizzo 		 */
39852a7db7a6SVincenzo Maffione 		na->nm_bdg_attach = netmap_default_bdg_attach;
398637e3a6d3SLuigi Rizzo 
3987f9790aebSLuigi Rizzo 	return 0;
3988f9790aebSLuigi Rizzo }
3989f9790aebSLuigi Rizzo 
399037e3a6d3SLuigi Rizzo /* Wrapper for the register callback provided netmap-enabled
399137e3a6d3SLuigi Rizzo  * hardware drivers.
399237e3a6d3SLuigi Rizzo  * nm_iszombie(na) means that the driver module has been
39934bf50f18SLuigi Rizzo  * unloaded, so we cannot call into it.
399437e3a6d3SLuigi Rizzo  * nm_os_ifnet_lock() must guarantee mutual exclusion with
399537e3a6d3SLuigi Rizzo  * module unloading.
39964bf50f18SLuigi Rizzo  */
39974bf50f18SLuigi Rizzo static int
399837e3a6d3SLuigi Rizzo netmap_hw_reg(struct netmap_adapter *na, int onoff)
39994bf50f18SLuigi Rizzo {
40004bf50f18SLuigi Rizzo 	struct netmap_hw_adapter *hwna =
40014bf50f18SLuigi Rizzo 		(struct netmap_hw_adapter*)na;
400237e3a6d3SLuigi Rizzo 	int error = 0;
40034bf50f18SLuigi Rizzo 
400437e3a6d3SLuigi Rizzo 	nm_os_ifnet_lock();
40054bf50f18SLuigi Rizzo 
400637e3a6d3SLuigi Rizzo 	if (nm_iszombie(na)) {
400737e3a6d3SLuigi Rizzo 		if (onoff) {
400837e3a6d3SLuigi Rizzo 			error = ENXIO;
400937e3a6d3SLuigi Rizzo 		} else if (na != NULL) {
401037e3a6d3SLuigi Rizzo 			na->na_flags &= ~NAF_NETMAP_ON;
401137e3a6d3SLuigi Rizzo 		}
401237e3a6d3SLuigi Rizzo 		goto out;
401337e3a6d3SLuigi Rizzo 	}
401437e3a6d3SLuigi Rizzo 
401537e3a6d3SLuigi Rizzo 	error = hwna->nm_hw_register(na, onoff);
401637e3a6d3SLuigi Rizzo 
401737e3a6d3SLuigi Rizzo out:
401837e3a6d3SLuigi Rizzo 	nm_os_ifnet_unlock();
401937e3a6d3SLuigi Rizzo 
402037e3a6d3SLuigi Rizzo 	return error;
402137e3a6d3SLuigi Rizzo }
402237e3a6d3SLuigi Rizzo 
402337e3a6d3SLuigi Rizzo static void
402437e3a6d3SLuigi Rizzo netmap_hw_dtor(struct netmap_adapter *na)
402537e3a6d3SLuigi Rizzo {
40262a7db7a6SVincenzo Maffione 	if (na->ifp == NULL)
402737e3a6d3SLuigi Rizzo 		return;
402837e3a6d3SLuigi Rizzo 
40292a7db7a6SVincenzo Maffione 	NM_DETACH_NA(na->ifp);
40304bf50f18SLuigi Rizzo }
40314bf50f18SLuigi Rizzo 
4032f18be576SLuigi Rizzo 
403368b8534bSLuigi Rizzo /*
4034c3e9b4dbSLuiz Otavio O Souza  * Allocate a netmap_adapter object, and initialize it from the
403537e3a6d3SLuigi Rizzo  * 'arg' passed by the driver on attach.
4036c3e9b4dbSLuiz Otavio O Souza  * We allocate a block of memory of 'size' bytes, which has room
4037c3e9b4dbSLuiz Otavio O Souza  * for struct netmap_adapter plus additional room private to
4038c3e9b4dbSLuiz Otavio O Souza  * the caller.
403968b8534bSLuigi Rizzo  * Return 0 on success, ENOMEM otherwise.
404068b8534bSLuigi Rizzo  */
4041c3e9b4dbSLuiz Otavio O Souza int
40424f80b14cSVincenzo Maffione netmap_attach_ext(struct netmap_adapter *arg, size_t size, int override_reg)
404368b8534bSLuigi Rizzo {
4044f9790aebSLuigi Rizzo 	struct netmap_hw_adapter *hwna = NULL;
404537e3a6d3SLuigi Rizzo 	struct ifnet *ifp = NULL;
404668b8534bSLuigi Rizzo 
4047c3e9b4dbSLuiz Otavio O Souza 	if (size < sizeof(struct netmap_hw_adapter)) {
4048b6e66be2SVincenzo Maffione 		if (netmap_debug & NM_DEBUG_ON)
4049b6e66be2SVincenzo Maffione 			nm_prerr("Invalid netmap adapter size %d", (int)size);
4050c3e9b4dbSLuiz Otavio O Souza 		return EINVAL;
4051c3e9b4dbSLuiz Otavio O Souza 	}
4052c3e9b4dbSLuiz Otavio O Souza 
4053b6e66be2SVincenzo Maffione 	if (arg == NULL || arg->ifp == NULL) {
4054b6e66be2SVincenzo Maffione 		if (netmap_debug & NM_DEBUG_ON)
4055b6e66be2SVincenzo Maffione 			nm_prerr("either arg or arg->ifp is NULL");
40562a7db7a6SVincenzo Maffione 		return EINVAL;
4057b6e66be2SVincenzo Maffione 	}
4058b6e66be2SVincenzo Maffione 
4059b6e66be2SVincenzo Maffione 	if (arg->num_tx_rings == 0 || arg->num_rx_rings == 0) {
4060b6e66be2SVincenzo Maffione 		if (netmap_debug & NM_DEBUG_ON)
4061b6e66be2SVincenzo Maffione 			nm_prerr("%s: invalid rings tx %d rx %d",
4062b6e66be2SVincenzo Maffione 				arg->name, arg->num_tx_rings, arg->num_rx_rings);
4063b6e66be2SVincenzo Maffione 		return EINVAL;
4064b6e66be2SVincenzo Maffione 	}
40654f80b14cSVincenzo Maffione 
406637e3a6d3SLuigi Rizzo 	ifp = arg->ifp;
40672a7db7a6SVincenzo Maffione 	if (NM_NA_CLASH(ifp)) {
40684f80b14cSVincenzo Maffione 		/* If NA(ifp) is not null but there is no valid netmap
40694f80b14cSVincenzo Maffione 		 * adapter it means that someone else is using the same
40704f80b14cSVincenzo Maffione 		 * pointer (e.g. ax25_ptr on linux). This happens for
40714f80b14cSVincenzo Maffione 		 * instance when also PF_RING is in use. */
4072b6e66be2SVincenzo Maffione 		nm_prerr("Error: netmap adapter hook is busy");
40734f80b14cSVincenzo Maffione 		return EBUSY;
40744f80b14cSVincenzo Maffione 	}
40754f80b14cSVincenzo Maffione 
4076c3e9b4dbSLuiz Otavio O Souza 	hwna = nm_os_malloc(size);
4077f9790aebSLuigi Rizzo 	if (hwna == NULL)
4078ae10d1afSLuigi Rizzo 		goto fail;
4079f9790aebSLuigi Rizzo 	hwna->up = *arg;
4080847bf383SLuigi Rizzo 	hwna->up.na_flags |= NAF_HOST_RINGS | NAF_NATIVE;
4081b6e66be2SVincenzo Maffione 	strlcpy(hwna->up.name, ifp->if_xname, sizeof(hwna->up.name));
40824f80b14cSVincenzo Maffione 	if (override_reg) {
40834bf50f18SLuigi Rizzo 		hwna->nm_hw_register = hwna->up.nm_register;
408437e3a6d3SLuigi Rizzo 		hwna->up.nm_register = netmap_hw_reg;
40854f80b14cSVincenzo Maffione 	}
4086f9790aebSLuigi Rizzo 	if (netmap_attach_common(&hwna->up)) {
4087c3e9b4dbSLuiz Otavio O Souza 		nm_os_free(hwna);
4088f9790aebSLuigi Rizzo 		goto fail;
4089f9790aebSLuigi Rizzo 	}
4090f9790aebSLuigi Rizzo 	netmap_adapter_get(&hwna->up);
4091f9790aebSLuigi Rizzo 
409237e3a6d3SLuigi Rizzo 	NM_ATTACH_NA(ifp, &hwna->up);
409337e3a6d3SLuigi Rizzo 
40942a7db7a6SVincenzo Maffione 	nm_os_onattach(ifp);
40952a7db7a6SVincenzo Maffione 
409637e3a6d3SLuigi Rizzo 	if (arg->nm_dtor == NULL) {
409737e3a6d3SLuigi Rizzo 		hwna->up.nm_dtor = netmap_hw_dtor;
409837e3a6d3SLuigi Rizzo 	}
4099f9790aebSLuigi Rizzo 
41001ef2a881SVincenzo Maffione 	if_printf(ifp, "netmap queues/slots: TX %d/%d, RX %d/%d\n",
4101d82f9014SRui Paulo 	    hwna->up.num_tx_rings, hwna->up.num_tx_desc,
4102d82f9014SRui Paulo 	    hwna->up.num_rx_rings, hwna->up.num_rx_desc);
4103ae10d1afSLuigi Rizzo 	return 0;
410468b8534bSLuigi Rizzo 
4105ae10d1afSLuigi Rizzo fail:
4106b6e66be2SVincenzo Maffione 	nm_prerr("fail, arg %p ifp %p na %p", arg, ifp, hwna);
4107f9790aebSLuigi Rizzo 	return (hwna ? EINVAL : ENOMEM);
410868b8534bSLuigi Rizzo }
410968b8534bSLuigi Rizzo 
411068b8534bSLuigi Rizzo 
411137e3a6d3SLuigi Rizzo int
411237e3a6d3SLuigi Rizzo netmap_attach(struct netmap_adapter *arg)
411337e3a6d3SLuigi Rizzo {
41144f80b14cSVincenzo Maffione 	return netmap_attach_ext(arg, sizeof(struct netmap_hw_adapter),
41154f80b14cSVincenzo Maffione 			1 /* override nm_reg */);
411637e3a6d3SLuigi Rizzo }
411737e3a6d3SLuigi Rizzo 
411837e3a6d3SLuigi Rizzo 
4119f9790aebSLuigi Rizzo void
4120f9790aebSLuigi Rizzo NM_DBG(netmap_adapter_get)(struct netmap_adapter *na)
4121f9790aebSLuigi Rizzo {
4122f9790aebSLuigi Rizzo 	if (!na) {
4123f9790aebSLuigi Rizzo 		return;
4124f9790aebSLuigi Rizzo 	}
4125f9790aebSLuigi Rizzo 
4126f9790aebSLuigi Rizzo 	refcount_acquire(&na->na_refcount);
4127f9790aebSLuigi Rizzo }
4128f9790aebSLuigi Rizzo 
4129f9790aebSLuigi Rizzo 
4130f9790aebSLuigi Rizzo /* returns 1 iff the netmap_adapter is destroyed */
4131f9790aebSLuigi Rizzo int
4132f9790aebSLuigi Rizzo NM_DBG(netmap_adapter_put)(struct netmap_adapter *na)
4133f9790aebSLuigi Rizzo {
4134f9790aebSLuigi Rizzo 	if (!na)
4135f9790aebSLuigi Rizzo 		return 1;
4136f9790aebSLuigi Rizzo 
4137f9790aebSLuigi Rizzo 	if (!refcount_release(&na->na_refcount))
4138f9790aebSLuigi Rizzo 		return 0;
4139f9790aebSLuigi Rizzo 
4140f9790aebSLuigi Rizzo 	if (na->nm_dtor)
4141f9790aebSLuigi Rizzo 		na->nm_dtor(na);
4142f9790aebSLuigi Rizzo 
41434f80b14cSVincenzo Maffione 	if (na->tx_rings) { /* XXX should not happen */
4144b6e66be2SVincenzo Maffione 		if (netmap_debug & NM_DEBUG_ON)
4145b6e66be2SVincenzo Maffione 			nm_prerr("freeing leftover tx_rings");
41464f80b14cSVincenzo Maffione 		na->nm_krings_delete(na);
41474f80b14cSVincenzo Maffione 	}
41484f80b14cSVincenzo Maffione 	netmap_pipe_dealloc(na);
41494f80b14cSVincenzo Maffione 	if (na->nm_mem)
41504f80b14cSVincenzo Maffione 		netmap_mem_put(na->nm_mem);
41514f80b14cSVincenzo Maffione 	bzero(na, sizeof(*na));
41524f80b14cSVincenzo Maffione 	nm_os_free(na);
4153f9790aebSLuigi Rizzo 
4154f9790aebSLuigi Rizzo 	return 1;
4155f9790aebSLuigi Rizzo }
4156f9790aebSLuigi Rizzo 
415789cc2556SLuigi Rizzo /* nm_krings_create callback for all hardware native adapters */
4158f9790aebSLuigi Rizzo int
4159f9790aebSLuigi Rizzo netmap_hw_krings_create(struct netmap_adapter *na)
4160f9790aebSLuigi Rizzo {
4161f0ea3689SLuigi Rizzo 	int ret = netmap_krings_create(na, 0);
416217885a7bSLuigi Rizzo 	if (ret == 0) {
416317885a7bSLuigi Rizzo 		/* initialize the mbq for the sw rx ring */
41642a7db7a6SVincenzo Maffione 		u_int lim = netmap_real_rings(na, NR_RX), i;
41652a7db7a6SVincenzo Maffione 		for (i = na->num_rx_rings; i < lim; i++) {
41662a7db7a6SVincenzo Maffione 			mbq_safe_init(&NMR(na, NR_RX)[i]->rx_queue);
41672a7db7a6SVincenzo Maffione 		}
416875f4f3edSVincenzo Maffione 		nm_prdis("initialized sw rx queue %d", na->num_rx_rings);
416917885a7bSLuigi Rizzo 	}
417017885a7bSLuigi Rizzo 	return ret;
4171f9790aebSLuigi Rizzo }
4172f9790aebSLuigi Rizzo 
4173f9790aebSLuigi Rizzo 
4174f9790aebSLuigi Rizzo 
417568b8534bSLuigi Rizzo /*
417689cc2556SLuigi Rizzo  * Called on module unload by the netmap-enabled drivers
417768b8534bSLuigi Rizzo  */
417868b8534bSLuigi Rizzo void
417968b8534bSLuigi Rizzo netmap_detach(struct ifnet *ifp)
418068b8534bSLuigi Rizzo {
418168b8534bSLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
418268b8534bSLuigi Rizzo 
418368b8534bSLuigi Rizzo 	if (!na)
418468b8534bSLuigi Rizzo 		return;
418568b8534bSLuigi Rizzo 
4186f9790aebSLuigi Rizzo 	NMG_LOCK();
418737e3a6d3SLuigi Rizzo 	netmap_set_all_rings(na, NM_KR_LOCKED);
4188847bf383SLuigi Rizzo 	/*
4189847bf383SLuigi Rizzo 	 * if the netmap adapter is not native, somebody
4190847bf383SLuigi Rizzo 	 * changed it, so we can not release it here.
419137e3a6d3SLuigi Rizzo 	 * The NAF_ZOMBIE flag will notify the new owner that
4192847bf383SLuigi Rizzo 	 * the driver is gone.
4193847bf383SLuigi Rizzo 	 */
41944f80b14cSVincenzo Maffione 	if (!(na->na_flags & NAF_NATIVE) || !netmap_adapter_put(na)) {
41954f80b14cSVincenzo Maffione 		na->na_flags |= NAF_ZOMBIE;
4196847bf383SLuigi Rizzo 	}
419737e3a6d3SLuigi Rizzo 	/* give active users a chance to notice that NAF_ZOMBIE has been
419837e3a6d3SLuigi Rizzo 	 * turned on, so that they can stop and return an error to userspace.
419937e3a6d3SLuigi Rizzo 	 * Note that this becomes a NOP if there are no active users and,
420037e3a6d3SLuigi Rizzo 	 * therefore, the put() above has deleted the na, since now NA(ifp) is
420137e3a6d3SLuigi Rizzo 	 * NULL.
420237e3a6d3SLuigi Rizzo 	 */
4203f9790aebSLuigi Rizzo 	netmap_enable_all_rings(ifp);
4204f9790aebSLuigi Rizzo 	NMG_UNLOCK();
4205ae10d1afSLuigi Rizzo }
4206f18be576SLuigi Rizzo 
4207f18be576SLuigi Rizzo 
420868b8534bSLuigi Rizzo /*
420902ad4083SLuigi Rizzo  * Intercept packets from the network stack and pass them
421002ad4083SLuigi Rizzo  * to netmap as incoming packets on the 'software' ring.
421117885a7bSLuigi Rizzo  *
421217885a7bSLuigi Rizzo  * We only store packets in a bounded mbq and then copy them
421317885a7bSLuigi Rizzo  * in the relevant rxsync routine.
421417885a7bSLuigi Rizzo  *
4215ce3ee1e7SLuigi Rizzo  * We rely on the OS to make sure that the ifp and na do not go
4216ce3ee1e7SLuigi Rizzo  * away (typically the caller checks for IFF_DRV_RUNNING or the like).
4217ce3ee1e7SLuigi Rizzo  * In nm_register() or whenever there is a reinitialization,
4218f9790aebSLuigi Rizzo  * we make sure to make the mode change visible here.
421968b8534bSLuigi Rizzo  */
422068b8534bSLuigi Rizzo int
4221ce3ee1e7SLuigi Rizzo netmap_transmit(struct ifnet *ifp, struct mbuf *m)
422268b8534bSLuigi Rizzo {
422368b8534bSLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
422437e3a6d3SLuigi Rizzo 	struct netmap_kring *kring, *tx_kring;
422517885a7bSLuigi Rizzo 	u_int len = MBUF_LEN(m);
422617885a7bSLuigi Rizzo 	u_int error = ENOBUFS;
422737e3a6d3SLuigi Rizzo 	unsigned int txr;
422817885a7bSLuigi Rizzo 	struct mbq *q;
4229c3e9b4dbSLuiz Otavio O Souza 	int busy;
42302a7db7a6SVincenzo Maffione 	u_int i;
423168b8534bSLuigi Rizzo 
42322a7db7a6SVincenzo Maffione 	i = MBUF_TXQ(m);
42332a7db7a6SVincenzo Maffione 	if (i >= na->num_host_rx_rings) {
42342a7db7a6SVincenzo Maffione 		i = i % na->num_host_rx_rings;
42352a7db7a6SVincenzo Maffione 	}
42362a7db7a6SVincenzo Maffione 	kring = NMR(na, NR_RX)[nma_get_nrings(na, NR_RX) + i];
42372a7db7a6SVincenzo Maffione 
4238ce3ee1e7SLuigi Rizzo 	// XXX [Linux] we do not need this lock
4239ce3ee1e7SLuigi Rizzo 	// if we follow the down/configure/up protocol -gl
4240ce3ee1e7SLuigi Rizzo 	// mtx_lock(&na->core_lock);
424117885a7bSLuigi Rizzo 
42424bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na)) {
4243b6e66be2SVincenzo Maffione 		nm_prerr("%s not in netmap mode anymore", na->name);
4244ce3ee1e7SLuigi Rizzo 		error = ENXIO;
4245ce3ee1e7SLuigi Rizzo 		goto done;
4246ce3ee1e7SLuigi Rizzo 	}
4247ce3ee1e7SLuigi Rizzo 
424837e3a6d3SLuigi Rizzo 	txr = MBUF_TXQ(m);
424937e3a6d3SLuigi Rizzo 	if (txr >= na->num_tx_rings) {
425037e3a6d3SLuigi Rizzo 		txr %= na->num_tx_rings;
425137e3a6d3SLuigi Rizzo 	}
42522ff91c17SVincenzo Maffione 	tx_kring = NMR(na, NR_TX)[txr];
425337e3a6d3SLuigi Rizzo 
425437e3a6d3SLuigi Rizzo 	if (tx_kring->nr_mode == NKR_NETMAP_OFF) {
425537e3a6d3SLuigi Rizzo 		return MBUF_TRANSMIT(na, ifp, m);
425637e3a6d3SLuigi Rizzo 	}
425737e3a6d3SLuigi Rizzo 
425817885a7bSLuigi Rizzo 	q = &kring->rx_queue;
425917885a7bSLuigi Rizzo 
4260ce3ee1e7SLuigi Rizzo 	// XXX reconsider long packets if we handle fragments
42614bf50f18SLuigi Rizzo 	if (len > NETMAP_BUF_SIZE(na)) { /* too long for us */
4262b6e66be2SVincenzo Maffione 		nm_prerr("%s from_host, drop packet size %d > %d", na->name,
42634bf50f18SLuigi Rizzo 			len, NETMAP_BUF_SIZE(na));
4264ce3ee1e7SLuigi Rizzo 		goto done;
4265849bec0eSLuigi Rizzo 	}
426617885a7bSLuigi Rizzo 
42672a7db7a6SVincenzo Maffione 	if (!netmap_generic_hwcsum) {
42682a7db7a6SVincenzo Maffione 		if (nm_os_mbuf_has_csum_offld(m)) {
426975f4f3edSVincenzo Maffione 			nm_prlim(1, "%s drop mbuf that needs checksum offload", na->name);
42702a7db7a6SVincenzo Maffione 			goto done;
42712a7db7a6SVincenzo Maffione 		}
42722a7db7a6SVincenzo Maffione 	}
42732a7db7a6SVincenzo Maffione 
42742a7db7a6SVincenzo Maffione 	if (nm_os_mbuf_has_seg_offld(m)) {
427575f4f3edSVincenzo Maffione 		nm_prlim(1, "%s drop mbuf that needs generic segmentation offload", na->name);
427637e3a6d3SLuigi Rizzo 		goto done;
427737e3a6d3SLuigi Rizzo 	}
427837e3a6d3SLuigi Rizzo 
427989a9a5b5SVincenzo Maffione #ifdef __FreeBSD__
428089a9a5b5SVincenzo Maffione 	ETHER_BPF_MTAP(ifp, m);
428189a9a5b5SVincenzo Maffione #endif /* __FreeBSD__ */
428289a9a5b5SVincenzo Maffione 
4283c3e9b4dbSLuiz Otavio O Souza 	/* protect against netmap_rxsync_from_host(), netmap_sw_to_nic()
428417885a7bSLuigi Rizzo 	 * and maybe other instances of netmap_transmit (the latter
428517885a7bSLuigi Rizzo 	 * not possible on Linux).
4286c3e9b4dbSLuiz Otavio O Souza 	 * We enqueue the mbuf only if we are sure there is going to be
4287c3e9b4dbSLuiz Otavio O Souza 	 * enough room in the host RX ring, otherwise we drop it.
4288ce3ee1e7SLuigi Rizzo 	 */
4289997b054cSLuigi Rizzo 	mbq_lock(q);
429017885a7bSLuigi Rizzo 
4291c3e9b4dbSLuiz Otavio O Souza 	busy = kring->nr_hwtail - kring->nr_hwcur;
4292c3e9b4dbSLuiz Otavio O Souza 	if (busy < 0)
4293c3e9b4dbSLuiz Otavio O Souza 		busy += kring->nkr_num_slots;
4294c3e9b4dbSLuiz Otavio O Souza 	if (busy + mbq_len(q) >= kring->nkr_num_slots - 1) {
429575f4f3edSVincenzo Maffione 		nm_prlim(2, "%s full hwcur %d hwtail %d qlen %d", na->name,
4296c3e9b4dbSLuiz Otavio O Souza 			kring->nr_hwcur, kring->nr_hwtail, mbq_len(q));
4297ce3ee1e7SLuigi Rizzo 	} else {
429817885a7bSLuigi Rizzo 		mbq_enqueue(q, m);
429975f4f3edSVincenzo Maffione 		nm_prdis(2, "%s %d bufs in queue", na->name, mbq_len(q));
430017885a7bSLuigi Rizzo 		/* notify outside the lock */
430117885a7bSLuigi Rizzo 		m = NULL;
430268b8534bSLuigi Rizzo 		error = 0;
4303ce3ee1e7SLuigi Rizzo 	}
4304997b054cSLuigi Rizzo 	mbq_unlock(q);
4305ce3ee1e7SLuigi Rizzo 
430668b8534bSLuigi Rizzo done:
430717885a7bSLuigi Rizzo 	if (m)
430868b8534bSLuigi Rizzo 		m_freem(m);
430917885a7bSLuigi Rizzo 	/* unconditionally wake up listeners */
4310847bf383SLuigi Rizzo 	kring->nm_notify(kring, 0);
431189cc2556SLuigi Rizzo 	/* this is normally netmap_notify(), but for nics
431289cc2556SLuigi Rizzo 	 * connected to a bridge it is netmap_bwrap_intr_notify(),
431389cc2556SLuigi Rizzo 	 * that possibly forwards the frames through the switch
431489cc2556SLuigi Rizzo 	 */
431568b8534bSLuigi Rizzo 
431668b8534bSLuigi Rizzo 	return (error);
431768b8534bSLuigi Rizzo }
431868b8534bSLuigi Rizzo 
431968b8534bSLuigi Rizzo 
432068b8534bSLuigi Rizzo /*
43217ba6ecf2SVincenzo Maffione  * Reset function to be called by the driver routines when reinitializing
43227ba6ecf2SVincenzo Maffione  * a hardware ring. The driver is in charge of locking to protect the kring
432355f0ad5fSVincenzo Maffione  * while this operation is being performed. This is normally achieved by
432455f0ad5fSVincenzo Maffione  * calling netmap_disable_all_rings() before triggering a reset.
43257ba6ecf2SVincenzo Maffione  * If the kring is not in netmap mode, return NULL to inform the caller
43267ba6ecf2SVincenzo Maffione  * that this is the case.
432755f0ad5fSVincenzo Maffione  * If the kring is in netmap mode, set hwofs so that the netmap indices
432855f0ad5fSVincenzo Maffione  * seen by userspace (head/cut/tail) do not change, although the internal
432955f0ad5fSVincenzo Maffione  * NIC indices have been reset to 0.
43307ba6ecf2SVincenzo Maffione  * In any case, adjust kring->nr_mode.
433168b8534bSLuigi Rizzo  */
433268b8534bSLuigi Rizzo struct netmap_slot *
4333ce3ee1e7SLuigi Rizzo netmap_reset(struct netmap_adapter *na, enum txrx tx, u_int n,
433468b8534bSLuigi Rizzo 	u_int new_cur)
433568b8534bSLuigi Rizzo {
433668b8534bSLuigi Rizzo 	struct netmap_kring *kring;
433755f0ad5fSVincenzo Maffione 	u_int new_hwtail, new_hwofs;
433868b8534bSLuigi Rizzo 
43394bf50f18SLuigi Rizzo 	if (!nm_native_on(na)) {
434075f4f3edSVincenzo Maffione 		nm_prdis("interface not in native netmap mode");
434168b8534bSLuigi Rizzo 		return NULL;	/* nothing to reinitialize */
4342ce3ee1e7SLuigi Rizzo 	}
434368b8534bSLuigi Rizzo 
434464ae02c3SLuigi Rizzo 	if (tx == NR_TX) {
43458241616dSLuigi Rizzo 		if (n >= na->num_tx_rings)
43468241616dSLuigi Rizzo 			return NULL;
43472ff91c17SVincenzo Maffione 		kring = na->tx_rings[n];
434855f0ad5fSVincenzo Maffione 		/*
434955f0ad5fSVincenzo Maffione 		 * Set hwofs to rhead, so that slots[rhead] is mapped to
435055f0ad5fSVincenzo Maffione 		 * the NIC internal slot 0, and thus the netmap buffer
435155f0ad5fSVincenzo Maffione 		 * at rhead is the next to be transmitted. Transmissions
435255f0ad5fSVincenzo Maffione 		 * that were pending before the reset are considered as
435355f0ad5fSVincenzo Maffione 		 * sent, so that we can have hwcur = rhead. All the slots
435455f0ad5fSVincenzo Maffione 		 * are now owned by the user, so we can also reinit hwtail.
435555f0ad5fSVincenzo Maffione 		 */
435655f0ad5fSVincenzo Maffione 		new_hwofs = kring->rhead;
435755f0ad5fSVincenzo Maffione 		new_hwtail = nm_prev(kring->rhead, kring->nkr_num_slots - 1);
435864ae02c3SLuigi Rizzo 	} else {
43598241616dSLuigi Rizzo 		if (n >= na->num_rx_rings)
43608241616dSLuigi Rizzo 			return NULL;
43612ff91c17SVincenzo Maffione 		kring = na->rx_rings[n];
436255f0ad5fSVincenzo Maffione 		/*
436355f0ad5fSVincenzo Maffione 		 * Set hwofs to hwtail, so that slots[hwtail] is mapped to
436455f0ad5fSVincenzo Maffione 		 * the NIC internal slot 0, and thus the netmap buffer
436555f0ad5fSVincenzo Maffione 		 * at hwtail is the next to be given to the NIC.
436655f0ad5fSVincenzo Maffione 		 * Unread slots (the ones in [rhead,hwtail[) are owned by
436755f0ad5fSVincenzo Maffione 		 * the user, and thus the caller cannot give them
436855f0ad5fSVincenzo Maffione 		 * to the NIC right now.
436955f0ad5fSVincenzo Maffione 		 */
437055f0ad5fSVincenzo Maffione 		new_hwofs = kring->nr_hwtail;
437155f0ad5fSVincenzo Maffione 		new_hwtail = kring->nr_hwtail;
43727ba6ecf2SVincenzo Maffione 	}
437337e3a6d3SLuigi Rizzo 	if (kring->nr_pending_mode == NKR_NETMAP_OFF) {
437437e3a6d3SLuigi Rizzo 		kring->nr_mode = NKR_NETMAP_OFF;
437537e3a6d3SLuigi Rizzo 		return NULL;
437637e3a6d3SLuigi Rizzo 	}
43777ba6ecf2SVincenzo Maffione 	if (netmap_verbose) {
437855f0ad5fSVincenzo Maffione 	    nm_prinf("%s, hc %u->%u, ht %u->%u, ho %u->%u", kring->name,
437955f0ad5fSVincenzo Maffione 	        kring->nr_hwcur, kring->rhead,
438055f0ad5fSVincenzo Maffione 	        kring->nr_hwtail, new_hwtail,
438155f0ad5fSVincenzo Maffione 		kring->nkr_hwofs, new_hwofs);
438264ae02c3SLuigi Rizzo 	}
438355f0ad5fSVincenzo Maffione 	kring->nr_hwcur = kring->rhead;
438455f0ad5fSVincenzo Maffione 	kring->nr_hwtail = new_hwtail;
438555f0ad5fSVincenzo Maffione 	kring->nkr_hwofs = new_hwofs;
4386506cc70cSLuigi Rizzo 
438768b8534bSLuigi Rizzo 	/*
4388ce3ee1e7SLuigi Rizzo 	 * Wakeup on the individual and global selwait
4389506cc70cSLuigi Rizzo 	 * We do the wakeup here, but the ring is not yet reconfigured.
4390506cc70cSLuigi Rizzo 	 * However, we are under lock so there are no races.
439168b8534bSLuigi Rizzo 	 */
439237e3a6d3SLuigi Rizzo 	kring->nr_mode = NKR_NETMAP_ON;
4393847bf383SLuigi Rizzo 	kring->nm_notify(kring, 0);
439468b8534bSLuigi Rizzo 	return kring->ring->slot;
439568b8534bSLuigi Rizzo }
439668b8534bSLuigi Rizzo 
439768b8534bSLuigi Rizzo 
4398ce3ee1e7SLuigi Rizzo /*
4399f9790aebSLuigi Rizzo  * Dispatch rx/tx interrupts to the netmap rings.
4400ce3ee1e7SLuigi Rizzo  *
4401ce3ee1e7SLuigi Rizzo  * "work_done" is non-null on the RX path, NULL for the TX path.
4402ce3ee1e7SLuigi Rizzo  * We rely on the OS to make sure that there is only one active
4403ce3ee1e7SLuigi Rizzo  * instance per queue, and that there is appropriate locking.
4404849bec0eSLuigi Rizzo  *
4405f9790aebSLuigi Rizzo  * The 'notify' routine depends on what the ring is attached to.
4406f9790aebSLuigi Rizzo  * - for a netmap file descriptor, do a selwakeup on the individual
4407f9790aebSLuigi Rizzo  *   waitqueue, plus one on the global one if needed
44084bf50f18SLuigi Rizzo  *   (see netmap_notify)
44094bf50f18SLuigi Rizzo  * - for a nic connected to a switch, call the proper forwarding routine
44104bf50f18SLuigi Rizzo  *   (see netmap_bwrap_intr_notify)
4411f9790aebSLuigi Rizzo  */
441237e3a6d3SLuigi Rizzo int
441337e3a6d3SLuigi Rizzo netmap_common_irq(struct netmap_adapter *na, u_int q, u_int *work_done)
4414f9790aebSLuigi Rizzo {
4415f9790aebSLuigi Rizzo 	struct netmap_kring *kring;
4416847bf383SLuigi Rizzo 	enum txrx t = (work_done ? NR_RX : NR_TX);
4417f9790aebSLuigi Rizzo 
4418f9790aebSLuigi Rizzo 	q &= NETMAP_RING_MASK;
4419f9790aebSLuigi Rizzo 
4420b6e66be2SVincenzo Maffione 	if (netmap_debug & (NM_DEBUG_RXINTR|NM_DEBUG_TXINTR)) {
4421b6e66be2SVincenzo Maffione 	        nm_prlim(5, "received %s queue %d", work_done ? "RX" : "TX" , q);
4422f9790aebSLuigi Rizzo 	}
4423f9790aebSLuigi Rizzo 
4424847bf383SLuigi Rizzo 	if (q >= nma_get_nrings(na, t))
442537e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS; // not a physical queue
4426847bf383SLuigi Rizzo 
44272ff91c17SVincenzo Maffione 	kring = NMR(na, t)[q];
4428847bf383SLuigi Rizzo 
442937e3a6d3SLuigi Rizzo 	if (kring->nr_mode == NKR_NETMAP_OFF) {
443037e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
443137e3a6d3SLuigi Rizzo 	}
443237e3a6d3SLuigi Rizzo 
4433847bf383SLuigi Rizzo 	if (t == NR_RX) {
4434f9790aebSLuigi Rizzo 		kring->nr_kflags |= NKR_PENDINTR;	// XXX atomic ?
4435f9790aebSLuigi Rizzo 		*work_done = 1; /* do not fire napi again */
4436f9790aebSLuigi Rizzo 	}
443737e3a6d3SLuigi Rizzo 
443837e3a6d3SLuigi Rizzo 	return kring->nm_notify(kring, 0);
4439f9790aebSLuigi Rizzo }
4440f9790aebSLuigi Rizzo 
444117885a7bSLuigi Rizzo 
4442f9790aebSLuigi Rizzo /*
4443f9790aebSLuigi Rizzo  * Default functions to handle rx/tx interrupts from a physical device.
4444f9790aebSLuigi Rizzo  * "work_done" is non-null on the RX path, NULL for the TX path.
4445f9790aebSLuigi Rizzo  *
444637e3a6d3SLuigi Rizzo  * If the card is not in netmap mode, simply return NM_IRQ_PASS,
4447ce3ee1e7SLuigi Rizzo  * so that the caller proceeds with regular processing.
444837e3a6d3SLuigi Rizzo  * Otherwise call netmap_common_irq().
4449ce3ee1e7SLuigi Rizzo  *
4450ce3ee1e7SLuigi Rizzo  * If the card is connected to a netmap file descriptor,
4451ce3ee1e7SLuigi Rizzo  * do a selwakeup on the individual queue, plus one on the global one
4452ce3ee1e7SLuigi Rizzo  * if needed (multiqueue card _and_ there are multiqueue listeners),
445337e3a6d3SLuigi Rizzo  * and return NR_IRQ_COMPLETED.
4454ce3ee1e7SLuigi Rizzo  *
4455ce3ee1e7SLuigi Rizzo  * Finally, if called on rx from an interface connected to a switch,
445637e3a6d3SLuigi Rizzo  * calls the proper forwarding routine.
44571a26580eSLuigi Rizzo  */
4458babc7c12SLuigi Rizzo int
4459ce3ee1e7SLuigi Rizzo netmap_rx_irq(struct ifnet *ifp, u_int q, u_int *work_done)
44601a26580eSLuigi Rizzo {
44614bf50f18SLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
44624bf50f18SLuigi Rizzo 
44634bf50f18SLuigi Rizzo 	/*
44644bf50f18SLuigi Rizzo 	 * XXX emulated netmap mode sets NAF_SKIP_INTR so
44654bf50f18SLuigi Rizzo 	 * we still use the regular driver even though the previous
44664bf50f18SLuigi Rizzo 	 * check fails. It is unclear whether we should use
44674bf50f18SLuigi Rizzo 	 * nm_native_on() here.
44684bf50f18SLuigi Rizzo 	 */
44694bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na))
447037e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
4471849bec0eSLuigi Rizzo 
44724bf50f18SLuigi Rizzo 	if (na->na_flags & NAF_SKIP_INTR) {
447375f4f3edSVincenzo Maffione 		nm_prdis("use regular interrupt");
447437e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
44758241616dSLuigi Rizzo 	}
44768241616dSLuigi Rizzo 
447737e3a6d3SLuigi Rizzo 	return netmap_common_irq(na, q, work_done);
44781a26580eSLuigi Rizzo }
44791a26580eSLuigi Rizzo 
44802a7db7a6SVincenzo Maffione /* set/clear native flags and if_transmit/netdev_ops */
44812a7db7a6SVincenzo Maffione void
44822a7db7a6SVincenzo Maffione nm_set_native_flags(struct netmap_adapter *na)
44832a7db7a6SVincenzo Maffione {
44842a7db7a6SVincenzo Maffione 	struct ifnet *ifp = na->ifp;
44852a7db7a6SVincenzo Maffione 
44862a7db7a6SVincenzo Maffione 	/* We do the setup for intercepting packets only if we are the
44871d238b07SVincenzo Maffione 	 * first user of this adapter. */
44882a7db7a6SVincenzo Maffione 	if (na->active_fds > 0) {
44892a7db7a6SVincenzo Maffione 		return;
44902a7db7a6SVincenzo Maffione 	}
44912a7db7a6SVincenzo Maffione 
44922a7db7a6SVincenzo Maffione 	na->na_flags |= NAF_NETMAP_ON;
44932a7db7a6SVincenzo Maffione 	nm_os_onenter(ifp);
4494b51f459aSCy Schubert 	nm_update_hostrings_mode(na);
44952a7db7a6SVincenzo Maffione }
44962a7db7a6SVincenzo Maffione 
44972a7db7a6SVincenzo Maffione void
44982a7db7a6SVincenzo Maffione nm_clear_native_flags(struct netmap_adapter *na)
44992a7db7a6SVincenzo Maffione {
45002a7db7a6SVincenzo Maffione 	struct ifnet *ifp = na->ifp;
45012a7db7a6SVincenzo Maffione 
45022a7db7a6SVincenzo Maffione 	/* We undo the setup for intercepting packets only if we are the
4503b6e66be2SVincenzo Maffione 	 * last user of this adapter. */
45042a7db7a6SVincenzo Maffione 	if (na->active_fds > 0) {
45052a7db7a6SVincenzo Maffione 		return;
45062a7db7a6SVincenzo Maffione 	}
45072a7db7a6SVincenzo Maffione 
4508b51f459aSCy Schubert 	nm_update_hostrings_mode(na);
45092a7db7a6SVincenzo Maffione 	nm_os_onexit(ifp);
45102a7db7a6SVincenzo Maffione 
45112a7db7a6SVincenzo Maffione 	na->na_flags &= ~NAF_NETMAP_ON;
45122a7db7a6SVincenzo Maffione }
45132a7db7a6SVincenzo Maffione 
451475f4f3edSVincenzo Maffione void
451575f4f3edSVincenzo Maffione netmap_krings_mode_commit(struct netmap_adapter *na, int onoff)
451675f4f3edSVincenzo Maffione {
451775f4f3edSVincenzo Maffione 	enum txrx t;
451875f4f3edSVincenzo Maffione 
451975f4f3edSVincenzo Maffione 	for_rx_tx(t) {
452075f4f3edSVincenzo Maffione 		int i;
452175f4f3edSVincenzo Maffione 
452275f4f3edSVincenzo Maffione 		for (i = 0; i < netmap_real_rings(na, t); i++) {
452375f4f3edSVincenzo Maffione 			struct netmap_kring *kring = NMR(na, t)[i];
452475f4f3edSVincenzo Maffione 
452575f4f3edSVincenzo Maffione 			if (onoff && nm_kring_pending_on(kring))
452675f4f3edSVincenzo Maffione 				kring->nr_mode = NKR_NETMAP_ON;
452775f4f3edSVincenzo Maffione 			else if (!onoff && nm_kring_pending_off(kring))
452875f4f3edSVincenzo Maffione 				kring->nr_mode = NKR_NETMAP_OFF;
452975f4f3edSVincenzo Maffione 		}
453075f4f3edSVincenzo Maffione 	}
453175f4f3edSVincenzo Maffione }
453275f4f3edSVincenzo Maffione 
453301c7d25fSLuigi Rizzo /*
4534f9790aebSLuigi Rizzo  * Module loader and unloader
4535f196ce38SLuigi Rizzo  *
4536f9790aebSLuigi Rizzo  * netmap_init() creates the /dev/netmap device and initializes
4537f9790aebSLuigi Rizzo  * all global variables. Returns 0 on success, errno on failure
4538f9790aebSLuigi Rizzo  * (but there is no chance)
4539f9790aebSLuigi Rizzo  *
4540f9790aebSLuigi Rizzo  * netmap_fini() destroys everything.
4541f196ce38SLuigi Rizzo  */
4542babc7c12SLuigi Rizzo 
4543babc7c12SLuigi Rizzo static struct cdev *netmap_dev; /* /dev/netmap character device. */
4544f9790aebSLuigi Rizzo extern struct cdevsw netmap_cdevsw;
4545babc7c12SLuigi Rizzo 
454617885a7bSLuigi Rizzo 
4547f9790aebSLuigi Rizzo void
454868b8534bSLuigi Rizzo netmap_fini(void)
454968b8534bSLuigi Rizzo {
4550f9790aebSLuigi Rizzo 	if (netmap_dev)
455168b8534bSLuigi Rizzo 		destroy_dev(netmap_dev);
455237e3a6d3SLuigi Rizzo 	/* we assume that there are no longer netmap users */
455337e3a6d3SLuigi Rizzo 	nm_os_ifnet_fini();
455437e3a6d3SLuigi Rizzo 	netmap_uninit_bridges();
4555ce3ee1e7SLuigi Rizzo 	netmap_mem_fini();
4556ce3ee1e7SLuigi Rizzo 	NMG_LOCK_DESTROY();
4557b6e66be2SVincenzo Maffione 	nm_prinf("netmap: unloaded module.");
455868b8534bSLuigi Rizzo }
455968b8534bSLuigi Rizzo 
456017885a7bSLuigi Rizzo 
4561f9790aebSLuigi Rizzo int
4562f9790aebSLuigi Rizzo netmap_init(void)
456368b8534bSLuigi Rizzo {
4564f9790aebSLuigi Rizzo 	int error;
456568b8534bSLuigi Rizzo 
4566f9790aebSLuigi Rizzo 	NMG_LOCK_INIT();
456768b8534bSLuigi Rizzo 
4568f9790aebSLuigi Rizzo 	error = netmap_mem_init();
4569f9790aebSLuigi Rizzo 	if (error != 0)
4570f9790aebSLuigi Rizzo 		goto fail;
4571c929ca72SLuigi Rizzo 	/*
4572c929ca72SLuigi Rizzo 	 * MAKEDEV_ETERNAL_KLD avoids an expensive check on syscalls
4573c929ca72SLuigi Rizzo 	 * when the module is compiled in.
4574c929ca72SLuigi Rizzo 	 * XXX could use make_dev_credv() to get error number
4575c929ca72SLuigi Rizzo 	 */
45760e73f29aSLuigi Rizzo 	netmap_dev = make_dev_credf(MAKEDEV_ETERNAL_KLD,
457711c0b69cSAdrian Chadd 		&netmap_cdevsw, 0, NULL, UID_ROOT, GID_WHEEL, 0600,
45780e73f29aSLuigi Rizzo 			      "netmap");
4579f9790aebSLuigi Rizzo 	if (!netmap_dev)
4580f9790aebSLuigi Rizzo 		goto fail;
4581f9790aebSLuigi Rizzo 
4582847bf383SLuigi Rizzo 	error = netmap_init_bridges();
4583847bf383SLuigi Rizzo 	if (error)
4584847bf383SLuigi Rizzo 		goto fail;
4585847bf383SLuigi Rizzo 
45864bf50f18SLuigi Rizzo #ifdef __FreeBSD__
458737e3a6d3SLuigi Rizzo 	nm_os_vi_init_index();
45884bf50f18SLuigi Rizzo #endif
4589847bf383SLuigi Rizzo 
459037e3a6d3SLuigi Rizzo 	error = nm_os_ifnet_init();
459137e3a6d3SLuigi Rizzo 	if (error)
459237e3a6d3SLuigi Rizzo 		goto fail;
459337e3a6d3SLuigi Rizzo 
4594fef84509SMark Johnston #if !defined(__FreeBSD__) || defined(KLD_MODULE)
4595b6e66be2SVincenzo Maffione 	nm_prinf("netmap: loaded module");
4596fef84509SMark Johnston #endif
4597f9790aebSLuigi Rizzo 	return (0);
4598f9790aebSLuigi Rizzo fail:
459968b8534bSLuigi Rizzo 	netmap_fini();
4600f9790aebSLuigi Rizzo 	return (EINVAL); /* may be incorrect */
460168b8534bSLuigi Rizzo }
4602