xref: /freebsd-14.2/sys/dev/netmap/netmap.c (revision c3e9b4db)
168b8534bSLuigi Rizzo /*
237e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2014 Matteo Landi
337e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Luigi Rizzo
437e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Giuseppe Lettieri
537e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Vincenzo Maffione
637e3a6d3SLuigi Rizzo  * All rights reserved.
768b8534bSLuigi Rizzo  *
868b8534bSLuigi Rizzo  * Redistribution and use in source and binary forms, with or without
968b8534bSLuigi Rizzo  * modification, are permitted provided that the following conditions
1068b8534bSLuigi Rizzo  * are met:
1168b8534bSLuigi Rizzo  *   1. Redistributions of source code must retain the above copyright
1268b8534bSLuigi Rizzo  *      notice, this list of conditions and the following disclaimer.
1368b8534bSLuigi Rizzo  *   2. Redistributions in binary form must reproduce the above copyright
1468b8534bSLuigi Rizzo  *      notice, this list of conditions and the following disclaimer in the
1568b8534bSLuigi Rizzo  *      documentation and/or other materials provided with the distribution.
1668b8534bSLuigi Rizzo  *
1768b8534bSLuigi Rizzo  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1868b8534bSLuigi Rizzo  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1968b8534bSLuigi Rizzo  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2068b8534bSLuigi Rizzo  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2168b8534bSLuigi Rizzo  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2268b8534bSLuigi Rizzo  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2368b8534bSLuigi Rizzo  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2468b8534bSLuigi Rizzo  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2568b8534bSLuigi Rizzo  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2668b8534bSLuigi Rizzo  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2768b8534bSLuigi Rizzo  * SUCH DAMAGE.
2868b8534bSLuigi Rizzo  */
2968b8534bSLuigi Rizzo 
30ce3ee1e7SLuigi Rizzo 
3168b8534bSLuigi Rizzo /*
32f9790aebSLuigi Rizzo  * $FreeBSD$
33f9790aebSLuigi Rizzo  *
3468b8534bSLuigi Rizzo  * This module supports memory mapped access to network devices,
3568b8534bSLuigi Rizzo  * see netmap(4).
3668b8534bSLuigi Rizzo  *
3768b8534bSLuigi Rizzo  * The module uses a large, memory pool allocated by the kernel
3868b8534bSLuigi Rizzo  * and accessible as mmapped memory by multiple userspace threads/processes.
3968b8534bSLuigi Rizzo  * The memory pool contains packet buffers and "netmap rings",
4068b8534bSLuigi Rizzo  * i.e. user-accessible copies of the interface's queues.
4168b8534bSLuigi Rizzo  *
4268b8534bSLuigi Rizzo  * Access to the network card works like this:
4368b8534bSLuigi Rizzo  * 1. a process/thread issues one or more open() on /dev/netmap, to create
4468b8534bSLuigi Rizzo  *    select()able file descriptor on which events are reported.
4568b8534bSLuigi Rizzo  * 2. on each descriptor, the process issues an ioctl() to identify
4668b8534bSLuigi Rizzo  *    the interface that should report events to the file descriptor.
4768b8534bSLuigi Rizzo  * 3. on each descriptor, the process issues an mmap() request to
4868b8534bSLuigi Rizzo  *    map the shared memory region within the process' address space.
4968b8534bSLuigi Rizzo  *    The list of interesting queues is indicated by a location in
5068b8534bSLuigi Rizzo  *    the shared memory region.
5168b8534bSLuigi Rizzo  * 4. using the functions in the netmap(4) userspace API, a process
5268b8534bSLuigi Rizzo  *    can look up the occupation state of a queue, access memory buffers,
5368b8534bSLuigi Rizzo  *    and retrieve received packets or enqueue packets to transmit.
5468b8534bSLuigi Rizzo  * 5. using some ioctl()s the process can synchronize the userspace view
5568b8534bSLuigi Rizzo  *    of the queue with the actual status in the kernel. This includes both
5668b8534bSLuigi Rizzo  *    receiving the notification of new packets, and transmitting new
5768b8534bSLuigi Rizzo  *    packets on the output interface.
5868b8534bSLuigi Rizzo  * 6. select() or poll() can be used to wait for events on individual
5968b8534bSLuigi Rizzo  *    transmit or receive queues (or all queues for a given interface).
60ce3ee1e7SLuigi Rizzo  *
61ce3ee1e7SLuigi Rizzo 
62ce3ee1e7SLuigi Rizzo 		SYNCHRONIZATION (USER)
63ce3ee1e7SLuigi Rizzo 
64ce3ee1e7SLuigi Rizzo The netmap rings and data structures may be shared among multiple
65ce3ee1e7SLuigi Rizzo user threads or even independent processes.
66ce3ee1e7SLuigi Rizzo Any synchronization among those threads/processes is delegated
67ce3ee1e7SLuigi Rizzo to the threads themselves. Only one thread at a time can be in
68ce3ee1e7SLuigi Rizzo a system call on the same netmap ring. The OS does not enforce
69ce3ee1e7SLuigi Rizzo this and only guarantees against system crashes in case of
70ce3ee1e7SLuigi Rizzo invalid usage.
71ce3ee1e7SLuigi Rizzo 
72ce3ee1e7SLuigi Rizzo 		LOCKING (INTERNAL)
73ce3ee1e7SLuigi Rizzo 
74ce3ee1e7SLuigi Rizzo Within the kernel, access to the netmap rings is protected as follows:
75ce3ee1e7SLuigi Rizzo 
76ce3ee1e7SLuigi Rizzo - a spinlock on each ring, to handle producer/consumer races on
77ce3ee1e7SLuigi Rizzo   RX rings attached to the host stack (against multiple host
78ce3ee1e7SLuigi Rizzo   threads writing from the host stack to the same ring),
79ce3ee1e7SLuigi Rizzo   and on 'destination' rings attached to a VALE switch
80ce3ee1e7SLuigi Rizzo   (i.e. RX rings in VALE ports, and TX rings in NIC/host ports)
81ce3ee1e7SLuigi Rizzo   protecting multiple active senders for the same destination)
82ce3ee1e7SLuigi Rizzo 
83ce3ee1e7SLuigi Rizzo - an atomic variable to guarantee that there is at most one
84ce3ee1e7SLuigi Rizzo   instance of *_*xsync() on the ring at any time.
85ce3ee1e7SLuigi Rizzo   For rings connected to user file
86ce3ee1e7SLuigi Rizzo   descriptors, an atomic_test_and_set() protects this, and the
87ce3ee1e7SLuigi Rizzo   lock on the ring is not actually used.
88ce3ee1e7SLuigi Rizzo   For NIC RX rings connected to a VALE switch, an atomic_test_and_set()
89ce3ee1e7SLuigi Rizzo   is also used to prevent multiple executions (the driver might indeed
90ce3ee1e7SLuigi Rizzo   already guarantee this).
91ce3ee1e7SLuigi Rizzo   For NIC TX rings connected to a VALE switch, the lock arbitrates
92ce3ee1e7SLuigi Rizzo   access to the queue (both when allocating buffers and when pushing
93ce3ee1e7SLuigi Rizzo   them out).
94ce3ee1e7SLuigi Rizzo 
95ce3ee1e7SLuigi Rizzo - *xsync() should be protected against initializations of the card.
96ce3ee1e7SLuigi Rizzo   On FreeBSD most devices have the reset routine protected by
97ce3ee1e7SLuigi Rizzo   a RING lock (ixgbe, igb, em) or core lock (re). lem is missing
98ce3ee1e7SLuigi Rizzo   the RING protection on rx_reset(), this should be added.
99ce3ee1e7SLuigi Rizzo 
100ce3ee1e7SLuigi Rizzo   On linux there is an external lock on the tx path, which probably
101ce3ee1e7SLuigi Rizzo   also arbitrates access to the reset routine. XXX to be revised
102ce3ee1e7SLuigi Rizzo 
103ce3ee1e7SLuigi Rizzo - a per-interface core_lock protecting access from the host stack
104ce3ee1e7SLuigi Rizzo   while interfaces may be detached from netmap mode.
105ce3ee1e7SLuigi Rizzo   XXX there should be no need for this lock if we detach the interfaces
106ce3ee1e7SLuigi Rizzo   only while they are down.
107ce3ee1e7SLuigi Rizzo 
108ce3ee1e7SLuigi Rizzo 
109ce3ee1e7SLuigi Rizzo --- VALE SWITCH ---
110ce3ee1e7SLuigi Rizzo 
111ce3ee1e7SLuigi Rizzo NMG_LOCK() serializes all modifications to switches and ports.
112ce3ee1e7SLuigi Rizzo A switch cannot be deleted until all ports are gone.
113ce3ee1e7SLuigi Rizzo 
114ce3ee1e7SLuigi Rizzo For each switch, an SX lock (RWlock on linux) protects
115ce3ee1e7SLuigi Rizzo deletion of ports. When configuring or deleting a new port, the
116ce3ee1e7SLuigi Rizzo lock is acquired in exclusive mode (after holding NMG_LOCK).
117ce3ee1e7SLuigi Rizzo When forwarding, the lock is acquired in shared mode (without NMG_LOCK).
118ce3ee1e7SLuigi Rizzo The lock is held throughout the entire forwarding cycle,
119ce3ee1e7SLuigi Rizzo during which the thread may incur in a page fault.
120ce3ee1e7SLuigi Rizzo Hence it is important that sleepable shared locks are used.
121ce3ee1e7SLuigi Rizzo 
122ce3ee1e7SLuigi Rizzo On the rx ring, the per-port lock is grabbed initially to reserve
123ce3ee1e7SLuigi Rizzo a number of slot in the ring, then the lock is released,
124ce3ee1e7SLuigi Rizzo packets are copied from source to destination, and then
125ce3ee1e7SLuigi Rizzo the lock is acquired again and the receive ring is updated.
126ce3ee1e7SLuigi Rizzo (A similar thing is done on the tx ring for NIC and host stack
127ce3ee1e7SLuigi Rizzo ports attached to the switch)
128ce3ee1e7SLuigi Rizzo 
12968b8534bSLuigi Rizzo  */
13068b8534bSLuigi Rizzo 
1314bf50f18SLuigi Rizzo 
1324bf50f18SLuigi Rizzo /* --- internals ----
1334bf50f18SLuigi Rizzo  *
1344bf50f18SLuigi Rizzo  * Roadmap to the code that implements the above.
1354bf50f18SLuigi Rizzo  *
1364bf50f18SLuigi Rizzo  * > 1. a process/thread issues one or more open() on /dev/netmap, to create
1374bf50f18SLuigi Rizzo  * >    select()able file descriptor on which events are reported.
1384bf50f18SLuigi Rizzo  *
1394bf50f18SLuigi Rizzo  *  	Internally, we allocate a netmap_priv_d structure, that will be
14037e3a6d3SLuigi Rizzo  *  	initialized on ioctl(NIOCREGIF). There is one netmap_priv_d
14137e3a6d3SLuigi Rizzo  *  	structure for each open().
1424bf50f18SLuigi Rizzo  *
1434bf50f18SLuigi Rizzo  *      os-specific:
14437e3a6d3SLuigi Rizzo  *  	    FreeBSD: see netmap_open() (netmap_freebsd.c)
14537e3a6d3SLuigi Rizzo  *  	    linux:   see linux_netmap_open() (netmap_linux.c)
1464bf50f18SLuigi Rizzo  *
1474bf50f18SLuigi Rizzo  * > 2. on each descriptor, the process issues an ioctl() to identify
1484bf50f18SLuigi Rizzo  * >    the interface that should report events to the file descriptor.
1494bf50f18SLuigi Rizzo  *
1504bf50f18SLuigi Rizzo  * 	Implemented by netmap_ioctl(), NIOCREGIF case, with nmr->nr_cmd==0.
1514bf50f18SLuigi Rizzo  * 	Most important things happen in netmap_get_na() and
1524bf50f18SLuigi Rizzo  * 	netmap_do_regif(), called from there. Additional details can be
1534bf50f18SLuigi Rizzo  * 	found in the comments above those functions.
1544bf50f18SLuigi Rizzo  *
1554bf50f18SLuigi Rizzo  * 	In all cases, this action creates/takes-a-reference-to a
1564bf50f18SLuigi Rizzo  * 	netmap_*_adapter describing the port, and allocates a netmap_if
1574bf50f18SLuigi Rizzo  * 	and all necessary netmap rings, filling them with netmap buffers.
1584bf50f18SLuigi Rizzo  *
1594bf50f18SLuigi Rizzo  *      In this phase, the sync callbacks for each ring are set (these are used
1604bf50f18SLuigi Rizzo  *      in steps 5 and 6 below).  The callbacks depend on the type of adapter.
1614bf50f18SLuigi Rizzo  *      The adapter creation/initialization code puts them in the
1624bf50f18SLuigi Rizzo  * 	netmap_adapter (fields na->nm_txsync and na->nm_rxsync).  Then, they
1634bf50f18SLuigi Rizzo  * 	are copied from there to the netmap_kring's during netmap_do_regif(), by
1644bf50f18SLuigi Rizzo  * 	the nm_krings_create() callback.  All the nm_krings_create callbacks
1654bf50f18SLuigi Rizzo  * 	actually call netmap_krings_create() to perform this and the other
1664bf50f18SLuigi Rizzo  * 	common stuff. netmap_krings_create() also takes care of the host rings,
1674bf50f18SLuigi Rizzo  * 	if needed, by setting their sync callbacks appropriately.
1684bf50f18SLuigi Rizzo  *
1694bf50f18SLuigi Rizzo  * 	Additional actions depend on the kind of netmap_adapter that has been
1704bf50f18SLuigi Rizzo  * 	registered:
1714bf50f18SLuigi Rizzo  *
1724bf50f18SLuigi Rizzo  * 	- netmap_hw_adapter:  	     [netmap.c]
1734bf50f18SLuigi Rizzo  * 	     This is a system netdev/ifp with native netmap support.
1744bf50f18SLuigi Rizzo  * 	     The ifp is detached from the host stack by redirecting:
1754bf50f18SLuigi Rizzo  * 	       - transmissions (from the network stack) to netmap_transmit()
1764bf50f18SLuigi Rizzo  * 	       - receive notifications to the nm_notify() callback for
1774bf50f18SLuigi Rizzo  * 	         this adapter. The callback is normally netmap_notify(), unless
1784bf50f18SLuigi Rizzo  * 	         the ifp is attached to a bridge using bwrap, in which case it
1794bf50f18SLuigi Rizzo  * 	         is netmap_bwrap_intr_notify().
1804bf50f18SLuigi Rizzo  *
1814bf50f18SLuigi Rizzo  * 	- netmap_generic_adapter:      [netmap_generic.c]
1824bf50f18SLuigi Rizzo  * 	      A system netdev/ifp without native netmap support.
1834bf50f18SLuigi Rizzo  *
1844bf50f18SLuigi Rizzo  * 	(the decision about native/non native support is taken in
1854bf50f18SLuigi Rizzo  * 	 netmap_get_hw_na(), called by netmap_get_na())
1864bf50f18SLuigi Rizzo  *
1874bf50f18SLuigi Rizzo  * 	- netmap_vp_adapter 		[netmap_vale.c]
1884bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_bdg_na().
1894bf50f18SLuigi Rizzo  * 	      This is a persistent or ephemeral VALE port. Ephemeral ports
1904bf50f18SLuigi Rizzo  * 	      are created on the fly if they don't already exist, and are
1914bf50f18SLuigi Rizzo  * 	      always attached to a bridge.
192453130d9SPedro F. Giffuni  * 	      Persistent VALE ports must must be created separately, and i
1934bf50f18SLuigi Rizzo  * 	      then attached like normal NICs. The NIOCREGIF we are examining
1944bf50f18SLuigi Rizzo  * 	      will find them only if they had previosly been created and
1954bf50f18SLuigi Rizzo  * 	      attached (see VALE_CTL below).
1964bf50f18SLuigi Rizzo  *
1974bf50f18SLuigi Rizzo  * 	- netmap_pipe_adapter 	      [netmap_pipe.c]
1984bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_pipe_na().
1994bf50f18SLuigi Rizzo  * 	      Both pipe ends are created, if they didn't already exist.
2004bf50f18SLuigi Rizzo  *
2014bf50f18SLuigi Rizzo  * 	- netmap_monitor_adapter      [netmap_monitor.c]
2024bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_monitor_na().
2034bf50f18SLuigi Rizzo  * 	      If successful, the nm_sync callbacks of the monitored adapter
2044bf50f18SLuigi Rizzo  * 	      will be intercepted by the returned monitor.
2054bf50f18SLuigi Rizzo  *
2064bf50f18SLuigi Rizzo  * 	- netmap_bwrap_adapter	      [netmap_vale.c]
2074bf50f18SLuigi Rizzo  * 	      Cannot be obtained in this way, see VALE_CTL below
2084bf50f18SLuigi Rizzo  *
2094bf50f18SLuigi Rizzo  *
2104bf50f18SLuigi Rizzo  * 	os-specific:
2114bf50f18SLuigi Rizzo  * 	    linux: we first go through linux_netmap_ioctl() to
2124bf50f18SLuigi Rizzo  * 	           adapt the FreeBSD interface to the linux one.
2134bf50f18SLuigi Rizzo  *
2144bf50f18SLuigi Rizzo  *
2154bf50f18SLuigi Rizzo  * > 3. on each descriptor, the process issues an mmap() request to
2164bf50f18SLuigi Rizzo  * >    map the shared memory region within the process' address space.
2174bf50f18SLuigi Rizzo  * >    The list of interesting queues is indicated by a location in
2184bf50f18SLuigi Rizzo  * >    the shared memory region.
2194bf50f18SLuigi Rizzo  *
2204bf50f18SLuigi Rizzo  *      os-specific:
2214bf50f18SLuigi Rizzo  *  	    FreeBSD: netmap_mmap_single (netmap_freebsd.c).
2224bf50f18SLuigi Rizzo  *  	    linux:   linux_netmap_mmap (netmap_linux.c).
2234bf50f18SLuigi Rizzo  *
2244bf50f18SLuigi Rizzo  * > 4. using the functions in the netmap(4) userspace API, a process
2254bf50f18SLuigi Rizzo  * >    can look up the occupation state of a queue, access memory buffers,
2264bf50f18SLuigi Rizzo  * >    and retrieve received packets or enqueue packets to transmit.
2274bf50f18SLuigi Rizzo  *
2284bf50f18SLuigi Rizzo  * 	these actions do not involve the kernel.
2294bf50f18SLuigi Rizzo  *
2304bf50f18SLuigi Rizzo  * > 5. using some ioctl()s the process can synchronize the userspace view
2314bf50f18SLuigi Rizzo  * >    of the queue with the actual status in the kernel. This includes both
2324bf50f18SLuigi Rizzo  * >    receiving the notification of new packets, and transmitting new
2334bf50f18SLuigi Rizzo  * >    packets on the output interface.
2344bf50f18SLuigi Rizzo  *
2354bf50f18SLuigi Rizzo  * 	These are implemented in netmap_ioctl(), NIOCTXSYNC and NIOCRXSYNC
2364bf50f18SLuigi Rizzo  * 	cases. They invoke the nm_sync callbacks on the netmap_kring
2374bf50f18SLuigi Rizzo  * 	structures, as initialized in step 2 and maybe later modified
2384bf50f18SLuigi Rizzo  * 	by a monitor. Monitors, however, will always call the original
2394bf50f18SLuigi Rizzo  * 	callback before doing anything else.
2404bf50f18SLuigi Rizzo  *
2414bf50f18SLuigi Rizzo  *
2424bf50f18SLuigi Rizzo  * > 6. select() or poll() can be used to wait for events on individual
2434bf50f18SLuigi Rizzo  * >    transmit or receive queues (or all queues for a given interface).
2444bf50f18SLuigi Rizzo  *
2454bf50f18SLuigi Rizzo  * 	Implemented in netmap_poll(). This will call the same nm_sync()
2464bf50f18SLuigi Rizzo  * 	callbacks as in step 5 above.
2474bf50f18SLuigi Rizzo  *
2484bf50f18SLuigi Rizzo  * 	os-specific:
2494bf50f18SLuigi Rizzo  * 		linux: we first go through linux_netmap_poll() to adapt
2504bf50f18SLuigi Rizzo  * 		       the FreeBSD interface to the linux one.
2514bf50f18SLuigi Rizzo  *
2524bf50f18SLuigi Rizzo  *
2534bf50f18SLuigi Rizzo  *  ----  VALE_CTL -----
2544bf50f18SLuigi Rizzo  *
2554bf50f18SLuigi Rizzo  *  VALE switches are controlled by issuing a NIOCREGIF with a non-null
2564bf50f18SLuigi Rizzo  *  nr_cmd in the nmreq structure. These subcommands are handled by
2574bf50f18SLuigi Rizzo  *  netmap_bdg_ctl() in netmap_vale.c. Persistent VALE ports are created
2584bf50f18SLuigi Rizzo  *  and destroyed by issuing the NETMAP_BDG_NEWIF and NETMAP_BDG_DELIF
2594bf50f18SLuigi Rizzo  *  subcommands, respectively.
2604bf50f18SLuigi Rizzo  *
2614bf50f18SLuigi Rizzo  *  Any network interface known to the system (including a persistent VALE
2624bf50f18SLuigi Rizzo  *  port) can be attached to a VALE switch by issuing the
2634bf50f18SLuigi Rizzo  *  NETMAP_BDG_ATTACH subcommand. After the attachment, persistent VALE ports
2644bf50f18SLuigi Rizzo  *  look exactly like ephemeral VALE ports (as created in step 2 above).  The
2654bf50f18SLuigi Rizzo  *  attachment of other interfaces, instead, requires the creation of a
2664bf50f18SLuigi Rizzo  *  netmap_bwrap_adapter.  Moreover, the attached interface must be put in
2674bf50f18SLuigi Rizzo  *  netmap mode. This may require the creation of a netmap_generic_adapter if
2684bf50f18SLuigi Rizzo  *  we have no native support for the interface, or if generic adapters have
2694bf50f18SLuigi Rizzo  *  been forced by sysctl.
2704bf50f18SLuigi Rizzo  *
2714bf50f18SLuigi Rizzo  *  Both persistent VALE ports and bwraps are handled by netmap_get_bdg_na(),
2724bf50f18SLuigi Rizzo  *  called by nm_bdg_ctl_attach(), and discriminated by the nm_bdg_attach()
2734bf50f18SLuigi Rizzo  *  callback.  In the case of the bwrap, the callback creates the
2744bf50f18SLuigi Rizzo  *  netmap_bwrap_adapter.  The initialization of the bwrap is then
2754bf50f18SLuigi Rizzo  *  completed by calling netmap_do_regif() on it, in the nm_bdg_ctl()
2764bf50f18SLuigi Rizzo  *  callback (netmap_bwrap_bdg_ctl in netmap_vale.c).
2774bf50f18SLuigi Rizzo  *  A generic adapter for the wrapped ifp will be created if needed, when
2784bf50f18SLuigi Rizzo  *  netmap_get_bdg_na() calls netmap_get_hw_na().
2794bf50f18SLuigi Rizzo  *
2804bf50f18SLuigi Rizzo  *
2814bf50f18SLuigi Rizzo  *  ---- DATAPATHS -----
2824bf50f18SLuigi Rizzo  *
2834bf50f18SLuigi Rizzo  *              -= SYSTEM DEVICE WITH NATIVE SUPPORT =-
2844bf50f18SLuigi Rizzo  *
2854bf50f18SLuigi Rizzo  *    na == NA(ifp) == netmap_hw_adapter created in DEVICE_netmap_attach()
2864bf50f18SLuigi Rizzo  *
2874bf50f18SLuigi Rizzo  *    - tx from netmap userspace:
2884bf50f18SLuigi Rizzo  *	 concurrently:
2894bf50f18SLuigi Rizzo  *           1) ioctl(NIOCTXSYNC)/netmap_poll() in process context
2904bf50f18SLuigi Rizzo  *                kring->nm_sync() == DEVICE_netmap_txsync()
2914bf50f18SLuigi Rizzo  *           2) device interrupt handler
2924bf50f18SLuigi Rizzo  *                na->nm_notify()  == netmap_notify()
2934bf50f18SLuigi Rizzo  *    - rx from netmap userspace:
2944bf50f18SLuigi Rizzo  *       concurrently:
2954bf50f18SLuigi Rizzo  *           1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
2964bf50f18SLuigi Rizzo  *                kring->nm_sync() == DEVICE_netmap_rxsync()
2974bf50f18SLuigi Rizzo  *           2) device interrupt handler
2984bf50f18SLuigi Rizzo  *                na->nm_notify()  == netmap_notify()
299847bf383SLuigi Rizzo  *    - rx from host stack
3004bf50f18SLuigi Rizzo  *       concurrently:
3014bf50f18SLuigi Rizzo  *           1) host stack
3024bf50f18SLuigi Rizzo  *                netmap_transmit()
3034bf50f18SLuigi Rizzo  *                  na->nm_notify  == netmap_notify()
3044bf50f18SLuigi Rizzo  *           2) ioctl(NIOCRXSYNC)/netmap_poll() in process context
30537e3a6d3SLuigi Rizzo  *                kring->nm_sync() == netmap_rxsync_from_host
3064bf50f18SLuigi Rizzo  *                  netmap_rxsync_from_host(na, NULL, NULL)
3074bf50f18SLuigi Rizzo  *    - tx to host stack
3084bf50f18SLuigi Rizzo  *           ioctl(NIOCTXSYNC)/netmap_poll() in process context
30937e3a6d3SLuigi Rizzo  *             kring->nm_sync() == netmap_txsync_to_host
3104bf50f18SLuigi Rizzo  *               netmap_txsync_to_host(na)
31137e3a6d3SLuigi Rizzo  *                 nm_os_send_up()
31237e3a6d3SLuigi Rizzo  *                   FreeBSD: na->if_input() == ether_input()
3134bf50f18SLuigi Rizzo  *                   linux: netif_rx() with NM_MAGIC_PRIORITY_RX
3144bf50f18SLuigi Rizzo  *
3154bf50f18SLuigi Rizzo  *
3164bf50f18SLuigi Rizzo  *               -= SYSTEM DEVICE WITH GENERIC SUPPORT =-
3174bf50f18SLuigi Rizzo  *
318847bf383SLuigi Rizzo  *    na == NA(ifp) == generic_netmap_adapter created in generic_netmap_attach()
319847bf383SLuigi Rizzo  *
320847bf383SLuigi Rizzo  *    - tx from netmap userspace:
321847bf383SLuigi Rizzo  *       concurrently:
322847bf383SLuigi Rizzo  *           1) ioctl(NIOCTXSYNC)/netmap_poll() in process context
323847bf383SLuigi Rizzo  *               kring->nm_sync() == generic_netmap_txsync()
32437e3a6d3SLuigi Rizzo  *                   nm_os_generic_xmit_frame()
325847bf383SLuigi Rizzo  *                       linux:   dev_queue_xmit() with NM_MAGIC_PRIORITY_TX
32637e3a6d3SLuigi Rizzo  *                           ifp->ndo_start_xmit == generic_ndo_start_xmit()
32737e3a6d3SLuigi Rizzo  *                               gna->save_start_xmit == orig. dev. start_xmit
328847bf383SLuigi Rizzo  *                       FreeBSD: na->if_transmit() == orig. dev if_transmit
329847bf383SLuigi Rizzo  *           2) generic_mbuf_destructor()
330847bf383SLuigi Rizzo  *                   na->nm_notify() == netmap_notify()
331847bf383SLuigi Rizzo  *    - rx from netmap userspace:
332847bf383SLuigi Rizzo  *           1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
333847bf383SLuigi Rizzo  *               kring->nm_sync() == generic_netmap_rxsync()
334847bf383SLuigi Rizzo  *                   mbq_safe_dequeue()
335847bf383SLuigi Rizzo  *           2) device driver
336847bf383SLuigi Rizzo  *               generic_rx_handler()
337847bf383SLuigi Rizzo  *                   mbq_safe_enqueue()
338847bf383SLuigi Rizzo  *                   na->nm_notify() == netmap_notify()
33937e3a6d3SLuigi Rizzo  *    - rx from host stack
34037e3a6d3SLuigi Rizzo  *        FreeBSD: same as native
34137e3a6d3SLuigi Rizzo  *        Linux: same as native except:
342847bf383SLuigi Rizzo  *           1) host stack
34337e3a6d3SLuigi Rizzo  *               dev_queue_xmit() without NM_MAGIC_PRIORITY_TX
34437e3a6d3SLuigi Rizzo  *                   ifp->ndo_start_xmit == generic_ndo_start_xmit()
345847bf383SLuigi Rizzo  *                       netmap_transmit()
346847bf383SLuigi Rizzo  *                           na->nm_notify() == netmap_notify()
34737e3a6d3SLuigi Rizzo  *    - tx to host stack (same as native):
3484bf50f18SLuigi Rizzo  *
3494bf50f18SLuigi Rizzo  *
350847bf383SLuigi Rizzo  *                           -= VALE =-
3514bf50f18SLuigi Rizzo  *
352847bf383SLuigi Rizzo  *   INCOMING:
3534bf50f18SLuigi Rizzo  *
354847bf383SLuigi Rizzo  *      - VALE ports:
355847bf383SLuigi Rizzo  *          ioctl(NIOCTXSYNC)/netmap_poll() in process context
356847bf383SLuigi Rizzo  *              kring->nm_sync() == netmap_vp_txsync()
3574bf50f18SLuigi Rizzo  *
358847bf383SLuigi Rizzo  *      - system device with native support:
359847bf383SLuigi Rizzo  *         from cable:
360847bf383SLuigi Rizzo  *             interrupt
361847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr != host ring)
362847bf383SLuigi Rizzo  *                     kring->nm_sync() == DEVICE_netmap_rxsync()
363847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
364847bf383SLuigi Rizzo  *                     kring->nm_sync() == DEVICE_netmap_rxsync()
365847bf383SLuigi Rizzo  *         from host stack:
366847bf383SLuigi Rizzo  *             netmap_transmit()
367847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr == host ring)
36837e3a6d3SLuigi Rizzo  *                     kring->nm_sync() == netmap_rxsync_from_host()
369847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
3704bf50f18SLuigi Rizzo  *
371847bf383SLuigi Rizzo  *      - system device with generic support:
372847bf383SLuigi Rizzo  *         from device driver:
373847bf383SLuigi Rizzo  *            generic_rx_handler()
374847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr != host ring)
375847bf383SLuigi Rizzo  *                     kring->nm_sync() == generic_netmap_rxsync()
376847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
377847bf383SLuigi Rizzo  *                     kring->nm_sync() == generic_netmap_rxsync()
378847bf383SLuigi Rizzo  *         from host stack:
379847bf383SLuigi Rizzo  *            netmap_transmit()
380847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr == host ring)
38137e3a6d3SLuigi Rizzo  *                     kring->nm_sync() == netmap_rxsync_from_host()
382847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
3834bf50f18SLuigi Rizzo  *
384847bf383SLuigi Rizzo  *   (all cases) --> nm_bdg_flush()
385847bf383SLuigi Rizzo  *                      dest_na->nm_notify() == (see below)
3864bf50f18SLuigi Rizzo  *
387847bf383SLuigi Rizzo  *   OUTGOING:
3884bf50f18SLuigi Rizzo  *
389847bf383SLuigi Rizzo  *      - VALE ports:
390847bf383SLuigi Rizzo  *         concurrently:
391*c3e9b4dbSLuiz Otavio O Souza  *             1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
392847bf383SLuigi Rizzo  *                    kring->nm_sync() == netmap_vp_rxsync()
393847bf383SLuigi Rizzo  *             2) from nm_bdg_flush()
394847bf383SLuigi Rizzo  *                    na->nm_notify() == netmap_notify()
3954bf50f18SLuigi Rizzo  *
396847bf383SLuigi Rizzo  *      - system device with native support:
397847bf383SLuigi Rizzo  *          to cable:
398847bf383SLuigi Rizzo  *             na->nm_notify() == netmap_bwrap_notify()
399847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
400847bf383SLuigi Rizzo  *                 kring->nm_sync() == DEVICE_netmap_txsync()
401847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
402847bf383SLuigi Rizzo  *          to host stack:
403847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
40437e3a6d3SLuigi Rizzo  *                 kring->nm_sync() == netmap_txsync_to_host
405847bf383SLuigi Rizzo  *                 netmap_vp_rxsync_locked()
4064bf50f18SLuigi Rizzo  *
407847bf383SLuigi Rizzo  *      - system device with generic adapter:
408847bf383SLuigi Rizzo  *          to device driver:
409847bf383SLuigi Rizzo  *             na->nm_notify() == netmap_bwrap_notify()
410847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
411847bf383SLuigi Rizzo  *                 kring->nm_sync() == generic_netmap_txsync()
412847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
413847bf383SLuigi Rizzo  *          to host stack:
414847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
41537e3a6d3SLuigi Rizzo  *                 kring->nm_sync() == netmap_txsync_to_host
416847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
4174bf50f18SLuigi Rizzo  *
4184bf50f18SLuigi Rizzo  */
4194bf50f18SLuigi Rizzo 
420ce3ee1e7SLuigi Rizzo /*
421ce3ee1e7SLuigi Rizzo  * OS-specific code that is used only within this file.
422ce3ee1e7SLuigi Rizzo  * Other OS-specific code that must be accessed by drivers
423ce3ee1e7SLuigi Rizzo  * is present in netmap_kern.h
424ce3ee1e7SLuigi Rizzo  */
42501c7d25fSLuigi Rizzo 
426ce3ee1e7SLuigi Rizzo #if defined(__FreeBSD__)
42768b8534bSLuigi Rizzo #include <sys/cdefs.h> /* prerequisite */
42868b8534bSLuigi Rizzo #include <sys/types.h>
42968b8534bSLuigi Rizzo #include <sys/errno.h>
43068b8534bSLuigi Rizzo #include <sys/param.h>	/* defines used in kernel.h */
43168b8534bSLuigi Rizzo #include <sys/kernel.h>	/* types used in module initialization */
432f9790aebSLuigi Rizzo #include <sys/conf.h>	/* cdevsw struct, UID, GID */
43389e3fd52SLuigi Rizzo #include <sys/filio.h>	/* FIONBIO */
43468b8534bSLuigi Rizzo #include <sys/sockio.h>
43568b8534bSLuigi Rizzo #include <sys/socketvar.h>	/* struct socket */
43668b8534bSLuigi Rizzo #include <sys/malloc.h>
43768b8534bSLuigi Rizzo #include <sys/poll.h>
43889f6b863SAttilio Rao #include <sys/rwlock.h>
43968b8534bSLuigi Rizzo #include <sys/socket.h> /* sockaddrs */
44068b8534bSLuigi Rizzo #include <sys/selinfo.h>
44168b8534bSLuigi Rizzo #include <sys/sysctl.h>
442339f59c0SGleb Smirnoff #include <sys/jail.h>
443339f59c0SGleb Smirnoff #include <net/vnet.h>
44468b8534bSLuigi Rizzo #include <net/if.h>
44576039bc8SGleb Smirnoff #include <net/if_var.h>
44668b8534bSLuigi Rizzo #include <net/bpf.h>		/* BIOCIMMEDIATE */
44768b8534bSLuigi Rizzo #include <machine/bus.h>	/* bus_dmamap_* */
448ce3ee1e7SLuigi Rizzo #include <sys/endian.h>
449ce3ee1e7SLuigi Rizzo #include <sys/refcount.h>
45068b8534bSLuigi Rizzo 
45168b8534bSLuigi Rizzo 
452ce3ee1e7SLuigi Rizzo #elif defined(linux)
453ce3ee1e7SLuigi Rizzo 
454ce3ee1e7SLuigi Rizzo #include "bsd_glue.h"
455ce3ee1e7SLuigi Rizzo 
456ce3ee1e7SLuigi Rizzo #elif defined(__APPLE__)
457ce3ee1e7SLuigi Rizzo 
458ce3ee1e7SLuigi Rizzo #warning OSX support is only partial
459ce3ee1e7SLuigi Rizzo #include "osx_glue.h"
460ce3ee1e7SLuigi Rizzo 
46137e3a6d3SLuigi Rizzo #elif defined (_WIN32)
46237e3a6d3SLuigi Rizzo 
46337e3a6d3SLuigi Rizzo #include "win_glue.h"
46437e3a6d3SLuigi Rizzo 
465ce3ee1e7SLuigi Rizzo #else
466ce3ee1e7SLuigi Rizzo 
467ce3ee1e7SLuigi Rizzo #error	Unsupported platform
468ce3ee1e7SLuigi Rizzo 
469ce3ee1e7SLuigi Rizzo #endif /* unsupported */
470ce3ee1e7SLuigi Rizzo 
471ce3ee1e7SLuigi Rizzo /*
472ce3ee1e7SLuigi Rizzo  * common headers
473ce3ee1e7SLuigi Rizzo  */
4740b8ed8e0SLuigi Rizzo #include <net/netmap.h>
4750b8ed8e0SLuigi Rizzo #include <dev/netmap/netmap_kern.h>
476ce3ee1e7SLuigi Rizzo #include <dev/netmap/netmap_mem2.h>
4770b8ed8e0SLuigi Rizzo 
478ce3ee1e7SLuigi Rizzo 
4795819da83SLuigi Rizzo /* user-controlled variables */
4805819da83SLuigi Rizzo int netmap_verbose;
4815819da83SLuigi Rizzo 
4825819da83SLuigi Rizzo static int netmap_no_timestamp; /* don't timestamp on rxsync */
4835819da83SLuigi Rizzo int netmap_mitigate = 1;
484c85cb1a0SLuigi Rizzo int netmap_no_pendintr = 1;
485f18be576SLuigi Rizzo int netmap_txsync_retry = 2;
486f196ce38SLuigi Rizzo int netmap_flags = 0;	/* debug flags */
487*c3e9b4dbSLuiz Otavio O Souza static int netmap_fwd = 0;	/* force transparent forwarding */
488f196ce38SLuigi Rizzo 
489f9790aebSLuigi Rizzo /*
490f9790aebSLuigi Rizzo  * netmap_admode selects the netmap mode to use.
491f9790aebSLuigi Rizzo  * Invalid values are reset to NETMAP_ADMODE_BEST
492f9790aebSLuigi Rizzo  */
493f9790aebSLuigi Rizzo enum {	NETMAP_ADMODE_BEST = 0,	/* use native, fallback to generic */
494f9790aebSLuigi Rizzo 	NETMAP_ADMODE_NATIVE,	/* either native or none */
495f9790aebSLuigi Rizzo 	NETMAP_ADMODE_GENERIC,	/* force generic */
496f9790aebSLuigi Rizzo 	NETMAP_ADMODE_LAST };
497f9790aebSLuigi Rizzo static int netmap_admode = NETMAP_ADMODE_BEST;
498f9790aebSLuigi Rizzo 
49937e3a6d3SLuigi Rizzo /* netmap_generic_mit controls mitigation of RX notifications for
50037e3a6d3SLuigi Rizzo  * the generic netmap adapter. The value is a time interval in
50137e3a6d3SLuigi Rizzo  * nanoseconds. */
50237e3a6d3SLuigi Rizzo int netmap_generic_mit = 100*1000;
50337e3a6d3SLuigi Rizzo 
50437e3a6d3SLuigi Rizzo /* We use by default netmap-aware qdiscs with generic netmap adapters,
50537e3a6d3SLuigi Rizzo  * even if there can be a little performance hit with hardware NICs.
50637e3a6d3SLuigi Rizzo  * However, using the qdisc is the safer approach, for two reasons:
50737e3a6d3SLuigi Rizzo  * 1) it prevents non-fifo qdiscs to break the TX notification
50837e3a6d3SLuigi Rizzo  *    scheme, which is based on mbuf destructors when txqdisc is
50937e3a6d3SLuigi Rizzo  *    not used.
51037e3a6d3SLuigi Rizzo  * 2) it makes it possible to transmit over software devices that
51137e3a6d3SLuigi Rizzo  *    change skb->dev, like bridge, veth, ...
51237e3a6d3SLuigi Rizzo  *
51337e3a6d3SLuigi Rizzo  * Anyway users looking for the best performance should
51437e3a6d3SLuigi Rizzo  * use native adapters.
51537e3a6d3SLuigi Rizzo  */
51637e3a6d3SLuigi Rizzo int netmap_generic_txqdisc = 1;
51737e3a6d3SLuigi Rizzo 
51837e3a6d3SLuigi Rizzo /* Default number of slots and queues for generic adapters. */
51937e3a6d3SLuigi Rizzo int netmap_generic_ringsize = 1024;
52037e3a6d3SLuigi Rizzo int netmap_generic_rings = 1;
52137e3a6d3SLuigi Rizzo 
52237e3a6d3SLuigi Rizzo /* Non-zero if ptnet devices are allowed to use virtio-net headers. */
52337e3a6d3SLuigi Rizzo int ptnet_vnet_hdr = 1;
52437e3a6d3SLuigi Rizzo 
525*c3e9b4dbSLuiz Otavio O Souza /* 0 if ptnetmap should not use worker threads for TX processing */
526*c3e9b4dbSLuiz Otavio O Souza int ptnetmap_tx_workers = 1;
527*c3e9b4dbSLuiz Otavio O Souza 
52837e3a6d3SLuigi Rizzo /*
52937e3a6d3SLuigi Rizzo  * SYSCTL calls are grouped between SYSBEGIN and SYSEND to be emulated
53037e3a6d3SLuigi Rizzo  * in some other operating systems
53137e3a6d3SLuigi Rizzo  */
53237e3a6d3SLuigi Rizzo SYSBEGIN(main_init);
53337e3a6d3SLuigi Rizzo 
53437e3a6d3SLuigi Rizzo SYSCTL_DECL(_dev_netmap);
53537e3a6d3SLuigi Rizzo SYSCTL_NODE(_dev, OID_AUTO, netmap, CTLFLAG_RW, 0, "Netmap args");
53637e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, verbose,
53737e3a6d3SLuigi Rizzo     CTLFLAG_RW, &netmap_verbose, 0, "Verbose mode");
53837e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, no_timestamp,
53937e3a6d3SLuigi Rizzo     CTLFLAG_RW, &netmap_no_timestamp, 0, "no_timestamp");
54037e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, mitigate, CTLFLAG_RW, &netmap_mitigate, 0, "");
54137e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, no_pendintr,
54237e3a6d3SLuigi Rizzo     CTLFLAG_RW, &netmap_no_pendintr, 0, "Always look for new received packets.");
54337e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, txsync_retry, CTLFLAG_RW,
54437e3a6d3SLuigi Rizzo     &netmap_txsync_retry, 0 , "Number of txsync loops in bridge's flush.");
545f9790aebSLuigi Rizzo 
546f196ce38SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, flags, CTLFLAG_RW, &netmap_flags, 0 , "");
547091fd0abSLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, fwd, CTLFLAG_RW, &netmap_fwd, 0 , "");
548f9790aebSLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, admode, CTLFLAG_RW, &netmap_admode, 0 , "");
549f9790aebSLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, generic_mit, CTLFLAG_RW, &netmap_generic_mit, 0 , "");
550f9790aebSLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, generic_ringsize, CTLFLAG_RW, &netmap_generic_ringsize, 0 , "");
551f0ea3689SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, generic_rings, CTLFLAG_RW, &netmap_generic_rings, 0 , "");
55237e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, generic_txqdisc, CTLFLAG_RW, &netmap_generic_txqdisc, 0 , "");
55337e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, ptnet_vnet_hdr, CTLFLAG_RW, &ptnet_vnet_hdr, 0 , "");
554*c3e9b4dbSLuiz Otavio O Souza SYSCTL_INT(_dev_netmap, OID_AUTO, ptnetmap_tx_workers, CTLFLAG_RW, &ptnetmap_tx_workers, 0 , "");
55537e3a6d3SLuigi Rizzo 
55637e3a6d3SLuigi Rizzo SYSEND;
557f196ce38SLuigi Rizzo 
558ce3ee1e7SLuigi Rizzo NMG_LOCK_T	netmap_global_lock;
559ce3ee1e7SLuigi Rizzo 
56017885a7bSLuigi Rizzo /*
56117885a7bSLuigi Rizzo  * mark the ring as stopped, and run through the locks
56217885a7bSLuigi Rizzo  * to make sure other users get to see it.
56337e3a6d3SLuigi Rizzo  * stopped must be either NR_KR_STOPPED (for unbounded stop)
56437e3a6d3SLuigi Rizzo  * of NR_KR_LOCKED (brief stop for mutual exclusion purposes)
56517885a7bSLuigi Rizzo  */
5664bf50f18SLuigi Rizzo static void
56737e3a6d3SLuigi Rizzo netmap_disable_ring(struct netmap_kring *kr, int stopped)
568ce3ee1e7SLuigi Rizzo {
56937e3a6d3SLuigi Rizzo 	nm_kr_stop(kr, stopped);
57037e3a6d3SLuigi Rizzo 	// XXX check if nm_kr_stop is sufficient
571ce3ee1e7SLuigi Rizzo 	mtx_lock(&kr->q_lock);
572ce3ee1e7SLuigi Rizzo 	mtx_unlock(&kr->q_lock);
573ce3ee1e7SLuigi Rizzo 	nm_kr_put(kr);
574ce3ee1e7SLuigi Rizzo }
575ce3ee1e7SLuigi Rizzo 
576847bf383SLuigi Rizzo /* stop or enable a single ring */
5774bf50f18SLuigi Rizzo void
578847bf383SLuigi Rizzo netmap_set_ring(struct netmap_adapter *na, u_int ring_id, enum txrx t, int stopped)
5794bf50f18SLuigi Rizzo {
5804bf50f18SLuigi Rizzo 	if (stopped)
58137e3a6d3SLuigi Rizzo 		netmap_disable_ring(NMR(na, t) + ring_id, stopped);
5824bf50f18SLuigi Rizzo 	else
583847bf383SLuigi Rizzo 		NMR(na, t)[ring_id].nkr_stopped = 0;
5844bf50f18SLuigi Rizzo }
5854bf50f18SLuigi Rizzo 
586f9790aebSLuigi Rizzo 
58789cc2556SLuigi Rizzo /* stop or enable all the rings of na */
5884bf50f18SLuigi Rizzo void
5894bf50f18SLuigi Rizzo netmap_set_all_rings(struct netmap_adapter *na, int stopped)
590ce3ee1e7SLuigi Rizzo {
591ce3ee1e7SLuigi Rizzo 	int i;
592847bf383SLuigi Rizzo 	enum txrx t;
593ce3ee1e7SLuigi Rizzo 
5944bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na))
595ce3ee1e7SLuigi Rizzo 		return;
596ce3ee1e7SLuigi Rizzo 
597847bf383SLuigi Rizzo 	for_rx_tx(t) {
598847bf383SLuigi Rizzo 		for (i = 0; i < netmap_real_rings(na, t); i++) {
599847bf383SLuigi Rizzo 			netmap_set_ring(na, i, t, stopped);
600ce3ee1e7SLuigi Rizzo 		}
601ce3ee1e7SLuigi Rizzo 	}
602ce3ee1e7SLuigi Rizzo }
603ce3ee1e7SLuigi Rizzo 
60489cc2556SLuigi Rizzo /*
60589cc2556SLuigi Rizzo  * Convenience function used in drivers.  Waits for current txsync()s/rxsync()s
60689cc2556SLuigi Rizzo  * to finish and prevents any new one from starting.  Call this before turning
607ddb13598SKevin Lo  * netmap mode off, or before removing the hardware rings (e.g., on module
60837e3a6d3SLuigi Rizzo  * onload).
60989cc2556SLuigi Rizzo  */
610f9790aebSLuigi Rizzo void
611f9790aebSLuigi Rizzo netmap_disable_all_rings(struct ifnet *ifp)
612f9790aebSLuigi Rizzo {
61337e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
61437e3a6d3SLuigi Rizzo 		netmap_set_all_rings(NA(ifp), NM_KR_STOPPED);
61537e3a6d3SLuigi Rizzo 	}
616f9790aebSLuigi Rizzo }
617f9790aebSLuigi Rizzo 
61889cc2556SLuigi Rizzo /*
61989cc2556SLuigi Rizzo  * Convenience function used in drivers.  Re-enables rxsync and txsync on the
62089cc2556SLuigi Rizzo  * adapter's rings In linux drivers, this should be placed near each
62189cc2556SLuigi Rizzo  * napi_enable().
62289cc2556SLuigi Rizzo  */
623f9790aebSLuigi Rizzo void
624f9790aebSLuigi Rizzo netmap_enable_all_rings(struct ifnet *ifp)
625f9790aebSLuigi Rizzo {
62637e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
6274bf50f18SLuigi Rizzo 		netmap_set_all_rings(NA(ifp), 0 /* enabled */);
628f9790aebSLuigi Rizzo 	}
62937e3a6d3SLuigi Rizzo }
630f9790aebSLuigi Rizzo 
63137e3a6d3SLuigi Rizzo void
63237e3a6d3SLuigi Rizzo netmap_make_zombie(struct ifnet *ifp)
63337e3a6d3SLuigi Rizzo {
63437e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
63537e3a6d3SLuigi Rizzo 		struct netmap_adapter *na = NA(ifp);
63637e3a6d3SLuigi Rizzo 		netmap_set_all_rings(na, NM_KR_LOCKED);
63737e3a6d3SLuigi Rizzo 		na->na_flags |= NAF_ZOMBIE;
63837e3a6d3SLuigi Rizzo 		netmap_set_all_rings(na, 0);
63937e3a6d3SLuigi Rizzo 	}
64037e3a6d3SLuigi Rizzo }
64137e3a6d3SLuigi Rizzo 
64237e3a6d3SLuigi Rizzo void
64337e3a6d3SLuigi Rizzo netmap_undo_zombie(struct ifnet *ifp)
64437e3a6d3SLuigi Rizzo {
64537e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
64637e3a6d3SLuigi Rizzo 		struct netmap_adapter *na = NA(ifp);
64737e3a6d3SLuigi Rizzo 		if (na->na_flags & NAF_ZOMBIE) {
64837e3a6d3SLuigi Rizzo 			netmap_set_all_rings(na, NM_KR_LOCKED);
64937e3a6d3SLuigi Rizzo 			na->na_flags &= ~NAF_ZOMBIE;
65037e3a6d3SLuigi Rizzo 			netmap_set_all_rings(na, 0);
65137e3a6d3SLuigi Rizzo 		}
65237e3a6d3SLuigi Rizzo 	}
65337e3a6d3SLuigi Rizzo }
654f9790aebSLuigi Rizzo 
655ce3ee1e7SLuigi Rizzo /*
656ce3ee1e7SLuigi Rizzo  * generic bound_checking function
657ce3ee1e7SLuigi Rizzo  */
658ce3ee1e7SLuigi Rizzo u_int
659ce3ee1e7SLuigi Rizzo nm_bound_var(u_int *v, u_int dflt, u_int lo, u_int hi, const char *msg)
660ce3ee1e7SLuigi Rizzo {
661ce3ee1e7SLuigi Rizzo 	u_int oldv = *v;
662ce3ee1e7SLuigi Rizzo 	const char *op = NULL;
663ce3ee1e7SLuigi Rizzo 
664ce3ee1e7SLuigi Rizzo 	if (dflt < lo)
665ce3ee1e7SLuigi Rizzo 		dflt = lo;
666ce3ee1e7SLuigi Rizzo 	if (dflt > hi)
667ce3ee1e7SLuigi Rizzo 		dflt = hi;
668ce3ee1e7SLuigi Rizzo 	if (oldv < lo) {
669ce3ee1e7SLuigi Rizzo 		*v = dflt;
670ce3ee1e7SLuigi Rizzo 		op = "Bump";
671ce3ee1e7SLuigi Rizzo 	} else if (oldv > hi) {
672ce3ee1e7SLuigi Rizzo 		*v = hi;
673ce3ee1e7SLuigi Rizzo 		op = "Clamp";
674ce3ee1e7SLuigi Rizzo 	}
675ce3ee1e7SLuigi Rizzo 	if (op && msg)
676*c3e9b4dbSLuiz Otavio O Souza 		nm_prinf("%s %s to %d (was %d)\n", op, msg, *v, oldv);
677ce3ee1e7SLuigi Rizzo 	return *v;
678ce3ee1e7SLuigi Rizzo }
679ce3ee1e7SLuigi Rizzo 
680f9790aebSLuigi Rizzo 
681ce3ee1e7SLuigi Rizzo /*
682ce3ee1e7SLuigi Rizzo  * packet-dump function, user-supplied or static buffer.
683ce3ee1e7SLuigi Rizzo  * The destination buffer must be at least 30+4*len
684ce3ee1e7SLuigi Rizzo  */
685ce3ee1e7SLuigi Rizzo const char *
686ce3ee1e7SLuigi Rizzo nm_dump_buf(char *p, int len, int lim, char *dst)
687ce3ee1e7SLuigi Rizzo {
688ce3ee1e7SLuigi Rizzo 	static char _dst[8192];
689ce3ee1e7SLuigi Rizzo 	int i, j, i0;
690ce3ee1e7SLuigi Rizzo 	static char hex[] ="0123456789abcdef";
691ce3ee1e7SLuigi Rizzo 	char *o;	/* output position */
692ce3ee1e7SLuigi Rizzo 
693ce3ee1e7SLuigi Rizzo #define P_HI(x)	hex[((x) & 0xf0)>>4]
694ce3ee1e7SLuigi Rizzo #define P_LO(x)	hex[((x) & 0xf)]
695ce3ee1e7SLuigi Rizzo #define P_C(x)	((x) >= 0x20 && (x) <= 0x7e ? (x) : '.')
696ce3ee1e7SLuigi Rizzo 	if (!dst)
697ce3ee1e7SLuigi Rizzo 		dst = _dst;
698ce3ee1e7SLuigi Rizzo 	if (lim <= 0 || lim > len)
699ce3ee1e7SLuigi Rizzo 		lim = len;
700ce3ee1e7SLuigi Rizzo 	o = dst;
701ce3ee1e7SLuigi Rizzo 	sprintf(o, "buf 0x%p len %d lim %d\n", p, len, lim);
702ce3ee1e7SLuigi Rizzo 	o += strlen(o);
703ce3ee1e7SLuigi Rizzo 	/* hexdump routine */
704ce3ee1e7SLuigi Rizzo 	for (i = 0; i < lim; ) {
705ce3ee1e7SLuigi Rizzo 		sprintf(o, "%5d: ", i);
706ce3ee1e7SLuigi Rizzo 		o += strlen(o);
707ce3ee1e7SLuigi Rizzo 		memset(o, ' ', 48);
708ce3ee1e7SLuigi Rizzo 		i0 = i;
709ce3ee1e7SLuigi Rizzo 		for (j=0; j < 16 && i < lim; i++, j++) {
710ce3ee1e7SLuigi Rizzo 			o[j*3] = P_HI(p[i]);
711ce3ee1e7SLuigi Rizzo 			o[j*3+1] = P_LO(p[i]);
712ce3ee1e7SLuigi Rizzo 		}
713ce3ee1e7SLuigi Rizzo 		i = i0;
714ce3ee1e7SLuigi Rizzo 		for (j=0; j < 16 && i < lim; i++, j++)
715ce3ee1e7SLuigi Rizzo 			o[j + 48] = P_C(p[i]);
716ce3ee1e7SLuigi Rizzo 		o[j+48] = '\n';
717ce3ee1e7SLuigi Rizzo 		o += j+49;
718ce3ee1e7SLuigi Rizzo 	}
719ce3ee1e7SLuigi Rizzo 	*o = '\0';
720ce3ee1e7SLuigi Rizzo #undef P_HI
721ce3ee1e7SLuigi Rizzo #undef P_LO
722ce3ee1e7SLuigi Rizzo #undef P_C
723ce3ee1e7SLuigi Rizzo 	return dst;
724ce3ee1e7SLuigi Rizzo }
725f196ce38SLuigi Rizzo 
726f18be576SLuigi Rizzo 
727ae10d1afSLuigi Rizzo /*
728ae10d1afSLuigi Rizzo  * Fetch configuration from the device, to cope with dynamic
729ae10d1afSLuigi Rizzo  * reconfigurations after loading the module.
730ae10d1afSLuigi Rizzo  */
73189cc2556SLuigi Rizzo /* call with NMG_LOCK held */
732f9790aebSLuigi Rizzo int
733ae10d1afSLuigi Rizzo netmap_update_config(struct netmap_adapter *na)
734ae10d1afSLuigi Rizzo {
735ae10d1afSLuigi Rizzo 	u_int txr, txd, rxr, rxd;
736ae10d1afSLuigi Rizzo 
737ae10d1afSLuigi Rizzo 	txr = txd = rxr = rxd = 0;
7386641c68bSLuigi Rizzo 	if (na->nm_config == NULL ||
739847bf383SLuigi Rizzo 	    na->nm_config(na, &txr, &txd, &rxr, &rxd))
740847bf383SLuigi Rizzo 	{
741ae10d1afSLuigi Rizzo 		/* take whatever we had at init time */
742ae10d1afSLuigi Rizzo 		txr = na->num_tx_rings;
743ae10d1afSLuigi Rizzo 		txd = na->num_tx_desc;
744ae10d1afSLuigi Rizzo 		rxr = na->num_rx_rings;
745ae10d1afSLuigi Rizzo 		rxd = na->num_rx_desc;
746ae10d1afSLuigi Rizzo 	}
747ae10d1afSLuigi Rizzo 
748ae10d1afSLuigi Rizzo 	if (na->num_tx_rings == txr && na->num_tx_desc == txd &&
749ae10d1afSLuigi Rizzo 	    na->num_rx_rings == rxr && na->num_rx_desc == rxd)
750ae10d1afSLuigi Rizzo 		return 0; /* nothing changed */
751f9790aebSLuigi Rizzo 	if (netmap_verbose || na->active_fds > 0) {
752ae10d1afSLuigi Rizzo 		D("stored config %s: txring %d x %d, rxring %d x %d",
7534bf50f18SLuigi Rizzo 			na->name,
754ae10d1afSLuigi Rizzo 			na->num_tx_rings, na->num_tx_desc,
755ae10d1afSLuigi Rizzo 			na->num_rx_rings, na->num_rx_desc);
756ae10d1afSLuigi Rizzo 		D("new config %s: txring %d x %d, rxring %d x %d",
7574bf50f18SLuigi Rizzo 			na->name, txr, txd, rxr, rxd);
758ae10d1afSLuigi Rizzo 	}
759f9790aebSLuigi Rizzo 	if (na->active_fds == 0) {
760ae10d1afSLuigi Rizzo 		D("configuration changed (but fine)");
761ae10d1afSLuigi Rizzo 		na->num_tx_rings = txr;
762ae10d1afSLuigi Rizzo 		na->num_tx_desc = txd;
763ae10d1afSLuigi Rizzo 		na->num_rx_rings = rxr;
764ae10d1afSLuigi Rizzo 		na->num_rx_desc = rxd;
765ae10d1afSLuigi Rizzo 		return 0;
766ae10d1afSLuigi Rizzo 	}
767ae10d1afSLuigi Rizzo 	D("configuration changed while active, this is bad...");
768ae10d1afSLuigi Rizzo 	return 1;
769ae10d1afSLuigi Rizzo }
770ae10d1afSLuigi Rizzo 
77137e3a6d3SLuigi Rizzo /* nm_sync callbacks for the host rings */
77237e3a6d3SLuigi Rizzo static int netmap_txsync_to_host(struct netmap_kring *kring, int flags);
77337e3a6d3SLuigi Rizzo static int netmap_rxsync_from_host(struct netmap_kring *kring, int flags);
774f0ea3689SLuigi Rizzo 
775f0ea3689SLuigi Rizzo /* create the krings array and initialize the fields common to all adapters.
776f0ea3689SLuigi Rizzo  * The array layout is this:
777f0ea3689SLuigi Rizzo  *
778f0ea3689SLuigi Rizzo  *                    +----------+
779f0ea3689SLuigi Rizzo  * na->tx_rings ----->|          | \
780f0ea3689SLuigi Rizzo  *                    |          |  } na->num_tx_ring
781f0ea3689SLuigi Rizzo  *                    |          | /
782f0ea3689SLuigi Rizzo  *                    +----------+
783f0ea3689SLuigi Rizzo  *                    |          |    host tx kring
784f0ea3689SLuigi Rizzo  * na->rx_rings ----> +----------+
785f0ea3689SLuigi Rizzo  *                    |          | \
786f0ea3689SLuigi Rizzo  *                    |          |  } na->num_rx_rings
787f0ea3689SLuigi Rizzo  *                    |          | /
788f0ea3689SLuigi Rizzo  *                    +----------+
789f0ea3689SLuigi Rizzo  *                    |          |    host rx kring
790f0ea3689SLuigi Rizzo  *                    +----------+
791f0ea3689SLuigi Rizzo  * na->tailroom ----->|          | \
792f0ea3689SLuigi Rizzo  *                    |          |  } tailroom bytes
793f0ea3689SLuigi Rizzo  *                    |          | /
794f0ea3689SLuigi Rizzo  *                    +----------+
795f0ea3689SLuigi Rizzo  *
796f0ea3689SLuigi Rizzo  * Note: for compatibility, host krings are created even when not needed.
797f0ea3689SLuigi Rizzo  * The tailroom space is currently used by vale ports for allocating leases.
798f0ea3689SLuigi Rizzo  */
79989cc2556SLuigi Rizzo /* call with NMG_LOCK held */
800f9790aebSLuigi Rizzo int
801f0ea3689SLuigi Rizzo netmap_krings_create(struct netmap_adapter *na, u_int tailroom)
802f9790aebSLuigi Rizzo {
803f9790aebSLuigi Rizzo 	u_int i, len, ndesc;
804f9790aebSLuigi Rizzo 	struct netmap_kring *kring;
805847bf383SLuigi Rizzo 	u_int n[NR_TXRX];
806847bf383SLuigi Rizzo 	enum txrx t;
807f9790aebSLuigi Rizzo 
808*c3e9b4dbSLuiz Otavio O Souza 	if (na->tx_rings != NULL) {
809*c3e9b4dbSLuiz Otavio O Souza 		D("warning: krings were already created");
810*c3e9b4dbSLuiz Otavio O Souza 		return 0;
811*c3e9b4dbSLuiz Otavio O Souza 	}
812*c3e9b4dbSLuiz Otavio O Souza 
813f0ea3689SLuigi Rizzo 	/* account for the (possibly fake) host rings */
814847bf383SLuigi Rizzo 	n[NR_TX] = na->num_tx_rings + 1;
815847bf383SLuigi Rizzo 	n[NR_RX] = na->num_rx_rings + 1;
816f0ea3689SLuigi Rizzo 
817847bf383SLuigi Rizzo 	len = (n[NR_TX] + n[NR_RX]) * sizeof(struct netmap_kring) + tailroom;
818f9790aebSLuigi Rizzo 
819*c3e9b4dbSLuiz Otavio O Souza 	na->tx_rings = nm_os_malloc((size_t)len);
820f9790aebSLuigi Rizzo 	if (na->tx_rings == NULL) {
821f9790aebSLuigi Rizzo 		D("Cannot allocate krings");
822f9790aebSLuigi Rizzo 		return ENOMEM;
823f9790aebSLuigi Rizzo 	}
824847bf383SLuigi Rizzo 	na->rx_rings = na->tx_rings + n[NR_TX];
825f9790aebSLuigi Rizzo 
82617885a7bSLuigi Rizzo 	/*
82717885a7bSLuigi Rizzo 	 * All fields in krings are 0 except the one initialized below.
82817885a7bSLuigi Rizzo 	 * but better be explicit on important kring fields.
82917885a7bSLuigi Rizzo 	 */
830847bf383SLuigi Rizzo 	for_rx_tx(t) {
831847bf383SLuigi Rizzo 		ndesc = nma_get_ndesc(na, t);
832847bf383SLuigi Rizzo 		for (i = 0; i < n[t]; i++) {
833847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
834f9790aebSLuigi Rizzo 			bzero(kring, sizeof(*kring));
835f9790aebSLuigi Rizzo 			kring->na = na;
83617885a7bSLuigi Rizzo 			kring->ring_id = i;
837847bf383SLuigi Rizzo 			kring->tx = t;
838f9790aebSLuigi Rizzo 			kring->nkr_num_slots = ndesc;
83937e3a6d3SLuigi Rizzo 			kring->nr_mode = NKR_NETMAP_OFF;
84037e3a6d3SLuigi Rizzo 			kring->nr_pending_mode = NKR_NETMAP_OFF;
841847bf383SLuigi Rizzo 			if (i < nma_get_nrings(na, t)) {
842847bf383SLuigi Rizzo 				kring->nm_sync = (t == NR_TX ? na->nm_txsync : na->nm_rxsync);
84337e3a6d3SLuigi Rizzo 			} else {
844847bf383SLuigi Rizzo 				kring->nm_sync = (t == NR_TX ?
84537e3a6d3SLuigi Rizzo 						netmap_txsync_to_host:
84637e3a6d3SLuigi Rizzo 						netmap_rxsync_from_host);
847f0ea3689SLuigi Rizzo 			}
848847bf383SLuigi Rizzo 			kring->nm_notify = na->nm_notify;
849847bf383SLuigi Rizzo 			kring->rhead = kring->rcur = kring->nr_hwcur = 0;
850f9790aebSLuigi Rizzo 			/*
85117885a7bSLuigi Rizzo 			 * IMPORTANT: Always keep one slot empty.
852f9790aebSLuigi Rizzo 			 */
853847bf383SLuigi Rizzo 			kring->rtail = kring->nr_hwtail = (t == NR_TX ? ndesc - 1 : 0);
854847bf383SLuigi Rizzo 			snprintf(kring->name, sizeof(kring->name) - 1, "%s %s%d", na->name,
855847bf383SLuigi Rizzo 					nm_txrx2str(t), i);
856f0ea3689SLuigi Rizzo 			ND("ktx %s h %d c %d t %d",
857f0ea3689SLuigi Rizzo 				kring->name, kring->rhead, kring->rcur, kring->rtail);
858847bf383SLuigi Rizzo 			mtx_init(&kring->q_lock, (t == NR_TX ? "nm_txq_lock" : "nm_rxq_lock"), NULL, MTX_DEF);
85937e3a6d3SLuigi Rizzo 			nm_os_selinfo_init(&kring->si);
860f9790aebSLuigi Rizzo 		}
86137e3a6d3SLuigi Rizzo 		nm_os_selinfo_init(&na->si[t]);
862f0ea3689SLuigi Rizzo 	}
863f9790aebSLuigi Rizzo 
864847bf383SLuigi Rizzo 	na->tailroom = na->rx_rings + n[NR_RX];
865f9790aebSLuigi Rizzo 
866f9790aebSLuigi Rizzo 	return 0;
867f9790aebSLuigi Rizzo }
868f9790aebSLuigi Rizzo 
869f9790aebSLuigi Rizzo 
870f0ea3689SLuigi Rizzo /* undo the actions performed by netmap_krings_create */
87189cc2556SLuigi Rizzo /* call with NMG_LOCK held */
872f9790aebSLuigi Rizzo void
873f9790aebSLuigi Rizzo netmap_krings_delete(struct netmap_adapter *na)
874f9790aebSLuigi Rizzo {
875f0ea3689SLuigi Rizzo 	struct netmap_kring *kring = na->tx_rings;
876847bf383SLuigi Rizzo 	enum txrx t;
877847bf383SLuigi Rizzo 
878*c3e9b4dbSLuiz Otavio O Souza 	if (na->tx_rings == NULL) {
879*c3e9b4dbSLuiz Otavio O Souza 		D("warning: krings were already deleted");
880*c3e9b4dbSLuiz Otavio O Souza 		return;
881*c3e9b4dbSLuiz Otavio O Souza 	}
882*c3e9b4dbSLuiz Otavio O Souza 
883847bf383SLuigi Rizzo 	for_rx_tx(t)
88437e3a6d3SLuigi Rizzo 		nm_os_selinfo_uninit(&na->si[t]);
885f9790aebSLuigi Rizzo 
886f0ea3689SLuigi Rizzo 	/* we rely on the krings layout described above */
887f0ea3689SLuigi Rizzo 	for ( ; kring != na->tailroom; kring++) {
888f0ea3689SLuigi Rizzo 		mtx_destroy(&kring->q_lock);
88937e3a6d3SLuigi Rizzo 		nm_os_selinfo_uninit(&kring->si);
890f9790aebSLuigi Rizzo 	}
891*c3e9b4dbSLuiz Otavio O Souza 	nm_os_free(na->tx_rings);
892f9790aebSLuigi Rizzo 	na->tx_rings = na->rx_rings = na->tailroom = NULL;
893f9790aebSLuigi Rizzo }
894f9790aebSLuigi Rizzo 
895f9790aebSLuigi Rizzo 
89617885a7bSLuigi Rizzo /*
89717885a7bSLuigi Rizzo  * Destructor for NIC ports. They also have an mbuf queue
89817885a7bSLuigi Rizzo  * on the rings connected to the host so we need to purge
89917885a7bSLuigi Rizzo  * them first.
90017885a7bSLuigi Rizzo  */
90189cc2556SLuigi Rizzo /* call with NMG_LOCK held */
90237e3a6d3SLuigi Rizzo void
90317885a7bSLuigi Rizzo netmap_hw_krings_delete(struct netmap_adapter *na)
90417885a7bSLuigi Rizzo {
90517885a7bSLuigi Rizzo 	struct mbq *q = &na->rx_rings[na->num_rx_rings].rx_queue;
90617885a7bSLuigi Rizzo 
90717885a7bSLuigi Rizzo 	ND("destroy sw mbq with len %d", mbq_len(q));
90817885a7bSLuigi Rizzo 	mbq_purge(q);
90937e3a6d3SLuigi Rizzo 	mbq_safe_fini(q);
91017885a7bSLuigi Rizzo 	netmap_krings_delete(na);
91117885a7bSLuigi Rizzo }
91217885a7bSLuigi Rizzo 
91317885a7bSLuigi Rizzo 
914f9790aebSLuigi Rizzo 
91568b8534bSLuigi Rizzo /*
916847bf383SLuigi Rizzo  * Undo everything that was done in netmap_do_regif(). In particular,
917847bf383SLuigi Rizzo  * call nm_register(ifp,0) to stop netmap mode on the interface and
9184bf50f18SLuigi Rizzo  * revert to normal operation.
91968b8534bSLuigi Rizzo  */
920ce3ee1e7SLuigi Rizzo /* call with NMG_LOCK held */
921847bf383SLuigi Rizzo static void netmap_unset_ringid(struct netmap_priv_d *);
92237e3a6d3SLuigi Rizzo static void netmap_krings_put(struct netmap_priv_d *);
92337e3a6d3SLuigi Rizzo void
924847bf383SLuigi Rizzo netmap_do_unregif(struct netmap_priv_d *priv)
92568b8534bSLuigi Rizzo {
926f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
92768b8534bSLuigi Rizzo 
928ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
929f9790aebSLuigi Rizzo 	na->active_fds--;
93037e3a6d3SLuigi Rizzo 	/* unset nr_pending_mode and possibly release exclusive mode */
93137e3a6d3SLuigi Rizzo 	netmap_krings_put(priv);
932847bf383SLuigi Rizzo 
933847bf383SLuigi Rizzo #ifdef	WITH_MONITOR
93437e3a6d3SLuigi Rizzo 	/* XXX check whether we have to do something with monitor
93537e3a6d3SLuigi Rizzo 	 * when rings change nr_mode. */
93637e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0) {
937847bf383SLuigi Rizzo 		/* walk through all the rings and tell any monitor
938847bf383SLuigi Rizzo 		 * that the port is going to exit netmap mode
939847bf383SLuigi Rizzo 		 */
940847bf383SLuigi Rizzo 		netmap_monitor_stop(na);
94137e3a6d3SLuigi Rizzo 	}
942847bf383SLuigi Rizzo #endif
94337e3a6d3SLuigi Rizzo 
94437e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0 || nm_kring_pending(priv)) {
94537e3a6d3SLuigi Rizzo 		na->nm_register(na, 0);
94637e3a6d3SLuigi Rizzo 	}
94737e3a6d3SLuigi Rizzo 
94837e3a6d3SLuigi Rizzo 	/* delete rings and buffers that are no longer needed */
94937e3a6d3SLuigi Rizzo 	netmap_mem_rings_delete(na);
95037e3a6d3SLuigi Rizzo 
95137e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0) {	/* last instance */
95268b8534bSLuigi Rizzo 		/*
95337e3a6d3SLuigi Rizzo 		 * (TO CHECK) We enter here
954f18be576SLuigi Rizzo 		 * when the last reference to this file descriptor goes
955f18be576SLuigi Rizzo 		 * away. This means we cannot have any pending poll()
956f18be576SLuigi Rizzo 		 * or interrupt routine operating on the structure.
957ce3ee1e7SLuigi Rizzo 		 * XXX The file may be closed in a thread while
958ce3ee1e7SLuigi Rizzo 		 * another thread is using it.
959ce3ee1e7SLuigi Rizzo 		 * Linux keeps the file opened until the last reference
960ce3ee1e7SLuigi Rizzo 		 * by any outstanding ioctl/poll or mmap is gone.
961ce3ee1e7SLuigi Rizzo 		 * FreeBSD does not track mmap()s (but we do) and
962ce3ee1e7SLuigi Rizzo 		 * wakes up any sleeping poll(). Need to check what
963ce3ee1e7SLuigi Rizzo 		 * happens if the close() occurs while a concurrent
964ce3ee1e7SLuigi Rizzo 		 * syscall is running.
96568b8534bSLuigi Rizzo 		 */
96637e3a6d3SLuigi Rizzo 		if (netmap_verbose)
96737e3a6d3SLuigi Rizzo 			D("deleting last instance for %s", na->name);
96837e3a6d3SLuigi Rizzo 
96937e3a6d3SLuigi Rizzo                 if (nm_netmap_on(na)) {
97037e3a6d3SLuigi Rizzo                     D("BUG: netmap on while going to delete the krings");
97137e3a6d3SLuigi Rizzo                 }
97237e3a6d3SLuigi Rizzo 
973f9790aebSLuigi Rizzo 		na->nm_krings_delete(na);
97468b8534bSLuigi Rizzo 	}
97537e3a6d3SLuigi Rizzo 
976847bf383SLuigi Rizzo 	/* possibily decrement counter of tx_si/rx_si users */
977847bf383SLuigi Rizzo 	netmap_unset_ringid(priv);
978f9790aebSLuigi Rizzo 	/* delete the nifp */
979847bf383SLuigi Rizzo 	netmap_mem_if_delete(na, priv->np_nifp);
980847bf383SLuigi Rizzo 	/* drop the allocator */
981847bf383SLuigi Rizzo 	netmap_mem_deref(na->nm_mem, na);
982847bf383SLuigi Rizzo 	/* mark the priv as unregistered */
983847bf383SLuigi Rizzo 	priv->np_na = NULL;
984847bf383SLuigi Rizzo 	priv->np_nifp = NULL;
9855819da83SLuigi Rizzo }
98668b8534bSLuigi Rizzo 
98789cc2556SLuigi Rizzo /* call with NMG_LOCK held */
988f0ea3689SLuigi Rizzo static __inline int
989847bf383SLuigi Rizzo nm_si_user(struct netmap_priv_d *priv, enum txrx t)
990f0ea3689SLuigi Rizzo {
991f0ea3689SLuigi Rizzo 	return (priv->np_na != NULL &&
992847bf383SLuigi Rizzo 		(priv->np_qlast[t] - priv->np_qfirst[t] > 1));
993f0ea3689SLuigi Rizzo }
994f0ea3689SLuigi Rizzo 
99537e3a6d3SLuigi Rizzo struct netmap_priv_d*
99637e3a6d3SLuigi Rizzo netmap_priv_new(void)
99737e3a6d3SLuigi Rizzo {
99837e3a6d3SLuigi Rizzo 	struct netmap_priv_d *priv;
99937e3a6d3SLuigi Rizzo 
1000*c3e9b4dbSLuiz Otavio O Souza 	priv = nm_os_malloc(sizeof(struct netmap_priv_d));
100137e3a6d3SLuigi Rizzo 	if (priv == NULL)
100237e3a6d3SLuigi Rizzo 		return NULL;
100337e3a6d3SLuigi Rizzo 	priv->np_refs = 1;
100437e3a6d3SLuigi Rizzo 	nm_os_get_module();
100537e3a6d3SLuigi Rizzo 	return priv;
100637e3a6d3SLuigi Rizzo }
100737e3a6d3SLuigi Rizzo 
1008ce3ee1e7SLuigi Rizzo /*
10098fd44c93SLuigi Rizzo  * Destructor of the netmap_priv_d, called when the fd is closed
10108fd44c93SLuigi Rizzo  * Action: undo all the things done by NIOCREGIF,
10118fd44c93SLuigi Rizzo  * On FreeBSD we need to track whether there are active mmap()s,
10128fd44c93SLuigi Rizzo  * and we use np_active_mmaps for that. On linux, the field is always 0.
10138fd44c93SLuigi Rizzo  * Return: 1 if we can free priv, 0 otherwise.
101489cc2556SLuigi Rizzo  *
1015ce3ee1e7SLuigi Rizzo  */
101689cc2556SLuigi Rizzo /* call with NMG_LOCK held */
101737e3a6d3SLuigi Rizzo void
101837e3a6d3SLuigi Rizzo netmap_priv_delete(struct netmap_priv_d *priv)
1019ce3ee1e7SLuigi Rizzo {
1020f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1021ce3ee1e7SLuigi Rizzo 
1022847adfb7SLuigi Rizzo 	/* number of active references to this fd */
10238fd44c93SLuigi Rizzo 	if (--priv->np_refs > 0) {
102437e3a6d3SLuigi Rizzo 		return;
1025ce3ee1e7SLuigi Rizzo 	}
102637e3a6d3SLuigi Rizzo 	nm_os_put_module();
102737e3a6d3SLuigi Rizzo 	if (na) {
1028847bf383SLuigi Rizzo 		netmap_do_unregif(priv);
102937e3a6d3SLuigi Rizzo 	}
103037e3a6d3SLuigi Rizzo 	netmap_unget_na(na, priv->np_ifp);
103137e3a6d3SLuigi Rizzo 	bzero(priv, sizeof(*priv));	/* for safety */
1032*c3e9b4dbSLuiz Otavio O Souza 	nm_os_free(priv);
1033f196ce38SLuigi Rizzo }
10345819da83SLuigi Rizzo 
1035f9790aebSLuigi Rizzo 
103689cc2556SLuigi Rizzo /* call with NMG_LOCK *not* held */
1037f9790aebSLuigi Rizzo void
10385819da83SLuigi Rizzo netmap_dtor(void *data)
10395819da83SLuigi Rizzo {
10405819da83SLuigi Rizzo 	struct netmap_priv_d *priv = data;
10415819da83SLuigi Rizzo 
1042ce3ee1e7SLuigi Rizzo 	NMG_LOCK();
104337e3a6d3SLuigi Rizzo 	netmap_priv_delete(priv);
1044ce3ee1e7SLuigi Rizzo 	NMG_UNLOCK();
1045ce3ee1e7SLuigi Rizzo }
104668b8534bSLuigi Rizzo 
1047f18be576SLuigi Rizzo 
104868b8534bSLuigi Rizzo /*
1049*c3e9b4dbSLuiz Otavio O Souza  * Handlers for synchronization of the rings from/to the host stack.
1050*c3e9b4dbSLuiz Otavio O Souza  * These are associated to a network interface and are just another
1051*c3e9b4dbSLuiz Otavio O Souza  * ring pair managed by userspace.
1052*c3e9b4dbSLuiz Otavio O Souza  *
1053*c3e9b4dbSLuiz Otavio O Souza  * Netmap also supports transparent forwarding (NS_FORWARD and NR_FORWARD
1054*c3e9b4dbSLuiz Otavio O Souza  * flags):
1055*c3e9b4dbSLuiz Otavio O Souza  *
1056*c3e9b4dbSLuiz Otavio O Souza  * - Before releasing buffers on hw RX rings, the application can mark
1057*c3e9b4dbSLuiz Otavio O Souza  *   them with the NS_FORWARD flag. During the next RXSYNC or poll(), they
1058*c3e9b4dbSLuiz Otavio O Souza  *   will be forwarded to the host stack, similarly to what happened if
1059*c3e9b4dbSLuiz Otavio O Souza  *   the application moved them to the host TX ring.
1060*c3e9b4dbSLuiz Otavio O Souza  *
1061*c3e9b4dbSLuiz Otavio O Souza  * - Before releasing buffers on the host RX ring, the application can
1062*c3e9b4dbSLuiz Otavio O Souza  *   mark them with the NS_FORWARD flag. During the next RXSYNC or poll(),
1063*c3e9b4dbSLuiz Otavio O Souza  *   they will be forwarded to the hw TX rings, saving the application
1064*c3e9b4dbSLuiz Otavio O Souza  *   from doing the same task in user-space.
1065*c3e9b4dbSLuiz Otavio O Souza  *
1066*c3e9b4dbSLuiz Otavio O Souza  * Transparent fowarding can be enabled per-ring, by setting the NR_FORWARD
1067*c3e9b4dbSLuiz Otavio O Souza  * flag, or globally with the netmap_fwd sysctl.
1068*c3e9b4dbSLuiz Otavio O Souza  *
1069091fd0abSLuigi Rizzo  * The transfer NIC --> host is relatively easy, just encapsulate
1070091fd0abSLuigi Rizzo  * into mbufs and we are done. The host --> NIC side is slightly
1071091fd0abSLuigi Rizzo  * harder because there might not be room in the tx ring so it
1072091fd0abSLuigi Rizzo  * might take a while before releasing the buffer.
1073091fd0abSLuigi Rizzo  */
1074091fd0abSLuigi Rizzo 
1075f18be576SLuigi Rizzo 
1076091fd0abSLuigi Rizzo /*
1077*c3e9b4dbSLuiz Otavio O Souza  * Pass a whole queue of mbufs to the host stack as coming from 'dst'
107817885a7bSLuigi Rizzo  * We do not need to lock because the queue is private.
1079*c3e9b4dbSLuiz Otavio O Souza  * After this call the queue is empty.
1080091fd0abSLuigi Rizzo  */
1081091fd0abSLuigi Rizzo static void
1082f9790aebSLuigi Rizzo netmap_send_up(struct ifnet *dst, struct mbq *q)
1083091fd0abSLuigi Rizzo {
1084091fd0abSLuigi Rizzo 	struct mbuf *m;
108537e3a6d3SLuigi Rizzo 	struct mbuf *head = NULL, *prev = NULL;
1086091fd0abSLuigi Rizzo 
1087*c3e9b4dbSLuiz Otavio O Souza 	/* Send packets up, outside the lock; head/prev machinery
1088*c3e9b4dbSLuiz Otavio O Souza 	 * is only useful for Windows. */
1089f9790aebSLuigi Rizzo 	while ((m = mbq_dequeue(q)) != NULL) {
1090091fd0abSLuigi Rizzo 		if (netmap_verbose & NM_VERB_HOST)
1091091fd0abSLuigi Rizzo 			D("sending up pkt %p size %d", m, MBUF_LEN(m));
109237e3a6d3SLuigi Rizzo 		prev = nm_os_send_up(dst, m, prev);
109337e3a6d3SLuigi Rizzo 		if (head == NULL)
109437e3a6d3SLuigi Rizzo 			head = prev;
1095091fd0abSLuigi Rizzo 	}
109637e3a6d3SLuigi Rizzo 	if (head)
109737e3a6d3SLuigi Rizzo 		nm_os_send_up(dst, NULL, head);
109837e3a6d3SLuigi Rizzo 	mbq_fini(q);
1099091fd0abSLuigi Rizzo }
1100091fd0abSLuigi Rizzo 
1101f18be576SLuigi Rizzo 
1102091fd0abSLuigi Rizzo /*
1103*c3e9b4dbSLuiz Otavio O Souza  * Scan the buffers from hwcur to ring->head, and put a copy of those
1104*c3e9b4dbSLuiz Otavio O Souza  * marked NS_FORWARD (or all of them if forced) into a queue of mbufs.
1105*c3e9b4dbSLuiz Otavio O Souza  * Drop remaining packets in the unlikely event
110617885a7bSLuigi Rizzo  * of an mbuf shortage.
1107091fd0abSLuigi Rizzo  */
1108091fd0abSLuigi Rizzo static void
1109091fd0abSLuigi Rizzo netmap_grab_packets(struct netmap_kring *kring, struct mbq *q, int force)
1110091fd0abSLuigi Rizzo {
111117885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1112847bf383SLuigi Rizzo 	u_int const head = kring->rhead;
111317885a7bSLuigi Rizzo 	u_int n;
1114f9790aebSLuigi Rizzo 	struct netmap_adapter *na = kring->na;
1115091fd0abSLuigi Rizzo 
111617885a7bSLuigi Rizzo 	for (n = kring->nr_hwcur; n != head; n = nm_next(n, lim)) {
111717885a7bSLuigi Rizzo 		struct mbuf *m;
1118091fd0abSLuigi Rizzo 		struct netmap_slot *slot = &kring->ring->slot[n];
1119091fd0abSLuigi Rizzo 
1120091fd0abSLuigi Rizzo 		if ((slot->flags & NS_FORWARD) == 0 && !force)
1121091fd0abSLuigi Rizzo 			continue;
11224bf50f18SLuigi Rizzo 		if (slot->len < 14 || slot->len > NETMAP_BUF_SIZE(na)) {
112317885a7bSLuigi Rizzo 			RD(5, "bad pkt at %d len %d", n, slot->len);
1124091fd0abSLuigi Rizzo 			continue;
1125091fd0abSLuigi Rizzo 		}
1126091fd0abSLuigi Rizzo 		slot->flags &= ~NS_FORWARD; // XXX needed ?
112717885a7bSLuigi Rizzo 		/* XXX TODO: adapt to the case of a multisegment packet */
11284bf50f18SLuigi Rizzo 		m = m_devget(NMB(na, slot), slot->len, 0, na->ifp, NULL);
1129091fd0abSLuigi Rizzo 
1130091fd0abSLuigi Rizzo 		if (m == NULL)
1131091fd0abSLuigi Rizzo 			break;
1132f9790aebSLuigi Rizzo 		mbq_enqueue(q, m);
1133091fd0abSLuigi Rizzo 	}
1134091fd0abSLuigi Rizzo }
1135091fd0abSLuigi Rizzo 
113637e3a6d3SLuigi Rizzo static inline int
113737e3a6d3SLuigi Rizzo _nm_may_forward(struct netmap_kring *kring)
113837e3a6d3SLuigi Rizzo {
113937e3a6d3SLuigi Rizzo 	return	((netmap_fwd || kring->ring->flags & NR_FORWARD) &&
114037e3a6d3SLuigi Rizzo 		 kring->na->na_flags & NAF_HOST_RINGS &&
114137e3a6d3SLuigi Rizzo 		 kring->tx == NR_RX);
114237e3a6d3SLuigi Rizzo }
114337e3a6d3SLuigi Rizzo 
114437e3a6d3SLuigi Rizzo static inline int
114537e3a6d3SLuigi Rizzo nm_may_forward_up(struct netmap_kring *kring)
114637e3a6d3SLuigi Rizzo {
114737e3a6d3SLuigi Rizzo 	return	_nm_may_forward(kring) &&
114837e3a6d3SLuigi Rizzo 		 kring->ring_id != kring->na->num_rx_rings;
114937e3a6d3SLuigi Rizzo }
115037e3a6d3SLuigi Rizzo 
115137e3a6d3SLuigi Rizzo static inline int
1152*c3e9b4dbSLuiz Otavio O Souza nm_may_forward_down(struct netmap_kring *kring, int sync_flags)
115337e3a6d3SLuigi Rizzo {
115437e3a6d3SLuigi Rizzo 	return	_nm_may_forward(kring) &&
1155*c3e9b4dbSLuiz Otavio O Souza 		 (sync_flags & NAF_CAN_FORWARD_DOWN) &&
115637e3a6d3SLuigi Rizzo 		 kring->ring_id == kring->na->num_rx_rings;
115737e3a6d3SLuigi Rizzo }
1158f18be576SLuigi Rizzo 
1159091fd0abSLuigi Rizzo /*
116017885a7bSLuigi Rizzo  * Send to the NIC rings packets marked NS_FORWARD between
1161*c3e9b4dbSLuiz Otavio O Souza  * kring->nr_hwcur and kring->rhead.
1162*c3e9b4dbSLuiz Otavio O Souza  * Called under kring->rx_queue.lock on the sw rx ring.
1163*c3e9b4dbSLuiz Otavio O Souza  *
1164*c3e9b4dbSLuiz Otavio O Souza  * It can only be called if the user opened all the TX hw rings,
1165*c3e9b4dbSLuiz Otavio O Souza  * see NAF_CAN_FORWARD_DOWN flag.
1166*c3e9b4dbSLuiz Otavio O Souza  * We can touch the TX netmap rings (slots, head and cur) since
1167*c3e9b4dbSLuiz Otavio O Souza  * we are in poll/ioctl system call context, and the application
1168*c3e9b4dbSLuiz Otavio O Souza  * is not supposed to touch the ring (using a different thread)
1169*c3e9b4dbSLuiz Otavio O Souza  * during the execution of the system call.
1170091fd0abSLuigi Rizzo  */
117117885a7bSLuigi Rizzo static u_int
1172091fd0abSLuigi Rizzo netmap_sw_to_nic(struct netmap_adapter *na)
1173091fd0abSLuigi Rizzo {
1174091fd0abSLuigi Rizzo 	struct netmap_kring *kring = &na->rx_rings[na->num_rx_rings];
117517885a7bSLuigi Rizzo 	struct netmap_slot *rxslot = kring->ring->slot;
117617885a7bSLuigi Rizzo 	u_int i, rxcur = kring->nr_hwcur;
117717885a7bSLuigi Rizzo 	u_int const head = kring->rhead;
117817885a7bSLuigi Rizzo 	u_int const src_lim = kring->nkr_num_slots - 1;
117917885a7bSLuigi Rizzo 	u_int sent = 0;
1180ce3ee1e7SLuigi Rizzo 
118117885a7bSLuigi Rizzo 	/* scan rings to find space, then fill as much as possible */
118217885a7bSLuigi Rizzo 	for (i = 0; i < na->num_tx_rings; i++) {
118317885a7bSLuigi Rizzo 		struct netmap_kring *kdst = &na->tx_rings[i];
118417885a7bSLuigi Rizzo 		struct netmap_ring *rdst = kdst->ring;
118517885a7bSLuigi Rizzo 		u_int const dst_lim = kdst->nkr_num_slots - 1;
1186ce3ee1e7SLuigi Rizzo 
118717885a7bSLuigi Rizzo 		/* XXX do we trust ring or kring->rcur,rtail ? */
118817885a7bSLuigi Rizzo 		for (; rxcur != head && !nm_ring_empty(rdst);
118917885a7bSLuigi Rizzo 		     rxcur = nm_next(rxcur, src_lim) ) {
1190091fd0abSLuigi Rizzo 			struct netmap_slot *src, *dst, tmp;
119137e3a6d3SLuigi Rizzo 			u_int dst_head = rdst->head;
119217885a7bSLuigi Rizzo 
119317885a7bSLuigi Rizzo 			src = &rxslot[rxcur];
119417885a7bSLuigi Rizzo 			if ((src->flags & NS_FORWARD) == 0 && !netmap_fwd)
119517885a7bSLuigi Rizzo 				continue;
119617885a7bSLuigi Rizzo 
119717885a7bSLuigi Rizzo 			sent++;
119817885a7bSLuigi Rizzo 
119937e3a6d3SLuigi Rizzo 			dst = &rdst->slot[dst_head];
120017885a7bSLuigi Rizzo 
1201091fd0abSLuigi Rizzo 			tmp = *src;
120217885a7bSLuigi Rizzo 
1203091fd0abSLuigi Rizzo 			src->buf_idx = dst->buf_idx;
1204091fd0abSLuigi Rizzo 			src->flags = NS_BUF_CHANGED;
1205091fd0abSLuigi Rizzo 
1206091fd0abSLuigi Rizzo 			dst->buf_idx = tmp.buf_idx;
1207091fd0abSLuigi Rizzo 			dst->len = tmp.len;
1208091fd0abSLuigi Rizzo 			dst->flags = NS_BUF_CHANGED;
1209091fd0abSLuigi Rizzo 
121037e3a6d3SLuigi Rizzo 			rdst->head = rdst->cur = nm_next(dst_head, dst_lim);
1211091fd0abSLuigi Rizzo 		}
1212*c3e9b4dbSLuiz Otavio O Souza 		/* if (sent) XXX txsync ? it would be just an optimization */
1213091fd0abSLuigi Rizzo 	}
121417885a7bSLuigi Rizzo 	return sent;
1215091fd0abSLuigi Rizzo }
1216091fd0abSLuigi Rizzo 
1217f18be576SLuigi Rizzo 
1218091fd0abSLuigi Rizzo /*
1219ce3ee1e7SLuigi Rizzo  * netmap_txsync_to_host() passes packets up. We are called from a
122002ad4083SLuigi Rizzo  * system call in user process context, and the only contention
122102ad4083SLuigi Rizzo  * can be among multiple user threads erroneously calling
1222091fd0abSLuigi Rizzo  * this routine concurrently.
122368b8534bSLuigi Rizzo  */
122437e3a6d3SLuigi Rizzo static int
122537e3a6d3SLuigi Rizzo netmap_txsync_to_host(struct netmap_kring *kring, int flags)
122668b8534bSLuigi Rizzo {
122737e3a6d3SLuigi Rizzo 	struct netmap_adapter *na = kring->na;
122817885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1229f0ea3689SLuigi Rizzo 	u_int const head = kring->rhead;
1230f9790aebSLuigi Rizzo 	struct mbq q;
123168b8534bSLuigi Rizzo 
123217885a7bSLuigi Rizzo 	/* Take packets from hwcur to head and pass them up.
1233*c3e9b4dbSLuiz Otavio O Souza 	 * Force hwcur = head since netmap_grab_packets() stops at head
123468b8534bSLuigi Rizzo 	 */
1235f9790aebSLuigi Rizzo 	mbq_init(&q);
123617885a7bSLuigi Rizzo 	netmap_grab_packets(kring, &q, 1 /* force */);
123717885a7bSLuigi Rizzo 	ND("have %d pkts in queue", mbq_len(&q));
123817885a7bSLuigi Rizzo 	kring->nr_hwcur = head;
123917885a7bSLuigi Rizzo 	kring->nr_hwtail = head + lim;
124017885a7bSLuigi Rizzo 	if (kring->nr_hwtail > lim)
124117885a7bSLuigi Rizzo 		kring->nr_hwtail -= lim + 1;
124268b8534bSLuigi Rizzo 
1243f9790aebSLuigi Rizzo 	netmap_send_up(na->ifp, &q);
124437e3a6d3SLuigi Rizzo 	return 0;
1245f18be576SLuigi Rizzo }
1246f18be576SLuigi Rizzo 
1247f18be576SLuigi Rizzo 
124868b8534bSLuigi Rizzo /*
124902ad4083SLuigi Rizzo  * rxsync backend for packets coming from the host stack.
125017885a7bSLuigi Rizzo  * They have been put in kring->rx_queue by netmap_transmit().
125117885a7bSLuigi Rizzo  * We protect access to the kring using kring->rx_queue.lock
125202ad4083SLuigi Rizzo  *
1253*c3e9b4dbSLuiz Otavio O Souza  * also moves to the nic hw rings any packet the user has marked
1254*c3e9b4dbSLuiz Otavio O Souza  * for transparent-mode forwarding, then sets the NR_FORWARD
1255*c3e9b4dbSLuiz Otavio O Souza  * flag in the kring to let the caller push them out
125668b8534bSLuigi Rizzo  */
12578fd44c93SLuigi Rizzo static int
125837e3a6d3SLuigi Rizzo netmap_rxsync_from_host(struct netmap_kring *kring, int flags)
125968b8534bSLuigi Rizzo {
126037e3a6d3SLuigi Rizzo 	struct netmap_adapter *na = kring->na;
126168b8534bSLuigi Rizzo 	struct netmap_ring *ring = kring->ring;
126217885a7bSLuigi Rizzo 	u_int nm_i, n;
126317885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1264f0ea3689SLuigi Rizzo 	u_int const head = kring->rhead;
126517885a7bSLuigi Rizzo 	int ret = 0;
1266847bf383SLuigi Rizzo 	struct mbq *q = &kring->rx_queue, fq;
126768b8534bSLuigi Rizzo 
1268847bf383SLuigi Rizzo 	mbq_init(&fq); /* fq holds packets to be freed */
1269847bf383SLuigi Rizzo 
1270997b054cSLuigi Rizzo 	mbq_lock(q);
127117885a7bSLuigi Rizzo 
127217885a7bSLuigi Rizzo 	/* First part: import newly received packets */
127317885a7bSLuigi Rizzo 	n = mbq_len(q);
127417885a7bSLuigi Rizzo 	if (n) { /* grab packets from the queue */
127517885a7bSLuigi Rizzo 		struct mbuf *m;
127617885a7bSLuigi Rizzo 		uint32_t stop_i;
127717885a7bSLuigi Rizzo 
127817885a7bSLuigi Rizzo 		nm_i = kring->nr_hwtail;
1279*c3e9b4dbSLuiz Otavio O Souza 		stop_i = nm_prev(kring->nr_hwcur, lim);
128017885a7bSLuigi Rizzo 		while ( nm_i != stop_i && (m = mbq_dequeue(q)) != NULL ) {
128117885a7bSLuigi Rizzo 			int len = MBUF_LEN(m);
128217885a7bSLuigi Rizzo 			struct netmap_slot *slot = &ring->slot[nm_i];
128317885a7bSLuigi Rizzo 
12844bf50f18SLuigi Rizzo 			m_copydata(m, 0, len, NMB(na, slot));
128517885a7bSLuigi Rizzo 			ND("nm %d len %d", nm_i, len);
128617885a7bSLuigi Rizzo 			if (netmap_verbose)
12874bf50f18SLuigi Rizzo                                 D("%s", nm_dump_buf(NMB(na, slot),len, 128, NULL));
128817885a7bSLuigi Rizzo 
128917885a7bSLuigi Rizzo 			slot->len = len;
129017885a7bSLuigi Rizzo 			slot->flags = kring->nkr_slot_flags;
129117885a7bSLuigi Rizzo 			nm_i = nm_next(nm_i, lim);
1292847bf383SLuigi Rizzo 			mbq_enqueue(&fq, m);
129364ae02c3SLuigi Rizzo 		}
129417885a7bSLuigi Rizzo 		kring->nr_hwtail = nm_i;
129564ae02c3SLuigi Rizzo 	}
129617885a7bSLuigi Rizzo 
129717885a7bSLuigi Rizzo 	/*
129817885a7bSLuigi Rizzo 	 * Second part: skip past packets that userspace has released.
129917885a7bSLuigi Rizzo 	 */
130017885a7bSLuigi Rizzo 	nm_i = kring->nr_hwcur;
130117885a7bSLuigi Rizzo 	if (nm_i != head) { /* something was released */
1302*c3e9b4dbSLuiz Otavio O Souza 		if (nm_may_forward_down(kring, flags)) {
130317885a7bSLuigi Rizzo 			ret = netmap_sw_to_nic(na);
130437e3a6d3SLuigi Rizzo 			if (ret > 0) {
130537e3a6d3SLuigi Rizzo 				kring->nr_kflags |= NR_FORWARD;
130637e3a6d3SLuigi Rizzo 				ret = 0;
130737e3a6d3SLuigi Rizzo 			}
130837e3a6d3SLuigi Rizzo 		}
130917885a7bSLuigi Rizzo 		kring->nr_hwcur = head;
131064ae02c3SLuigi Rizzo 	}
131117885a7bSLuigi Rizzo 
1312997b054cSLuigi Rizzo 	mbq_unlock(q);
1313847bf383SLuigi Rizzo 
1314847bf383SLuigi Rizzo 	mbq_purge(&fq);
131537e3a6d3SLuigi Rizzo 	mbq_fini(&fq);
1316847bf383SLuigi Rizzo 
131717885a7bSLuigi Rizzo 	return ret;
131868b8534bSLuigi Rizzo }
131968b8534bSLuigi Rizzo 
132068b8534bSLuigi Rizzo 
1321f9790aebSLuigi Rizzo /* Get a netmap adapter for the port.
1322f9790aebSLuigi Rizzo  *
1323f9790aebSLuigi Rizzo  * If it is possible to satisfy the request, return 0
1324f9790aebSLuigi Rizzo  * with *na containing the netmap adapter found.
1325f9790aebSLuigi Rizzo  * Otherwise return an error code, with *na containing NULL.
1326f9790aebSLuigi Rizzo  *
1327f9790aebSLuigi Rizzo  * When the port is attached to a bridge, we always return
1328f9790aebSLuigi Rizzo  * EBUSY.
1329f9790aebSLuigi Rizzo  * Otherwise, if the port is already bound to a file descriptor,
1330f9790aebSLuigi Rizzo  * then we unconditionally return the existing adapter into *na.
1331f9790aebSLuigi Rizzo  * In all the other cases, we return (into *na) either native,
1332f9790aebSLuigi Rizzo  * generic or NULL, according to the following table:
1333f9790aebSLuigi Rizzo  *
1334f9790aebSLuigi Rizzo  *					native_support
1335f9790aebSLuigi Rizzo  * active_fds   dev.netmap.admode         YES     NO
1336f9790aebSLuigi Rizzo  * -------------------------------------------------------
1337f9790aebSLuigi Rizzo  *    >0              *                 NA(ifp) NA(ifp)
1338f9790aebSLuigi Rizzo  *
1339f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_BEST      NATIVE  GENERIC
1340f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_NATIVE    NATIVE   NULL
1341f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_GENERIC   GENERIC GENERIC
1342f9790aebSLuigi Rizzo  *
1343f9790aebSLuigi Rizzo  */
134437e3a6d3SLuigi Rizzo static void netmap_hw_dtor(struct netmap_adapter *); /* needed by NM_IS_NATIVE() */
1345f9790aebSLuigi Rizzo int
1346*c3e9b4dbSLuiz Otavio O Souza netmap_get_hw_na(struct ifnet *ifp, struct netmap_mem_d *nmd, struct netmap_adapter **na)
1347f9790aebSLuigi Rizzo {
1348f9790aebSLuigi Rizzo 	/* generic support */
1349f9790aebSLuigi Rizzo 	int i = netmap_admode;	/* Take a snapshot. */
1350f9790aebSLuigi Rizzo 	struct netmap_adapter *prev_na;
1351847bf383SLuigi Rizzo 	int error = 0;
1352f9790aebSLuigi Rizzo 
1353f9790aebSLuigi Rizzo 	*na = NULL; /* default */
1354f9790aebSLuigi Rizzo 
1355f9790aebSLuigi Rizzo 	/* reset in case of invalid value */
1356f9790aebSLuigi Rizzo 	if (i < NETMAP_ADMODE_BEST || i >= NETMAP_ADMODE_LAST)
1357f9790aebSLuigi Rizzo 		i = netmap_admode = NETMAP_ADMODE_BEST;
1358f9790aebSLuigi Rizzo 
135937e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
13604bf50f18SLuigi Rizzo 		prev_na = NA(ifp);
1361f9790aebSLuigi Rizzo 		/* If an adapter already exists, return it if
1362f9790aebSLuigi Rizzo 		 * there are active file descriptors or if
1363f9790aebSLuigi Rizzo 		 * netmap is not forced to use generic
1364f9790aebSLuigi Rizzo 		 * adapters.
1365f9790aebSLuigi Rizzo 		 */
13664bf50f18SLuigi Rizzo 		if (NETMAP_OWNED_BY_ANY(prev_na)
13674bf50f18SLuigi Rizzo 			|| i != NETMAP_ADMODE_GENERIC
13684bf50f18SLuigi Rizzo 			|| prev_na->na_flags & NAF_FORCE_NATIVE
13694bf50f18SLuigi Rizzo #ifdef WITH_PIPES
13704bf50f18SLuigi Rizzo 			/* ugly, but we cannot allow an adapter switch
13714bf50f18SLuigi Rizzo 			 * if some pipe is referring to this one
13724bf50f18SLuigi Rizzo 			 */
13734bf50f18SLuigi Rizzo 			|| prev_na->na_next_pipe > 0
13744bf50f18SLuigi Rizzo #endif
13754bf50f18SLuigi Rizzo 		) {
13764bf50f18SLuigi Rizzo 			*na = prev_na;
1377*c3e9b4dbSLuiz Otavio O Souza 			goto assign_mem;
1378f9790aebSLuigi Rizzo 		}
1379f9790aebSLuigi Rizzo 	}
1380f9790aebSLuigi Rizzo 
1381f9790aebSLuigi Rizzo 	/* If there isn't native support and netmap is not allowed
1382f9790aebSLuigi Rizzo 	 * to use generic adapters, we cannot satisfy the request.
1383f9790aebSLuigi Rizzo 	 */
138437e3a6d3SLuigi Rizzo 	if (!NM_IS_NATIVE(ifp) && i == NETMAP_ADMODE_NATIVE)
1385f2637526SLuigi Rizzo 		return EOPNOTSUPP;
1386f9790aebSLuigi Rizzo 
1387f9790aebSLuigi Rizzo 	/* Otherwise, create a generic adapter and return it,
1388f9790aebSLuigi Rizzo 	 * saving the previously used netmap adapter, if any.
1389f9790aebSLuigi Rizzo 	 *
1390f9790aebSLuigi Rizzo 	 * Note that here 'prev_na', if not NULL, MUST be a
1391f9790aebSLuigi Rizzo 	 * native adapter, and CANNOT be a generic one. This is
1392f9790aebSLuigi Rizzo 	 * true because generic adapters are created on demand, and
1393f9790aebSLuigi Rizzo 	 * destroyed when not used anymore. Therefore, if the adapter
1394f9790aebSLuigi Rizzo 	 * currently attached to an interface 'ifp' is generic, it
1395f9790aebSLuigi Rizzo 	 * must be that
1396f9790aebSLuigi Rizzo 	 * (NA(ifp)->active_fds > 0 || NETMAP_OWNED_BY_KERN(NA(ifp))).
1397f9790aebSLuigi Rizzo 	 * Consequently, if NA(ifp) is generic, we will enter one of
1398f9790aebSLuigi Rizzo 	 * the branches above. This ensures that we never override
1399f9790aebSLuigi Rizzo 	 * a generic adapter with another generic adapter.
1400f9790aebSLuigi Rizzo 	 */
1401f9790aebSLuigi Rizzo 	error = generic_netmap_attach(ifp);
1402f9790aebSLuigi Rizzo 	if (error)
1403f9790aebSLuigi Rizzo 		return error;
1404f9790aebSLuigi Rizzo 
1405f9790aebSLuigi Rizzo 	*na = NA(ifp);
1406*c3e9b4dbSLuiz Otavio O Souza 
1407*c3e9b4dbSLuiz Otavio O Souza assign_mem:
1408*c3e9b4dbSLuiz Otavio O Souza 	if (nmd != NULL && !((*na)->na_flags & NAF_MEM_OWNER) &&
1409*c3e9b4dbSLuiz Otavio O Souza 	    (*na)->active_fds == 0 && ((*na)->nm_mem != nmd)) {
1410*c3e9b4dbSLuiz Otavio O Souza 		netmap_mem_put((*na)->nm_mem);
1411*c3e9b4dbSLuiz Otavio O Souza 		(*na)->nm_mem = netmap_mem_get(nmd);
1412f9790aebSLuigi Rizzo 	}
1413f9790aebSLuigi Rizzo 
1414*c3e9b4dbSLuiz Otavio O Souza 	return 0;
1415*c3e9b4dbSLuiz Otavio O Souza }
1416f9790aebSLuigi Rizzo 
141768b8534bSLuigi Rizzo /*
1418ce3ee1e7SLuigi Rizzo  * MUST BE CALLED UNDER NMG_LOCK()
1419ce3ee1e7SLuigi Rizzo  *
1420f2637526SLuigi Rizzo  * Get a refcounted reference to a netmap adapter attached
1421f2637526SLuigi Rizzo  * to the interface specified by nmr.
1422ce3ee1e7SLuigi Rizzo  * This is always called in the execution of an ioctl().
1423ce3ee1e7SLuigi Rizzo  *
1424f2637526SLuigi Rizzo  * Return ENXIO if the interface specified by the request does
1425f2637526SLuigi Rizzo  * not exist, ENOTSUP if netmap is not supported by the interface,
1426f2637526SLuigi Rizzo  * EBUSY if the interface is already attached to a bridge,
1427f2637526SLuigi Rizzo  * EINVAL if parameters are invalid, ENOMEM if needed resources
1428f2637526SLuigi Rizzo  * could not be allocated.
1429f2637526SLuigi Rizzo  * If successful, hold a reference to the netmap adapter.
1430f18be576SLuigi Rizzo  *
143137e3a6d3SLuigi Rizzo  * If the interface specified by nmr is a system one, also keep
143237e3a6d3SLuigi Rizzo  * a reference to it and return a valid *ifp.
143368b8534bSLuigi Rizzo  */
1434f9790aebSLuigi Rizzo int
143537e3a6d3SLuigi Rizzo netmap_get_na(struct nmreq *nmr, struct netmap_adapter **na,
1436*c3e9b4dbSLuiz Otavio O Souza 	      struct ifnet **ifp, struct netmap_mem_d *nmd, int create)
143768b8534bSLuigi Rizzo {
1438f9790aebSLuigi Rizzo 	int error = 0;
1439f0ea3689SLuigi Rizzo 	struct netmap_adapter *ret = NULL;
1440*c3e9b4dbSLuiz Otavio O Souza 	int nmd_ref = 0;
1441f9790aebSLuigi Rizzo 
1442f9790aebSLuigi Rizzo 	*na = NULL;     /* default return value */
144337e3a6d3SLuigi Rizzo 	*ifp = NULL;
1444f196ce38SLuigi Rizzo 
1445ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
1446ce3ee1e7SLuigi Rizzo 
1447*c3e9b4dbSLuiz Otavio O Souza 	/* if the request contain a memid, try to find the
1448*c3e9b4dbSLuiz Otavio O Souza 	 * corresponding memory region
1449*c3e9b4dbSLuiz Otavio O Souza 	 */
1450*c3e9b4dbSLuiz Otavio O Souza 	if (nmd == NULL && nmr->nr_arg2) {
1451*c3e9b4dbSLuiz Otavio O Souza 		nmd = netmap_mem_find(nmr->nr_arg2);
1452*c3e9b4dbSLuiz Otavio O Souza 		if (nmd == NULL)
1453*c3e9b4dbSLuiz Otavio O Souza 			return EINVAL;
1454*c3e9b4dbSLuiz Otavio O Souza 		/* keep the rereference */
1455*c3e9b4dbSLuiz Otavio O Souza 		nmd_ref = 1;
1456*c3e9b4dbSLuiz Otavio O Souza 	}
1457*c3e9b4dbSLuiz Otavio O Souza 
145837e3a6d3SLuigi Rizzo 	/* We cascade through all possible types of netmap adapter.
14594bf50f18SLuigi Rizzo 	 * All netmap_get_*_na() functions return an error and an na,
14604bf50f18SLuigi Rizzo 	 * with the following combinations:
14614bf50f18SLuigi Rizzo 	 *
14624bf50f18SLuigi Rizzo 	 * error    na
14634bf50f18SLuigi Rizzo 	 *   0	   NULL		type doesn't match
14644bf50f18SLuigi Rizzo 	 *  !0	   NULL		type matches, but na creation/lookup failed
14654bf50f18SLuigi Rizzo 	 *   0	  !NULL		type matches and na created/found
14664bf50f18SLuigi Rizzo 	 *  !0    !NULL		impossible
14674bf50f18SLuigi Rizzo 	 */
14684bf50f18SLuigi Rizzo 
146937e3a6d3SLuigi Rizzo 	/* try to see if this is a ptnetmap port */
1470*c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_pt_host_na(nmr, na, nmd, create);
147137e3a6d3SLuigi Rizzo 	if (error || *na != NULL)
1472*c3e9b4dbSLuiz Otavio O Souza 		goto out;
147337e3a6d3SLuigi Rizzo 
14744bf50f18SLuigi Rizzo 	/* try to see if this is a monitor port */
1475*c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_monitor_na(nmr, na, nmd, create);
14764bf50f18SLuigi Rizzo 	if (error || *na != NULL)
1477*c3e9b4dbSLuiz Otavio O Souza 		goto out;
14784bf50f18SLuigi Rizzo 
14794bf50f18SLuigi Rizzo 	/* try to see if this is a pipe port */
1480*c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_pipe_na(nmr, na, nmd, create);
1481f0ea3689SLuigi Rizzo 	if (error || *na != NULL)
1482*c3e9b4dbSLuiz Otavio O Souza 		goto out;
1483ce3ee1e7SLuigi Rizzo 
14844bf50f18SLuigi Rizzo 	/* try to see if this is a bridge port */
1485*c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_bdg_na(nmr, na, nmd, create);
1486f0ea3689SLuigi Rizzo 	if (error)
1487*c3e9b4dbSLuiz Otavio O Souza 		goto out;
1488f0ea3689SLuigi Rizzo 
1489f0ea3689SLuigi Rizzo 	if (*na != NULL) /* valid match in netmap_get_bdg_na() */
1490847bf383SLuigi Rizzo 		goto out;
1491f0ea3689SLuigi Rizzo 
149289cc2556SLuigi Rizzo 	/*
149389cc2556SLuigi Rizzo 	 * This must be a hardware na, lookup the name in the system.
149489cc2556SLuigi Rizzo 	 * Note that by hardware we actually mean "it shows up in ifconfig".
149589cc2556SLuigi Rizzo 	 * This may still be a tap, a veth/epair, or even a
149689cc2556SLuigi Rizzo 	 * persistent VALE port.
149789cc2556SLuigi Rizzo 	 */
149837e3a6d3SLuigi Rizzo 	*ifp = ifunit_ref(nmr->nr_name);
149937e3a6d3SLuigi Rizzo 	if (*ifp == NULL) {
1500*c3e9b4dbSLuiz Otavio O Souza 		error = ENXIO;
1501*c3e9b4dbSLuiz Otavio O Souza 		goto out;
1502f196ce38SLuigi Rizzo 	}
1503ce3ee1e7SLuigi Rizzo 
1504*c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_hw_na(*ifp, nmd, &ret);
1505f9790aebSLuigi Rizzo 	if (error)
1506f9790aebSLuigi Rizzo 		goto out;
1507f18be576SLuigi Rizzo 
1508f9790aebSLuigi Rizzo 	*na = ret;
1509f9790aebSLuigi Rizzo 	netmap_adapter_get(ret);
1510f0ea3689SLuigi Rizzo 
1511f9790aebSLuigi Rizzo out:
151237e3a6d3SLuigi Rizzo 	if (error) {
151337e3a6d3SLuigi Rizzo 		if (ret)
1514f0ea3689SLuigi Rizzo 			netmap_adapter_put(ret);
151537e3a6d3SLuigi Rizzo 		if (*ifp) {
151637e3a6d3SLuigi Rizzo 			if_rele(*ifp);
151737e3a6d3SLuigi Rizzo 			*ifp = NULL;
151837e3a6d3SLuigi Rizzo 		}
151937e3a6d3SLuigi Rizzo 	}
1520*c3e9b4dbSLuiz Otavio O Souza 	if (nmd_ref)
1521*c3e9b4dbSLuiz Otavio O Souza 		netmap_mem_put(nmd);
1522f18be576SLuigi Rizzo 
15235ab0d24dSLuigi Rizzo 	return error;
15245ab0d24dSLuigi Rizzo }
1525ce3ee1e7SLuigi Rizzo 
152637e3a6d3SLuigi Rizzo /* undo netmap_get_na() */
152737e3a6d3SLuigi Rizzo void
152837e3a6d3SLuigi Rizzo netmap_unget_na(struct netmap_adapter *na, struct ifnet *ifp)
152937e3a6d3SLuigi Rizzo {
153037e3a6d3SLuigi Rizzo 	if (ifp)
153137e3a6d3SLuigi Rizzo 		if_rele(ifp);
153237e3a6d3SLuigi Rizzo 	if (na)
153337e3a6d3SLuigi Rizzo 		netmap_adapter_put(na);
153437e3a6d3SLuigi Rizzo }
153537e3a6d3SLuigi Rizzo 
153637e3a6d3SLuigi Rizzo 
153737e3a6d3SLuigi Rizzo #define NM_FAIL_ON(t) do {						\
153837e3a6d3SLuigi Rizzo 	if (unlikely(t)) {						\
153937e3a6d3SLuigi Rizzo 		RD(5, "%s: fail '" #t "' "				\
154037e3a6d3SLuigi Rizzo 			"h %d c %d t %d "				\
154137e3a6d3SLuigi Rizzo 			"rh %d rc %d rt %d "				\
154237e3a6d3SLuigi Rizzo 			"hc %d ht %d",					\
154337e3a6d3SLuigi Rizzo 			kring->name,					\
154437e3a6d3SLuigi Rizzo 			head, cur, ring->tail,				\
154537e3a6d3SLuigi Rizzo 			kring->rhead, kring->rcur, kring->rtail,	\
154637e3a6d3SLuigi Rizzo 			kring->nr_hwcur, kring->nr_hwtail);		\
154737e3a6d3SLuigi Rizzo 		return kring->nkr_num_slots;				\
154837e3a6d3SLuigi Rizzo 	}								\
154937e3a6d3SLuigi Rizzo } while (0)
1550ce3ee1e7SLuigi Rizzo 
1551f9790aebSLuigi Rizzo /*
1552f9790aebSLuigi Rizzo  * validate parameters on entry for *_txsync()
1553f9790aebSLuigi Rizzo  * Returns ring->cur if ok, or something >= kring->nkr_num_slots
155417885a7bSLuigi Rizzo  * in case of error.
1555f9790aebSLuigi Rizzo  *
155617885a7bSLuigi Rizzo  * rhead, rcur and rtail=hwtail are stored from previous round.
155717885a7bSLuigi Rizzo  * hwcur is the next packet to send to the ring.
1558f9790aebSLuigi Rizzo  *
155917885a7bSLuigi Rizzo  * We want
156017885a7bSLuigi Rizzo  *    hwcur <= *rhead <= head <= cur <= tail = *rtail <= hwtail
1561f9790aebSLuigi Rizzo  *
156217885a7bSLuigi Rizzo  * hwcur, rhead, rtail and hwtail are reliable
1563f9790aebSLuigi Rizzo  */
156437e3a6d3SLuigi Rizzo u_int
156537e3a6d3SLuigi Rizzo nm_txsync_prologue(struct netmap_kring *kring, struct netmap_ring *ring)
1566f9790aebSLuigi Rizzo {
156717885a7bSLuigi Rizzo 	u_int head = ring->head; /* read only once */
1568f9790aebSLuigi Rizzo 	u_int cur = ring->cur; /* read only once */
1569f9790aebSLuigi Rizzo 	u_int n = kring->nkr_num_slots;
1570ce3ee1e7SLuigi Rizzo 
157117885a7bSLuigi Rizzo 	ND(5, "%s kcur %d ktail %d head %d cur %d tail %d",
157217885a7bSLuigi Rizzo 		kring->name,
157317885a7bSLuigi Rizzo 		kring->nr_hwcur, kring->nr_hwtail,
157417885a7bSLuigi Rizzo 		ring->head, ring->cur, ring->tail);
157517885a7bSLuigi Rizzo #if 1 /* kernel sanity checks; but we can trust the kring. */
157637e3a6d3SLuigi Rizzo 	NM_FAIL_ON(kring->nr_hwcur >= n || kring->rhead >= n ||
157737e3a6d3SLuigi Rizzo 	    kring->rtail >= n ||  kring->nr_hwtail >= n);
1578f9790aebSLuigi Rizzo #endif /* kernel sanity checks */
157917885a7bSLuigi Rizzo 	/*
158037e3a6d3SLuigi Rizzo 	 * user sanity checks. We only use head,
158137e3a6d3SLuigi Rizzo 	 * A, B, ... are possible positions for head:
158217885a7bSLuigi Rizzo 	 *
158337e3a6d3SLuigi Rizzo 	 *  0    A  rhead   B  rtail   C  n-1
158437e3a6d3SLuigi Rizzo 	 *  0    D  rtail   E  rhead   F  n-1
158517885a7bSLuigi Rizzo 	 *
158617885a7bSLuigi Rizzo 	 * B, F, D are valid. A, C, E are wrong
158717885a7bSLuigi Rizzo 	 */
158817885a7bSLuigi Rizzo 	if (kring->rtail >= kring->rhead) {
158917885a7bSLuigi Rizzo 		/* want rhead <= head <= rtail */
159037e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->rhead || head > kring->rtail);
159117885a7bSLuigi Rizzo 		/* and also head <= cur <= rtail */
159237e3a6d3SLuigi Rizzo 		NM_FAIL_ON(cur < head || cur > kring->rtail);
159317885a7bSLuigi Rizzo 	} else { /* here rtail < rhead */
159417885a7bSLuigi Rizzo 		/* we need head outside rtail .. rhead */
159537e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head > kring->rtail && head < kring->rhead);
159617885a7bSLuigi Rizzo 
159717885a7bSLuigi Rizzo 		/* two cases now: head <= rtail or head >= rhead  */
159817885a7bSLuigi Rizzo 		if (head <= kring->rtail) {
159917885a7bSLuigi Rizzo 			/* want head <= cur <= rtail */
160037e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head || cur > kring->rtail);
160117885a7bSLuigi Rizzo 		} else { /* head >= rhead */
160217885a7bSLuigi Rizzo 			/* cur must be outside rtail..head */
160337e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur > kring->rtail && cur < head);
1604f18be576SLuigi Rizzo 		}
1605f9790aebSLuigi Rizzo 	}
160617885a7bSLuigi Rizzo 	if (ring->tail != kring->rtail) {
1607a2a74091SLuigi Rizzo 		RD(5, "%s tail overwritten was %d need %d", kring->name,
160817885a7bSLuigi Rizzo 			ring->tail, kring->rtail);
160917885a7bSLuigi Rizzo 		ring->tail = kring->rtail;
161017885a7bSLuigi Rizzo 	}
161117885a7bSLuigi Rizzo 	kring->rhead = head;
161217885a7bSLuigi Rizzo 	kring->rcur = cur;
161317885a7bSLuigi Rizzo 	return head;
161468b8534bSLuigi Rizzo }
161568b8534bSLuigi Rizzo 
161668b8534bSLuigi Rizzo 
161768b8534bSLuigi Rizzo /*
1618f9790aebSLuigi Rizzo  * validate parameters on entry for *_rxsync()
161917885a7bSLuigi Rizzo  * Returns ring->head if ok, kring->nkr_num_slots on error.
1620f9790aebSLuigi Rizzo  *
162117885a7bSLuigi Rizzo  * For a valid configuration,
162217885a7bSLuigi Rizzo  * hwcur <= head <= cur <= tail <= hwtail
1623f9790aebSLuigi Rizzo  *
162417885a7bSLuigi Rizzo  * We only consider head and cur.
162517885a7bSLuigi Rizzo  * hwcur and hwtail are reliable.
1626f9790aebSLuigi Rizzo  *
1627f9790aebSLuigi Rizzo  */
162837e3a6d3SLuigi Rizzo u_int
162937e3a6d3SLuigi Rizzo nm_rxsync_prologue(struct netmap_kring *kring, struct netmap_ring *ring)
1630f9790aebSLuigi Rizzo {
163117885a7bSLuigi Rizzo 	uint32_t const n = kring->nkr_num_slots;
163217885a7bSLuigi Rizzo 	uint32_t head, cur;
1633f9790aebSLuigi Rizzo 
1634847bf383SLuigi Rizzo 	ND(5,"%s kc %d kt %d h %d c %d t %d",
163517885a7bSLuigi Rizzo 		kring->name,
163617885a7bSLuigi Rizzo 		kring->nr_hwcur, kring->nr_hwtail,
163717885a7bSLuigi Rizzo 		ring->head, ring->cur, ring->tail);
163817885a7bSLuigi Rizzo 	/*
163917885a7bSLuigi Rizzo 	 * Before storing the new values, we should check they do not
164017885a7bSLuigi Rizzo 	 * move backwards. However:
164117885a7bSLuigi Rizzo 	 * - head is not an issue because the previous value is hwcur;
164217885a7bSLuigi Rizzo 	 * - cur could in principle go back, however it does not matter
164317885a7bSLuigi Rizzo 	 *   because we are processing a brand new rxsync()
164417885a7bSLuigi Rizzo 	 */
164517885a7bSLuigi Rizzo 	cur = kring->rcur = ring->cur;	/* read only once */
164617885a7bSLuigi Rizzo 	head = kring->rhead = ring->head;	/* read only once */
1647f9790aebSLuigi Rizzo #if 1 /* kernel sanity checks */
164837e3a6d3SLuigi Rizzo 	NM_FAIL_ON(kring->nr_hwcur >= n || kring->nr_hwtail >= n);
1649f9790aebSLuigi Rizzo #endif /* kernel sanity checks */
1650f9790aebSLuigi Rizzo 	/* user sanity checks */
165117885a7bSLuigi Rizzo 	if (kring->nr_hwtail >= kring->nr_hwcur) {
165217885a7bSLuigi Rizzo 		/* want hwcur <= rhead <= hwtail */
165337e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->nr_hwcur || head > kring->nr_hwtail);
165417885a7bSLuigi Rizzo 		/* and also rhead <= rcur <= hwtail */
165537e3a6d3SLuigi Rizzo 		NM_FAIL_ON(cur < head || cur > kring->nr_hwtail);
1656f9790aebSLuigi Rizzo 	} else {
165717885a7bSLuigi Rizzo 		/* we need rhead outside hwtail..hwcur */
165837e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->nr_hwcur && head > kring->nr_hwtail);
165917885a7bSLuigi Rizzo 		/* two cases now: head <= hwtail or head >= hwcur  */
166017885a7bSLuigi Rizzo 		if (head <= kring->nr_hwtail) {
166117885a7bSLuigi Rizzo 			/* want head <= cur <= hwtail */
166237e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head || cur > kring->nr_hwtail);
166317885a7bSLuigi Rizzo 		} else {
166417885a7bSLuigi Rizzo 			/* cur must be outside hwtail..head */
166537e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head && cur > kring->nr_hwtail);
1666f9790aebSLuigi Rizzo 		}
1667f9790aebSLuigi Rizzo 	}
166817885a7bSLuigi Rizzo 	if (ring->tail != kring->rtail) {
166917885a7bSLuigi Rizzo 		RD(5, "%s tail overwritten was %d need %d",
167017885a7bSLuigi Rizzo 			kring->name,
167117885a7bSLuigi Rizzo 			ring->tail, kring->rtail);
167217885a7bSLuigi Rizzo 		ring->tail = kring->rtail;
167317885a7bSLuigi Rizzo 	}
167417885a7bSLuigi Rizzo 	return head;
1675f9790aebSLuigi Rizzo }
1676f9790aebSLuigi Rizzo 
167717885a7bSLuigi Rizzo 
1678f9790aebSLuigi Rizzo /*
167968b8534bSLuigi Rizzo  * Error routine called when txsync/rxsync detects an error.
168017885a7bSLuigi Rizzo  * Can't do much more than resetting head =cur = hwcur, tail = hwtail
168168b8534bSLuigi Rizzo  * Return 1 on reinit.
1682506cc70cSLuigi Rizzo  *
1683506cc70cSLuigi Rizzo  * This routine is only called by the upper half of the kernel.
1684506cc70cSLuigi Rizzo  * It only reads hwcur (which is changed only by the upper half, too)
168517885a7bSLuigi Rizzo  * and hwtail (which may be changed by the lower half, but only on
1686506cc70cSLuigi Rizzo  * a tx ring and only to increase it, so any error will be recovered
1687506cc70cSLuigi Rizzo  * on the next call). For the above, we don't strictly need to call
1688506cc70cSLuigi Rizzo  * it under lock.
168968b8534bSLuigi Rizzo  */
169068b8534bSLuigi Rizzo int
169168b8534bSLuigi Rizzo netmap_ring_reinit(struct netmap_kring *kring)
169268b8534bSLuigi Rizzo {
169368b8534bSLuigi Rizzo 	struct netmap_ring *ring = kring->ring;
169468b8534bSLuigi Rizzo 	u_int i, lim = kring->nkr_num_slots - 1;
169568b8534bSLuigi Rizzo 	int errors = 0;
169668b8534bSLuigi Rizzo 
1697ce3ee1e7SLuigi Rizzo 	// XXX KASSERT nm_kr_tryget
16984bf50f18SLuigi Rizzo 	RD(10, "called for %s", kring->name);
169917885a7bSLuigi Rizzo 	// XXX probably wrong to trust userspace
170017885a7bSLuigi Rizzo 	kring->rhead = ring->head;
170117885a7bSLuigi Rizzo 	kring->rcur  = ring->cur;
170217885a7bSLuigi Rizzo 	kring->rtail = ring->tail;
170317885a7bSLuigi Rizzo 
170468b8534bSLuigi Rizzo 	if (ring->cur > lim)
170568b8534bSLuigi Rizzo 		errors++;
170617885a7bSLuigi Rizzo 	if (ring->head > lim)
170717885a7bSLuigi Rizzo 		errors++;
170817885a7bSLuigi Rizzo 	if (ring->tail > lim)
170917885a7bSLuigi Rizzo 		errors++;
171068b8534bSLuigi Rizzo 	for (i = 0; i <= lim; i++) {
171168b8534bSLuigi Rizzo 		u_int idx = ring->slot[i].buf_idx;
171268b8534bSLuigi Rizzo 		u_int len = ring->slot[i].len;
1713847bf383SLuigi Rizzo 		if (idx < 2 || idx >= kring->na->na_lut.objtotal) {
171417885a7bSLuigi Rizzo 			RD(5, "bad index at slot %d idx %d len %d ", i, idx, len);
171568b8534bSLuigi Rizzo 			ring->slot[i].buf_idx = 0;
171668b8534bSLuigi Rizzo 			ring->slot[i].len = 0;
17174bf50f18SLuigi Rizzo 		} else if (len > NETMAP_BUF_SIZE(kring->na)) {
171868b8534bSLuigi Rizzo 			ring->slot[i].len = 0;
171917885a7bSLuigi Rizzo 			RD(5, "bad len at slot %d idx %d len %d", i, idx, len);
172068b8534bSLuigi Rizzo 		}
172168b8534bSLuigi Rizzo 	}
172268b8534bSLuigi Rizzo 	if (errors) {
17238241616dSLuigi Rizzo 		RD(10, "total %d errors", errors);
172417885a7bSLuigi Rizzo 		RD(10, "%s reinit, cur %d -> %d tail %d -> %d",
172517885a7bSLuigi Rizzo 			kring->name,
172668b8534bSLuigi Rizzo 			ring->cur, kring->nr_hwcur,
172717885a7bSLuigi Rizzo 			ring->tail, kring->nr_hwtail);
172817885a7bSLuigi Rizzo 		ring->head = kring->rhead = kring->nr_hwcur;
172917885a7bSLuigi Rizzo 		ring->cur  = kring->rcur  = kring->nr_hwcur;
173017885a7bSLuigi Rizzo 		ring->tail = kring->rtail = kring->nr_hwtail;
173168b8534bSLuigi Rizzo 	}
173268b8534bSLuigi Rizzo 	return (errors ? 1 : 0);
173368b8534bSLuigi Rizzo }
173468b8534bSLuigi Rizzo 
17354bf50f18SLuigi Rizzo /* interpret the ringid and flags fields of an nmreq, by translating them
17364bf50f18SLuigi Rizzo  * into a pair of intervals of ring indices:
17374bf50f18SLuigi Rizzo  *
17384bf50f18SLuigi Rizzo  * [priv->np_txqfirst, priv->np_txqlast) and
17394bf50f18SLuigi Rizzo  * [priv->np_rxqfirst, priv->np_rxqlast)
17404bf50f18SLuigi Rizzo  *
174168b8534bSLuigi Rizzo  */
17424bf50f18SLuigi Rizzo int
17434bf50f18SLuigi Rizzo netmap_interp_ringid(struct netmap_priv_d *priv, uint16_t ringid, uint32_t flags)
174468b8534bSLuigi Rizzo {
1745f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1746f0ea3689SLuigi Rizzo 	u_int j, i = ringid & NETMAP_RING_MASK;
1747f0ea3689SLuigi Rizzo 	u_int reg = flags & NR_REG_MASK;
174837e3a6d3SLuigi Rizzo 	int excluded_direction[] = { NR_TX_RINGS_ONLY, NR_RX_RINGS_ONLY };
1749847bf383SLuigi Rizzo 	enum txrx t;
175068b8534bSLuigi Rizzo 
1751f0ea3689SLuigi Rizzo 	if (reg == NR_REG_DEFAULT) {
1752f0ea3689SLuigi Rizzo 		/* convert from old ringid to flags */
175368b8534bSLuigi Rizzo 		if (ringid & NETMAP_SW_RING) {
1754f0ea3689SLuigi Rizzo 			reg = NR_REG_SW;
175568b8534bSLuigi Rizzo 		} else if (ringid & NETMAP_HW_RING) {
1756f0ea3689SLuigi Rizzo 			reg = NR_REG_ONE_NIC;
175768b8534bSLuigi Rizzo 		} else {
1758f0ea3689SLuigi Rizzo 			reg = NR_REG_ALL_NIC;
1759f0ea3689SLuigi Rizzo 		}
1760f0ea3689SLuigi Rizzo 		D("deprecated API, old ringid 0x%x -> ringid %x reg %d", ringid, i, reg);
1761f0ea3689SLuigi Rizzo 	}
176237e3a6d3SLuigi Rizzo 
1763*c3e9b4dbSLuiz Otavio O Souza 	if ((flags & NR_PTNETMAP_HOST) && ((reg != NR_REG_ALL_NIC &&
1764*c3e9b4dbSLuiz Otavio O Souza                     reg != NR_REG_PIPE_MASTER && reg != NR_REG_PIPE_SLAVE) ||
176537e3a6d3SLuigi Rizzo 			flags & (NR_RX_RINGS_ONLY|NR_TX_RINGS_ONLY))) {
176637e3a6d3SLuigi Rizzo 		D("Error: only NR_REG_ALL_NIC supported with netmap passthrough");
176737e3a6d3SLuigi Rizzo 		return EINVAL;
176837e3a6d3SLuigi Rizzo 	}
176937e3a6d3SLuigi Rizzo 
177037e3a6d3SLuigi Rizzo 	for_rx_tx(t) {
177137e3a6d3SLuigi Rizzo 		if (flags & excluded_direction[t]) {
177237e3a6d3SLuigi Rizzo 			priv->np_qfirst[t] = priv->np_qlast[t] = 0;
177337e3a6d3SLuigi Rizzo 			continue;
177437e3a6d3SLuigi Rizzo 		}
1775f0ea3689SLuigi Rizzo 		switch (reg) {
1776f0ea3689SLuigi Rizzo 		case NR_REG_ALL_NIC:
1777f0ea3689SLuigi Rizzo 		case NR_REG_PIPE_MASTER:
1778f0ea3689SLuigi Rizzo 		case NR_REG_PIPE_SLAVE:
1779847bf383SLuigi Rizzo 			priv->np_qfirst[t] = 0;
1780847bf383SLuigi Rizzo 			priv->np_qlast[t] = nma_get_nrings(na, t);
178137e3a6d3SLuigi Rizzo 			ND("ALL/PIPE: %s %d %d", nm_txrx2str(t),
178237e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1783f0ea3689SLuigi Rizzo 			break;
1784f0ea3689SLuigi Rizzo 		case NR_REG_SW:
1785f0ea3689SLuigi Rizzo 		case NR_REG_NIC_SW:
1786f0ea3689SLuigi Rizzo 			if (!(na->na_flags & NAF_HOST_RINGS)) {
1787f0ea3689SLuigi Rizzo 				D("host rings not supported");
1788f0ea3689SLuigi Rizzo 				return EINVAL;
1789f0ea3689SLuigi Rizzo 			}
1790847bf383SLuigi Rizzo 			priv->np_qfirst[t] = (reg == NR_REG_SW ?
1791847bf383SLuigi Rizzo 				nma_get_nrings(na, t) : 0);
1792847bf383SLuigi Rizzo 			priv->np_qlast[t] = nma_get_nrings(na, t) + 1;
179337e3a6d3SLuigi Rizzo 			ND("%s: %s %d %d", reg == NR_REG_SW ? "SW" : "NIC+SW",
179437e3a6d3SLuigi Rizzo 				nm_txrx2str(t),
179537e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1796f0ea3689SLuigi Rizzo 			break;
1797f0ea3689SLuigi Rizzo 		case NR_REG_ONE_NIC:
1798f0ea3689SLuigi Rizzo 			if (i >= na->num_tx_rings && i >= na->num_rx_rings) {
1799f0ea3689SLuigi Rizzo 				D("invalid ring id %d", i);
1800f0ea3689SLuigi Rizzo 				return EINVAL;
1801f0ea3689SLuigi Rizzo 			}
1802f0ea3689SLuigi Rizzo 			/* if not enough rings, use the first one */
1803f0ea3689SLuigi Rizzo 			j = i;
1804847bf383SLuigi Rizzo 			if (j >= nma_get_nrings(na, t))
1805f0ea3689SLuigi Rizzo 				j = 0;
1806847bf383SLuigi Rizzo 			priv->np_qfirst[t] = j;
1807847bf383SLuigi Rizzo 			priv->np_qlast[t] = j + 1;
180837e3a6d3SLuigi Rizzo 			ND("ONE_NIC: %s %d %d", nm_txrx2str(t),
180937e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1810f0ea3689SLuigi Rizzo 			break;
1811f0ea3689SLuigi Rizzo 		default:
1812f0ea3689SLuigi Rizzo 			D("invalid regif type %d", reg);
1813f0ea3689SLuigi Rizzo 			return EINVAL;
181468b8534bSLuigi Rizzo 		}
181537e3a6d3SLuigi Rizzo 	}
1816f0ea3689SLuigi Rizzo 	priv->np_flags = (flags & ~NR_REG_MASK) | reg;
18174bf50f18SLuigi Rizzo 
1818*c3e9b4dbSLuiz Otavio O Souza 	/* Allow transparent forwarding mode in the host --> nic
1819*c3e9b4dbSLuiz Otavio O Souza 	 * direction only if all the TX hw rings have been opened. */
1820*c3e9b4dbSLuiz Otavio O Souza 	if (priv->np_qfirst[NR_TX] == 0 &&
1821*c3e9b4dbSLuiz Otavio O Souza 			priv->np_qlast[NR_TX] >= na->num_tx_rings) {
1822*c3e9b4dbSLuiz Otavio O Souza 		priv->np_sync_flags |= NAF_CAN_FORWARD_DOWN;
1823*c3e9b4dbSLuiz Otavio O Souza 	}
1824*c3e9b4dbSLuiz Otavio O Souza 
1825ae10d1afSLuigi Rizzo 	if (netmap_verbose) {
1826f0ea3689SLuigi Rizzo 		D("%s: tx [%d,%d) rx [%d,%d) id %d",
18274bf50f18SLuigi Rizzo 			na->name,
1828847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
1829847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
1830847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
1831847bf383SLuigi Rizzo 			priv->np_qlast[NR_RX],
1832f0ea3689SLuigi Rizzo 			i);
1833ae10d1afSLuigi Rizzo 	}
183468b8534bSLuigi Rizzo 	return 0;
183568b8534bSLuigi Rizzo }
183668b8534bSLuigi Rizzo 
18374bf50f18SLuigi Rizzo 
18384bf50f18SLuigi Rizzo /*
18394bf50f18SLuigi Rizzo  * Set the ring ID. For devices with a single queue, a request
18404bf50f18SLuigi Rizzo  * for all rings is the same as a single ring.
18414bf50f18SLuigi Rizzo  */
18424bf50f18SLuigi Rizzo static int
18434bf50f18SLuigi Rizzo netmap_set_ringid(struct netmap_priv_d *priv, uint16_t ringid, uint32_t flags)
18444bf50f18SLuigi Rizzo {
18454bf50f18SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
18464bf50f18SLuigi Rizzo 	int error;
1847847bf383SLuigi Rizzo 	enum txrx t;
18484bf50f18SLuigi Rizzo 
18494bf50f18SLuigi Rizzo 	error = netmap_interp_ringid(priv, ringid, flags);
18504bf50f18SLuigi Rizzo 	if (error) {
18514bf50f18SLuigi Rizzo 		return error;
18524bf50f18SLuigi Rizzo 	}
18534bf50f18SLuigi Rizzo 
18544bf50f18SLuigi Rizzo 	priv->np_txpoll = (ringid & NETMAP_NO_TX_POLL) ? 0 : 1;
18554bf50f18SLuigi Rizzo 
18564bf50f18SLuigi Rizzo 	/* optimization: count the users registered for more than
18574bf50f18SLuigi Rizzo 	 * one ring, which are the ones sleeping on the global queue.
18584bf50f18SLuigi Rizzo 	 * The default netmap_notify() callback will then
18594bf50f18SLuigi Rizzo 	 * avoid signaling the global queue if nobody is using it
18604bf50f18SLuigi Rizzo 	 */
1861847bf383SLuigi Rizzo 	for_rx_tx(t) {
1862847bf383SLuigi Rizzo 		if (nm_si_user(priv, t))
1863847bf383SLuigi Rizzo 			na->si_users[t]++;
1864847bf383SLuigi Rizzo 	}
18654bf50f18SLuigi Rizzo 	return 0;
18664bf50f18SLuigi Rizzo }
18674bf50f18SLuigi Rizzo 
1868847bf383SLuigi Rizzo static void
1869847bf383SLuigi Rizzo netmap_unset_ringid(struct netmap_priv_d *priv)
1870847bf383SLuigi Rizzo {
1871847bf383SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1872847bf383SLuigi Rizzo 	enum txrx t;
1873847bf383SLuigi Rizzo 
1874847bf383SLuigi Rizzo 	for_rx_tx(t) {
1875847bf383SLuigi Rizzo 		if (nm_si_user(priv, t))
1876847bf383SLuigi Rizzo 			na->si_users[t]--;
1877847bf383SLuigi Rizzo 		priv->np_qfirst[t] = priv->np_qlast[t] = 0;
1878847bf383SLuigi Rizzo 	}
1879847bf383SLuigi Rizzo 	priv->np_flags = 0;
1880847bf383SLuigi Rizzo 	priv->np_txpoll = 0;
1881847bf383SLuigi Rizzo }
1882847bf383SLuigi Rizzo 
1883847bf383SLuigi Rizzo 
188437e3a6d3SLuigi Rizzo /* Set the nr_pending_mode for the requested rings.
188537e3a6d3SLuigi Rizzo  * If requested, also try to get exclusive access to the rings, provided
188637e3a6d3SLuigi Rizzo  * the rings we want to bind are not exclusively owned by a previous bind.
1887847bf383SLuigi Rizzo  */
1888847bf383SLuigi Rizzo static int
188937e3a6d3SLuigi Rizzo netmap_krings_get(struct netmap_priv_d *priv)
1890847bf383SLuigi Rizzo {
1891847bf383SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1892847bf383SLuigi Rizzo 	u_int i;
1893847bf383SLuigi Rizzo 	struct netmap_kring *kring;
1894847bf383SLuigi Rizzo 	int excl = (priv->np_flags & NR_EXCLUSIVE);
1895847bf383SLuigi Rizzo 	enum txrx t;
1896847bf383SLuigi Rizzo 
1897847bf383SLuigi Rizzo 	ND("%s: grabbing tx [%d, %d) rx [%d, %d)",
1898847bf383SLuigi Rizzo 			na->name,
1899847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
1900847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
1901847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
1902847bf383SLuigi Rizzo 			priv->np_qlast[NR_RX]);
1903847bf383SLuigi Rizzo 
1904847bf383SLuigi Rizzo 	/* first round: check that all the requested rings
1905847bf383SLuigi Rizzo 	 * are neither alread exclusively owned, nor we
1906847bf383SLuigi Rizzo 	 * want exclusive ownership when they are already in use
1907847bf383SLuigi Rizzo 	 */
1908847bf383SLuigi Rizzo 	for_rx_tx(t) {
1909847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
1910847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
1911847bf383SLuigi Rizzo 			if ((kring->nr_kflags & NKR_EXCLUSIVE) ||
1912847bf383SLuigi Rizzo 			    (kring->users && excl))
1913847bf383SLuigi Rizzo 			{
1914847bf383SLuigi Rizzo 				ND("ring %s busy", kring->name);
1915847bf383SLuigi Rizzo 				return EBUSY;
1916847bf383SLuigi Rizzo 			}
1917847bf383SLuigi Rizzo 		}
1918847bf383SLuigi Rizzo 	}
1919847bf383SLuigi Rizzo 
192037e3a6d3SLuigi Rizzo 	/* second round: increment usage count (possibly marking them
192137e3a6d3SLuigi Rizzo 	 * as exclusive) and set the nr_pending_mode
1922847bf383SLuigi Rizzo 	 */
1923847bf383SLuigi Rizzo 	for_rx_tx(t) {
1924847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
1925847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
1926847bf383SLuigi Rizzo 			kring->users++;
1927847bf383SLuigi Rizzo 			if (excl)
1928847bf383SLuigi Rizzo 				kring->nr_kflags |= NKR_EXCLUSIVE;
192937e3a6d3SLuigi Rizzo 	                kring->nr_pending_mode = NKR_NETMAP_ON;
1930847bf383SLuigi Rizzo 		}
1931847bf383SLuigi Rizzo 	}
1932847bf383SLuigi Rizzo 
1933847bf383SLuigi Rizzo 	return 0;
1934847bf383SLuigi Rizzo 
1935847bf383SLuigi Rizzo }
1936847bf383SLuigi Rizzo 
193737e3a6d3SLuigi Rizzo /* Undo netmap_krings_get(). This is done by clearing the exclusive mode
193837e3a6d3SLuigi Rizzo  * if was asked on regif, and unset the nr_pending_mode if we are the
193937e3a6d3SLuigi Rizzo  * last users of the involved rings. */
1940847bf383SLuigi Rizzo static void
194137e3a6d3SLuigi Rizzo netmap_krings_put(struct netmap_priv_d *priv)
1942847bf383SLuigi Rizzo {
1943847bf383SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1944847bf383SLuigi Rizzo 	u_int i;
1945847bf383SLuigi Rizzo 	struct netmap_kring *kring;
1946847bf383SLuigi Rizzo 	int excl = (priv->np_flags & NR_EXCLUSIVE);
1947847bf383SLuigi Rizzo 	enum txrx t;
1948847bf383SLuigi Rizzo 
1949847bf383SLuigi Rizzo 	ND("%s: releasing tx [%d, %d) rx [%d, %d)",
1950847bf383SLuigi Rizzo 			na->name,
1951847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
1952847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
1953847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
1954847bf383SLuigi Rizzo 			priv->np_qlast[MR_RX]);
1955847bf383SLuigi Rizzo 
1956847bf383SLuigi Rizzo 
1957847bf383SLuigi Rizzo 	for_rx_tx(t) {
1958847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
1959847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
1960847bf383SLuigi Rizzo 			if (excl)
1961847bf383SLuigi Rizzo 				kring->nr_kflags &= ~NKR_EXCLUSIVE;
1962847bf383SLuigi Rizzo 			kring->users--;
196337e3a6d3SLuigi Rizzo 			if (kring->users == 0)
196437e3a6d3SLuigi Rizzo 				kring->nr_pending_mode = NKR_NETMAP_OFF;
1965847bf383SLuigi Rizzo 		}
1966847bf383SLuigi Rizzo 	}
1967847bf383SLuigi Rizzo }
1968847bf383SLuigi Rizzo 
1969f18be576SLuigi Rizzo /*
1970f18be576SLuigi Rizzo  * possibly move the interface to netmap-mode.
1971f18be576SLuigi Rizzo  * If success it returns a pointer to netmap_if, otherwise NULL.
1972ce3ee1e7SLuigi Rizzo  * This must be called with NMG_LOCK held.
19734bf50f18SLuigi Rizzo  *
19744bf50f18SLuigi Rizzo  * The following na callbacks are called in the process:
19754bf50f18SLuigi Rizzo  *
19764bf50f18SLuigi Rizzo  * na->nm_config()			[by netmap_update_config]
19774bf50f18SLuigi Rizzo  * (get current number and size of rings)
19784bf50f18SLuigi Rizzo  *
19794bf50f18SLuigi Rizzo  *  	We have a generic one for linux (netmap_linux_config).
19804bf50f18SLuigi Rizzo  *  	The bwrap has to override this, since it has to forward
19814bf50f18SLuigi Rizzo  *  	the request to the wrapped adapter (netmap_bwrap_config).
19824bf50f18SLuigi Rizzo  *
19834bf50f18SLuigi Rizzo  *
1984847bf383SLuigi Rizzo  * na->nm_krings_create()
19854bf50f18SLuigi Rizzo  * (create and init the krings array)
19864bf50f18SLuigi Rizzo  *
19874bf50f18SLuigi Rizzo  * 	One of the following:
19884bf50f18SLuigi Rizzo  *
19894bf50f18SLuigi Rizzo  *	* netmap_hw_krings_create, 			(hw ports)
19904bf50f18SLuigi Rizzo  *		creates the standard layout for the krings
19914bf50f18SLuigi Rizzo  * 		and adds the mbq (used for the host rings).
19924bf50f18SLuigi Rizzo  *
19934bf50f18SLuigi Rizzo  * 	* netmap_vp_krings_create			(VALE ports)
19944bf50f18SLuigi Rizzo  * 		add leases and scratchpads
19954bf50f18SLuigi Rizzo  *
19964bf50f18SLuigi Rizzo  * 	* netmap_pipe_krings_create			(pipes)
19974bf50f18SLuigi Rizzo  * 		create the krings and rings of both ends and
19984bf50f18SLuigi Rizzo  * 		cross-link them
19994bf50f18SLuigi Rizzo  *
20004bf50f18SLuigi Rizzo  *      * netmap_monitor_krings_create 			(monitors)
20014bf50f18SLuigi Rizzo  *      	avoid allocating the mbq
20024bf50f18SLuigi Rizzo  *
20034bf50f18SLuigi Rizzo  *      * netmap_bwrap_krings_create			(bwraps)
20044bf50f18SLuigi Rizzo  *      	create both the brap krings array,
20054bf50f18SLuigi Rizzo  *      	the krings array of the wrapped adapter, and
20064bf50f18SLuigi Rizzo  *      	(if needed) the fake array for the host adapter
20074bf50f18SLuigi Rizzo  *
20084bf50f18SLuigi Rizzo  * na->nm_register(, 1)
20094bf50f18SLuigi Rizzo  * (put the adapter in netmap mode)
20104bf50f18SLuigi Rizzo  *
20114bf50f18SLuigi Rizzo  * 	This may be one of the following:
20124bf50f18SLuigi Rizzo  *
201337e3a6d3SLuigi Rizzo  * 	* netmap_hw_reg				        (hw ports)
20144bf50f18SLuigi Rizzo  * 		checks that the ifp is still there, then calls
20154bf50f18SLuigi Rizzo  * 		the hardware specific callback;
20164bf50f18SLuigi Rizzo  *
20174bf50f18SLuigi Rizzo  * 	* netmap_vp_reg					(VALE ports)
20184bf50f18SLuigi Rizzo  *		If the port is connected to a bridge,
20194bf50f18SLuigi Rizzo  *		set the NAF_NETMAP_ON flag under the
20204bf50f18SLuigi Rizzo  *		bridge write lock.
20214bf50f18SLuigi Rizzo  *
20224bf50f18SLuigi Rizzo  *	* netmap_pipe_reg				(pipes)
20234bf50f18SLuigi Rizzo  *		inform the other pipe end that it is no
2024453130d9SPedro F. Giffuni  *		longer responsible for the lifetime of this
20254bf50f18SLuigi Rizzo  *		pipe end
20264bf50f18SLuigi Rizzo  *
20274bf50f18SLuigi Rizzo  *	* netmap_monitor_reg				(monitors)
20284bf50f18SLuigi Rizzo  *		intercept the sync callbacks of the monitored
20294bf50f18SLuigi Rizzo  *		rings
20304bf50f18SLuigi Rizzo  *
203137e3a6d3SLuigi Rizzo  *	* netmap_bwrap_reg				(bwraps)
20324bf50f18SLuigi Rizzo  *		cross-link the bwrap and hwna rings,
20334bf50f18SLuigi Rizzo  *		forward the request to the hwna, override
20344bf50f18SLuigi Rizzo  *		the hwna notify callback (to get the frames
20354bf50f18SLuigi Rizzo  *		coming from outside go through the bridge).
20364bf50f18SLuigi Rizzo  *
20374bf50f18SLuigi Rizzo  *
2038f18be576SLuigi Rizzo  */
2039847bf383SLuigi Rizzo int
2040f9790aebSLuigi Rizzo netmap_do_regif(struct netmap_priv_d *priv, struct netmap_adapter *na,
2041847bf383SLuigi Rizzo 	uint16_t ringid, uint32_t flags)
2042f18be576SLuigi Rizzo {
2043f18be576SLuigi Rizzo 	struct netmap_if *nifp = NULL;
2044847bf383SLuigi Rizzo 	int error;
2045f18be576SLuigi Rizzo 
2046ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
2047f18be576SLuigi Rizzo 	/* ring configuration may have changed, fetch from the card */
2048f18be576SLuigi Rizzo 	netmap_update_config(na);
2049f9790aebSLuigi Rizzo 	priv->np_na = na;     /* store the reference */
2050f0ea3689SLuigi Rizzo 	error = netmap_set_ringid(priv, ringid, flags);
2051f18be576SLuigi Rizzo 	if (error)
2052847bf383SLuigi Rizzo 		goto err;
2053847bf383SLuigi Rizzo 	error = netmap_mem_finalize(na->nm_mem, na);
2054ce3ee1e7SLuigi Rizzo 	if (error)
2055847bf383SLuigi Rizzo 		goto err;
2056847bf383SLuigi Rizzo 
2057847bf383SLuigi Rizzo 	if (na->active_fds == 0) {
2058847bf383SLuigi Rizzo 		/*
2059847bf383SLuigi Rizzo 		 * If this is the first registration of the adapter,
206037e3a6d3SLuigi Rizzo 		 * create the  in-kernel view of the netmap rings,
2061847bf383SLuigi Rizzo 		 * the netmap krings.
2062847bf383SLuigi Rizzo 		 */
2063847bf383SLuigi Rizzo 
2064847bf383SLuigi Rizzo 		/*
2065847bf383SLuigi Rizzo 		 * Depending on the adapter, this may also create
2066847bf383SLuigi Rizzo 		 * the netmap rings themselves
2067847bf383SLuigi Rizzo 		 */
2068847bf383SLuigi Rizzo 		error = na->nm_krings_create(na);
2069847bf383SLuigi Rizzo 		if (error)
2070847bf383SLuigi Rizzo 			goto err_drop_mem;
2071847bf383SLuigi Rizzo 
2072ce3ee1e7SLuigi Rizzo 	}
2073847bf383SLuigi Rizzo 
207437e3a6d3SLuigi Rizzo 	/* now the krings must exist and we can check whether some
207537e3a6d3SLuigi Rizzo 	 * previous bind has exclusive ownership on them, and set
207637e3a6d3SLuigi Rizzo 	 * nr_pending_mode
2077847bf383SLuigi Rizzo 	 */
207837e3a6d3SLuigi Rizzo 	error = netmap_krings_get(priv);
2079847bf383SLuigi Rizzo 	if (error)
208037e3a6d3SLuigi Rizzo 		goto err_del_krings;
208137e3a6d3SLuigi Rizzo 
208237e3a6d3SLuigi Rizzo 	/* create all needed missing netmap rings */
208337e3a6d3SLuigi Rizzo 	error = netmap_mem_rings_create(na);
208437e3a6d3SLuigi Rizzo 	if (error)
208537e3a6d3SLuigi Rizzo 		goto err_rel_excl;
2086847bf383SLuigi Rizzo 
2087847bf383SLuigi Rizzo 	/* in all cases, create a new netmap if */
2088*c3e9b4dbSLuiz Otavio O Souza 	nifp = netmap_mem_if_new(na, priv);
2089847bf383SLuigi Rizzo 	if (nifp == NULL) {
2090f18be576SLuigi Rizzo 		error = ENOMEM;
209137e3a6d3SLuigi Rizzo 		goto err_del_rings;
2092ce3ee1e7SLuigi Rizzo 	}
2093847bf383SLuigi Rizzo 
209437e3a6d3SLuigi Rizzo 	if (na->active_fds == 0) {
209589cc2556SLuigi Rizzo 		/* cache the allocator info in the na */
209637e3a6d3SLuigi Rizzo 		error = netmap_mem_get_lut(na->nm_mem, &na->na_lut);
2097847bf383SLuigi Rizzo 		if (error)
2098847bf383SLuigi Rizzo 			goto err_del_if;
209937e3a6d3SLuigi Rizzo 		ND("lut %p bufs %u size %u", na->na_lut.lut, na->na_lut.objtotal,
210037e3a6d3SLuigi Rizzo 					    na->na_lut.objsize);
2101f18be576SLuigi Rizzo 	}
2102847bf383SLuigi Rizzo 
210337e3a6d3SLuigi Rizzo 	if (nm_kring_pending(priv)) {
210437e3a6d3SLuigi Rizzo 		/* Some kring is switching mode, tell the adapter to
210537e3a6d3SLuigi Rizzo 		 * react on this. */
210637e3a6d3SLuigi Rizzo 		error = na->nm_register(na, 1);
210737e3a6d3SLuigi Rizzo 		if (error)
210837e3a6d3SLuigi Rizzo 			goto err_put_lut;
210937e3a6d3SLuigi Rizzo 	}
211037e3a6d3SLuigi Rizzo 
211137e3a6d3SLuigi Rizzo 	/* Commit the reference. */
211237e3a6d3SLuigi Rizzo 	na->active_fds++;
211337e3a6d3SLuigi Rizzo 
2114ce3ee1e7SLuigi Rizzo 	/*
2115847bf383SLuigi Rizzo 	 * advertise that the interface is ready by setting np_nifp.
2116847bf383SLuigi Rizzo 	 * The barrier is needed because readers (poll, *SYNC and mmap)
2117ce3ee1e7SLuigi Rizzo 	 * check for priv->np_nifp != NULL without locking
2118ce3ee1e7SLuigi Rizzo 	 */
2119847bf383SLuigi Rizzo 	mb(); /* make sure previous writes are visible to all CPUs */
2120ce3ee1e7SLuigi Rizzo 	priv->np_nifp = nifp;
2121847bf383SLuigi Rizzo 
2122847bf383SLuigi Rizzo 	return 0;
2123847bf383SLuigi Rizzo 
212437e3a6d3SLuigi Rizzo err_put_lut:
212537e3a6d3SLuigi Rizzo 	if (na->active_fds == 0)
2126847bf383SLuigi Rizzo 		memset(&na->na_lut, 0, sizeof(na->na_lut));
212737e3a6d3SLuigi Rizzo err_del_if:
2128847bf383SLuigi Rizzo 	netmap_mem_if_delete(na, nifp);
2129847bf383SLuigi Rizzo err_rel_excl:
213037e3a6d3SLuigi Rizzo 	netmap_krings_put(priv);
2131847bf383SLuigi Rizzo err_del_rings:
2132847bf383SLuigi Rizzo 	netmap_mem_rings_delete(na);
2133847bf383SLuigi Rizzo err_del_krings:
2134847bf383SLuigi Rizzo 	if (na->active_fds == 0)
2135847bf383SLuigi Rizzo 		na->nm_krings_delete(na);
2136847bf383SLuigi Rizzo err_drop_mem:
2137847bf383SLuigi Rizzo 	netmap_mem_deref(na->nm_mem, na);
2138847bf383SLuigi Rizzo err:
2139847bf383SLuigi Rizzo 	priv->np_na = NULL;
2140847bf383SLuigi Rizzo 	return error;
2141ce3ee1e7SLuigi Rizzo }
2142847bf383SLuigi Rizzo 
2143847bf383SLuigi Rizzo 
2144847bf383SLuigi Rizzo /*
214537e3a6d3SLuigi Rizzo  * update kring and ring at the end of rxsync/txsync.
2146847bf383SLuigi Rizzo  */
2147847bf383SLuigi Rizzo static inline void
214837e3a6d3SLuigi Rizzo nm_sync_finalize(struct netmap_kring *kring)
2149847bf383SLuigi Rizzo {
215037e3a6d3SLuigi Rizzo 	/*
215137e3a6d3SLuigi Rizzo 	 * Update ring tail to what the kernel knows
215237e3a6d3SLuigi Rizzo 	 * After txsync: head/rhead/hwcur might be behind cur/rcur
215337e3a6d3SLuigi Rizzo 	 * if no carrier.
215437e3a6d3SLuigi Rizzo 	 */
2155847bf383SLuigi Rizzo 	kring->ring->tail = kring->rtail = kring->nr_hwtail;
2156847bf383SLuigi Rizzo 
2157847bf383SLuigi Rizzo 	ND(5, "%s now hwcur %d hwtail %d head %d cur %d tail %d",
2158847bf383SLuigi Rizzo 		kring->name, kring->nr_hwcur, kring->nr_hwtail,
2159847bf383SLuigi Rizzo 		kring->rhead, kring->rcur, kring->rtail);
2160847bf383SLuigi Rizzo }
2161847bf383SLuigi Rizzo 
2162*c3e9b4dbSLuiz Otavio O Souza /* set ring timestamp */
2163*c3e9b4dbSLuiz Otavio O Souza static inline void
2164*c3e9b4dbSLuiz Otavio O Souza ring_timestamp_set(struct netmap_ring *ring)
2165*c3e9b4dbSLuiz Otavio O Souza {
2166*c3e9b4dbSLuiz Otavio O Souza 	if (netmap_no_timestamp == 0 || ring->flags & NR_TIMESTAMP) {
2167*c3e9b4dbSLuiz Otavio O Souza 		microtime(&ring->ts);
2168*c3e9b4dbSLuiz Otavio O Souza 	}
2169*c3e9b4dbSLuiz Otavio O Souza }
2170*c3e9b4dbSLuiz Otavio O Souza 
2171*c3e9b4dbSLuiz Otavio O Souza 
217268b8534bSLuigi Rizzo /*
217368b8534bSLuigi Rizzo  * ioctl(2) support for the "netmap" device.
217468b8534bSLuigi Rizzo  *
217568b8534bSLuigi Rizzo  * Following a list of accepted commands:
217668b8534bSLuigi Rizzo  * - NIOCGINFO
217768b8534bSLuigi Rizzo  * - SIOCGIFADDR	just for convenience
217868b8534bSLuigi Rizzo  * - NIOCREGIF
217968b8534bSLuigi Rizzo  * - NIOCTXSYNC
218068b8534bSLuigi Rizzo  * - NIOCRXSYNC
218168b8534bSLuigi Rizzo  *
218268b8534bSLuigi Rizzo  * Return 0 on success, errno otherwise.
218368b8534bSLuigi Rizzo  */
2184f9790aebSLuigi Rizzo int
218537e3a6d3SLuigi Rizzo netmap_ioctl(struct netmap_priv_d *priv, u_long cmd, caddr_t data, struct thread *td)
218668b8534bSLuigi Rizzo {
2187*c3e9b4dbSLuiz Otavio O Souza 	struct mbq q;	/* packets from RX hw queues to host stack */
218868b8534bSLuigi Rizzo 	struct nmreq *nmr = (struct nmreq *) data;
2189ce3ee1e7SLuigi Rizzo 	struct netmap_adapter *na = NULL;
2190*c3e9b4dbSLuiz Otavio O Souza 	struct netmap_mem_d *nmd = NULL;
219137e3a6d3SLuigi Rizzo 	struct ifnet *ifp = NULL;
219237e3a6d3SLuigi Rizzo 	int error = 0;
2193f0ea3689SLuigi Rizzo 	u_int i, qfirst, qlast;
219468b8534bSLuigi Rizzo 	struct netmap_if *nifp;
2195ce3ee1e7SLuigi Rizzo 	struct netmap_kring *krings;
2196*c3e9b4dbSLuiz Otavio O Souza 	int sync_flags;
2197847bf383SLuigi Rizzo 	enum txrx t;
219868b8534bSLuigi Rizzo 
219917885a7bSLuigi Rizzo 	if (cmd == NIOCGINFO || cmd == NIOCREGIF) {
220017885a7bSLuigi Rizzo 		/* truncate name */
220117885a7bSLuigi Rizzo 		nmr->nr_name[sizeof(nmr->nr_name) - 1] = '\0';
220217885a7bSLuigi Rizzo 		if (nmr->nr_version != NETMAP_API) {
220317885a7bSLuigi Rizzo 			D("API mismatch for %s got %d need %d",
220417885a7bSLuigi Rizzo 				nmr->nr_name,
220517885a7bSLuigi Rizzo 				nmr->nr_version, NETMAP_API);
220617885a7bSLuigi Rizzo 			nmr->nr_version = NETMAP_API;
2207f0ea3689SLuigi Rizzo 		}
2208f0ea3689SLuigi Rizzo 		if (nmr->nr_version < NETMAP_MIN_API ||
2209f0ea3689SLuigi Rizzo 		    nmr->nr_version > NETMAP_MAX_API) {
221017885a7bSLuigi Rizzo 			return EINVAL;
221117885a7bSLuigi Rizzo 		}
221217885a7bSLuigi Rizzo 	}
221368b8534bSLuigi Rizzo 
221468b8534bSLuigi Rizzo 	switch (cmd) {
221568b8534bSLuigi Rizzo 	case NIOCGINFO:		/* return capabilities etc */
2216f18be576SLuigi Rizzo 		if (nmr->nr_cmd == NETMAP_BDG_LIST) {
2217f18be576SLuigi Rizzo 			error = netmap_bdg_ctl(nmr, NULL);
2218f18be576SLuigi Rizzo 			break;
2219f18be576SLuigi Rizzo 		}
2220ce3ee1e7SLuigi Rizzo 
2221ce3ee1e7SLuigi Rizzo 		NMG_LOCK();
2222ce3ee1e7SLuigi Rizzo 		do {
2223ce3ee1e7SLuigi Rizzo 			/* memsize is always valid */
2224ce3ee1e7SLuigi Rizzo 			u_int memflags;
2225ce3ee1e7SLuigi Rizzo 
2226ce3ee1e7SLuigi Rizzo 			if (nmr->nr_name[0] != '\0') {
222737e3a6d3SLuigi Rizzo 
2228ce3ee1e7SLuigi Rizzo 				/* get a refcount */
2229*c3e9b4dbSLuiz Otavio O Souza 				error = netmap_get_na(nmr, &na, &ifp, NULL, 1 /* create */);
223037e3a6d3SLuigi Rizzo 				if (error) {
223137e3a6d3SLuigi Rizzo 					na = NULL;
223237e3a6d3SLuigi Rizzo 					ifp = NULL;
22338241616dSLuigi Rizzo 					break;
223437e3a6d3SLuigi Rizzo 				}
2235f9790aebSLuigi Rizzo 				nmd = na->nm_mem; /* get memory allocator */
2236*c3e9b4dbSLuiz Otavio O Souza 			} else {
2237*c3e9b4dbSLuiz Otavio O Souza 				nmd = netmap_mem_find(nmr->nr_arg2 ? nmr->nr_arg2 : 1);
2238*c3e9b4dbSLuiz Otavio O Souza 				if (nmd == NULL) {
2239*c3e9b4dbSLuiz Otavio O Souza 					error = EINVAL;
2240*c3e9b4dbSLuiz Otavio O Souza 					break;
2241*c3e9b4dbSLuiz Otavio O Souza 				}
2242ce3ee1e7SLuigi Rizzo 			}
2243ce3ee1e7SLuigi Rizzo 
2244f0ea3689SLuigi Rizzo 			error = netmap_mem_get_info(nmd, &nmr->nr_memsize, &memflags,
2245f0ea3689SLuigi Rizzo 				&nmr->nr_arg2);
2246ce3ee1e7SLuigi Rizzo 			if (error)
2247ce3ee1e7SLuigi Rizzo 				break;
2248ce3ee1e7SLuigi Rizzo 			if (na == NULL) /* only memory info */
2249ce3ee1e7SLuigi Rizzo 				break;
22508241616dSLuigi Rizzo 			nmr->nr_offset = 0;
22518241616dSLuigi Rizzo 			nmr->nr_rx_slots = nmr->nr_tx_slots = 0;
2252ae10d1afSLuigi Rizzo 			netmap_update_config(na);
2253d76bf4ffSLuigi Rizzo 			nmr->nr_rx_rings = na->num_rx_rings;
2254d76bf4ffSLuigi Rizzo 			nmr->nr_tx_rings = na->num_tx_rings;
225564ae02c3SLuigi Rizzo 			nmr->nr_rx_slots = na->num_rx_desc;
225664ae02c3SLuigi Rizzo 			nmr->nr_tx_slots = na->num_tx_desc;
2257ce3ee1e7SLuigi Rizzo 		} while (0);
225837e3a6d3SLuigi Rizzo 		netmap_unget_na(na, ifp);
2259ce3ee1e7SLuigi Rizzo 		NMG_UNLOCK();
226068b8534bSLuigi Rizzo 		break;
226168b8534bSLuigi Rizzo 
226268b8534bSLuigi Rizzo 	case NIOCREGIF:
2263844a6f0cSLuigi Rizzo 		/*
2264844a6f0cSLuigi Rizzo 		 * If nmr->nr_cmd is not zero, this NIOCREGIF is not really
2265844a6f0cSLuigi Rizzo 		 * a regif operation, but a different one, specified by the
2266844a6f0cSLuigi Rizzo 		 * value of nmr->nr_cmd.
2267844a6f0cSLuigi Rizzo 		 */
2268f18be576SLuigi Rizzo 		i = nmr->nr_cmd;
2269f9790aebSLuigi Rizzo 		if (i == NETMAP_BDG_ATTACH || i == NETMAP_BDG_DETACH
22704bf50f18SLuigi Rizzo 				|| i == NETMAP_BDG_VNET_HDR
22714bf50f18SLuigi Rizzo 				|| i == NETMAP_BDG_NEWIF
227237e3a6d3SLuigi Rizzo 				|| i == NETMAP_BDG_DELIF
227337e3a6d3SLuigi Rizzo 				|| i == NETMAP_BDG_POLLING_ON
227437e3a6d3SLuigi Rizzo 				|| i == NETMAP_BDG_POLLING_OFF) {
2275844a6f0cSLuigi Rizzo 			/* possibly attach/detach NIC and VALE switch */
2276f18be576SLuigi Rizzo 			error = netmap_bdg_ctl(nmr, NULL);
2277f18be576SLuigi Rizzo 			break;
227837e3a6d3SLuigi Rizzo 		} else if (i == NETMAP_PT_HOST_CREATE || i == NETMAP_PT_HOST_DELETE) {
2279844a6f0cSLuigi Rizzo 			/* forward the command to the ptnetmap subsystem */
228037e3a6d3SLuigi Rizzo 			error = ptnetmap_ctl(nmr, priv->np_na);
228137e3a6d3SLuigi Rizzo 			break;
228237e3a6d3SLuigi Rizzo 		} else if (i == NETMAP_VNET_HDR_GET) {
2283844a6f0cSLuigi Rizzo 			/* get vnet-header length for this netmap port */
228437e3a6d3SLuigi Rizzo 			struct ifnet *ifp;
228537e3a6d3SLuigi Rizzo 
228637e3a6d3SLuigi Rizzo 			NMG_LOCK();
2287*c3e9b4dbSLuiz Otavio O Souza 			error = netmap_get_na(nmr, &na, &ifp, NULL, 0);
228837e3a6d3SLuigi Rizzo 			if (na && !error) {
228937e3a6d3SLuigi Rizzo 				nmr->nr_arg1 = na->virt_hdr_len;
229037e3a6d3SLuigi Rizzo 			}
229137e3a6d3SLuigi Rizzo 			netmap_unget_na(na, ifp);
229237e3a6d3SLuigi Rizzo 			NMG_UNLOCK();
229337e3a6d3SLuigi Rizzo 			break;
2294844a6f0cSLuigi Rizzo 		} else if (i == NETMAP_POOLS_INFO_GET) {
2295844a6f0cSLuigi Rizzo 			/* get information from the memory allocator */
2296*c3e9b4dbSLuiz Otavio O Souza 			NMG_LOCK();
2297*c3e9b4dbSLuiz Otavio O Souza 			if (priv->np_na && priv->np_na->nm_mem) {
2298*c3e9b4dbSLuiz Otavio O Souza 				struct netmap_mem_d *nmd = priv->np_na->nm_mem;
2299*c3e9b4dbSLuiz Otavio O Souza 				error = netmap_mem_pools_info_get(nmr, nmd);
2300*c3e9b4dbSLuiz Otavio O Souza 			} else {
2301*c3e9b4dbSLuiz Otavio O Souza 				error = EINVAL;
2302*c3e9b4dbSLuiz Otavio O Souza 			}
2303*c3e9b4dbSLuiz Otavio O Souza 			NMG_UNLOCK();
2304844a6f0cSLuigi Rizzo 			break;
2305f18be576SLuigi Rizzo 		} else if (i != 0) {
2306f18be576SLuigi Rizzo 			D("nr_cmd must be 0 not %d", i);
2307f18be576SLuigi Rizzo 			error = EINVAL;
2308f18be576SLuigi Rizzo 			break;
2309f18be576SLuigi Rizzo 		}
2310f18be576SLuigi Rizzo 
23118241616dSLuigi Rizzo 		/* protect access to priv from concurrent NIOCREGIF */
2312ce3ee1e7SLuigi Rizzo 		NMG_LOCK();
2313ce3ee1e7SLuigi Rizzo 		do {
2314ce3ee1e7SLuigi Rizzo 			u_int memflags;
231537e3a6d3SLuigi Rizzo 			struct ifnet *ifp;
2316ce3ee1e7SLuigi Rizzo 
2317847bf383SLuigi Rizzo 			if (priv->np_nifp != NULL) {	/* thread already registered */
2318f0ea3689SLuigi Rizzo 				error = EBUSY;
2319506cc70cSLuigi Rizzo 				break;
2320506cc70cSLuigi Rizzo 			}
2321*c3e9b4dbSLuiz Otavio O Souza 
2322*c3e9b4dbSLuiz Otavio O Souza 			if (nmr->nr_arg2) {
2323*c3e9b4dbSLuiz Otavio O Souza 				/* find the allocator and get a reference */
2324*c3e9b4dbSLuiz Otavio O Souza 				nmd = netmap_mem_find(nmr->nr_arg2);
2325*c3e9b4dbSLuiz Otavio O Souza 				if (nmd == NULL) {
2326*c3e9b4dbSLuiz Otavio O Souza 					error = EINVAL;
2327*c3e9b4dbSLuiz Otavio O Souza 					break;
2328*c3e9b4dbSLuiz Otavio O Souza 				}
2329*c3e9b4dbSLuiz Otavio O Souza 			}
233068b8534bSLuigi Rizzo 			/* find the interface and a reference */
2331*c3e9b4dbSLuiz Otavio O Souza 			error = netmap_get_na(nmr, &na, &ifp, nmd,
233237e3a6d3SLuigi Rizzo 					      1 /* create */); /* keep reference */
233368b8534bSLuigi Rizzo 			if (error)
2334ce3ee1e7SLuigi Rizzo 				break;
2335f9790aebSLuigi Rizzo 			if (NETMAP_OWNED_BY_KERN(na)) {
2336ce3ee1e7SLuigi Rizzo 				error = EBUSY;
2337ce3ee1e7SLuigi Rizzo 				break;
2338f196ce38SLuigi Rizzo 			}
233937e3a6d3SLuigi Rizzo 
234037e3a6d3SLuigi Rizzo 			if (na->virt_hdr_len && !(nmr->nr_flags & NR_ACCEPT_VNET_HDR)) {
234137e3a6d3SLuigi Rizzo 				error = EIO;
234237e3a6d3SLuigi Rizzo 				break;
234337e3a6d3SLuigi Rizzo 			}
234437e3a6d3SLuigi Rizzo 
2345847bf383SLuigi Rizzo 			error = netmap_do_regif(priv, na, nmr->nr_ringid, nmr->nr_flags);
2346847bf383SLuigi Rizzo 			if (error) {    /* reg. failed, release priv and ref */
2347ce3ee1e7SLuigi Rizzo 				break;
234868b8534bSLuigi Rizzo 			}
2349847bf383SLuigi Rizzo 			nifp = priv->np_nifp;
2350f0ea3689SLuigi Rizzo 			priv->np_td = td; // XXX kqueue, debugging only
235168b8534bSLuigi Rizzo 
235268b8534bSLuigi Rizzo 			/* return the offset of the netmap_if object */
2353d76bf4ffSLuigi Rizzo 			nmr->nr_rx_rings = na->num_rx_rings;
2354d76bf4ffSLuigi Rizzo 			nmr->nr_tx_rings = na->num_tx_rings;
235564ae02c3SLuigi Rizzo 			nmr->nr_rx_slots = na->num_rx_desc;
235664ae02c3SLuigi Rizzo 			nmr->nr_tx_slots = na->num_tx_desc;
2357f0ea3689SLuigi Rizzo 			error = netmap_mem_get_info(na->nm_mem, &nmr->nr_memsize, &memflags,
2358f0ea3689SLuigi Rizzo 				&nmr->nr_arg2);
2359ce3ee1e7SLuigi Rizzo 			if (error) {
2360847bf383SLuigi Rizzo 				netmap_do_unregif(priv);
2361ce3ee1e7SLuigi Rizzo 				break;
2362ce3ee1e7SLuigi Rizzo 			}
2363ce3ee1e7SLuigi Rizzo 			if (memflags & NETMAP_MEM_PRIVATE) {
23643d819cb6SLuigi Rizzo 				*(uint32_t *)(uintptr_t)&nifp->ni_flags |= NI_PRIV_MEM;
2365ce3ee1e7SLuigi Rizzo 			}
2366847bf383SLuigi Rizzo 			for_rx_tx(t) {
2367847bf383SLuigi Rizzo 				priv->np_si[t] = nm_si_user(priv, t) ?
2368847bf383SLuigi Rizzo 					&na->si[t] : &NMR(na, t)[priv->np_qfirst[t]].si;
2369847bf383SLuigi Rizzo 			}
2370f0ea3689SLuigi Rizzo 
2371f0ea3689SLuigi Rizzo 			if (nmr->nr_arg3) {
237237e3a6d3SLuigi Rizzo 				if (netmap_verbose)
2373f0ea3689SLuigi Rizzo 					D("requested %d extra buffers", nmr->nr_arg3);
2374f0ea3689SLuigi Rizzo 				nmr->nr_arg3 = netmap_extra_alloc(na,
2375f0ea3689SLuigi Rizzo 					&nifp->ni_bufs_head, nmr->nr_arg3);
237637e3a6d3SLuigi Rizzo 				if (netmap_verbose)
2377f0ea3689SLuigi Rizzo 					D("got %d extra buffers", nmr->nr_arg3);
2378f0ea3689SLuigi Rizzo 			}
2379ce3ee1e7SLuigi Rizzo 			nmr->nr_offset = netmap_mem_if_offset(na->nm_mem, nifp);
238037e3a6d3SLuigi Rizzo 
238137e3a6d3SLuigi Rizzo 			/* store ifp reference so that priv destructor may release it */
238237e3a6d3SLuigi Rizzo 			priv->np_ifp = ifp;
2383ce3ee1e7SLuigi Rizzo 		} while (0);
2384*c3e9b4dbSLuiz Otavio O Souza 		if (error) {
2385*c3e9b4dbSLuiz Otavio O Souza 			netmap_unget_na(na, ifp);
2386*c3e9b4dbSLuiz Otavio O Souza 		}
2387*c3e9b4dbSLuiz Otavio O Souza 		/* release the reference from netmap_mem_find() or
2388*c3e9b4dbSLuiz Otavio O Souza 		 * netmap_mem_ext_create()
2389*c3e9b4dbSLuiz Otavio O Souza 		 */
2390*c3e9b4dbSLuiz Otavio O Souza 		if (nmd)
2391*c3e9b4dbSLuiz Otavio O Souza 			netmap_mem_put(nmd);
2392ce3ee1e7SLuigi Rizzo 		NMG_UNLOCK();
239368b8534bSLuigi Rizzo 		break;
239468b8534bSLuigi Rizzo 
239568b8534bSLuigi Rizzo 	case NIOCTXSYNC:
239668b8534bSLuigi Rizzo 	case NIOCRXSYNC:
23978241616dSLuigi Rizzo 		nifp = priv->np_nifp;
23988241616dSLuigi Rizzo 
23998241616dSLuigi Rizzo 		if (nifp == NULL) {
2400506cc70cSLuigi Rizzo 			error = ENXIO;
2401506cc70cSLuigi Rizzo 			break;
2402506cc70cSLuigi Rizzo 		}
24036641c68bSLuigi Rizzo 		mb(); /* make sure following reads are not from cache */
24048241616dSLuigi Rizzo 
2405f9790aebSLuigi Rizzo 		na = priv->np_na;      /* we have a reference */
24068241616dSLuigi Rizzo 
2407f9790aebSLuigi Rizzo 		if (na == NULL) {
2408f9790aebSLuigi Rizzo 			D("Internal error: nifp != NULL && na == NULL");
24098241616dSLuigi Rizzo 			error = ENXIO;
24108241616dSLuigi Rizzo 			break;
24118241616dSLuigi Rizzo 		}
24128241616dSLuigi Rizzo 
2413*c3e9b4dbSLuiz Otavio O Souza 		mbq_init(&q);
2414847bf383SLuigi Rizzo 		t = (cmd == NIOCTXSYNC ? NR_TX : NR_RX);
2415847bf383SLuigi Rizzo 		krings = NMR(na, t);
2416847bf383SLuigi Rizzo 		qfirst = priv->np_qfirst[t];
2417847bf383SLuigi Rizzo 		qlast = priv->np_qlast[t];
2418*c3e9b4dbSLuiz Otavio O Souza 		sync_flags = priv->np_sync_flags;
241968b8534bSLuigi Rizzo 
2420f0ea3689SLuigi Rizzo 		for (i = qfirst; i < qlast; i++) {
2421ce3ee1e7SLuigi Rizzo 			struct netmap_kring *kring = krings + i;
242237e3a6d3SLuigi Rizzo 			struct netmap_ring *ring = kring->ring;
242337e3a6d3SLuigi Rizzo 
242437e3a6d3SLuigi Rizzo 			if (unlikely(nm_kr_tryget(kring, 1, &error))) {
242537e3a6d3SLuigi Rizzo 				error = (error ? EIO : 0);
242637e3a6d3SLuigi Rizzo 				continue;
2427ce3ee1e7SLuigi Rizzo 			}
242837e3a6d3SLuigi Rizzo 
242968b8534bSLuigi Rizzo 			if (cmd == NIOCTXSYNC) {
243068b8534bSLuigi Rizzo 				if (netmap_verbose & NM_VERB_TXSYNC)
24313c0caf6cSLuigi Rizzo 					D("pre txsync ring %d cur %d hwcur %d",
243237e3a6d3SLuigi Rizzo 					    i, ring->cur,
243368b8534bSLuigi Rizzo 					    kring->nr_hwcur);
243437e3a6d3SLuigi Rizzo 				if (nm_txsync_prologue(kring, ring) >= kring->nkr_num_slots) {
243517885a7bSLuigi Rizzo 					netmap_ring_reinit(kring);
2436*c3e9b4dbSLuiz Otavio O Souza 				} else if (kring->nm_sync(kring, sync_flags | NAF_FORCE_RECLAIM) == 0) {
243737e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
243817885a7bSLuigi Rizzo 				}
243968b8534bSLuigi Rizzo 				if (netmap_verbose & NM_VERB_TXSYNC)
24403c0caf6cSLuigi Rizzo 					D("post txsync ring %d cur %d hwcur %d",
244137e3a6d3SLuigi Rizzo 					    i, ring->cur,
244268b8534bSLuigi Rizzo 					    kring->nr_hwcur);
244368b8534bSLuigi Rizzo 			} else {
244437e3a6d3SLuigi Rizzo 				if (nm_rxsync_prologue(kring, ring) >= kring->nkr_num_slots) {
2445847bf383SLuigi Rizzo 					netmap_ring_reinit(kring);
2446*c3e9b4dbSLuiz Otavio O Souza 				}
2447*c3e9b4dbSLuiz Otavio O Souza 				if (nm_may_forward_up(kring)) {
2448*c3e9b4dbSLuiz Otavio O Souza 					/* transparent forwarding, see netmap_poll() */
2449*c3e9b4dbSLuiz Otavio O Souza 					netmap_grab_packets(kring, &q, netmap_fwd);
2450*c3e9b4dbSLuiz Otavio O Souza 				}
2451*c3e9b4dbSLuiz Otavio O Souza 				if (kring->nm_sync(kring, sync_flags | NAF_FORCE_READ) == 0) {
245237e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
2453847bf383SLuigi Rizzo 				}
2454*c3e9b4dbSLuiz Otavio O Souza 				ring_timestamp_set(ring);
245568b8534bSLuigi Rizzo 			}
2456ce3ee1e7SLuigi Rizzo 			nm_kr_put(kring);
245768b8534bSLuigi Rizzo 		}
245868b8534bSLuigi Rizzo 
2459*c3e9b4dbSLuiz Otavio O Souza 		if (mbq_peek(&q)) {
2460*c3e9b4dbSLuiz Otavio O Souza 			netmap_send_up(na->ifp, &q);
2461*c3e9b4dbSLuiz Otavio O Souza 		}
2462*c3e9b4dbSLuiz Otavio O Souza 
246368b8534bSLuigi Rizzo 		break;
246468b8534bSLuigi Rizzo 
2465847bf383SLuigi Rizzo #ifdef WITH_VALE
24664bf50f18SLuigi Rizzo 	case NIOCCONFIG:
24674bf50f18SLuigi Rizzo 		error = netmap_bdg_config(nmr);
24684bf50f18SLuigi Rizzo 		break;
2469847bf383SLuigi Rizzo #endif
2470f196ce38SLuigi Rizzo #ifdef __FreeBSD__
247189e3fd52SLuigi Rizzo 	case FIONBIO:
247289e3fd52SLuigi Rizzo 	case FIOASYNC:
247389e3fd52SLuigi Rizzo 		ND("FIONBIO/FIOASYNC are no-ops");
247489e3fd52SLuigi Rizzo 		break;
247589e3fd52SLuigi Rizzo 
247668b8534bSLuigi Rizzo 	case BIOCIMMEDIATE:
247768b8534bSLuigi Rizzo 	case BIOCGHDRCMPLT:
247868b8534bSLuigi Rizzo 	case BIOCSHDRCMPLT:
247968b8534bSLuigi Rizzo 	case BIOCSSEESENT:
248068b8534bSLuigi Rizzo 		D("ignore BIOCIMMEDIATE/BIOCSHDRCMPLT/BIOCSHDRCMPLT/BIOCSSEESENT");
248168b8534bSLuigi Rizzo 		break;
248268b8534bSLuigi Rizzo 
2483babc7c12SLuigi Rizzo 	default:	/* allow device-specific ioctls */
248468b8534bSLuigi Rizzo 	    {
2485b3d37588SLuigi Rizzo 		struct ifnet *ifp = ifunit_ref(nmr->nr_name);
2486b3d37588SLuigi Rizzo 		if (ifp == NULL) {
2487b3d37588SLuigi Rizzo 			error = ENXIO;
2488b3d37588SLuigi Rizzo 		} else {
248968b8534bSLuigi Rizzo 			struct socket so;
2490ce3ee1e7SLuigi Rizzo 
249168b8534bSLuigi Rizzo 			bzero(&so, sizeof(so));
249268b8534bSLuigi Rizzo 			so.so_vnet = ifp->if_vnet;
249368b8534bSLuigi Rizzo 			// so->so_proto not null.
249468b8534bSLuigi Rizzo 			error = ifioctl(&so, cmd, data, td);
2495b3d37588SLuigi Rizzo 			if_rele(ifp);
2496b3d37588SLuigi Rizzo 		}
2497babc7c12SLuigi Rizzo 		break;
249868b8534bSLuigi Rizzo 	    }
2499f196ce38SLuigi Rizzo 
2500f196ce38SLuigi Rizzo #else /* linux */
2501f196ce38SLuigi Rizzo 	default:
2502f196ce38SLuigi Rizzo 		error = EOPNOTSUPP;
2503f196ce38SLuigi Rizzo #endif /* linux */
250468b8534bSLuigi Rizzo 	}
250568b8534bSLuigi Rizzo 
250668b8534bSLuigi Rizzo 	return (error);
250768b8534bSLuigi Rizzo }
250868b8534bSLuigi Rizzo 
250968b8534bSLuigi Rizzo 
251068b8534bSLuigi Rizzo /*
251168b8534bSLuigi Rizzo  * select(2) and poll(2) handlers for the "netmap" device.
251268b8534bSLuigi Rizzo  *
251368b8534bSLuigi Rizzo  * Can be called for one or more queues.
251468b8534bSLuigi Rizzo  * Return true the event mask corresponding to ready events.
251568b8534bSLuigi Rizzo  * If there are no ready events, do a selrecord on either individual
2516ce3ee1e7SLuigi Rizzo  * selinfo or on the global one.
251768b8534bSLuigi Rizzo  * Device-dependent parts (locking and sync of tx/rx rings)
251868b8534bSLuigi Rizzo  * are done through callbacks.
2519f196ce38SLuigi Rizzo  *
252001c7d25fSLuigi Rizzo  * On linux, arguments are really pwait, the poll table, and 'td' is struct file *
252101c7d25fSLuigi Rizzo  * The first one is remapped to pwait as selrecord() uses the name as an
252201c7d25fSLuigi Rizzo  * hidden argument.
252368b8534bSLuigi Rizzo  */
2524f9790aebSLuigi Rizzo int
252537e3a6d3SLuigi Rizzo netmap_poll(struct netmap_priv_d *priv, int events, NM_SELRECORD_T *sr)
252668b8534bSLuigi Rizzo {
252768b8534bSLuigi Rizzo 	struct netmap_adapter *na;
252868b8534bSLuigi Rizzo 	struct netmap_kring *kring;
252937e3a6d3SLuigi Rizzo 	struct netmap_ring *ring;
2530847bf383SLuigi Rizzo 	u_int i, check_all_tx, check_all_rx, want[NR_TXRX], revents = 0;
2531847bf383SLuigi Rizzo #define want_tx want[NR_TX]
2532847bf383SLuigi Rizzo #define want_rx want[NR_RX]
2533*c3e9b4dbSLuiz Otavio O Souza 	struct mbq q;	/* packets from RX hw queues to host stack */
2534847bf383SLuigi Rizzo 	enum txrx t;
253501c7d25fSLuigi Rizzo 
2536f9790aebSLuigi Rizzo 	/*
2537f9790aebSLuigi Rizzo 	 * In order to avoid nested locks, we need to "double check"
2538f9790aebSLuigi Rizzo 	 * txsync and rxsync if we decide to do a selrecord().
2539f9790aebSLuigi Rizzo 	 * retry_tx (and retry_rx, later) prevent looping forever.
2540f9790aebSLuigi Rizzo 	 */
254117885a7bSLuigi Rizzo 	int retry_tx = 1, retry_rx = 1;
2542ce3ee1e7SLuigi Rizzo 
2543*c3e9b4dbSLuiz Otavio O Souza 	/* Transparent mode: send_down is 1 if we have found some
2544*c3e9b4dbSLuiz Otavio O Souza 	 * packets to forward (host RX ring --> NIC) during the rx
2545*c3e9b4dbSLuiz Otavio O Souza 	 * scan and we have not sent them down to the NIC yet.
2546*c3e9b4dbSLuiz Otavio O Souza 	 * Transparent mode requires to bind all rings to a single
2547*c3e9b4dbSLuiz Otavio O Souza 	 * file descriptor.
2548f0ea3689SLuigi Rizzo 	 */
254937e3a6d3SLuigi Rizzo 	int send_down = 0;
2550*c3e9b4dbSLuiz Otavio O Souza 	int sync_flags = priv->np_sync_flags;
255137e3a6d3SLuigi Rizzo 
255237e3a6d3SLuigi Rizzo 	mbq_init(&q);
255368b8534bSLuigi Rizzo 
25548241616dSLuigi Rizzo 	if (priv->np_nifp == NULL) {
25558241616dSLuigi Rizzo 		D("No if registered");
25568241616dSLuigi Rizzo 		return POLLERR;
25578241616dSLuigi Rizzo 	}
2558847bf383SLuigi Rizzo 	mb(); /* make sure following reads are not from cache */
25598241616dSLuigi Rizzo 
2560f9790aebSLuigi Rizzo 	na = priv->np_na;
2561f9790aebSLuigi Rizzo 
25624bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na))
256368b8534bSLuigi Rizzo 		return POLLERR;
256468b8534bSLuigi Rizzo 
256568b8534bSLuigi Rizzo 	if (netmap_verbose & 0x8000)
25664bf50f18SLuigi Rizzo 		D("device %s events 0x%x", na->name, events);
256768b8534bSLuigi Rizzo 	want_tx = events & (POLLOUT | POLLWRNORM);
256868b8534bSLuigi Rizzo 	want_rx = events & (POLLIN | POLLRDNORM);
256968b8534bSLuigi Rizzo 
257068b8534bSLuigi Rizzo 	/*
2571f9790aebSLuigi Rizzo 	 * check_all_{tx|rx} are set if the card has more than one queue AND
2572f9790aebSLuigi Rizzo 	 * the file descriptor is bound to all of them. If so, we sleep on
2573ce3ee1e7SLuigi Rizzo 	 * the "global" selinfo, otherwise we sleep on individual selinfo
2574ce3ee1e7SLuigi Rizzo 	 * (FreeBSD only allows two selinfo's per file descriptor).
2575ce3ee1e7SLuigi Rizzo 	 * The interrupt routine in the driver wake one or the other
2576ce3ee1e7SLuigi Rizzo 	 * (or both) depending on which clients are active.
257768b8534bSLuigi Rizzo 	 *
257868b8534bSLuigi Rizzo 	 * rxsync() is only called if we run out of buffers on a POLLIN.
257968b8534bSLuigi Rizzo 	 * txsync() is called if we run out of buffers on POLLOUT, or
258068b8534bSLuigi Rizzo 	 * there are pending packets to send. The latter can be disabled
258168b8534bSLuigi Rizzo 	 * passing NETMAP_NO_TX_POLL in the NIOCREG call.
258268b8534bSLuigi Rizzo 	 */
2583847bf383SLuigi Rizzo 	check_all_tx = nm_si_user(priv, NR_TX);
2584847bf383SLuigi Rizzo 	check_all_rx = nm_si_user(priv, NR_RX);
258564ae02c3SLuigi Rizzo 
258668b8534bSLuigi Rizzo 	/*
2587f9790aebSLuigi Rizzo 	 * We start with a lock free round which is cheap if we have
2588f9790aebSLuigi Rizzo 	 * slots available. If this fails, then lock and call the sync
258968b8534bSLuigi Rizzo 	 * routines.
259068b8534bSLuigi Rizzo 	 */
259137e3a6d3SLuigi Rizzo #if 1 /* new code- call rx if any of the ring needs to release or read buffers */
259237e3a6d3SLuigi Rizzo 	if (want_tx) {
259337e3a6d3SLuigi Rizzo 		t = NR_TX;
259437e3a6d3SLuigi Rizzo 		for (i = priv->np_qfirst[t]; want[t] && i < priv->np_qlast[t]; i++) {
259537e3a6d3SLuigi Rizzo 			kring = &NMR(na, t)[i];
259637e3a6d3SLuigi Rizzo 			/* XXX compare ring->cur and kring->tail */
259737e3a6d3SLuigi Rizzo 			if (!nm_ring_empty(kring->ring)) {
259837e3a6d3SLuigi Rizzo 				revents |= want[t];
259937e3a6d3SLuigi Rizzo 				want[t] = 0;	/* also breaks the loop */
260037e3a6d3SLuigi Rizzo 			}
260137e3a6d3SLuigi Rizzo 		}
260237e3a6d3SLuigi Rizzo 	}
260337e3a6d3SLuigi Rizzo 	if (want_rx) {
260437e3a6d3SLuigi Rizzo 		want_rx = 0; /* look for a reason to run the handlers */
260537e3a6d3SLuigi Rizzo 		t = NR_RX;
260637e3a6d3SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
260737e3a6d3SLuigi Rizzo 			kring = &NMR(na, t)[i];
260837e3a6d3SLuigi Rizzo 			if (kring->ring->cur == kring->ring->tail /* try fetch new buffers */
260937e3a6d3SLuigi Rizzo 			    || kring->rhead != kring->ring->head /* release buffers */) {
261037e3a6d3SLuigi Rizzo 				want_rx = 1;
261137e3a6d3SLuigi Rizzo 			}
261237e3a6d3SLuigi Rizzo 		}
261337e3a6d3SLuigi Rizzo 		if (!want_rx)
261437e3a6d3SLuigi Rizzo 			revents |= events & (POLLIN | POLLRDNORM); /* we have data */
261537e3a6d3SLuigi Rizzo 	}
261637e3a6d3SLuigi Rizzo #else /* old code */
2617847bf383SLuigi Rizzo 	for_rx_tx(t) {
2618847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[t]; want[t] && i < priv->np_qlast[t]; i++) {
2619847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
262017885a7bSLuigi Rizzo 			/* XXX compare ring->cur and kring->tail */
262117885a7bSLuigi Rizzo 			if (!nm_ring_empty(kring->ring)) {
2622847bf383SLuigi Rizzo 				revents |= want[t];
2623847bf383SLuigi Rizzo 				want[t] = 0;	/* also breaks the loop */
262468b8534bSLuigi Rizzo 			}
262568b8534bSLuigi Rizzo 		}
262668b8534bSLuigi Rizzo 	}
262737e3a6d3SLuigi Rizzo #endif /* old code */
262868b8534bSLuigi Rizzo 
262968b8534bSLuigi Rizzo 	/*
263017885a7bSLuigi Rizzo 	 * If we want to push packets out (priv->np_txpoll) or
263117885a7bSLuigi Rizzo 	 * want_tx is still set, we must issue txsync calls
263217885a7bSLuigi Rizzo 	 * (on all rings, to avoid that the tx rings stall).
2633f9790aebSLuigi Rizzo 	 * XXX should also check cur != hwcur on the tx rings.
2634f9790aebSLuigi Rizzo 	 * Fortunately, normal tx mode has np_txpoll set.
263568b8534bSLuigi Rizzo 	 */
263668b8534bSLuigi Rizzo 	if (priv->np_txpoll || want_tx) {
263717885a7bSLuigi Rizzo 		/*
263817885a7bSLuigi Rizzo 		 * The first round checks if anyone is ready, if not
263917885a7bSLuigi Rizzo 		 * do a selrecord and another round to handle races.
264017885a7bSLuigi Rizzo 		 * want_tx goes to 0 if any space is found, and is
264117885a7bSLuigi Rizzo 		 * used to skip rings with no pending transmissions.
2642ce3ee1e7SLuigi Rizzo 		 */
2643091fd0abSLuigi Rizzo flush_tx:
264437e3a6d3SLuigi Rizzo 		for (i = priv->np_qfirst[NR_TX]; i < priv->np_qlast[NR_TX]; i++) {
264517885a7bSLuigi Rizzo 			int found = 0;
264617885a7bSLuigi Rizzo 
264768b8534bSLuigi Rizzo 			kring = &na->tx_rings[i];
264837e3a6d3SLuigi Rizzo 			ring = kring->ring;
264937e3a6d3SLuigi Rizzo 
265037e3a6d3SLuigi Rizzo 			if (!send_down && !want_tx && ring->cur == kring->nr_hwcur)
265168b8534bSLuigi Rizzo 				continue;
265237e3a6d3SLuigi Rizzo 
265337e3a6d3SLuigi Rizzo 			if (nm_kr_tryget(kring, 1, &revents))
265417885a7bSLuigi Rizzo 				continue;
265537e3a6d3SLuigi Rizzo 
265637e3a6d3SLuigi Rizzo 			if (nm_txsync_prologue(kring, ring) >= kring->nkr_num_slots) {
265717885a7bSLuigi Rizzo 				netmap_ring_reinit(kring);
265817885a7bSLuigi Rizzo 				revents |= POLLERR;
265917885a7bSLuigi Rizzo 			} else {
2660*c3e9b4dbSLuiz Otavio O Souza 				if (kring->nm_sync(kring, sync_flags))
266168b8534bSLuigi Rizzo 					revents |= POLLERR;
2662847bf383SLuigi Rizzo 				else
266337e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
266417885a7bSLuigi Rizzo 			}
266568b8534bSLuigi Rizzo 
266617885a7bSLuigi Rizzo 			/*
266717885a7bSLuigi Rizzo 			 * If we found new slots, notify potential
266817885a7bSLuigi Rizzo 			 * listeners on the same ring.
266917885a7bSLuigi Rizzo 			 * Since we just did a txsync, look at the copies
267017885a7bSLuigi Rizzo 			 * of cur,tail in the kring.
2671f9790aebSLuigi Rizzo 			 */
267217885a7bSLuigi Rizzo 			found = kring->rcur != kring->rtail;
267317885a7bSLuigi Rizzo 			nm_kr_put(kring);
267417885a7bSLuigi Rizzo 			if (found) { /* notify other listeners */
267568b8534bSLuigi Rizzo 				revents |= want_tx;
267668b8534bSLuigi Rizzo 				want_tx = 0;
2677847bf383SLuigi Rizzo 				kring->nm_notify(kring, 0);
267868b8534bSLuigi Rizzo 			}
2679ce3ee1e7SLuigi Rizzo 		}
268037e3a6d3SLuigi Rizzo 		/* if there were any packet to forward we must have handled them by now */
268137e3a6d3SLuigi Rizzo 		send_down = 0;
268237e3a6d3SLuigi Rizzo 		if (want_tx && retry_tx && sr) {
268337e3a6d3SLuigi Rizzo 			nm_os_selrecord(sr, check_all_tx ?
2684847bf383SLuigi Rizzo 			    &na->si[NR_TX] : &na->tx_rings[priv->np_qfirst[NR_TX]].si);
2685ce3ee1e7SLuigi Rizzo 			retry_tx = 0;
2686ce3ee1e7SLuigi Rizzo 			goto flush_tx;
268768b8534bSLuigi Rizzo 		}
268868b8534bSLuigi Rizzo 	}
268968b8534bSLuigi Rizzo 
269068b8534bSLuigi Rizzo 	/*
269117885a7bSLuigi Rizzo 	 * If want_rx is still set scan receive rings.
269268b8534bSLuigi Rizzo 	 * Do it on all rings because otherwise we starve.
269368b8534bSLuigi Rizzo 	 */
269468b8534bSLuigi Rizzo 	if (want_rx) {
269589cc2556SLuigi Rizzo 		/* two rounds here for race avoidance */
2696ce3ee1e7SLuigi Rizzo do_retry_rx:
2697847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[NR_RX]; i < priv->np_qlast[NR_RX]; i++) {
269817885a7bSLuigi Rizzo 			int found = 0;
269917885a7bSLuigi Rizzo 
270068b8534bSLuigi Rizzo 			kring = &na->rx_rings[i];
270137e3a6d3SLuigi Rizzo 			ring = kring->ring;
2702ce3ee1e7SLuigi Rizzo 
270337e3a6d3SLuigi Rizzo 			if (unlikely(nm_kr_tryget(kring, 1, &revents)))
270417885a7bSLuigi Rizzo 				continue;
2705ce3ee1e7SLuigi Rizzo 
270637e3a6d3SLuigi Rizzo 			if (nm_rxsync_prologue(kring, ring) >= kring->nkr_num_slots) {
2707847bf383SLuigi Rizzo 				netmap_ring_reinit(kring);
2708847bf383SLuigi Rizzo 				revents |= POLLERR;
2709847bf383SLuigi Rizzo 			}
2710847bf383SLuigi Rizzo 			/* now we can use kring->rcur, rtail */
2711847bf383SLuigi Rizzo 
271217885a7bSLuigi Rizzo 			/*
2713*c3e9b4dbSLuiz Otavio O Souza 			 * transparent mode support: collect packets from
2714*c3e9b4dbSLuiz Otavio O Souza 			 * hw rxring(s) that have been released by the user
2715ce3ee1e7SLuigi Rizzo 			 */
271637e3a6d3SLuigi Rizzo 			if (nm_may_forward_up(kring)) {
2717091fd0abSLuigi Rizzo 				netmap_grab_packets(kring, &q, netmap_fwd);
2718091fd0abSLuigi Rizzo 			}
271968b8534bSLuigi Rizzo 
2720*c3e9b4dbSLuiz Otavio O Souza 			/* Clear the NR_FORWARD flag anyway, it may be set by
2721*c3e9b4dbSLuiz Otavio O Souza 			 * the nm_sync() below only on for the host RX ring (see
2722*c3e9b4dbSLuiz Otavio O Souza 			 * netmap_rxsync_from_host()). */
272337e3a6d3SLuigi Rizzo 			kring->nr_kflags &= ~NR_FORWARD;
2724*c3e9b4dbSLuiz Otavio O Souza 			if (kring->nm_sync(kring, sync_flags))
272568b8534bSLuigi Rizzo 				revents |= POLLERR;
2726847bf383SLuigi Rizzo 			else
272737e3a6d3SLuigi Rizzo 				nm_sync_finalize(kring);
2728*c3e9b4dbSLuiz Otavio O Souza 			send_down |= (kring->nr_kflags & NR_FORWARD);
2729*c3e9b4dbSLuiz Otavio O Souza 			ring_timestamp_set(ring);
273017885a7bSLuigi Rizzo 			found = kring->rcur != kring->rtail;
273117885a7bSLuigi Rizzo 			nm_kr_put(kring);
273217885a7bSLuigi Rizzo 			if (found) {
273368b8534bSLuigi Rizzo 				revents |= want_rx;
2734ce3ee1e7SLuigi Rizzo 				retry_rx = 0;
2735847bf383SLuigi Rizzo 				kring->nm_notify(kring, 0);
273668b8534bSLuigi Rizzo 			}
273768b8534bSLuigi Rizzo 		}
273817885a7bSLuigi Rizzo 
273937e3a6d3SLuigi Rizzo 		if (retry_rx && sr) {
274037e3a6d3SLuigi Rizzo 			nm_os_selrecord(sr, check_all_rx ?
2741847bf383SLuigi Rizzo 			    &na->si[NR_RX] : &na->rx_rings[priv->np_qfirst[NR_RX]].si);
274237e3a6d3SLuigi Rizzo 		}
2743*c3e9b4dbSLuiz Otavio O Souza 		if (send_down || retry_rx) {
274417885a7bSLuigi Rizzo 			retry_rx = 0;
274517885a7bSLuigi Rizzo 			if (send_down)
274617885a7bSLuigi Rizzo 				goto flush_tx; /* and retry_rx */
274717885a7bSLuigi Rizzo 			else
2748ce3ee1e7SLuigi Rizzo 				goto do_retry_rx;
2749ce3ee1e7SLuigi Rizzo 		}
275068b8534bSLuigi Rizzo 	}
2751091fd0abSLuigi Rizzo 
275217885a7bSLuigi Rizzo 	/*
2753*c3e9b4dbSLuiz Otavio O Souza 	 * Transparent mode: released bufs (i.e. between kring->nr_hwcur and
2754*c3e9b4dbSLuiz Otavio O Souza 	 * ring->head) marked with NS_FORWARD on hw rx rings are passed up
2755*c3e9b4dbSLuiz Otavio O Souza 	 * to the host stack.
2756ce3ee1e7SLuigi Rizzo 	 */
2757091fd0abSLuigi Rizzo 
2758*c3e9b4dbSLuiz Otavio O Souza 	if (mbq_peek(&q)) {
2759f9790aebSLuigi Rizzo 		netmap_send_up(na->ifp, &q);
276037e3a6d3SLuigi Rizzo 	}
276168b8534bSLuigi Rizzo 
276268b8534bSLuigi Rizzo 	return (revents);
2763847bf383SLuigi Rizzo #undef want_tx
2764847bf383SLuigi Rizzo #undef want_rx
276568b8534bSLuigi Rizzo }
276668b8534bSLuigi Rizzo 
276717885a7bSLuigi Rizzo 
276817885a7bSLuigi Rizzo /*-------------------- driver support routines -------------------*/
276968b8534bSLuigi Rizzo 
277089cc2556SLuigi Rizzo /* default notify callback */
2771f9790aebSLuigi Rizzo static int
2772847bf383SLuigi Rizzo netmap_notify(struct netmap_kring *kring, int flags)
2773f9790aebSLuigi Rizzo {
2774847bf383SLuigi Rizzo 	struct netmap_adapter *na = kring->na;
2775847bf383SLuigi Rizzo 	enum txrx t = kring->tx;
2776f9790aebSLuigi Rizzo 
277737e3a6d3SLuigi Rizzo 	nm_os_selwakeup(&kring->si);
277889cc2556SLuigi Rizzo 	/* optimization: avoid a wake up on the global
277989cc2556SLuigi Rizzo 	 * queue if nobody has registered for more
278089cc2556SLuigi Rizzo 	 * than one ring
278189cc2556SLuigi Rizzo 	 */
2782847bf383SLuigi Rizzo 	if (na->si_users[t] > 0)
278337e3a6d3SLuigi Rizzo 		nm_os_selwakeup(&na->si[t]);
2784847bf383SLuigi Rizzo 
278537e3a6d3SLuigi Rizzo 	return NM_IRQ_COMPLETED;
2786f9790aebSLuigi Rizzo }
2787f9790aebSLuigi Rizzo 
278889cc2556SLuigi Rizzo /* called by all routines that create netmap_adapters.
278937e3a6d3SLuigi Rizzo  * provide some defaults and get a reference to the
279037e3a6d3SLuigi Rizzo  * memory allocator
279189cc2556SLuigi Rizzo  */
2792f9790aebSLuigi Rizzo int
2793f9790aebSLuigi Rizzo netmap_attach_common(struct netmap_adapter *na)
2794f9790aebSLuigi Rizzo {
2795f9790aebSLuigi Rizzo 	if (na->num_tx_rings == 0 || na->num_rx_rings == 0) {
2796f9790aebSLuigi Rizzo 		D("%s: invalid rings tx %d rx %d",
27974bf50f18SLuigi Rizzo 			na->name, na->num_tx_rings, na->num_rx_rings);
2798f9790aebSLuigi Rizzo 		return EINVAL;
2799f9790aebSLuigi Rizzo 	}
280017885a7bSLuigi Rizzo 
280117885a7bSLuigi Rizzo #ifdef __FreeBSD__
280237e3a6d3SLuigi Rizzo 	if (na->na_flags & NAF_HOST_RINGS && na->ifp) {
280337e3a6d3SLuigi Rizzo 		na->if_input = na->ifp->if_input; /* for netmap_send_up */
28044bf50f18SLuigi Rizzo 	}
280537e3a6d3SLuigi Rizzo #endif /* __FreeBSD__ */
2806f9790aebSLuigi Rizzo 	if (na->nm_krings_create == NULL) {
280789cc2556SLuigi Rizzo 		/* we assume that we have been called by a driver,
280889cc2556SLuigi Rizzo 		 * since other port types all provide their own
280989cc2556SLuigi Rizzo 		 * nm_krings_create
281089cc2556SLuigi Rizzo 		 */
2811f9790aebSLuigi Rizzo 		na->nm_krings_create = netmap_hw_krings_create;
281217885a7bSLuigi Rizzo 		na->nm_krings_delete = netmap_hw_krings_delete;
2813f9790aebSLuigi Rizzo 	}
2814f9790aebSLuigi Rizzo 	if (na->nm_notify == NULL)
2815f9790aebSLuigi Rizzo 		na->nm_notify = netmap_notify;
2816f9790aebSLuigi Rizzo 	na->active_fds = 0;
2817f9790aebSLuigi Rizzo 
2818*c3e9b4dbSLuiz Otavio O Souza 	if (na->nm_mem == NULL) {
28194bf50f18SLuigi Rizzo 		/* use the global allocator */
2820*c3e9b4dbSLuiz Otavio O Souza 		na->nm_mem = netmap_mem_get(&nm_mem);
2821*c3e9b4dbSLuiz Otavio O Souza 	}
2822847bf383SLuigi Rizzo #ifdef WITH_VALE
28234bf50f18SLuigi Rizzo 	if (na->nm_bdg_attach == NULL)
28244bf50f18SLuigi Rizzo 		/* no special nm_bdg_attach callback. On VALE
28254bf50f18SLuigi Rizzo 		 * attach, we need to interpose a bwrap
28264bf50f18SLuigi Rizzo 		 */
28274bf50f18SLuigi Rizzo 		na->nm_bdg_attach = netmap_bwrap_attach;
2828847bf383SLuigi Rizzo #endif
282937e3a6d3SLuigi Rizzo 
2830f9790aebSLuigi Rizzo 	return 0;
2831f9790aebSLuigi Rizzo }
2832f9790aebSLuigi Rizzo 
2833f9790aebSLuigi Rizzo 
283489cc2556SLuigi Rizzo /* standard cleanup, called by all destructors */
2835f9790aebSLuigi Rizzo void
2836f9790aebSLuigi Rizzo netmap_detach_common(struct netmap_adapter *na)
2837f9790aebSLuigi Rizzo {
2838f9790aebSLuigi Rizzo 	if (na->tx_rings) { /* XXX should not happen */
2839f9790aebSLuigi Rizzo 		D("freeing leftover tx_rings");
2840f9790aebSLuigi Rizzo 		na->nm_krings_delete(na);
2841f9790aebSLuigi Rizzo 	}
2842f0ea3689SLuigi Rizzo 	netmap_pipe_dealloc(na);
2843847bf383SLuigi Rizzo 	if (na->nm_mem)
2844847bf383SLuigi Rizzo 		netmap_mem_put(na->nm_mem);
2845f9790aebSLuigi Rizzo 	bzero(na, sizeof(*na));
2846*c3e9b4dbSLuiz Otavio O Souza 	nm_os_free(na);
2847f9790aebSLuigi Rizzo }
2848f9790aebSLuigi Rizzo 
284937e3a6d3SLuigi Rizzo /* Wrapper for the register callback provided netmap-enabled
285037e3a6d3SLuigi Rizzo  * hardware drivers.
285137e3a6d3SLuigi Rizzo  * nm_iszombie(na) means that the driver module has been
28524bf50f18SLuigi Rizzo  * unloaded, so we cannot call into it.
285337e3a6d3SLuigi Rizzo  * nm_os_ifnet_lock() must guarantee mutual exclusion with
285437e3a6d3SLuigi Rizzo  * module unloading.
28554bf50f18SLuigi Rizzo  */
28564bf50f18SLuigi Rizzo static int
285737e3a6d3SLuigi Rizzo netmap_hw_reg(struct netmap_adapter *na, int onoff)
28584bf50f18SLuigi Rizzo {
28594bf50f18SLuigi Rizzo 	struct netmap_hw_adapter *hwna =
28604bf50f18SLuigi Rizzo 		(struct netmap_hw_adapter*)na;
286137e3a6d3SLuigi Rizzo 	int error = 0;
28624bf50f18SLuigi Rizzo 
286337e3a6d3SLuigi Rizzo 	nm_os_ifnet_lock();
28644bf50f18SLuigi Rizzo 
286537e3a6d3SLuigi Rizzo 	if (nm_iszombie(na)) {
286637e3a6d3SLuigi Rizzo 		if (onoff) {
286737e3a6d3SLuigi Rizzo 			error = ENXIO;
286837e3a6d3SLuigi Rizzo 		} else if (na != NULL) {
286937e3a6d3SLuigi Rizzo 			na->na_flags &= ~NAF_NETMAP_ON;
287037e3a6d3SLuigi Rizzo 		}
287137e3a6d3SLuigi Rizzo 		goto out;
287237e3a6d3SLuigi Rizzo 	}
287337e3a6d3SLuigi Rizzo 
287437e3a6d3SLuigi Rizzo 	error = hwna->nm_hw_register(na, onoff);
287537e3a6d3SLuigi Rizzo 
287637e3a6d3SLuigi Rizzo out:
287737e3a6d3SLuigi Rizzo 	nm_os_ifnet_unlock();
287837e3a6d3SLuigi Rizzo 
287937e3a6d3SLuigi Rizzo 	return error;
288037e3a6d3SLuigi Rizzo }
288137e3a6d3SLuigi Rizzo 
288237e3a6d3SLuigi Rizzo static void
288337e3a6d3SLuigi Rizzo netmap_hw_dtor(struct netmap_adapter *na)
288437e3a6d3SLuigi Rizzo {
288537e3a6d3SLuigi Rizzo 	if (nm_iszombie(na) || na->ifp == NULL)
288637e3a6d3SLuigi Rizzo 		return;
288737e3a6d3SLuigi Rizzo 
288837e3a6d3SLuigi Rizzo 	WNA(na->ifp) = NULL;
28894bf50f18SLuigi Rizzo }
28904bf50f18SLuigi Rizzo 
2891f18be576SLuigi Rizzo 
289268b8534bSLuigi Rizzo /*
2893*c3e9b4dbSLuiz Otavio O Souza  * Allocate a netmap_adapter object, and initialize it from the
289437e3a6d3SLuigi Rizzo  * 'arg' passed by the driver on attach.
2895*c3e9b4dbSLuiz Otavio O Souza  * We allocate a block of memory of 'size' bytes, which has room
2896*c3e9b4dbSLuiz Otavio O Souza  * for struct netmap_adapter plus additional room private to
2897*c3e9b4dbSLuiz Otavio O Souza  * the caller.
289868b8534bSLuigi Rizzo  * Return 0 on success, ENOMEM otherwise.
289968b8534bSLuigi Rizzo  */
2900*c3e9b4dbSLuiz Otavio O Souza int
2901*c3e9b4dbSLuiz Otavio O Souza netmap_attach_ext(struct netmap_adapter *arg, size_t size)
290268b8534bSLuigi Rizzo {
2903f9790aebSLuigi Rizzo 	struct netmap_hw_adapter *hwna = NULL;
290437e3a6d3SLuigi Rizzo 	struct ifnet *ifp = NULL;
290568b8534bSLuigi Rizzo 
2906*c3e9b4dbSLuiz Otavio O Souza 	if (size < sizeof(struct netmap_hw_adapter)) {
2907*c3e9b4dbSLuiz Otavio O Souza 		D("Invalid netmap adapter size %d", (int)size);
2908*c3e9b4dbSLuiz Otavio O Souza 		return EINVAL;
2909*c3e9b4dbSLuiz Otavio O Souza 	}
2910*c3e9b4dbSLuiz Otavio O Souza 
291137e3a6d3SLuigi Rizzo 	if (arg == NULL || arg->ifp == NULL)
2912ae10d1afSLuigi Rizzo 		goto fail;
291337e3a6d3SLuigi Rizzo 	ifp = arg->ifp;
2914*c3e9b4dbSLuiz Otavio O Souza 	hwna = nm_os_malloc(size);
2915f9790aebSLuigi Rizzo 	if (hwna == NULL)
2916ae10d1afSLuigi Rizzo 		goto fail;
2917f9790aebSLuigi Rizzo 	hwna->up = *arg;
2918847bf383SLuigi Rizzo 	hwna->up.na_flags |= NAF_HOST_RINGS | NAF_NATIVE;
29194bf50f18SLuigi Rizzo 	strncpy(hwna->up.name, ifp->if_xname, sizeof(hwna->up.name));
29204bf50f18SLuigi Rizzo 	hwna->nm_hw_register = hwna->up.nm_register;
292137e3a6d3SLuigi Rizzo 	hwna->up.nm_register = netmap_hw_reg;
2922f9790aebSLuigi Rizzo 	if (netmap_attach_common(&hwna->up)) {
2923*c3e9b4dbSLuiz Otavio O Souza 		nm_os_free(hwna);
2924f9790aebSLuigi Rizzo 		goto fail;
2925f9790aebSLuigi Rizzo 	}
2926f9790aebSLuigi Rizzo 	netmap_adapter_get(&hwna->up);
2927f9790aebSLuigi Rizzo 
292837e3a6d3SLuigi Rizzo 	NM_ATTACH_NA(ifp, &hwna->up);
292937e3a6d3SLuigi Rizzo 
293064ae02c3SLuigi Rizzo #ifdef linux
2931f18be576SLuigi Rizzo 	if (ifp->netdev_ops) {
2932f18be576SLuigi Rizzo 		/* prepare a clone of the netdev ops */
2933847bf383SLuigi Rizzo #ifndef NETMAP_LINUX_HAVE_NETDEV_OPS
2934f9790aebSLuigi Rizzo 		hwna->nm_ndo.ndo_start_xmit = ifp->netdev_ops;
2935f18be576SLuigi Rizzo #else
2936f9790aebSLuigi Rizzo 		hwna->nm_ndo = *ifp->netdev_ops;
293737e3a6d3SLuigi Rizzo #endif /* NETMAP_LINUX_HAVE_NETDEV_OPS */
2938f18be576SLuigi Rizzo 	}
2939f9790aebSLuigi Rizzo 	hwna->nm_ndo.ndo_start_xmit = linux_netmap_start_xmit;
29404bf50f18SLuigi Rizzo 	if (ifp->ethtool_ops) {
29414bf50f18SLuigi Rizzo 		hwna->nm_eto = *ifp->ethtool_ops;
29424bf50f18SLuigi Rizzo 	}
29434bf50f18SLuigi Rizzo 	hwna->nm_eto.set_ringparam = linux_netmap_set_ringparam;
2944847bf383SLuigi Rizzo #ifdef NETMAP_LINUX_HAVE_SET_CHANNELS
29454bf50f18SLuigi Rizzo 	hwna->nm_eto.set_channels = linux_netmap_set_channels;
294637e3a6d3SLuigi Rizzo #endif /* NETMAP_LINUX_HAVE_SET_CHANNELS */
29474bf50f18SLuigi Rizzo 	if (arg->nm_config == NULL) {
29484bf50f18SLuigi Rizzo 		hwna->up.nm_config = netmap_linux_config;
29494bf50f18SLuigi Rizzo 	}
2950ce3ee1e7SLuigi Rizzo #endif /* linux */
295137e3a6d3SLuigi Rizzo 	if (arg->nm_dtor == NULL) {
295237e3a6d3SLuigi Rizzo 		hwna->up.nm_dtor = netmap_hw_dtor;
295337e3a6d3SLuigi Rizzo 	}
2954f9790aebSLuigi Rizzo 
2955d82f9014SRui Paulo 	if_printf(ifp, "netmap queues/slots: TX %d/%d, RX %d/%d\n",
2956d82f9014SRui Paulo 	    hwna->up.num_tx_rings, hwna->up.num_tx_desc,
2957d82f9014SRui Paulo 	    hwna->up.num_rx_rings, hwna->up.num_rx_desc);
2958ae10d1afSLuigi Rizzo 	return 0;
295968b8534bSLuigi Rizzo 
2960ae10d1afSLuigi Rizzo fail:
2961f9790aebSLuigi Rizzo 	D("fail, arg %p ifp %p na %p", arg, ifp, hwna);
2962f9790aebSLuigi Rizzo 	return (hwna ? EINVAL : ENOMEM);
296368b8534bSLuigi Rizzo }
296468b8534bSLuigi Rizzo 
296568b8534bSLuigi Rizzo 
296637e3a6d3SLuigi Rizzo int
296737e3a6d3SLuigi Rizzo netmap_attach(struct netmap_adapter *arg)
296837e3a6d3SLuigi Rizzo {
2969*c3e9b4dbSLuiz Otavio O Souza 	return netmap_attach_ext(arg, sizeof(struct netmap_hw_adapter));
297037e3a6d3SLuigi Rizzo }
297137e3a6d3SLuigi Rizzo 
297237e3a6d3SLuigi Rizzo 
2973f9790aebSLuigi Rizzo void
2974f9790aebSLuigi Rizzo NM_DBG(netmap_adapter_get)(struct netmap_adapter *na)
2975f9790aebSLuigi Rizzo {
2976f9790aebSLuigi Rizzo 	if (!na) {
2977f9790aebSLuigi Rizzo 		return;
2978f9790aebSLuigi Rizzo 	}
2979f9790aebSLuigi Rizzo 
2980f9790aebSLuigi Rizzo 	refcount_acquire(&na->na_refcount);
2981f9790aebSLuigi Rizzo }
2982f9790aebSLuigi Rizzo 
2983f9790aebSLuigi Rizzo 
2984f9790aebSLuigi Rizzo /* returns 1 iff the netmap_adapter is destroyed */
2985f9790aebSLuigi Rizzo int
2986f9790aebSLuigi Rizzo NM_DBG(netmap_adapter_put)(struct netmap_adapter *na)
2987f9790aebSLuigi Rizzo {
2988f9790aebSLuigi Rizzo 	if (!na)
2989f9790aebSLuigi Rizzo 		return 1;
2990f9790aebSLuigi Rizzo 
2991f9790aebSLuigi Rizzo 	if (!refcount_release(&na->na_refcount))
2992f9790aebSLuigi Rizzo 		return 0;
2993f9790aebSLuigi Rizzo 
2994f9790aebSLuigi Rizzo 	if (na->nm_dtor)
2995f9790aebSLuigi Rizzo 		na->nm_dtor(na);
2996f9790aebSLuigi Rizzo 
2997f9790aebSLuigi Rizzo 	netmap_detach_common(na);
2998f9790aebSLuigi Rizzo 
2999f9790aebSLuigi Rizzo 	return 1;
3000f9790aebSLuigi Rizzo }
3001f9790aebSLuigi Rizzo 
300289cc2556SLuigi Rizzo /* nm_krings_create callback for all hardware native adapters */
3003f9790aebSLuigi Rizzo int
3004f9790aebSLuigi Rizzo netmap_hw_krings_create(struct netmap_adapter *na)
3005f9790aebSLuigi Rizzo {
3006f0ea3689SLuigi Rizzo 	int ret = netmap_krings_create(na, 0);
300717885a7bSLuigi Rizzo 	if (ret == 0) {
300817885a7bSLuigi Rizzo 		/* initialize the mbq for the sw rx ring */
300917885a7bSLuigi Rizzo 		mbq_safe_init(&na->rx_rings[na->num_rx_rings].rx_queue);
301017885a7bSLuigi Rizzo 		ND("initialized sw rx queue %d", na->num_rx_rings);
301117885a7bSLuigi Rizzo 	}
301217885a7bSLuigi Rizzo 	return ret;
3013f9790aebSLuigi Rizzo }
3014f9790aebSLuigi Rizzo 
3015f9790aebSLuigi Rizzo 
3016f9790aebSLuigi Rizzo 
301768b8534bSLuigi Rizzo /*
301889cc2556SLuigi Rizzo  * Called on module unload by the netmap-enabled drivers
301968b8534bSLuigi Rizzo  */
302068b8534bSLuigi Rizzo void
302168b8534bSLuigi Rizzo netmap_detach(struct ifnet *ifp)
302268b8534bSLuigi Rizzo {
302368b8534bSLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
302468b8534bSLuigi Rizzo 
302568b8534bSLuigi Rizzo 	if (!na)
302668b8534bSLuigi Rizzo 		return;
302768b8534bSLuigi Rizzo 
3028f9790aebSLuigi Rizzo 	NMG_LOCK();
302937e3a6d3SLuigi Rizzo 	netmap_set_all_rings(na, NM_KR_LOCKED);
303037e3a6d3SLuigi Rizzo 	na->na_flags |= NAF_ZOMBIE;
3031847bf383SLuigi Rizzo 	/*
3032847bf383SLuigi Rizzo 	 * if the netmap adapter is not native, somebody
3033847bf383SLuigi Rizzo 	 * changed it, so we can not release it here.
303437e3a6d3SLuigi Rizzo 	 * The NAF_ZOMBIE flag will notify the new owner that
3035847bf383SLuigi Rizzo 	 * the driver is gone.
3036847bf383SLuigi Rizzo 	 */
3037847bf383SLuigi Rizzo 	if (na->na_flags & NAF_NATIVE) {
303837e3a6d3SLuigi Rizzo 	        netmap_adapter_put(na);
3039847bf383SLuigi Rizzo 	}
304037e3a6d3SLuigi Rizzo 	/* give active users a chance to notice that NAF_ZOMBIE has been
304137e3a6d3SLuigi Rizzo 	 * turned on, so that they can stop and return an error to userspace.
304237e3a6d3SLuigi Rizzo 	 * Note that this becomes a NOP if there are no active users and,
304337e3a6d3SLuigi Rizzo 	 * therefore, the put() above has deleted the na, since now NA(ifp) is
304437e3a6d3SLuigi Rizzo 	 * NULL.
304537e3a6d3SLuigi Rizzo 	 */
3046f9790aebSLuigi Rizzo 	netmap_enable_all_rings(ifp);
3047f9790aebSLuigi Rizzo 	NMG_UNLOCK();
3048ae10d1afSLuigi Rizzo }
3049f18be576SLuigi Rizzo 
3050f18be576SLuigi Rizzo 
305168b8534bSLuigi Rizzo /*
305202ad4083SLuigi Rizzo  * Intercept packets from the network stack and pass them
305302ad4083SLuigi Rizzo  * to netmap as incoming packets on the 'software' ring.
305417885a7bSLuigi Rizzo  *
305517885a7bSLuigi Rizzo  * We only store packets in a bounded mbq and then copy them
305617885a7bSLuigi Rizzo  * in the relevant rxsync routine.
305717885a7bSLuigi Rizzo  *
3058ce3ee1e7SLuigi Rizzo  * We rely on the OS to make sure that the ifp and na do not go
3059ce3ee1e7SLuigi Rizzo  * away (typically the caller checks for IFF_DRV_RUNNING or the like).
3060ce3ee1e7SLuigi Rizzo  * In nm_register() or whenever there is a reinitialization,
3061f9790aebSLuigi Rizzo  * we make sure to make the mode change visible here.
306268b8534bSLuigi Rizzo  */
306368b8534bSLuigi Rizzo int
3064ce3ee1e7SLuigi Rizzo netmap_transmit(struct ifnet *ifp, struct mbuf *m)
306568b8534bSLuigi Rizzo {
306668b8534bSLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
306737e3a6d3SLuigi Rizzo 	struct netmap_kring *kring, *tx_kring;
306817885a7bSLuigi Rizzo 	u_int len = MBUF_LEN(m);
306917885a7bSLuigi Rizzo 	u_int error = ENOBUFS;
307037e3a6d3SLuigi Rizzo 	unsigned int txr;
307117885a7bSLuigi Rizzo 	struct mbq *q;
3072*c3e9b4dbSLuiz Otavio O Souza 	int busy;
307368b8534bSLuigi Rizzo 
3074847bf383SLuigi Rizzo 	kring = &na->rx_rings[na->num_rx_rings];
3075ce3ee1e7SLuigi Rizzo 	// XXX [Linux] we do not need this lock
3076ce3ee1e7SLuigi Rizzo 	// if we follow the down/configure/up protocol -gl
3077ce3ee1e7SLuigi Rizzo 	// mtx_lock(&na->core_lock);
307817885a7bSLuigi Rizzo 
30794bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na)) {
30804bf50f18SLuigi Rizzo 		D("%s not in netmap mode anymore", na->name);
3081ce3ee1e7SLuigi Rizzo 		error = ENXIO;
3082ce3ee1e7SLuigi Rizzo 		goto done;
3083ce3ee1e7SLuigi Rizzo 	}
3084ce3ee1e7SLuigi Rizzo 
308537e3a6d3SLuigi Rizzo 	txr = MBUF_TXQ(m);
308637e3a6d3SLuigi Rizzo 	if (txr >= na->num_tx_rings) {
308737e3a6d3SLuigi Rizzo 		txr %= na->num_tx_rings;
308837e3a6d3SLuigi Rizzo 	}
308937e3a6d3SLuigi Rizzo 	tx_kring = &NMR(na, NR_TX)[txr];
309037e3a6d3SLuigi Rizzo 
309137e3a6d3SLuigi Rizzo 	if (tx_kring->nr_mode == NKR_NETMAP_OFF) {
309237e3a6d3SLuigi Rizzo 		return MBUF_TRANSMIT(na, ifp, m);
309337e3a6d3SLuigi Rizzo 	}
309437e3a6d3SLuigi Rizzo 
309517885a7bSLuigi Rizzo 	q = &kring->rx_queue;
309617885a7bSLuigi Rizzo 
3097ce3ee1e7SLuigi Rizzo 	// XXX reconsider long packets if we handle fragments
30984bf50f18SLuigi Rizzo 	if (len > NETMAP_BUF_SIZE(na)) { /* too long for us */
30994bf50f18SLuigi Rizzo 		D("%s from_host, drop packet size %d > %d", na->name,
31004bf50f18SLuigi Rizzo 			len, NETMAP_BUF_SIZE(na));
3101ce3ee1e7SLuigi Rizzo 		goto done;
3102849bec0eSLuigi Rizzo 	}
310317885a7bSLuigi Rizzo 
310437e3a6d3SLuigi Rizzo 	if (nm_os_mbuf_has_offld(m)) {
3105*c3e9b4dbSLuiz Otavio O Souza 		RD(1, "%s drop mbuf that needs offloadings", na->name);
310637e3a6d3SLuigi Rizzo 		goto done;
310737e3a6d3SLuigi Rizzo 	}
310837e3a6d3SLuigi Rizzo 
3109*c3e9b4dbSLuiz Otavio O Souza 	/* protect against netmap_rxsync_from_host(), netmap_sw_to_nic()
311017885a7bSLuigi Rizzo 	 * and maybe other instances of netmap_transmit (the latter
311117885a7bSLuigi Rizzo 	 * not possible on Linux).
3112*c3e9b4dbSLuiz Otavio O Souza 	 * We enqueue the mbuf only if we are sure there is going to be
3113*c3e9b4dbSLuiz Otavio O Souza 	 * enough room in the host RX ring, otherwise we drop it.
3114ce3ee1e7SLuigi Rizzo 	 */
3115997b054cSLuigi Rizzo 	mbq_lock(q);
311617885a7bSLuigi Rizzo 
3117*c3e9b4dbSLuiz Otavio O Souza 	busy = kring->nr_hwtail - kring->nr_hwcur;
3118*c3e9b4dbSLuiz Otavio O Souza 	if (busy < 0)
3119*c3e9b4dbSLuiz Otavio O Souza 		busy += kring->nkr_num_slots;
3120*c3e9b4dbSLuiz Otavio O Souza 	if (busy + mbq_len(q) >= kring->nkr_num_slots - 1) {
3121*c3e9b4dbSLuiz Otavio O Souza 		RD(2, "%s full hwcur %d hwtail %d qlen %d", na->name,
3122*c3e9b4dbSLuiz Otavio O Souza 			kring->nr_hwcur, kring->nr_hwtail, mbq_len(q));
3123ce3ee1e7SLuigi Rizzo 	} else {
312417885a7bSLuigi Rizzo 		mbq_enqueue(q, m);
3125*c3e9b4dbSLuiz Otavio O Souza 		ND(2, "%s %d bufs in queue", na->name, mbq_len(q));
312617885a7bSLuigi Rizzo 		/* notify outside the lock */
312717885a7bSLuigi Rizzo 		m = NULL;
312868b8534bSLuigi Rizzo 		error = 0;
3129ce3ee1e7SLuigi Rizzo 	}
3130997b054cSLuigi Rizzo 	mbq_unlock(q);
3131ce3ee1e7SLuigi Rizzo 
313268b8534bSLuigi Rizzo done:
313317885a7bSLuigi Rizzo 	if (m)
313468b8534bSLuigi Rizzo 		m_freem(m);
313517885a7bSLuigi Rizzo 	/* unconditionally wake up listeners */
3136847bf383SLuigi Rizzo 	kring->nm_notify(kring, 0);
313789cc2556SLuigi Rizzo 	/* this is normally netmap_notify(), but for nics
313889cc2556SLuigi Rizzo 	 * connected to a bridge it is netmap_bwrap_intr_notify(),
313989cc2556SLuigi Rizzo 	 * that possibly forwards the frames through the switch
314089cc2556SLuigi Rizzo 	 */
314168b8534bSLuigi Rizzo 
314268b8534bSLuigi Rizzo 	return (error);
314368b8534bSLuigi Rizzo }
314468b8534bSLuigi Rizzo 
314568b8534bSLuigi Rizzo 
314668b8534bSLuigi Rizzo /*
314768b8534bSLuigi Rizzo  * netmap_reset() is called by the driver routines when reinitializing
314868b8534bSLuigi Rizzo  * a ring. The driver is in charge of locking to protect the kring.
3149f9790aebSLuigi Rizzo  * If native netmap mode is not set just return NULL.
315037e3a6d3SLuigi Rizzo  * If native netmap mode is set, in particular, we have to set nr_mode to
315137e3a6d3SLuigi Rizzo  * NKR_NETMAP_ON.
315268b8534bSLuigi Rizzo  */
315368b8534bSLuigi Rizzo struct netmap_slot *
3154ce3ee1e7SLuigi Rizzo netmap_reset(struct netmap_adapter *na, enum txrx tx, u_int n,
315568b8534bSLuigi Rizzo 	u_int new_cur)
315668b8534bSLuigi Rizzo {
315768b8534bSLuigi Rizzo 	struct netmap_kring *kring;
3158506cc70cSLuigi Rizzo 	int new_hwofs, lim;
315968b8534bSLuigi Rizzo 
31604bf50f18SLuigi Rizzo 	if (!nm_native_on(na)) {
31614bf50f18SLuigi Rizzo 		ND("interface not in native netmap mode");
316268b8534bSLuigi Rizzo 		return NULL;	/* nothing to reinitialize */
3163ce3ee1e7SLuigi Rizzo 	}
316468b8534bSLuigi Rizzo 
3165ce3ee1e7SLuigi Rizzo 	/* XXX note- in the new scheme, we are not guaranteed to be
3166ce3ee1e7SLuigi Rizzo 	 * under lock (e.g. when called on a device reset).
3167ce3ee1e7SLuigi Rizzo 	 * In this case, we should set a flag and do not trust too
3168ce3ee1e7SLuigi Rizzo 	 * much the values. In practice: TODO
3169ce3ee1e7SLuigi Rizzo 	 * - set a RESET flag somewhere in the kring
3170ce3ee1e7SLuigi Rizzo 	 * - do the processing in a conservative way
3171ce3ee1e7SLuigi Rizzo 	 * - let the *sync() fixup at the end.
3172ce3ee1e7SLuigi Rizzo 	 */
317364ae02c3SLuigi Rizzo 	if (tx == NR_TX) {
31748241616dSLuigi Rizzo 		if (n >= na->num_tx_rings)
31758241616dSLuigi Rizzo 			return NULL;
317637e3a6d3SLuigi Rizzo 
317764ae02c3SLuigi Rizzo 		kring = na->tx_rings + n;
317837e3a6d3SLuigi Rizzo 
317937e3a6d3SLuigi Rizzo 		if (kring->nr_pending_mode == NKR_NETMAP_OFF) {
318037e3a6d3SLuigi Rizzo 			kring->nr_mode = NKR_NETMAP_OFF;
318137e3a6d3SLuigi Rizzo 			return NULL;
318237e3a6d3SLuigi Rizzo 		}
318337e3a6d3SLuigi Rizzo 
318417885a7bSLuigi Rizzo 		// XXX check whether we should use hwcur or rcur
3185506cc70cSLuigi Rizzo 		new_hwofs = kring->nr_hwcur - new_cur;
318664ae02c3SLuigi Rizzo 	} else {
31878241616dSLuigi Rizzo 		if (n >= na->num_rx_rings)
31888241616dSLuigi Rizzo 			return NULL;
318964ae02c3SLuigi Rizzo 		kring = na->rx_rings + n;
319037e3a6d3SLuigi Rizzo 
319137e3a6d3SLuigi Rizzo 		if (kring->nr_pending_mode == NKR_NETMAP_OFF) {
319237e3a6d3SLuigi Rizzo 			kring->nr_mode = NKR_NETMAP_OFF;
319337e3a6d3SLuigi Rizzo 			return NULL;
319437e3a6d3SLuigi Rizzo 		}
319537e3a6d3SLuigi Rizzo 
319617885a7bSLuigi Rizzo 		new_hwofs = kring->nr_hwtail - new_cur;
319764ae02c3SLuigi Rizzo 	}
319864ae02c3SLuigi Rizzo 	lim = kring->nkr_num_slots - 1;
3199506cc70cSLuigi Rizzo 	if (new_hwofs > lim)
3200506cc70cSLuigi Rizzo 		new_hwofs -= lim + 1;
3201506cc70cSLuigi Rizzo 
3202ce3ee1e7SLuigi Rizzo 	/* Always set the new offset value and realign the ring. */
320317885a7bSLuigi Rizzo 	if (netmap_verbose)
320417885a7bSLuigi Rizzo 	    D("%s %s%d hwofs %d -> %d, hwtail %d -> %d",
32054bf50f18SLuigi Rizzo 		na->name,
320617885a7bSLuigi Rizzo 		tx == NR_TX ? "TX" : "RX", n,
3207ce3ee1e7SLuigi Rizzo 		kring->nkr_hwofs, new_hwofs,
320817885a7bSLuigi Rizzo 		kring->nr_hwtail,
320917885a7bSLuigi Rizzo 		tx == NR_TX ? lim : kring->nr_hwtail);
3210506cc70cSLuigi Rizzo 	kring->nkr_hwofs = new_hwofs;
321117885a7bSLuigi Rizzo 	if (tx == NR_TX) {
321217885a7bSLuigi Rizzo 		kring->nr_hwtail = kring->nr_hwcur + lim;
321317885a7bSLuigi Rizzo 		if (kring->nr_hwtail > lim)
321417885a7bSLuigi Rizzo 			kring->nr_hwtail -= lim + 1;
321517885a7bSLuigi Rizzo 	}
3216506cc70cSLuigi Rizzo 
3217f196ce38SLuigi Rizzo #if 0 // def linux
3218f196ce38SLuigi Rizzo 	/* XXX check that the mappings are correct */
3219f196ce38SLuigi Rizzo 	/* need ring_nr, adapter->pdev, direction */
3220f196ce38SLuigi Rizzo 	buffer_info->dma = dma_map_single(&pdev->dev, addr, adapter->rx_buffer_len, DMA_FROM_DEVICE);
3221f196ce38SLuigi Rizzo 	if (dma_mapping_error(&adapter->pdev->dev, buffer_info->dma)) {
3222f196ce38SLuigi Rizzo 		D("error mapping rx netmap buffer %d", i);
3223f196ce38SLuigi Rizzo 		// XXX fix error handling
3224f196ce38SLuigi Rizzo 	}
3225f196ce38SLuigi Rizzo 
3226f196ce38SLuigi Rizzo #endif /* linux */
322768b8534bSLuigi Rizzo 	/*
3228ce3ee1e7SLuigi Rizzo 	 * Wakeup on the individual and global selwait
3229506cc70cSLuigi Rizzo 	 * We do the wakeup here, but the ring is not yet reconfigured.
3230506cc70cSLuigi Rizzo 	 * However, we are under lock so there are no races.
323168b8534bSLuigi Rizzo 	 */
323237e3a6d3SLuigi Rizzo 	kring->nr_mode = NKR_NETMAP_ON;
3233847bf383SLuigi Rizzo 	kring->nm_notify(kring, 0);
323468b8534bSLuigi Rizzo 	return kring->ring->slot;
323568b8534bSLuigi Rizzo }
323668b8534bSLuigi Rizzo 
323768b8534bSLuigi Rizzo 
3238ce3ee1e7SLuigi Rizzo /*
3239f9790aebSLuigi Rizzo  * Dispatch rx/tx interrupts to the netmap rings.
3240ce3ee1e7SLuigi Rizzo  *
3241ce3ee1e7SLuigi Rizzo  * "work_done" is non-null on the RX path, NULL for the TX path.
3242ce3ee1e7SLuigi Rizzo  * We rely on the OS to make sure that there is only one active
3243ce3ee1e7SLuigi Rizzo  * instance per queue, and that there is appropriate locking.
3244849bec0eSLuigi Rizzo  *
3245f9790aebSLuigi Rizzo  * The 'notify' routine depends on what the ring is attached to.
3246f9790aebSLuigi Rizzo  * - for a netmap file descriptor, do a selwakeup on the individual
3247f9790aebSLuigi Rizzo  *   waitqueue, plus one on the global one if needed
32484bf50f18SLuigi Rizzo  *   (see netmap_notify)
32494bf50f18SLuigi Rizzo  * - for a nic connected to a switch, call the proper forwarding routine
32504bf50f18SLuigi Rizzo  *   (see netmap_bwrap_intr_notify)
3251f9790aebSLuigi Rizzo  */
325237e3a6d3SLuigi Rizzo int
325337e3a6d3SLuigi Rizzo netmap_common_irq(struct netmap_adapter *na, u_int q, u_int *work_done)
3254f9790aebSLuigi Rizzo {
3255f9790aebSLuigi Rizzo 	struct netmap_kring *kring;
3256847bf383SLuigi Rizzo 	enum txrx t = (work_done ? NR_RX : NR_TX);
3257f9790aebSLuigi Rizzo 
3258f9790aebSLuigi Rizzo 	q &= NETMAP_RING_MASK;
3259f9790aebSLuigi Rizzo 
3260f9790aebSLuigi Rizzo 	if (netmap_verbose) {
3261f9790aebSLuigi Rizzo 	        RD(5, "received %s queue %d", work_done ? "RX" : "TX" , q);
3262f9790aebSLuigi Rizzo 	}
3263f9790aebSLuigi Rizzo 
3264847bf383SLuigi Rizzo 	if (q >= nma_get_nrings(na, t))
326537e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS; // not a physical queue
3266847bf383SLuigi Rizzo 
3267847bf383SLuigi Rizzo 	kring = NMR(na, t) + q;
3268847bf383SLuigi Rizzo 
326937e3a6d3SLuigi Rizzo 	if (kring->nr_mode == NKR_NETMAP_OFF) {
327037e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
327137e3a6d3SLuigi Rizzo 	}
327237e3a6d3SLuigi Rizzo 
3273847bf383SLuigi Rizzo 	if (t == NR_RX) {
3274f9790aebSLuigi Rizzo 		kring->nr_kflags |= NKR_PENDINTR;	// XXX atomic ?
3275f9790aebSLuigi Rizzo 		*work_done = 1; /* do not fire napi again */
3276f9790aebSLuigi Rizzo 	}
327737e3a6d3SLuigi Rizzo 
327837e3a6d3SLuigi Rizzo 	return kring->nm_notify(kring, 0);
3279f9790aebSLuigi Rizzo }
3280f9790aebSLuigi Rizzo 
328117885a7bSLuigi Rizzo 
3282f9790aebSLuigi Rizzo /*
3283f9790aebSLuigi Rizzo  * Default functions to handle rx/tx interrupts from a physical device.
3284f9790aebSLuigi Rizzo  * "work_done" is non-null on the RX path, NULL for the TX path.
3285f9790aebSLuigi Rizzo  *
328637e3a6d3SLuigi Rizzo  * If the card is not in netmap mode, simply return NM_IRQ_PASS,
3287ce3ee1e7SLuigi Rizzo  * so that the caller proceeds with regular processing.
328837e3a6d3SLuigi Rizzo  * Otherwise call netmap_common_irq().
3289ce3ee1e7SLuigi Rizzo  *
3290ce3ee1e7SLuigi Rizzo  * If the card is connected to a netmap file descriptor,
3291ce3ee1e7SLuigi Rizzo  * do a selwakeup on the individual queue, plus one on the global one
3292ce3ee1e7SLuigi Rizzo  * if needed (multiqueue card _and_ there are multiqueue listeners),
329337e3a6d3SLuigi Rizzo  * and return NR_IRQ_COMPLETED.
3294ce3ee1e7SLuigi Rizzo  *
3295ce3ee1e7SLuigi Rizzo  * Finally, if called on rx from an interface connected to a switch,
329637e3a6d3SLuigi Rizzo  * calls the proper forwarding routine.
32971a26580eSLuigi Rizzo  */
3298babc7c12SLuigi Rizzo int
3299ce3ee1e7SLuigi Rizzo netmap_rx_irq(struct ifnet *ifp, u_int q, u_int *work_done)
33001a26580eSLuigi Rizzo {
33014bf50f18SLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
33024bf50f18SLuigi Rizzo 
33034bf50f18SLuigi Rizzo 	/*
33044bf50f18SLuigi Rizzo 	 * XXX emulated netmap mode sets NAF_SKIP_INTR so
33054bf50f18SLuigi Rizzo 	 * we still use the regular driver even though the previous
33064bf50f18SLuigi Rizzo 	 * check fails. It is unclear whether we should use
33074bf50f18SLuigi Rizzo 	 * nm_native_on() here.
33084bf50f18SLuigi Rizzo 	 */
33094bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na))
331037e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
3311849bec0eSLuigi Rizzo 
33124bf50f18SLuigi Rizzo 	if (na->na_flags & NAF_SKIP_INTR) {
33138241616dSLuigi Rizzo 		ND("use regular interrupt");
331437e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
33158241616dSLuigi Rizzo 	}
33168241616dSLuigi Rizzo 
331737e3a6d3SLuigi Rizzo 	return netmap_common_irq(na, q, work_done);
33181a26580eSLuigi Rizzo }
33191a26580eSLuigi Rizzo 
332064ae02c3SLuigi Rizzo 
332101c7d25fSLuigi Rizzo /*
3322f9790aebSLuigi Rizzo  * Module loader and unloader
3323f196ce38SLuigi Rizzo  *
3324f9790aebSLuigi Rizzo  * netmap_init() creates the /dev/netmap device and initializes
3325f9790aebSLuigi Rizzo  * all global variables. Returns 0 on success, errno on failure
3326f9790aebSLuigi Rizzo  * (but there is no chance)
3327f9790aebSLuigi Rizzo  *
3328f9790aebSLuigi Rizzo  * netmap_fini() destroys everything.
3329f196ce38SLuigi Rizzo  */
3330babc7c12SLuigi Rizzo 
3331babc7c12SLuigi Rizzo static struct cdev *netmap_dev; /* /dev/netmap character device. */
3332f9790aebSLuigi Rizzo extern struct cdevsw netmap_cdevsw;
3333babc7c12SLuigi Rizzo 
333417885a7bSLuigi Rizzo 
3335f9790aebSLuigi Rizzo void
333668b8534bSLuigi Rizzo netmap_fini(void)
333768b8534bSLuigi Rizzo {
3338f9790aebSLuigi Rizzo 	if (netmap_dev)
333968b8534bSLuigi Rizzo 		destroy_dev(netmap_dev);
334037e3a6d3SLuigi Rizzo 	/* we assume that there are no longer netmap users */
334137e3a6d3SLuigi Rizzo 	nm_os_ifnet_fini();
334237e3a6d3SLuigi Rizzo 	netmap_uninit_bridges();
3343ce3ee1e7SLuigi Rizzo 	netmap_mem_fini();
3344ce3ee1e7SLuigi Rizzo 	NMG_LOCK_DESTROY();
3345*c3e9b4dbSLuiz Otavio O Souza 	nm_prinf("netmap: unloaded module.\n");
334668b8534bSLuigi Rizzo }
334768b8534bSLuigi Rizzo 
334817885a7bSLuigi Rizzo 
3349f9790aebSLuigi Rizzo int
3350f9790aebSLuigi Rizzo netmap_init(void)
335168b8534bSLuigi Rizzo {
3352f9790aebSLuigi Rizzo 	int error;
335368b8534bSLuigi Rizzo 
3354f9790aebSLuigi Rizzo 	NMG_LOCK_INIT();
335568b8534bSLuigi Rizzo 
3356f9790aebSLuigi Rizzo 	error = netmap_mem_init();
3357f9790aebSLuigi Rizzo 	if (error != 0)
3358f9790aebSLuigi Rizzo 		goto fail;
3359c929ca72SLuigi Rizzo 	/*
3360c929ca72SLuigi Rizzo 	 * MAKEDEV_ETERNAL_KLD avoids an expensive check on syscalls
3361c929ca72SLuigi Rizzo 	 * when the module is compiled in.
3362c929ca72SLuigi Rizzo 	 * XXX could use make_dev_credv() to get error number
3363c929ca72SLuigi Rizzo 	 */
33640e73f29aSLuigi Rizzo 	netmap_dev = make_dev_credf(MAKEDEV_ETERNAL_KLD,
336511c0b69cSAdrian Chadd 		&netmap_cdevsw, 0, NULL, UID_ROOT, GID_WHEEL, 0600,
33660e73f29aSLuigi Rizzo 			      "netmap");
3367f9790aebSLuigi Rizzo 	if (!netmap_dev)
3368f9790aebSLuigi Rizzo 		goto fail;
3369f9790aebSLuigi Rizzo 
3370847bf383SLuigi Rizzo 	error = netmap_init_bridges();
3371847bf383SLuigi Rizzo 	if (error)
3372847bf383SLuigi Rizzo 		goto fail;
3373847bf383SLuigi Rizzo 
33744bf50f18SLuigi Rizzo #ifdef __FreeBSD__
337537e3a6d3SLuigi Rizzo 	nm_os_vi_init_index();
33764bf50f18SLuigi Rizzo #endif
3377847bf383SLuigi Rizzo 
337837e3a6d3SLuigi Rizzo 	error = nm_os_ifnet_init();
337937e3a6d3SLuigi Rizzo 	if (error)
338037e3a6d3SLuigi Rizzo 		goto fail;
338137e3a6d3SLuigi Rizzo 
3382*c3e9b4dbSLuiz Otavio O Souza 	nm_prinf("netmap: loaded module\n");
3383f9790aebSLuigi Rizzo 	return (0);
3384f9790aebSLuigi Rizzo fail:
338568b8534bSLuigi Rizzo 	netmap_fini();
3386f9790aebSLuigi Rizzo 	return (EINVAL); /* may be incorrect */
338768b8534bSLuigi Rizzo }
3388