xref: /freebsd/sys/dev/netmap/netmap.c (revision 718cf2ccb9956613756ab15d7a0e28f2c8e91cab)
1*718cf2ccSPedro F. Giffuni /*-
2*718cf2ccSPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3*718cf2ccSPedro F. Giffuni  *
437e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2014 Matteo Landi
537e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Luigi Rizzo
637e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Giuseppe Lettieri
737e3a6d3SLuigi Rizzo  * Copyright (C) 2011-2016 Vincenzo Maffione
837e3a6d3SLuigi Rizzo  * All rights reserved.
968b8534bSLuigi Rizzo  *
1068b8534bSLuigi Rizzo  * Redistribution and use in source and binary forms, with or without
1168b8534bSLuigi Rizzo  * modification, are permitted provided that the following conditions
1268b8534bSLuigi Rizzo  * are met:
1368b8534bSLuigi Rizzo  *   1. Redistributions of source code must retain the above copyright
1468b8534bSLuigi Rizzo  *      notice, this list of conditions and the following disclaimer.
1568b8534bSLuigi Rizzo  *   2. Redistributions in binary form must reproduce the above copyright
1668b8534bSLuigi Rizzo  *      notice, this list of conditions and the following disclaimer in the
1768b8534bSLuigi Rizzo  *      documentation and/or other materials provided with the distribution.
1868b8534bSLuigi Rizzo  *
1968b8534bSLuigi Rizzo  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
2068b8534bSLuigi Rizzo  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2168b8534bSLuigi Rizzo  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2268b8534bSLuigi Rizzo  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2368b8534bSLuigi Rizzo  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2468b8534bSLuigi Rizzo  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2568b8534bSLuigi Rizzo  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2668b8534bSLuigi Rizzo  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2768b8534bSLuigi Rizzo  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2868b8534bSLuigi Rizzo  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2968b8534bSLuigi Rizzo  * SUCH DAMAGE.
3068b8534bSLuigi Rizzo  */
3168b8534bSLuigi Rizzo 
32ce3ee1e7SLuigi Rizzo 
3368b8534bSLuigi Rizzo /*
34f9790aebSLuigi Rizzo  * $FreeBSD$
35f9790aebSLuigi Rizzo  *
3668b8534bSLuigi Rizzo  * This module supports memory mapped access to network devices,
3768b8534bSLuigi Rizzo  * see netmap(4).
3868b8534bSLuigi Rizzo  *
3968b8534bSLuigi Rizzo  * The module uses a large, memory pool allocated by the kernel
4068b8534bSLuigi Rizzo  * and accessible as mmapped memory by multiple userspace threads/processes.
4168b8534bSLuigi Rizzo  * The memory pool contains packet buffers and "netmap rings",
4268b8534bSLuigi Rizzo  * i.e. user-accessible copies of the interface's queues.
4368b8534bSLuigi Rizzo  *
4468b8534bSLuigi Rizzo  * Access to the network card works like this:
4568b8534bSLuigi Rizzo  * 1. a process/thread issues one or more open() on /dev/netmap, to create
4668b8534bSLuigi Rizzo  *    select()able file descriptor on which events are reported.
4768b8534bSLuigi Rizzo  * 2. on each descriptor, the process issues an ioctl() to identify
4868b8534bSLuigi Rizzo  *    the interface that should report events to the file descriptor.
4968b8534bSLuigi Rizzo  * 3. on each descriptor, the process issues an mmap() request to
5068b8534bSLuigi Rizzo  *    map the shared memory region within the process' address space.
5168b8534bSLuigi Rizzo  *    The list of interesting queues is indicated by a location in
5268b8534bSLuigi Rizzo  *    the shared memory region.
5368b8534bSLuigi Rizzo  * 4. using the functions in the netmap(4) userspace API, a process
5468b8534bSLuigi Rizzo  *    can look up the occupation state of a queue, access memory buffers,
5568b8534bSLuigi Rizzo  *    and retrieve received packets or enqueue packets to transmit.
5668b8534bSLuigi Rizzo  * 5. using some ioctl()s the process can synchronize the userspace view
5768b8534bSLuigi Rizzo  *    of the queue with the actual status in the kernel. This includes both
5868b8534bSLuigi Rizzo  *    receiving the notification of new packets, and transmitting new
5968b8534bSLuigi Rizzo  *    packets on the output interface.
6068b8534bSLuigi Rizzo  * 6. select() or poll() can be used to wait for events on individual
6168b8534bSLuigi Rizzo  *    transmit or receive queues (or all queues for a given interface).
62ce3ee1e7SLuigi Rizzo  *
63ce3ee1e7SLuigi Rizzo 
64ce3ee1e7SLuigi Rizzo 		SYNCHRONIZATION (USER)
65ce3ee1e7SLuigi Rizzo 
66ce3ee1e7SLuigi Rizzo The netmap rings and data structures may be shared among multiple
67ce3ee1e7SLuigi Rizzo user threads or even independent processes.
68ce3ee1e7SLuigi Rizzo Any synchronization among those threads/processes is delegated
69ce3ee1e7SLuigi Rizzo to the threads themselves. Only one thread at a time can be in
70ce3ee1e7SLuigi Rizzo a system call on the same netmap ring. The OS does not enforce
71ce3ee1e7SLuigi Rizzo this and only guarantees against system crashes in case of
72ce3ee1e7SLuigi Rizzo invalid usage.
73ce3ee1e7SLuigi Rizzo 
74ce3ee1e7SLuigi Rizzo 		LOCKING (INTERNAL)
75ce3ee1e7SLuigi Rizzo 
76ce3ee1e7SLuigi Rizzo Within the kernel, access to the netmap rings is protected as follows:
77ce3ee1e7SLuigi Rizzo 
78ce3ee1e7SLuigi Rizzo - a spinlock on each ring, to handle producer/consumer races on
79ce3ee1e7SLuigi Rizzo   RX rings attached to the host stack (against multiple host
80ce3ee1e7SLuigi Rizzo   threads writing from the host stack to the same ring),
81ce3ee1e7SLuigi Rizzo   and on 'destination' rings attached to a VALE switch
82ce3ee1e7SLuigi Rizzo   (i.e. RX rings in VALE ports, and TX rings in NIC/host ports)
83ce3ee1e7SLuigi Rizzo   protecting multiple active senders for the same destination)
84ce3ee1e7SLuigi Rizzo 
85ce3ee1e7SLuigi Rizzo - an atomic variable to guarantee that there is at most one
86ce3ee1e7SLuigi Rizzo   instance of *_*xsync() on the ring at any time.
87ce3ee1e7SLuigi Rizzo   For rings connected to user file
88ce3ee1e7SLuigi Rizzo   descriptors, an atomic_test_and_set() protects this, and the
89ce3ee1e7SLuigi Rizzo   lock on the ring is not actually used.
90ce3ee1e7SLuigi Rizzo   For NIC RX rings connected to a VALE switch, an atomic_test_and_set()
91ce3ee1e7SLuigi Rizzo   is also used to prevent multiple executions (the driver might indeed
92ce3ee1e7SLuigi Rizzo   already guarantee this).
93ce3ee1e7SLuigi Rizzo   For NIC TX rings connected to a VALE switch, the lock arbitrates
94ce3ee1e7SLuigi Rizzo   access to the queue (both when allocating buffers and when pushing
95ce3ee1e7SLuigi Rizzo   them out).
96ce3ee1e7SLuigi Rizzo 
97ce3ee1e7SLuigi Rizzo - *xsync() should be protected against initializations of the card.
98ce3ee1e7SLuigi Rizzo   On FreeBSD most devices have the reset routine protected by
99ce3ee1e7SLuigi Rizzo   a RING lock (ixgbe, igb, em) or core lock (re). lem is missing
100ce3ee1e7SLuigi Rizzo   the RING protection on rx_reset(), this should be added.
101ce3ee1e7SLuigi Rizzo 
102ce3ee1e7SLuigi Rizzo   On linux there is an external lock on the tx path, which probably
103ce3ee1e7SLuigi Rizzo   also arbitrates access to the reset routine. XXX to be revised
104ce3ee1e7SLuigi Rizzo 
105ce3ee1e7SLuigi Rizzo - a per-interface core_lock protecting access from the host stack
106ce3ee1e7SLuigi Rizzo   while interfaces may be detached from netmap mode.
107ce3ee1e7SLuigi Rizzo   XXX there should be no need for this lock if we detach the interfaces
108ce3ee1e7SLuigi Rizzo   only while they are down.
109ce3ee1e7SLuigi Rizzo 
110ce3ee1e7SLuigi Rizzo 
111ce3ee1e7SLuigi Rizzo --- VALE SWITCH ---
112ce3ee1e7SLuigi Rizzo 
113ce3ee1e7SLuigi Rizzo NMG_LOCK() serializes all modifications to switches and ports.
114ce3ee1e7SLuigi Rizzo A switch cannot be deleted until all ports are gone.
115ce3ee1e7SLuigi Rizzo 
116ce3ee1e7SLuigi Rizzo For each switch, an SX lock (RWlock on linux) protects
117ce3ee1e7SLuigi Rizzo deletion of ports. When configuring or deleting a new port, the
118ce3ee1e7SLuigi Rizzo lock is acquired in exclusive mode (after holding NMG_LOCK).
119ce3ee1e7SLuigi Rizzo When forwarding, the lock is acquired in shared mode (without NMG_LOCK).
120ce3ee1e7SLuigi Rizzo The lock is held throughout the entire forwarding cycle,
121ce3ee1e7SLuigi Rizzo during which the thread may incur in a page fault.
122ce3ee1e7SLuigi Rizzo Hence it is important that sleepable shared locks are used.
123ce3ee1e7SLuigi Rizzo 
124ce3ee1e7SLuigi Rizzo On the rx ring, the per-port lock is grabbed initially to reserve
125ce3ee1e7SLuigi Rizzo a number of slot in the ring, then the lock is released,
126ce3ee1e7SLuigi Rizzo packets are copied from source to destination, and then
127ce3ee1e7SLuigi Rizzo the lock is acquired again and the receive ring is updated.
128ce3ee1e7SLuigi Rizzo (A similar thing is done on the tx ring for NIC and host stack
129ce3ee1e7SLuigi Rizzo ports attached to the switch)
130ce3ee1e7SLuigi Rizzo 
13168b8534bSLuigi Rizzo  */
13268b8534bSLuigi Rizzo 
1334bf50f18SLuigi Rizzo 
1344bf50f18SLuigi Rizzo /* --- internals ----
1354bf50f18SLuigi Rizzo  *
1364bf50f18SLuigi Rizzo  * Roadmap to the code that implements the above.
1374bf50f18SLuigi Rizzo  *
1384bf50f18SLuigi Rizzo  * > 1. a process/thread issues one or more open() on /dev/netmap, to create
1394bf50f18SLuigi Rizzo  * >    select()able file descriptor on which events are reported.
1404bf50f18SLuigi Rizzo  *
1414bf50f18SLuigi Rizzo  *  	Internally, we allocate a netmap_priv_d structure, that will be
14237e3a6d3SLuigi Rizzo  *  	initialized on ioctl(NIOCREGIF). There is one netmap_priv_d
14337e3a6d3SLuigi Rizzo  *  	structure for each open().
1444bf50f18SLuigi Rizzo  *
1454bf50f18SLuigi Rizzo  *      os-specific:
14637e3a6d3SLuigi Rizzo  *  	    FreeBSD: see netmap_open() (netmap_freebsd.c)
14737e3a6d3SLuigi Rizzo  *  	    linux:   see linux_netmap_open() (netmap_linux.c)
1484bf50f18SLuigi Rizzo  *
1494bf50f18SLuigi Rizzo  * > 2. on each descriptor, the process issues an ioctl() to identify
1504bf50f18SLuigi Rizzo  * >    the interface that should report events to the file descriptor.
1514bf50f18SLuigi Rizzo  *
1524bf50f18SLuigi Rizzo  * 	Implemented by netmap_ioctl(), NIOCREGIF case, with nmr->nr_cmd==0.
1534bf50f18SLuigi Rizzo  * 	Most important things happen in netmap_get_na() and
1544bf50f18SLuigi Rizzo  * 	netmap_do_regif(), called from there. Additional details can be
1554bf50f18SLuigi Rizzo  * 	found in the comments above those functions.
1564bf50f18SLuigi Rizzo  *
1574bf50f18SLuigi Rizzo  * 	In all cases, this action creates/takes-a-reference-to a
1584bf50f18SLuigi Rizzo  * 	netmap_*_adapter describing the port, and allocates a netmap_if
1594bf50f18SLuigi Rizzo  * 	and all necessary netmap rings, filling them with netmap buffers.
1604bf50f18SLuigi Rizzo  *
1614bf50f18SLuigi Rizzo  *      In this phase, the sync callbacks for each ring are set (these are used
1624bf50f18SLuigi Rizzo  *      in steps 5 and 6 below).  The callbacks depend on the type of adapter.
1634bf50f18SLuigi Rizzo  *      The adapter creation/initialization code puts them in the
1644bf50f18SLuigi Rizzo  * 	netmap_adapter (fields na->nm_txsync and na->nm_rxsync).  Then, they
1654bf50f18SLuigi Rizzo  * 	are copied from there to the netmap_kring's during netmap_do_regif(), by
1664bf50f18SLuigi Rizzo  * 	the nm_krings_create() callback.  All the nm_krings_create callbacks
1674bf50f18SLuigi Rizzo  * 	actually call netmap_krings_create() to perform this and the other
1684bf50f18SLuigi Rizzo  * 	common stuff. netmap_krings_create() also takes care of the host rings,
1694bf50f18SLuigi Rizzo  * 	if needed, by setting their sync callbacks appropriately.
1704bf50f18SLuigi Rizzo  *
1714bf50f18SLuigi Rizzo  * 	Additional actions depend on the kind of netmap_adapter that has been
1724bf50f18SLuigi Rizzo  * 	registered:
1734bf50f18SLuigi Rizzo  *
1744bf50f18SLuigi Rizzo  * 	- netmap_hw_adapter:  	     [netmap.c]
1754bf50f18SLuigi Rizzo  * 	     This is a system netdev/ifp with native netmap support.
1764bf50f18SLuigi Rizzo  * 	     The ifp is detached from the host stack by redirecting:
1774bf50f18SLuigi Rizzo  * 	       - transmissions (from the network stack) to netmap_transmit()
1784bf50f18SLuigi Rizzo  * 	       - receive notifications to the nm_notify() callback for
1794bf50f18SLuigi Rizzo  * 	         this adapter. The callback is normally netmap_notify(), unless
1804bf50f18SLuigi Rizzo  * 	         the ifp is attached to a bridge using bwrap, in which case it
1814bf50f18SLuigi Rizzo  * 	         is netmap_bwrap_intr_notify().
1824bf50f18SLuigi Rizzo  *
1834bf50f18SLuigi Rizzo  * 	- netmap_generic_adapter:      [netmap_generic.c]
1844bf50f18SLuigi Rizzo  * 	      A system netdev/ifp without native netmap support.
1854bf50f18SLuigi Rizzo  *
1864bf50f18SLuigi Rizzo  * 	(the decision about native/non native support is taken in
1874bf50f18SLuigi Rizzo  * 	 netmap_get_hw_na(), called by netmap_get_na())
1884bf50f18SLuigi Rizzo  *
1894bf50f18SLuigi Rizzo  * 	- netmap_vp_adapter 		[netmap_vale.c]
1904bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_bdg_na().
1914bf50f18SLuigi Rizzo  * 	      This is a persistent or ephemeral VALE port. Ephemeral ports
1924bf50f18SLuigi Rizzo  * 	      are created on the fly if they don't already exist, and are
1934bf50f18SLuigi Rizzo  * 	      always attached to a bridge.
194453130d9SPedro F. Giffuni  * 	      Persistent VALE ports must must be created separately, and i
1954bf50f18SLuigi Rizzo  * 	      then attached like normal NICs. The NIOCREGIF we are examining
1964bf50f18SLuigi Rizzo  * 	      will find them only if they had previosly been created and
1974bf50f18SLuigi Rizzo  * 	      attached (see VALE_CTL below).
1984bf50f18SLuigi Rizzo  *
1994bf50f18SLuigi Rizzo  * 	- netmap_pipe_adapter 	      [netmap_pipe.c]
2004bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_pipe_na().
2014bf50f18SLuigi Rizzo  * 	      Both pipe ends are created, if they didn't already exist.
2024bf50f18SLuigi Rizzo  *
2034bf50f18SLuigi Rizzo  * 	- netmap_monitor_adapter      [netmap_monitor.c]
2044bf50f18SLuigi Rizzo  * 	      Returned by netmap_get_monitor_na().
2054bf50f18SLuigi Rizzo  * 	      If successful, the nm_sync callbacks of the monitored adapter
2064bf50f18SLuigi Rizzo  * 	      will be intercepted by the returned monitor.
2074bf50f18SLuigi Rizzo  *
2084bf50f18SLuigi Rizzo  * 	- netmap_bwrap_adapter	      [netmap_vale.c]
2094bf50f18SLuigi Rizzo  * 	      Cannot be obtained in this way, see VALE_CTL below
2104bf50f18SLuigi Rizzo  *
2114bf50f18SLuigi Rizzo  *
2124bf50f18SLuigi Rizzo  * 	os-specific:
2134bf50f18SLuigi Rizzo  * 	    linux: we first go through linux_netmap_ioctl() to
2144bf50f18SLuigi Rizzo  * 	           adapt the FreeBSD interface to the linux one.
2154bf50f18SLuigi Rizzo  *
2164bf50f18SLuigi Rizzo  *
2174bf50f18SLuigi Rizzo  * > 3. on each descriptor, the process issues an mmap() request to
2184bf50f18SLuigi Rizzo  * >    map the shared memory region within the process' address space.
2194bf50f18SLuigi Rizzo  * >    The list of interesting queues is indicated by a location in
2204bf50f18SLuigi Rizzo  * >    the shared memory region.
2214bf50f18SLuigi Rizzo  *
2224bf50f18SLuigi Rizzo  *      os-specific:
2234bf50f18SLuigi Rizzo  *  	    FreeBSD: netmap_mmap_single (netmap_freebsd.c).
2244bf50f18SLuigi Rizzo  *  	    linux:   linux_netmap_mmap (netmap_linux.c).
2254bf50f18SLuigi Rizzo  *
2264bf50f18SLuigi Rizzo  * > 4. using the functions in the netmap(4) userspace API, a process
2274bf50f18SLuigi Rizzo  * >    can look up the occupation state of a queue, access memory buffers,
2284bf50f18SLuigi Rizzo  * >    and retrieve received packets or enqueue packets to transmit.
2294bf50f18SLuigi Rizzo  *
2304bf50f18SLuigi Rizzo  * 	these actions do not involve the kernel.
2314bf50f18SLuigi Rizzo  *
2324bf50f18SLuigi Rizzo  * > 5. using some ioctl()s the process can synchronize the userspace view
2334bf50f18SLuigi Rizzo  * >    of the queue with the actual status in the kernel. This includes both
2344bf50f18SLuigi Rizzo  * >    receiving the notification of new packets, and transmitting new
2354bf50f18SLuigi Rizzo  * >    packets on the output interface.
2364bf50f18SLuigi Rizzo  *
2374bf50f18SLuigi Rizzo  * 	These are implemented in netmap_ioctl(), NIOCTXSYNC and NIOCRXSYNC
2384bf50f18SLuigi Rizzo  * 	cases. They invoke the nm_sync callbacks on the netmap_kring
2394bf50f18SLuigi Rizzo  * 	structures, as initialized in step 2 and maybe later modified
2404bf50f18SLuigi Rizzo  * 	by a monitor. Monitors, however, will always call the original
2414bf50f18SLuigi Rizzo  * 	callback before doing anything else.
2424bf50f18SLuigi Rizzo  *
2434bf50f18SLuigi Rizzo  *
2444bf50f18SLuigi Rizzo  * > 6. select() or poll() can be used to wait for events on individual
2454bf50f18SLuigi Rizzo  * >    transmit or receive queues (or all queues for a given interface).
2464bf50f18SLuigi Rizzo  *
2474bf50f18SLuigi Rizzo  * 	Implemented in netmap_poll(). This will call the same nm_sync()
2484bf50f18SLuigi Rizzo  * 	callbacks as in step 5 above.
2494bf50f18SLuigi Rizzo  *
2504bf50f18SLuigi Rizzo  * 	os-specific:
2514bf50f18SLuigi Rizzo  * 		linux: we first go through linux_netmap_poll() to adapt
2524bf50f18SLuigi Rizzo  * 		       the FreeBSD interface to the linux one.
2534bf50f18SLuigi Rizzo  *
2544bf50f18SLuigi Rizzo  *
2554bf50f18SLuigi Rizzo  *  ----  VALE_CTL -----
2564bf50f18SLuigi Rizzo  *
2574bf50f18SLuigi Rizzo  *  VALE switches are controlled by issuing a NIOCREGIF with a non-null
2584bf50f18SLuigi Rizzo  *  nr_cmd in the nmreq structure. These subcommands are handled by
2594bf50f18SLuigi Rizzo  *  netmap_bdg_ctl() in netmap_vale.c. Persistent VALE ports are created
2604bf50f18SLuigi Rizzo  *  and destroyed by issuing the NETMAP_BDG_NEWIF and NETMAP_BDG_DELIF
2614bf50f18SLuigi Rizzo  *  subcommands, respectively.
2624bf50f18SLuigi Rizzo  *
2634bf50f18SLuigi Rizzo  *  Any network interface known to the system (including a persistent VALE
2644bf50f18SLuigi Rizzo  *  port) can be attached to a VALE switch by issuing the
2654bf50f18SLuigi Rizzo  *  NETMAP_BDG_ATTACH subcommand. After the attachment, persistent VALE ports
2664bf50f18SLuigi Rizzo  *  look exactly like ephemeral VALE ports (as created in step 2 above).  The
2674bf50f18SLuigi Rizzo  *  attachment of other interfaces, instead, requires the creation of a
2684bf50f18SLuigi Rizzo  *  netmap_bwrap_adapter.  Moreover, the attached interface must be put in
2694bf50f18SLuigi Rizzo  *  netmap mode. This may require the creation of a netmap_generic_adapter if
2704bf50f18SLuigi Rizzo  *  we have no native support for the interface, or if generic adapters have
2714bf50f18SLuigi Rizzo  *  been forced by sysctl.
2724bf50f18SLuigi Rizzo  *
2734bf50f18SLuigi Rizzo  *  Both persistent VALE ports and bwraps are handled by netmap_get_bdg_na(),
2744bf50f18SLuigi Rizzo  *  called by nm_bdg_ctl_attach(), and discriminated by the nm_bdg_attach()
2754bf50f18SLuigi Rizzo  *  callback.  In the case of the bwrap, the callback creates the
2764bf50f18SLuigi Rizzo  *  netmap_bwrap_adapter.  The initialization of the bwrap is then
2774bf50f18SLuigi Rizzo  *  completed by calling netmap_do_regif() on it, in the nm_bdg_ctl()
2784bf50f18SLuigi Rizzo  *  callback (netmap_bwrap_bdg_ctl in netmap_vale.c).
2794bf50f18SLuigi Rizzo  *  A generic adapter for the wrapped ifp will be created if needed, when
2804bf50f18SLuigi Rizzo  *  netmap_get_bdg_na() calls netmap_get_hw_na().
2814bf50f18SLuigi Rizzo  *
2824bf50f18SLuigi Rizzo  *
2834bf50f18SLuigi Rizzo  *  ---- DATAPATHS -----
2844bf50f18SLuigi Rizzo  *
2854bf50f18SLuigi Rizzo  *              -= SYSTEM DEVICE WITH NATIVE SUPPORT =-
2864bf50f18SLuigi Rizzo  *
2874bf50f18SLuigi Rizzo  *    na == NA(ifp) == netmap_hw_adapter created in DEVICE_netmap_attach()
2884bf50f18SLuigi Rizzo  *
2894bf50f18SLuigi Rizzo  *    - tx from netmap userspace:
2904bf50f18SLuigi Rizzo  *	 concurrently:
2914bf50f18SLuigi Rizzo  *           1) ioctl(NIOCTXSYNC)/netmap_poll() in process context
2924bf50f18SLuigi Rizzo  *                kring->nm_sync() == DEVICE_netmap_txsync()
2934bf50f18SLuigi Rizzo  *           2) device interrupt handler
2944bf50f18SLuigi Rizzo  *                na->nm_notify()  == netmap_notify()
2954bf50f18SLuigi Rizzo  *    - rx from netmap userspace:
2964bf50f18SLuigi Rizzo  *       concurrently:
2974bf50f18SLuigi Rizzo  *           1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
2984bf50f18SLuigi Rizzo  *                kring->nm_sync() == DEVICE_netmap_rxsync()
2994bf50f18SLuigi Rizzo  *           2) device interrupt handler
3004bf50f18SLuigi Rizzo  *                na->nm_notify()  == netmap_notify()
301847bf383SLuigi Rizzo  *    - rx from host stack
3024bf50f18SLuigi Rizzo  *       concurrently:
3034bf50f18SLuigi Rizzo  *           1) host stack
3044bf50f18SLuigi Rizzo  *                netmap_transmit()
3054bf50f18SLuigi Rizzo  *                  na->nm_notify  == netmap_notify()
3064bf50f18SLuigi Rizzo  *           2) ioctl(NIOCRXSYNC)/netmap_poll() in process context
30737e3a6d3SLuigi Rizzo  *                kring->nm_sync() == netmap_rxsync_from_host
3084bf50f18SLuigi Rizzo  *                  netmap_rxsync_from_host(na, NULL, NULL)
3094bf50f18SLuigi Rizzo  *    - tx to host stack
3104bf50f18SLuigi Rizzo  *           ioctl(NIOCTXSYNC)/netmap_poll() in process context
31137e3a6d3SLuigi Rizzo  *             kring->nm_sync() == netmap_txsync_to_host
3124bf50f18SLuigi Rizzo  *               netmap_txsync_to_host(na)
31337e3a6d3SLuigi Rizzo  *                 nm_os_send_up()
31437e3a6d3SLuigi Rizzo  *                   FreeBSD: na->if_input() == ether_input()
3154bf50f18SLuigi Rizzo  *                   linux: netif_rx() with NM_MAGIC_PRIORITY_RX
3164bf50f18SLuigi Rizzo  *
3174bf50f18SLuigi Rizzo  *
3184bf50f18SLuigi Rizzo  *               -= SYSTEM DEVICE WITH GENERIC SUPPORT =-
3194bf50f18SLuigi Rizzo  *
320847bf383SLuigi Rizzo  *    na == NA(ifp) == generic_netmap_adapter created in generic_netmap_attach()
321847bf383SLuigi Rizzo  *
322847bf383SLuigi Rizzo  *    - tx from netmap userspace:
323847bf383SLuigi Rizzo  *       concurrently:
324847bf383SLuigi Rizzo  *           1) ioctl(NIOCTXSYNC)/netmap_poll() in process context
325847bf383SLuigi Rizzo  *               kring->nm_sync() == generic_netmap_txsync()
32637e3a6d3SLuigi Rizzo  *                   nm_os_generic_xmit_frame()
327847bf383SLuigi Rizzo  *                       linux:   dev_queue_xmit() with NM_MAGIC_PRIORITY_TX
32837e3a6d3SLuigi Rizzo  *                           ifp->ndo_start_xmit == generic_ndo_start_xmit()
32937e3a6d3SLuigi Rizzo  *                               gna->save_start_xmit == orig. dev. start_xmit
330847bf383SLuigi Rizzo  *                       FreeBSD: na->if_transmit() == orig. dev if_transmit
331847bf383SLuigi Rizzo  *           2) generic_mbuf_destructor()
332847bf383SLuigi Rizzo  *                   na->nm_notify() == netmap_notify()
333847bf383SLuigi Rizzo  *    - rx from netmap userspace:
334847bf383SLuigi Rizzo  *           1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
335847bf383SLuigi Rizzo  *               kring->nm_sync() == generic_netmap_rxsync()
336847bf383SLuigi Rizzo  *                   mbq_safe_dequeue()
337847bf383SLuigi Rizzo  *           2) device driver
338847bf383SLuigi Rizzo  *               generic_rx_handler()
339847bf383SLuigi Rizzo  *                   mbq_safe_enqueue()
340847bf383SLuigi Rizzo  *                   na->nm_notify() == netmap_notify()
34137e3a6d3SLuigi Rizzo  *    - rx from host stack
34237e3a6d3SLuigi Rizzo  *        FreeBSD: same as native
34337e3a6d3SLuigi Rizzo  *        Linux: same as native except:
344847bf383SLuigi Rizzo  *           1) host stack
34537e3a6d3SLuigi Rizzo  *               dev_queue_xmit() without NM_MAGIC_PRIORITY_TX
34637e3a6d3SLuigi Rizzo  *                   ifp->ndo_start_xmit == generic_ndo_start_xmit()
347847bf383SLuigi Rizzo  *                       netmap_transmit()
348847bf383SLuigi Rizzo  *                           na->nm_notify() == netmap_notify()
34937e3a6d3SLuigi Rizzo  *    - tx to host stack (same as native):
3504bf50f18SLuigi Rizzo  *
3514bf50f18SLuigi Rizzo  *
352847bf383SLuigi Rizzo  *                           -= VALE =-
3534bf50f18SLuigi Rizzo  *
354847bf383SLuigi Rizzo  *   INCOMING:
3554bf50f18SLuigi Rizzo  *
356847bf383SLuigi Rizzo  *      - VALE ports:
357847bf383SLuigi Rizzo  *          ioctl(NIOCTXSYNC)/netmap_poll() in process context
358847bf383SLuigi Rizzo  *              kring->nm_sync() == netmap_vp_txsync()
3594bf50f18SLuigi Rizzo  *
360847bf383SLuigi Rizzo  *      - system device with native support:
361847bf383SLuigi Rizzo  *         from cable:
362847bf383SLuigi Rizzo  *             interrupt
363847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr != host ring)
364847bf383SLuigi Rizzo  *                     kring->nm_sync() == DEVICE_netmap_rxsync()
365847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
366847bf383SLuigi Rizzo  *                     kring->nm_sync() == DEVICE_netmap_rxsync()
367847bf383SLuigi Rizzo  *         from host stack:
368847bf383SLuigi Rizzo  *             netmap_transmit()
369847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr == host ring)
37037e3a6d3SLuigi Rizzo  *                     kring->nm_sync() == netmap_rxsync_from_host()
371847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
3724bf50f18SLuigi Rizzo  *
373847bf383SLuigi Rizzo  *      - system device with generic support:
374847bf383SLuigi Rizzo  *         from device driver:
375847bf383SLuigi Rizzo  *            generic_rx_handler()
376847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr != host ring)
377847bf383SLuigi Rizzo  *                     kring->nm_sync() == generic_netmap_rxsync()
378847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
379847bf383SLuigi Rizzo  *                     kring->nm_sync() == generic_netmap_rxsync()
380847bf383SLuigi Rizzo  *         from host stack:
381847bf383SLuigi Rizzo  *            netmap_transmit()
382847bf383SLuigi Rizzo  *                na->nm_notify() == netmap_bwrap_intr_notify(ring_nr == host ring)
38337e3a6d3SLuigi Rizzo  *                     kring->nm_sync() == netmap_rxsync_from_host()
384847bf383SLuigi Rizzo  *                     netmap_vp_txsync()
3854bf50f18SLuigi Rizzo  *
386847bf383SLuigi Rizzo  *   (all cases) --> nm_bdg_flush()
387847bf383SLuigi Rizzo  *                      dest_na->nm_notify() == (see below)
3884bf50f18SLuigi Rizzo  *
389847bf383SLuigi Rizzo  *   OUTGOING:
3904bf50f18SLuigi Rizzo  *
391847bf383SLuigi Rizzo  *      - VALE ports:
392847bf383SLuigi Rizzo  *         concurrently:
393c3e9b4dbSLuiz Otavio O Souza  *             1) ioctl(NIOCRXSYNC)/netmap_poll() in process context
394847bf383SLuigi Rizzo  *                    kring->nm_sync() == netmap_vp_rxsync()
395847bf383SLuigi Rizzo  *             2) from nm_bdg_flush()
396847bf383SLuigi Rizzo  *                    na->nm_notify() == netmap_notify()
3974bf50f18SLuigi Rizzo  *
398847bf383SLuigi Rizzo  *      - system device with native support:
399847bf383SLuigi Rizzo  *          to cable:
400847bf383SLuigi Rizzo  *             na->nm_notify() == netmap_bwrap_notify()
401847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
402847bf383SLuigi Rizzo  *                 kring->nm_sync() == DEVICE_netmap_txsync()
403847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
404847bf383SLuigi Rizzo  *          to host stack:
405847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
40637e3a6d3SLuigi Rizzo  *                 kring->nm_sync() == netmap_txsync_to_host
407847bf383SLuigi Rizzo  *                 netmap_vp_rxsync_locked()
4084bf50f18SLuigi Rizzo  *
409847bf383SLuigi Rizzo  *      - system device with generic adapter:
410847bf383SLuigi Rizzo  *          to device driver:
411847bf383SLuigi Rizzo  *             na->nm_notify() == netmap_bwrap_notify()
412847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
413847bf383SLuigi Rizzo  *                 kring->nm_sync() == generic_netmap_txsync()
414847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
415847bf383SLuigi Rizzo  *          to host stack:
416847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
41737e3a6d3SLuigi Rizzo  *                 kring->nm_sync() == netmap_txsync_to_host
418847bf383SLuigi Rizzo  *                 netmap_vp_rxsync()
4194bf50f18SLuigi Rizzo  *
4204bf50f18SLuigi Rizzo  */
4214bf50f18SLuigi Rizzo 
422ce3ee1e7SLuigi Rizzo /*
423ce3ee1e7SLuigi Rizzo  * OS-specific code that is used only within this file.
424ce3ee1e7SLuigi Rizzo  * Other OS-specific code that must be accessed by drivers
425ce3ee1e7SLuigi Rizzo  * is present in netmap_kern.h
426ce3ee1e7SLuigi Rizzo  */
42701c7d25fSLuigi Rizzo 
428ce3ee1e7SLuigi Rizzo #if defined(__FreeBSD__)
42968b8534bSLuigi Rizzo #include <sys/cdefs.h> /* prerequisite */
43068b8534bSLuigi Rizzo #include <sys/types.h>
43168b8534bSLuigi Rizzo #include <sys/errno.h>
43268b8534bSLuigi Rizzo #include <sys/param.h>	/* defines used in kernel.h */
43368b8534bSLuigi Rizzo #include <sys/kernel.h>	/* types used in module initialization */
434f9790aebSLuigi Rizzo #include <sys/conf.h>	/* cdevsw struct, UID, GID */
43589e3fd52SLuigi Rizzo #include <sys/filio.h>	/* FIONBIO */
43668b8534bSLuigi Rizzo #include <sys/sockio.h>
43768b8534bSLuigi Rizzo #include <sys/socketvar.h>	/* struct socket */
43868b8534bSLuigi Rizzo #include <sys/malloc.h>
43968b8534bSLuigi Rizzo #include <sys/poll.h>
44089f6b863SAttilio Rao #include <sys/rwlock.h>
44168b8534bSLuigi Rizzo #include <sys/socket.h> /* sockaddrs */
44268b8534bSLuigi Rizzo #include <sys/selinfo.h>
44368b8534bSLuigi Rizzo #include <sys/sysctl.h>
444339f59c0SGleb Smirnoff #include <sys/jail.h>
445339f59c0SGleb Smirnoff #include <net/vnet.h>
44668b8534bSLuigi Rizzo #include <net/if.h>
44776039bc8SGleb Smirnoff #include <net/if_var.h>
44868b8534bSLuigi Rizzo #include <net/bpf.h>		/* BIOCIMMEDIATE */
44968b8534bSLuigi Rizzo #include <machine/bus.h>	/* bus_dmamap_* */
450ce3ee1e7SLuigi Rizzo #include <sys/endian.h>
451ce3ee1e7SLuigi Rizzo #include <sys/refcount.h>
45268b8534bSLuigi Rizzo 
45368b8534bSLuigi Rizzo 
454ce3ee1e7SLuigi Rizzo #elif defined(linux)
455ce3ee1e7SLuigi Rizzo 
456ce3ee1e7SLuigi Rizzo #include "bsd_glue.h"
457ce3ee1e7SLuigi Rizzo 
458ce3ee1e7SLuigi Rizzo #elif defined(__APPLE__)
459ce3ee1e7SLuigi Rizzo 
460ce3ee1e7SLuigi Rizzo #warning OSX support is only partial
461ce3ee1e7SLuigi Rizzo #include "osx_glue.h"
462ce3ee1e7SLuigi Rizzo 
46337e3a6d3SLuigi Rizzo #elif defined (_WIN32)
46437e3a6d3SLuigi Rizzo 
46537e3a6d3SLuigi Rizzo #include "win_glue.h"
46637e3a6d3SLuigi Rizzo 
467ce3ee1e7SLuigi Rizzo #else
468ce3ee1e7SLuigi Rizzo 
469ce3ee1e7SLuigi Rizzo #error	Unsupported platform
470ce3ee1e7SLuigi Rizzo 
471ce3ee1e7SLuigi Rizzo #endif /* unsupported */
472ce3ee1e7SLuigi Rizzo 
473ce3ee1e7SLuigi Rizzo /*
474ce3ee1e7SLuigi Rizzo  * common headers
475ce3ee1e7SLuigi Rizzo  */
4760b8ed8e0SLuigi Rizzo #include <net/netmap.h>
4770b8ed8e0SLuigi Rizzo #include <dev/netmap/netmap_kern.h>
478ce3ee1e7SLuigi Rizzo #include <dev/netmap/netmap_mem2.h>
4790b8ed8e0SLuigi Rizzo 
480ce3ee1e7SLuigi Rizzo 
4815819da83SLuigi Rizzo /* user-controlled variables */
4825819da83SLuigi Rizzo int netmap_verbose;
4835819da83SLuigi Rizzo 
4845819da83SLuigi Rizzo static int netmap_no_timestamp; /* don't timestamp on rxsync */
4855819da83SLuigi Rizzo int netmap_mitigate = 1;
486c85cb1a0SLuigi Rizzo int netmap_no_pendintr = 1;
487f18be576SLuigi Rizzo int netmap_txsync_retry = 2;
488f196ce38SLuigi Rizzo int netmap_flags = 0;	/* debug flags */
489c3e9b4dbSLuiz Otavio O Souza static int netmap_fwd = 0;	/* force transparent forwarding */
490f196ce38SLuigi Rizzo 
491f9790aebSLuigi Rizzo /*
492f9790aebSLuigi Rizzo  * netmap_admode selects the netmap mode to use.
493f9790aebSLuigi Rizzo  * Invalid values are reset to NETMAP_ADMODE_BEST
494f9790aebSLuigi Rizzo  */
495f9790aebSLuigi Rizzo enum {	NETMAP_ADMODE_BEST = 0,	/* use native, fallback to generic */
496f9790aebSLuigi Rizzo 	NETMAP_ADMODE_NATIVE,	/* either native or none */
497f9790aebSLuigi Rizzo 	NETMAP_ADMODE_GENERIC,	/* force generic */
498f9790aebSLuigi Rizzo 	NETMAP_ADMODE_LAST };
499f9790aebSLuigi Rizzo static int netmap_admode = NETMAP_ADMODE_BEST;
500f9790aebSLuigi Rizzo 
50137e3a6d3SLuigi Rizzo /* netmap_generic_mit controls mitigation of RX notifications for
50237e3a6d3SLuigi Rizzo  * the generic netmap adapter. The value is a time interval in
50337e3a6d3SLuigi Rizzo  * nanoseconds. */
50437e3a6d3SLuigi Rizzo int netmap_generic_mit = 100*1000;
50537e3a6d3SLuigi Rizzo 
50637e3a6d3SLuigi Rizzo /* We use by default netmap-aware qdiscs with generic netmap adapters,
50737e3a6d3SLuigi Rizzo  * even if there can be a little performance hit with hardware NICs.
50837e3a6d3SLuigi Rizzo  * However, using the qdisc is the safer approach, for two reasons:
50937e3a6d3SLuigi Rizzo  * 1) it prevents non-fifo qdiscs to break the TX notification
51037e3a6d3SLuigi Rizzo  *    scheme, which is based on mbuf destructors when txqdisc is
51137e3a6d3SLuigi Rizzo  *    not used.
51237e3a6d3SLuigi Rizzo  * 2) it makes it possible to transmit over software devices that
51337e3a6d3SLuigi Rizzo  *    change skb->dev, like bridge, veth, ...
51437e3a6d3SLuigi Rizzo  *
51537e3a6d3SLuigi Rizzo  * Anyway users looking for the best performance should
51637e3a6d3SLuigi Rizzo  * use native adapters.
51737e3a6d3SLuigi Rizzo  */
51837e3a6d3SLuigi Rizzo int netmap_generic_txqdisc = 1;
51937e3a6d3SLuigi Rizzo 
52037e3a6d3SLuigi Rizzo /* Default number of slots and queues for generic adapters. */
52137e3a6d3SLuigi Rizzo int netmap_generic_ringsize = 1024;
52237e3a6d3SLuigi Rizzo int netmap_generic_rings = 1;
52337e3a6d3SLuigi Rizzo 
52437e3a6d3SLuigi Rizzo /* Non-zero if ptnet devices are allowed to use virtio-net headers. */
52537e3a6d3SLuigi Rizzo int ptnet_vnet_hdr = 1;
52637e3a6d3SLuigi Rizzo 
527c3e9b4dbSLuiz Otavio O Souza /* 0 if ptnetmap should not use worker threads for TX processing */
528c3e9b4dbSLuiz Otavio O Souza int ptnetmap_tx_workers = 1;
529c3e9b4dbSLuiz Otavio O Souza 
53037e3a6d3SLuigi Rizzo /*
53137e3a6d3SLuigi Rizzo  * SYSCTL calls are grouped between SYSBEGIN and SYSEND to be emulated
53237e3a6d3SLuigi Rizzo  * in some other operating systems
53337e3a6d3SLuigi Rizzo  */
53437e3a6d3SLuigi Rizzo SYSBEGIN(main_init);
53537e3a6d3SLuigi Rizzo 
53637e3a6d3SLuigi Rizzo SYSCTL_DECL(_dev_netmap);
53737e3a6d3SLuigi Rizzo SYSCTL_NODE(_dev, OID_AUTO, netmap, CTLFLAG_RW, 0, "Netmap args");
53837e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, verbose,
53937e3a6d3SLuigi Rizzo     CTLFLAG_RW, &netmap_verbose, 0, "Verbose mode");
54037e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, no_timestamp,
54137e3a6d3SLuigi Rizzo     CTLFLAG_RW, &netmap_no_timestamp, 0, "no_timestamp");
54237e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, mitigate, CTLFLAG_RW, &netmap_mitigate, 0, "");
54337e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, no_pendintr,
54437e3a6d3SLuigi Rizzo     CTLFLAG_RW, &netmap_no_pendintr, 0, "Always look for new received packets.");
54537e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, txsync_retry, CTLFLAG_RW,
54637e3a6d3SLuigi Rizzo     &netmap_txsync_retry, 0 , "Number of txsync loops in bridge's flush.");
547f9790aebSLuigi Rizzo 
548f196ce38SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, flags, CTLFLAG_RW, &netmap_flags, 0 , "");
549091fd0abSLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, fwd, CTLFLAG_RW, &netmap_fwd, 0 , "");
550f9790aebSLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, admode, CTLFLAG_RW, &netmap_admode, 0 , "");
551f9790aebSLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, generic_mit, CTLFLAG_RW, &netmap_generic_mit, 0 , "");
552f9790aebSLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, generic_ringsize, CTLFLAG_RW, &netmap_generic_ringsize, 0 , "");
553f0ea3689SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, generic_rings, CTLFLAG_RW, &netmap_generic_rings, 0 , "");
55437e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, generic_txqdisc, CTLFLAG_RW, &netmap_generic_txqdisc, 0 , "");
55537e3a6d3SLuigi Rizzo SYSCTL_INT(_dev_netmap, OID_AUTO, ptnet_vnet_hdr, CTLFLAG_RW, &ptnet_vnet_hdr, 0 , "");
556c3e9b4dbSLuiz Otavio O Souza SYSCTL_INT(_dev_netmap, OID_AUTO, ptnetmap_tx_workers, CTLFLAG_RW, &ptnetmap_tx_workers, 0 , "");
55737e3a6d3SLuigi Rizzo 
55837e3a6d3SLuigi Rizzo SYSEND;
559f196ce38SLuigi Rizzo 
560ce3ee1e7SLuigi Rizzo NMG_LOCK_T	netmap_global_lock;
561ce3ee1e7SLuigi Rizzo 
56217885a7bSLuigi Rizzo /*
56317885a7bSLuigi Rizzo  * mark the ring as stopped, and run through the locks
56417885a7bSLuigi Rizzo  * to make sure other users get to see it.
56537e3a6d3SLuigi Rizzo  * stopped must be either NR_KR_STOPPED (for unbounded stop)
56637e3a6d3SLuigi Rizzo  * of NR_KR_LOCKED (brief stop for mutual exclusion purposes)
56717885a7bSLuigi Rizzo  */
5684bf50f18SLuigi Rizzo static void
56937e3a6d3SLuigi Rizzo netmap_disable_ring(struct netmap_kring *kr, int stopped)
570ce3ee1e7SLuigi Rizzo {
57137e3a6d3SLuigi Rizzo 	nm_kr_stop(kr, stopped);
57237e3a6d3SLuigi Rizzo 	// XXX check if nm_kr_stop is sufficient
573ce3ee1e7SLuigi Rizzo 	mtx_lock(&kr->q_lock);
574ce3ee1e7SLuigi Rizzo 	mtx_unlock(&kr->q_lock);
575ce3ee1e7SLuigi Rizzo 	nm_kr_put(kr);
576ce3ee1e7SLuigi Rizzo }
577ce3ee1e7SLuigi Rizzo 
578847bf383SLuigi Rizzo /* stop or enable a single ring */
5794bf50f18SLuigi Rizzo void
580847bf383SLuigi Rizzo netmap_set_ring(struct netmap_adapter *na, u_int ring_id, enum txrx t, int stopped)
5814bf50f18SLuigi Rizzo {
5824bf50f18SLuigi Rizzo 	if (stopped)
58337e3a6d3SLuigi Rizzo 		netmap_disable_ring(NMR(na, t) + ring_id, stopped);
5844bf50f18SLuigi Rizzo 	else
585847bf383SLuigi Rizzo 		NMR(na, t)[ring_id].nkr_stopped = 0;
5864bf50f18SLuigi Rizzo }
5874bf50f18SLuigi Rizzo 
588f9790aebSLuigi Rizzo 
58989cc2556SLuigi Rizzo /* stop or enable all the rings of na */
5904bf50f18SLuigi Rizzo void
5914bf50f18SLuigi Rizzo netmap_set_all_rings(struct netmap_adapter *na, int stopped)
592ce3ee1e7SLuigi Rizzo {
593ce3ee1e7SLuigi Rizzo 	int i;
594847bf383SLuigi Rizzo 	enum txrx t;
595ce3ee1e7SLuigi Rizzo 
5964bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na))
597ce3ee1e7SLuigi Rizzo 		return;
598ce3ee1e7SLuigi Rizzo 
599847bf383SLuigi Rizzo 	for_rx_tx(t) {
600847bf383SLuigi Rizzo 		for (i = 0; i < netmap_real_rings(na, t); i++) {
601847bf383SLuigi Rizzo 			netmap_set_ring(na, i, t, stopped);
602ce3ee1e7SLuigi Rizzo 		}
603ce3ee1e7SLuigi Rizzo 	}
604ce3ee1e7SLuigi Rizzo }
605ce3ee1e7SLuigi Rizzo 
60689cc2556SLuigi Rizzo /*
60789cc2556SLuigi Rizzo  * Convenience function used in drivers.  Waits for current txsync()s/rxsync()s
60889cc2556SLuigi Rizzo  * to finish and prevents any new one from starting.  Call this before turning
609ddb13598SKevin Lo  * netmap mode off, or before removing the hardware rings (e.g., on module
61037e3a6d3SLuigi Rizzo  * onload).
61189cc2556SLuigi Rizzo  */
612f9790aebSLuigi Rizzo void
613f9790aebSLuigi Rizzo netmap_disable_all_rings(struct ifnet *ifp)
614f9790aebSLuigi Rizzo {
61537e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
61637e3a6d3SLuigi Rizzo 		netmap_set_all_rings(NA(ifp), NM_KR_STOPPED);
61737e3a6d3SLuigi Rizzo 	}
618f9790aebSLuigi Rizzo }
619f9790aebSLuigi Rizzo 
62089cc2556SLuigi Rizzo /*
62189cc2556SLuigi Rizzo  * Convenience function used in drivers.  Re-enables rxsync and txsync on the
62289cc2556SLuigi Rizzo  * adapter's rings In linux drivers, this should be placed near each
62389cc2556SLuigi Rizzo  * napi_enable().
62489cc2556SLuigi Rizzo  */
625f9790aebSLuigi Rizzo void
626f9790aebSLuigi Rizzo netmap_enable_all_rings(struct ifnet *ifp)
627f9790aebSLuigi Rizzo {
62837e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
6294bf50f18SLuigi Rizzo 		netmap_set_all_rings(NA(ifp), 0 /* enabled */);
630f9790aebSLuigi Rizzo 	}
63137e3a6d3SLuigi Rizzo }
632f9790aebSLuigi Rizzo 
63337e3a6d3SLuigi Rizzo void
63437e3a6d3SLuigi Rizzo netmap_make_zombie(struct ifnet *ifp)
63537e3a6d3SLuigi Rizzo {
63637e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
63737e3a6d3SLuigi Rizzo 		struct netmap_adapter *na = NA(ifp);
63837e3a6d3SLuigi Rizzo 		netmap_set_all_rings(na, NM_KR_LOCKED);
63937e3a6d3SLuigi Rizzo 		na->na_flags |= NAF_ZOMBIE;
64037e3a6d3SLuigi Rizzo 		netmap_set_all_rings(na, 0);
64137e3a6d3SLuigi Rizzo 	}
64237e3a6d3SLuigi Rizzo }
64337e3a6d3SLuigi Rizzo 
64437e3a6d3SLuigi Rizzo void
64537e3a6d3SLuigi Rizzo netmap_undo_zombie(struct ifnet *ifp)
64637e3a6d3SLuigi Rizzo {
64737e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
64837e3a6d3SLuigi Rizzo 		struct netmap_adapter *na = NA(ifp);
64937e3a6d3SLuigi Rizzo 		if (na->na_flags & NAF_ZOMBIE) {
65037e3a6d3SLuigi Rizzo 			netmap_set_all_rings(na, NM_KR_LOCKED);
65137e3a6d3SLuigi Rizzo 			na->na_flags &= ~NAF_ZOMBIE;
65237e3a6d3SLuigi Rizzo 			netmap_set_all_rings(na, 0);
65337e3a6d3SLuigi Rizzo 		}
65437e3a6d3SLuigi Rizzo 	}
65537e3a6d3SLuigi Rizzo }
656f9790aebSLuigi Rizzo 
657ce3ee1e7SLuigi Rizzo /*
658ce3ee1e7SLuigi Rizzo  * generic bound_checking function
659ce3ee1e7SLuigi Rizzo  */
660ce3ee1e7SLuigi Rizzo u_int
661ce3ee1e7SLuigi Rizzo nm_bound_var(u_int *v, u_int dflt, u_int lo, u_int hi, const char *msg)
662ce3ee1e7SLuigi Rizzo {
663ce3ee1e7SLuigi Rizzo 	u_int oldv = *v;
664ce3ee1e7SLuigi Rizzo 	const char *op = NULL;
665ce3ee1e7SLuigi Rizzo 
666ce3ee1e7SLuigi Rizzo 	if (dflt < lo)
667ce3ee1e7SLuigi Rizzo 		dflt = lo;
668ce3ee1e7SLuigi Rizzo 	if (dflt > hi)
669ce3ee1e7SLuigi Rizzo 		dflt = hi;
670ce3ee1e7SLuigi Rizzo 	if (oldv < lo) {
671ce3ee1e7SLuigi Rizzo 		*v = dflt;
672ce3ee1e7SLuigi Rizzo 		op = "Bump";
673ce3ee1e7SLuigi Rizzo 	} else if (oldv > hi) {
674ce3ee1e7SLuigi Rizzo 		*v = hi;
675ce3ee1e7SLuigi Rizzo 		op = "Clamp";
676ce3ee1e7SLuigi Rizzo 	}
677ce3ee1e7SLuigi Rizzo 	if (op && msg)
678c3e9b4dbSLuiz Otavio O Souza 		nm_prinf("%s %s to %d (was %d)\n", op, msg, *v, oldv);
679ce3ee1e7SLuigi Rizzo 	return *v;
680ce3ee1e7SLuigi Rizzo }
681ce3ee1e7SLuigi Rizzo 
682f9790aebSLuigi Rizzo 
683ce3ee1e7SLuigi Rizzo /*
684ce3ee1e7SLuigi Rizzo  * packet-dump function, user-supplied or static buffer.
685ce3ee1e7SLuigi Rizzo  * The destination buffer must be at least 30+4*len
686ce3ee1e7SLuigi Rizzo  */
687ce3ee1e7SLuigi Rizzo const char *
688ce3ee1e7SLuigi Rizzo nm_dump_buf(char *p, int len, int lim, char *dst)
689ce3ee1e7SLuigi Rizzo {
690ce3ee1e7SLuigi Rizzo 	static char _dst[8192];
691ce3ee1e7SLuigi Rizzo 	int i, j, i0;
692ce3ee1e7SLuigi Rizzo 	static char hex[] ="0123456789abcdef";
693ce3ee1e7SLuigi Rizzo 	char *o;	/* output position */
694ce3ee1e7SLuigi Rizzo 
695ce3ee1e7SLuigi Rizzo #define P_HI(x)	hex[((x) & 0xf0)>>4]
696ce3ee1e7SLuigi Rizzo #define P_LO(x)	hex[((x) & 0xf)]
697ce3ee1e7SLuigi Rizzo #define P_C(x)	((x) >= 0x20 && (x) <= 0x7e ? (x) : '.')
698ce3ee1e7SLuigi Rizzo 	if (!dst)
699ce3ee1e7SLuigi Rizzo 		dst = _dst;
700ce3ee1e7SLuigi Rizzo 	if (lim <= 0 || lim > len)
701ce3ee1e7SLuigi Rizzo 		lim = len;
702ce3ee1e7SLuigi Rizzo 	o = dst;
703ce3ee1e7SLuigi Rizzo 	sprintf(o, "buf 0x%p len %d lim %d\n", p, len, lim);
704ce3ee1e7SLuigi Rizzo 	o += strlen(o);
705ce3ee1e7SLuigi Rizzo 	/* hexdump routine */
706ce3ee1e7SLuigi Rizzo 	for (i = 0; i < lim; ) {
707ce3ee1e7SLuigi Rizzo 		sprintf(o, "%5d: ", i);
708ce3ee1e7SLuigi Rizzo 		o += strlen(o);
709ce3ee1e7SLuigi Rizzo 		memset(o, ' ', 48);
710ce3ee1e7SLuigi Rizzo 		i0 = i;
711ce3ee1e7SLuigi Rizzo 		for (j=0; j < 16 && i < lim; i++, j++) {
712ce3ee1e7SLuigi Rizzo 			o[j*3] = P_HI(p[i]);
713ce3ee1e7SLuigi Rizzo 			o[j*3+1] = P_LO(p[i]);
714ce3ee1e7SLuigi Rizzo 		}
715ce3ee1e7SLuigi Rizzo 		i = i0;
716ce3ee1e7SLuigi Rizzo 		for (j=0; j < 16 && i < lim; i++, j++)
717ce3ee1e7SLuigi Rizzo 			o[j + 48] = P_C(p[i]);
718ce3ee1e7SLuigi Rizzo 		o[j+48] = '\n';
719ce3ee1e7SLuigi Rizzo 		o += j+49;
720ce3ee1e7SLuigi Rizzo 	}
721ce3ee1e7SLuigi Rizzo 	*o = '\0';
722ce3ee1e7SLuigi Rizzo #undef P_HI
723ce3ee1e7SLuigi Rizzo #undef P_LO
724ce3ee1e7SLuigi Rizzo #undef P_C
725ce3ee1e7SLuigi Rizzo 	return dst;
726ce3ee1e7SLuigi Rizzo }
727f196ce38SLuigi Rizzo 
728f18be576SLuigi Rizzo 
729ae10d1afSLuigi Rizzo /*
730ae10d1afSLuigi Rizzo  * Fetch configuration from the device, to cope with dynamic
731ae10d1afSLuigi Rizzo  * reconfigurations after loading the module.
732ae10d1afSLuigi Rizzo  */
73389cc2556SLuigi Rizzo /* call with NMG_LOCK held */
734f9790aebSLuigi Rizzo int
735ae10d1afSLuigi Rizzo netmap_update_config(struct netmap_adapter *na)
736ae10d1afSLuigi Rizzo {
737ae10d1afSLuigi Rizzo 	u_int txr, txd, rxr, rxd;
738ae10d1afSLuigi Rizzo 
739ae10d1afSLuigi Rizzo 	txr = txd = rxr = rxd = 0;
7406641c68bSLuigi Rizzo 	if (na->nm_config == NULL ||
741847bf383SLuigi Rizzo 	    na->nm_config(na, &txr, &txd, &rxr, &rxd))
742847bf383SLuigi Rizzo 	{
743ae10d1afSLuigi Rizzo 		/* take whatever we had at init time */
744ae10d1afSLuigi Rizzo 		txr = na->num_tx_rings;
745ae10d1afSLuigi Rizzo 		txd = na->num_tx_desc;
746ae10d1afSLuigi Rizzo 		rxr = na->num_rx_rings;
747ae10d1afSLuigi Rizzo 		rxd = na->num_rx_desc;
748ae10d1afSLuigi Rizzo 	}
749ae10d1afSLuigi Rizzo 
750ae10d1afSLuigi Rizzo 	if (na->num_tx_rings == txr && na->num_tx_desc == txd &&
751ae10d1afSLuigi Rizzo 	    na->num_rx_rings == rxr && na->num_rx_desc == rxd)
752ae10d1afSLuigi Rizzo 		return 0; /* nothing changed */
753f9790aebSLuigi Rizzo 	if (netmap_verbose || na->active_fds > 0) {
754ae10d1afSLuigi Rizzo 		D("stored config %s: txring %d x %d, rxring %d x %d",
7554bf50f18SLuigi Rizzo 			na->name,
756ae10d1afSLuigi Rizzo 			na->num_tx_rings, na->num_tx_desc,
757ae10d1afSLuigi Rizzo 			na->num_rx_rings, na->num_rx_desc);
758ae10d1afSLuigi Rizzo 		D("new config %s: txring %d x %d, rxring %d x %d",
7594bf50f18SLuigi Rizzo 			na->name, txr, txd, rxr, rxd);
760ae10d1afSLuigi Rizzo 	}
761f9790aebSLuigi Rizzo 	if (na->active_fds == 0) {
762ae10d1afSLuigi Rizzo 		D("configuration changed (but fine)");
763ae10d1afSLuigi Rizzo 		na->num_tx_rings = txr;
764ae10d1afSLuigi Rizzo 		na->num_tx_desc = txd;
765ae10d1afSLuigi Rizzo 		na->num_rx_rings = rxr;
766ae10d1afSLuigi Rizzo 		na->num_rx_desc = rxd;
767ae10d1afSLuigi Rizzo 		return 0;
768ae10d1afSLuigi Rizzo 	}
769ae10d1afSLuigi Rizzo 	D("configuration changed while active, this is bad...");
770ae10d1afSLuigi Rizzo 	return 1;
771ae10d1afSLuigi Rizzo }
772ae10d1afSLuigi Rizzo 
77337e3a6d3SLuigi Rizzo /* nm_sync callbacks for the host rings */
77437e3a6d3SLuigi Rizzo static int netmap_txsync_to_host(struct netmap_kring *kring, int flags);
77537e3a6d3SLuigi Rizzo static int netmap_rxsync_from_host(struct netmap_kring *kring, int flags);
776f0ea3689SLuigi Rizzo 
777f0ea3689SLuigi Rizzo /* create the krings array and initialize the fields common to all adapters.
778f0ea3689SLuigi Rizzo  * The array layout is this:
779f0ea3689SLuigi Rizzo  *
780f0ea3689SLuigi Rizzo  *                    +----------+
781f0ea3689SLuigi Rizzo  * na->tx_rings ----->|          | \
782f0ea3689SLuigi Rizzo  *                    |          |  } na->num_tx_ring
783f0ea3689SLuigi Rizzo  *                    |          | /
784f0ea3689SLuigi Rizzo  *                    +----------+
785f0ea3689SLuigi Rizzo  *                    |          |    host tx kring
786f0ea3689SLuigi Rizzo  * na->rx_rings ----> +----------+
787f0ea3689SLuigi Rizzo  *                    |          | \
788f0ea3689SLuigi Rizzo  *                    |          |  } na->num_rx_rings
789f0ea3689SLuigi Rizzo  *                    |          | /
790f0ea3689SLuigi Rizzo  *                    +----------+
791f0ea3689SLuigi Rizzo  *                    |          |    host rx kring
792f0ea3689SLuigi Rizzo  *                    +----------+
793f0ea3689SLuigi Rizzo  * na->tailroom ----->|          | \
794f0ea3689SLuigi Rizzo  *                    |          |  } tailroom bytes
795f0ea3689SLuigi Rizzo  *                    |          | /
796f0ea3689SLuigi Rizzo  *                    +----------+
797f0ea3689SLuigi Rizzo  *
798f0ea3689SLuigi Rizzo  * Note: for compatibility, host krings are created even when not needed.
799f0ea3689SLuigi Rizzo  * The tailroom space is currently used by vale ports for allocating leases.
800f0ea3689SLuigi Rizzo  */
80189cc2556SLuigi Rizzo /* call with NMG_LOCK held */
802f9790aebSLuigi Rizzo int
803f0ea3689SLuigi Rizzo netmap_krings_create(struct netmap_adapter *na, u_int tailroom)
804f9790aebSLuigi Rizzo {
805f9790aebSLuigi Rizzo 	u_int i, len, ndesc;
806f9790aebSLuigi Rizzo 	struct netmap_kring *kring;
807847bf383SLuigi Rizzo 	u_int n[NR_TXRX];
808847bf383SLuigi Rizzo 	enum txrx t;
809f9790aebSLuigi Rizzo 
810c3e9b4dbSLuiz Otavio O Souza 	if (na->tx_rings != NULL) {
811c3e9b4dbSLuiz Otavio O Souza 		D("warning: krings were already created");
812c3e9b4dbSLuiz Otavio O Souza 		return 0;
813c3e9b4dbSLuiz Otavio O Souza 	}
814c3e9b4dbSLuiz Otavio O Souza 
815f0ea3689SLuigi Rizzo 	/* account for the (possibly fake) host rings */
816847bf383SLuigi Rizzo 	n[NR_TX] = na->num_tx_rings + 1;
817847bf383SLuigi Rizzo 	n[NR_RX] = na->num_rx_rings + 1;
818f0ea3689SLuigi Rizzo 
819847bf383SLuigi Rizzo 	len = (n[NR_TX] + n[NR_RX]) * sizeof(struct netmap_kring) + tailroom;
820f9790aebSLuigi Rizzo 
821c3e9b4dbSLuiz Otavio O Souza 	na->tx_rings = nm_os_malloc((size_t)len);
822f9790aebSLuigi Rizzo 	if (na->tx_rings == NULL) {
823f9790aebSLuigi Rizzo 		D("Cannot allocate krings");
824f9790aebSLuigi Rizzo 		return ENOMEM;
825f9790aebSLuigi Rizzo 	}
826847bf383SLuigi Rizzo 	na->rx_rings = na->tx_rings + n[NR_TX];
827f9790aebSLuigi Rizzo 
82817885a7bSLuigi Rizzo 	/*
82917885a7bSLuigi Rizzo 	 * All fields in krings are 0 except the one initialized below.
83017885a7bSLuigi Rizzo 	 * but better be explicit on important kring fields.
83117885a7bSLuigi Rizzo 	 */
832847bf383SLuigi Rizzo 	for_rx_tx(t) {
833847bf383SLuigi Rizzo 		ndesc = nma_get_ndesc(na, t);
834847bf383SLuigi Rizzo 		for (i = 0; i < n[t]; i++) {
835847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
836f9790aebSLuigi Rizzo 			bzero(kring, sizeof(*kring));
837f9790aebSLuigi Rizzo 			kring->na = na;
83817885a7bSLuigi Rizzo 			kring->ring_id = i;
839847bf383SLuigi Rizzo 			kring->tx = t;
840f9790aebSLuigi Rizzo 			kring->nkr_num_slots = ndesc;
84137e3a6d3SLuigi Rizzo 			kring->nr_mode = NKR_NETMAP_OFF;
84237e3a6d3SLuigi Rizzo 			kring->nr_pending_mode = NKR_NETMAP_OFF;
843847bf383SLuigi Rizzo 			if (i < nma_get_nrings(na, t)) {
844847bf383SLuigi Rizzo 				kring->nm_sync = (t == NR_TX ? na->nm_txsync : na->nm_rxsync);
84537e3a6d3SLuigi Rizzo 			} else {
846847bf383SLuigi Rizzo 				kring->nm_sync = (t == NR_TX ?
84737e3a6d3SLuigi Rizzo 						netmap_txsync_to_host:
84837e3a6d3SLuigi Rizzo 						netmap_rxsync_from_host);
849f0ea3689SLuigi Rizzo 			}
850847bf383SLuigi Rizzo 			kring->nm_notify = na->nm_notify;
851847bf383SLuigi Rizzo 			kring->rhead = kring->rcur = kring->nr_hwcur = 0;
852f9790aebSLuigi Rizzo 			/*
85317885a7bSLuigi Rizzo 			 * IMPORTANT: Always keep one slot empty.
854f9790aebSLuigi Rizzo 			 */
855847bf383SLuigi Rizzo 			kring->rtail = kring->nr_hwtail = (t == NR_TX ? ndesc - 1 : 0);
856847bf383SLuigi Rizzo 			snprintf(kring->name, sizeof(kring->name) - 1, "%s %s%d", na->name,
857847bf383SLuigi Rizzo 					nm_txrx2str(t), i);
858f0ea3689SLuigi Rizzo 			ND("ktx %s h %d c %d t %d",
859f0ea3689SLuigi Rizzo 				kring->name, kring->rhead, kring->rcur, kring->rtail);
860847bf383SLuigi Rizzo 			mtx_init(&kring->q_lock, (t == NR_TX ? "nm_txq_lock" : "nm_rxq_lock"), NULL, MTX_DEF);
86137e3a6d3SLuigi Rizzo 			nm_os_selinfo_init(&kring->si);
862f9790aebSLuigi Rizzo 		}
86337e3a6d3SLuigi Rizzo 		nm_os_selinfo_init(&na->si[t]);
864f0ea3689SLuigi Rizzo 	}
865f9790aebSLuigi Rizzo 
866847bf383SLuigi Rizzo 	na->tailroom = na->rx_rings + n[NR_RX];
867f9790aebSLuigi Rizzo 
868f9790aebSLuigi Rizzo 	return 0;
869f9790aebSLuigi Rizzo }
870f9790aebSLuigi Rizzo 
871f9790aebSLuigi Rizzo 
872f0ea3689SLuigi Rizzo /* undo the actions performed by netmap_krings_create */
87389cc2556SLuigi Rizzo /* call with NMG_LOCK held */
874f9790aebSLuigi Rizzo void
875f9790aebSLuigi Rizzo netmap_krings_delete(struct netmap_adapter *na)
876f9790aebSLuigi Rizzo {
877f0ea3689SLuigi Rizzo 	struct netmap_kring *kring = na->tx_rings;
878847bf383SLuigi Rizzo 	enum txrx t;
879847bf383SLuigi Rizzo 
880c3e9b4dbSLuiz Otavio O Souza 	if (na->tx_rings == NULL) {
881c3e9b4dbSLuiz Otavio O Souza 		D("warning: krings were already deleted");
882c3e9b4dbSLuiz Otavio O Souza 		return;
883c3e9b4dbSLuiz Otavio O Souza 	}
884c3e9b4dbSLuiz Otavio O Souza 
885847bf383SLuigi Rizzo 	for_rx_tx(t)
88637e3a6d3SLuigi Rizzo 		nm_os_selinfo_uninit(&na->si[t]);
887f9790aebSLuigi Rizzo 
888f0ea3689SLuigi Rizzo 	/* we rely on the krings layout described above */
889f0ea3689SLuigi Rizzo 	for ( ; kring != na->tailroom; kring++) {
890f0ea3689SLuigi Rizzo 		mtx_destroy(&kring->q_lock);
89137e3a6d3SLuigi Rizzo 		nm_os_selinfo_uninit(&kring->si);
892f9790aebSLuigi Rizzo 	}
893c3e9b4dbSLuiz Otavio O Souza 	nm_os_free(na->tx_rings);
894f9790aebSLuigi Rizzo 	na->tx_rings = na->rx_rings = na->tailroom = NULL;
895f9790aebSLuigi Rizzo }
896f9790aebSLuigi Rizzo 
897f9790aebSLuigi Rizzo 
89817885a7bSLuigi Rizzo /*
89917885a7bSLuigi Rizzo  * Destructor for NIC ports. They also have an mbuf queue
90017885a7bSLuigi Rizzo  * on the rings connected to the host so we need to purge
90117885a7bSLuigi Rizzo  * them first.
90217885a7bSLuigi Rizzo  */
90389cc2556SLuigi Rizzo /* call with NMG_LOCK held */
90437e3a6d3SLuigi Rizzo void
90517885a7bSLuigi Rizzo netmap_hw_krings_delete(struct netmap_adapter *na)
90617885a7bSLuigi Rizzo {
90717885a7bSLuigi Rizzo 	struct mbq *q = &na->rx_rings[na->num_rx_rings].rx_queue;
90817885a7bSLuigi Rizzo 
90917885a7bSLuigi Rizzo 	ND("destroy sw mbq with len %d", mbq_len(q));
91017885a7bSLuigi Rizzo 	mbq_purge(q);
91137e3a6d3SLuigi Rizzo 	mbq_safe_fini(q);
91217885a7bSLuigi Rizzo 	netmap_krings_delete(na);
91317885a7bSLuigi Rizzo }
91417885a7bSLuigi Rizzo 
91517885a7bSLuigi Rizzo 
916f9790aebSLuigi Rizzo 
91768b8534bSLuigi Rizzo /*
918847bf383SLuigi Rizzo  * Undo everything that was done in netmap_do_regif(). In particular,
919847bf383SLuigi Rizzo  * call nm_register(ifp,0) to stop netmap mode on the interface and
9204bf50f18SLuigi Rizzo  * revert to normal operation.
92168b8534bSLuigi Rizzo  */
922ce3ee1e7SLuigi Rizzo /* call with NMG_LOCK held */
923847bf383SLuigi Rizzo static void netmap_unset_ringid(struct netmap_priv_d *);
92437e3a6d3SLuigi Rizzo static void netmap_krings_put(struct netmap_priv_d *);
92537e3a6d3SLuigi Rizzo void
926847bf383SLuigi Rizzo netmap_do_unregif(struct netmap_priv_d *priv)
92768b8534bSLuigi Rizzo {
928f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
92968b8534bSLuigi Rizzo 
930ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
931f9790aebSLuigi Rizzo 	na->active_fds--;
93237e3a6d3SLuigi Rizzo 	/* unset nr_pending_mode and possibly release exclusive mode */
93337e3a6d3SLuigi Rizzo 	netmap_krings_put(priv);
934847bf383SLuigi Rizzo 
935847bf383SLuigi Rizzo #ifdef	WITH_MONITOR
93637e3a6d3SLuigi Rizzo 	/* XXX check whether we have to do something with monitor
93737e3a6d3SLuigi Rizzo 	 * when rings change nr_mode. */
93837e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0) {
939847bf383SLuigi Rizzo 		/* walk through all the rings and tell any monitor
940847bf383SLuigi Rizzo 		 * that the port is going to exit netmap mode
941847bf383SLuigi Rizzo 		 */
942847bf383SLuigi Rizzo 		netmap_monitor_stop(na);
94337e3a6d3SLuigi Rizzo 	}
944847bf383SLuigi Rizzo #endif
94537e3a6d3SLuigi Rizzo 
94637e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0 || nm_kring_pending(priv)) {
94737e3a6d3SLuigi Rizzo 		na->nm_register(na, 0);
94837e3a6d3SLuigi Rizzo 	}
94937e3a6d3SLuigi Rizzo 
95037e3a6d3SLuigi Rizzo 	/* delete rings and buffers that are no longer needed */
95137e3a6d3SLuigi Rizzo 	netmap_mem_rings_delete(na);
95237e3a6d3SLuigi Rizzo 
95337e3a6d3SLuigi Rizzo 	if (na->active_fds <= 0) {	/* last instance */
95468b8534bSLuigi Rizzo 		/*
95537e3a6d3SLuigi Rizzo 		 * (TO CHECK) We enter here
956f18be576SLuigi Rizzo 		 * when the last reference to this file descriptor goes
957f18be576SLuigi Rizzo 		 * away. This means we cannot have any pending poll()
958f18be576SLuigi Rizzo 		 * or interrupt routine operating on the structure.
959ce3ee1e7SLuigi Rizzo 		 * XXX The file may be closed in a thread while
960ce3ee1e7SLuigi Rizzo 		 * another thread is using it.
961ce3ee1e7SLuigi Rizzo 		 * Linux keeps the file opened until the last reference
962ce3ee1e7SLuigi Rizzo 		 * by any outstanding ioctl/poll or mmap is gone.
963ce3ee1e7SLuigi Rizzo 		 * FreeBSD does not track mmap()s (but we do) and
964ce3ee1e7SLuigi Rizzo 		 * wakes up any sleeping poll(). Need to check what
965ce3ee1e7SLuigi Rizzo 		 * happens if the close() occurs while a concurrent
966ce3ee1e7SLuigi Rizzo 		 * syscall is running.
96768b8534bSLuigi Rizzo 		 */
96837e3a6d3SLuigi Rizzo 		if (netmap_verbose)
96937e3a6d3SLuigi Rizzo 			D("deleting last instance for %s", na->name);
97037e3a6d3SLuigi Rizzo 
97137e3a6d3SLuigi Rizzo                 if (nm_netmap_on(na)) {
97237e3a6d3SLuigi Rizzo                     D("BUG: netmap on while going to delete the krings");
97337e3a6d3SLuigi Rizzo                 }
97437e3a6d3SLuigi Rizzo 
975f9790aebSLuigi Rizzo 		na->nm_krings_delete(na);
97668b8534bSLuigi Rizzo 	}
97737e3a6d3SLuigi Rizzo 
978847bf383SLuigi Rizzo 	/* possibily decrement counter of tx_si/rx_si users */
979847bf383SLuigi Rizzo 	netmap_unset_ringid(priv);
980f9790aebSLuigi Rizzo 	/* delete the nifp */
981847bf383SLuigi Rizzo 	netmap_mem_if_delete(na, priv->np_nifp);
982847bf383SLuigi Rizzo 	/* drop the allocator */
983847bf383SLuigi Rizzo 	netmap_mem_deref(na->nm_mem, na);
984847bf383SLuigi Rizzo 	/* mark the priv as unregistered */
985847bf383SLuigi Rizzo 	priv->np_na = NULL;
986847bf383SLuigi Rizzo 	priv->np_nifp = NULL;
9875819da83SLuigi Rizzo }
98868b8534bSLuigi Rizzo 
98989cc2556SLuigi Rizzo /* call with NMG_LOCK held */
990f0ea3689SLuigi Rizzo static __inline int
991847bf383SLuigi Rizzo nm_si_user(struct netmap_priv_d *priv, enum txrx t)
992f0ea3689SLuigi Rizzo {
993f0ea3689SLuigi Rizzo 	return (priv->np_na != NULL &&
994847bf383SLuigi Rizzo 		(priv->np_qlast[t] - priv->np_qfirst[t] > 1));
995f0ea3689SLuigi Rizzo }
996f0ea3689SLuigi Rizzo 
99737e3a6d3SLuigi Rizzo struct netmap_priv_d*
99837e3a6d3SLuigi Rizzo netmap_priv_new(void)
99937e3a6d3SLuigi Rizzo {
100037e3a6d3SLuigi Rizzo 	struct netmap_priv_d *priv;
100137e3a6d3SLuigi Rizzo 
1002c3e9b4dbSLuiz Otavio O Souza 	priv = nm_os_malloc(sizeof(struct netmap_priv_d));
100337e3a6d3SLuigi Rizzo 	if (priv == NULL)
100437e3a6d3SLuigi Rizzo 		return NULL;
100537e3a6d3SLuigi Rizzo 	priv->np_refs = 1;
100637e3a6d3SLuigi Rizzo 	nm_os_get_module();
100737e3a6d3SLuigi Rizzo 	return priv;
100837e3a6d3SLuigi Rizzo }
100937e3a6d3SLuigi Rizzo 
1010ce3ee1e7SLuigi Rizzo /*
10118fd44c93SLuigi Rizzo  * Destructor of the netmap_priv_d, called when the fd is closed
10128fd44c93SLuigi Rizzo  * Action: undo all the things done by NIOCREGIF,
10138fd44c93SLuigi Rizzo  * On FreeBSD we need to track whether there are active mmap()s,
10148fd44c93SLuigi Rizzo  * and we use np_active_mmaps for that. On linux, the field is always 0.
10158fd44c93SLuigi Rizzo  * Return: 1 if we can free priv, 0 otherwise.
101689cc2556SLuigi Rizzo  *
1017ce3ee1e7SLuigi Rizzo  */
101889cc2556SLuigi Rizzo /* call with NMG_LOCK held */
101937e3a6d3SLuigi Rizzo void
102037e3a6d3SLuigi Rizzo netmap_priv_delete(struct netmap_priv_d *priv)
1021ce3ee1e7SLuigi Rizzo {
1022f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1023ce3ee1e7SLuigi Rizzo 
1024847adfb7SLuigi Rizzo 	/* number of active references to this fd */
10258fd44c93SLuigi Rizzo 	if (--priv->np_refs > 0) {
102637e3a6d3SLuigi Rizzo 		return;
1027ce3ee1e7SLuigi Rizzo 	}
102837e3a6d3SLuigi Rizzo 	nm_os_put_module();
102937e3a6d3SLuigi Rizzo 	if (na) {
1030847bf383SLuigi Rizzo 		netmap_do_unregif(priv);
103137e3a6d3SLuigi Rizzo 	}
103237e3a6d3SLuigi Rizzo 	netmap_unget_na(na, priv->np_ifp);
103337e3a6d3SLuigi Rizzo 	bzero(priv, sizeof(*priv));	/* for safety */
1034c3e9b4dbSLuiz Otavio O Souza 	nm_os_free(priv);
1035f196ce38SLuigi Rizzo }
10365819da83SLuigi Rizzo 
1037f9790aebSLuigi Rizzo 
103889cc2556SLuigi Rizzo /* call with NMG_LOCK *not* held */
1039f9790aebSLuigi Rizzo void
10405819da83SLuigi Rizzo netmap_dtor(void *data)
10415819da83SLuigi Rizzo {
10425819da83SLuigi Rizzo 	struct netmap_priv_d *priv = data;
10435819da83SLuigi Rizzo 
1044ce3ee1e7SLuigi Rizzo 	NMG_LOCK();
104537e3a6d3SLuigi Rizzo 	netmap_priv_delete(priv);
1046ce3ee1e7SLuigi Rizzo 	NMG_UNLOCK();
1047ce3ee1e7SLuigi Rizzo }
104868b8534bSLuigi Rizzo 
1049f18be576SLuigi Rizzo 
105068b8534bSLuigi Rizzo /*
1051c3e9b4dbSLuiz Otavio O Souza  * Handlers for synchronization of the rings from/to the host stack.
1052c3e9b4dbSLuiz Otavio O Souza  * These are associated to a network interface and are just another
1053c3e9b4dbSLuiz Otavio O Souza  * ring pair managed by userspace.
1054c3e9b4dbSLuiz Otavio O Souza  *
1055c3e9b4dbSLuiz Otavio O Souza  * Netmap also supports transparent forwarding (NS_FORWARD and NR_FORWARD
1056c3e9b4dbSLuiz Otavio O Souza  * flags):
1057c3e9b4dbSLuiz Otavio O Souza  *
1058c3e9b4dbSLuiz Otavio O Souza  * - Before releasing buffers on hw RX rings, the application can mark
1059c3e9b4dbSLuiz Otavio O Souza  *   them with the NS_FORWARD flag. During the next RXSYNC or poll(), they
1060c3e9b4dbSLuiz Otavio O Souza  *   will be forwarded to the host stack, similarly to what happened if
1061c3e9b4dbSLuiz Otavio O Souza  *   the application moved them to the host TX ring.
1062c3e9b4dbSLuiz Otavio O Souza  *
1063c3e9b4dbSLuiz Otavio O Souza  * - Before releasing buffers on the host RX ring, the application can
1064c3e9b4dbSLuiz Otavio O Souza  *   mark them with the NS_FORWARD flag. During the next RXSYNC or poll(),
1065c3e9b4dbSLuiz Otavio O Souza  *   they will be forwarded to the hw TX rings, saving the application
1066c3e9b4dbSLuiz Otavio O Souza  *   from doing the same task in user-space.
1067c3e9b4dbSLuiz Otavio O Souza  *
1068c3e9b4dbSLuiz Otavio O Souza  * Transparent fowarding can be enabled per-ring, by setting the NR_FORWARD
1069c3e9b4dbSLuiz Otavio O Souza  * flag, or globally with the netmap_fwd sysctl.
1070c3e9b4dbSLuiz Otavio O Souza  *
1071091fd0abSLuigi Rizzo  * The transfer NIC --> host is relatively easy, just encapsulate
1072091fd0abSLuigi Rizzo  * into mbufs and we are done. The host --> NIC side is slightly
1073091fd0abSLuigi Rizzo  * harder because there might not be room in the tx ring so it
1074091fd0abSLuigi Rizzo  * might take a while before releasing the buffer.
1075091fd0abSLuigi Rizzo  */
1076091fd0abSLuigi Rizzo 
1077f18be576SLuigi Rizzo 
1078091fd0abSLuigi Rizzo /*
1079c3e9b4dbSLuiz Otavio O Souza  * Pass a whole queue of mbufs to the host stack as coming from 'dst'
108017885a7bSLuigi Rizzo  * We do not need to lock because the queue is private.
1081c3e9b4dbSLuiz Otavio O Souza  * After this call the queue is empty.
1082091fd0abSLuigi Rizzo  */
1083091fd0abSLuigi Rizzo static void
1084f9790aebSLuigi Rizzo netmap_send_up(struct ifnet *dst, struct mbq *q)
1085091fd0abSLuigi Rizzo {
1086091fd0abSLuigi Rizzo 	struct mbuf *m;
108737e3a6d3SLuigi Rizzo 	struct mbuf *head = NULL, *prev = NULL;
1088091fd0abSLuigi Rizzo 
1089c3e9b4dbSLuiz Otavio O Souza 	/* Send packets up, outside the lock; head/prev machinery
1090c3e9b4dbSLuiz Otavio O Souza 	 * is only useful for Windows. */
1091f9790aebSLuigi Rizzo 	while ((m = mbq_dequeue(q)) != NULL) {
1092091fd0abSLuigi Rizzo 		if (netmap_verbose & NM_VERB_HOST)
1093091fd0abSLuigi Rizzo 			D("sending up pkt %p size %d", m, MBUF_LEN(m));
109437e3a6d3SLuigi Rizzo 		prev = nm_os_send_up(dst, m, prev);
109537e3a6d3SLuigi Rizzo 		if (head == NULL)
109637e3a6d3SLuigi Rizzo 			head = prev;
1097091fd0abSLuigi Rizzo 	}
109837e3a6d3SLuigi Rizzo 	if (head)
109937e3a6d3SLuigi Rizzo 		nm_os_send_up(dst, NULL, head);
110037e3a6d3SLuigi Rizzo 	mbq_fini(q);
1101091fd0abSLuigi Rizzo }
1102091fd0abSLuigi Rizzo 
1103f18be576SLuigi Rizzo 
1104091fd0abSLuigi Rizzo /*
1105c3e9b4dbSLuiz Otavio O Souza  * Scan the buffers from hwcur to ring->head, and put a copy of those
1106c3e9b4dbSLuiz Otavio O Souza  * marked NS_FORWARD (or all of them if forced) into a queue of mbufs.
1107c3e9b4dbSLuiz Otavio O Souza  * Drop remaining packets in the unlikely event
110817885a7bSLuigi Rizzo  * of an mbuf shortage.
1109091fd0abSLuigi Rizzo  */
1110091fd0abSLuigi Rizzo static void
1111091fd0abSLuigi Rizzo netmap_grab_packets(struct netmap_kring *kring, struct mbq *q, int force)
1112091fd0abSLuigi Rizzo {
111317885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1114847bf383SLuigi Rizzo 	u_int const head = kring->rhead;
111517885a7bSLuigi Rizzo 	u_int n;
1116f9790aebSLuigi Rizzo 	struct netmap_adapter *na = kring->na;
1117091fd0abSLuigi Rizzo 
111817885a7bSLuigi Rizzo 	for (n = kring->nr_hwcur; n != head; n = nm_next(n, lim)) {
111917885a7bSLuigi Rizzo 		struct mbuf *m;
1120091fd0abSLuigi Rizzo 		struct netmap_slot *slot = &kring->ring->slot[n];
1121091fd0abSLuigi Rizzo 
1122091fd0abSLuigi Rizzo 		if ((slot->flags & NS_FORWARD) == 0 && !force)
1123091fd0abSLuigi Rizzo 			continue;
11244bf50f18SLuigi Rizzo 		if (slot->len < 14 || slot->len > NETMAP_BUF_SIZE(na)) {
112517885a7bSLuigi Rizzo 			RD(5, "bad pkt at %d len %d", n, slot->len);
1126091fd0abSLuigi Rizzo 			continue;
1127091fd0abSLuigi Rizzo 		}
1128091fd0abSLuigi Rizzo 		slot->flags &= ~NS_FORWARD; // XXX needed ?
112917885a7bSLuigi Rizzo 		/* XXX TODO: adapt to the case of a multisegment packet */
11304bf50f18SLuigi Rizzo 		m = m_devget(NMB(na, slot), slot->len, 0, na->ifp, NULL);
1131091fd0abSLuigi Rizzo 
1132091fd0abSLuigi Rizzo 		if (m == NULL)
1133091fd0abSLuigi Rizzo 			break;
1134f9790aebSLuigi Rizzo 		mbq_enqueue(q, m);
1135091fd0abSLuigi Rizzo 	}
1136091fd0abSLuigi Rizzo }
1137091fd0abSLuigi Rizzo 
113837e3a6d3SLuigi Rizzo static inline int
113937e3a6d3SLuigi Rizzo _nm_may_forward(struct netmap_kring *kring)
114037e3a6d3SLuigi Rizzo {
114137e3a6d3SLuigi Rizzo 	return	((netmap_fwd || kring->ring->flags & NR_FORWARD) &&
114237e3a6d3SLuigi Rizzo 		 kring->na->na_flags & NAF_HOST_RINGS &&
114337e3a6d3SLuigi Rizzo 		 kring->tx == NR_RX);
114437e3a6d3SLuigi Rizzo }
114537e3a6d3SLuigi Rizzo 
114637e3a6d3SLuigi Rizzo static inline int
114737e3a6d3SLuigi Rizzo nm_may_forward_up(struct netmap_kring *kring)
114837e3a6d3SLuigi Rizzo {
114937e3a6d3SLuigi Rizzo 	return	_nm_may_forward(kring) &&
115037e3a6d3SLuigi Rizzo 		 kring->ring_id != kring->na->num_rx_rings;
115137e3a6d3SLuigi Rizzo }
115237e3a6d3SLuigi Rizzo 
115337e3a6d3SLuigi Rizzo static inline int
1154c3e9b4dbSLuiz Otavio O Souza nm_may_forward_down(struct netmap_kring *kring, int sync_flags)
115537e3a6d3SLuigi Rizzo {
115637e3a6d3SLuigi Rizzo 	return	_nm_may_forward(kring) &&
1157c3e9b4dbSLuiz Otavio O Souza 		 (sync_flags & NAF_CAN_FORWARD_DOWN) &&
115837e3a6d3SLuigi Rizzo 		 kring->ring_id == kring->na->num_rx_rings;
115937e3a6d3SLuigi Rizzo }
1160f18be576SLuigi Rizzo 
1161091fd0abSLuigi Rizzo /*
116217885a7bSLuigi Rizzo  * Send to the NIC rings packets marked NS_FORWARD between
1163c3e9b4dbSLuiz Otavio O Souza  * kring->nr_hwcur and kring->rhead.
1164c3e9b4dbSLuiz Otavio O Souza  * Called under kring->rx_queue.lock on the sw rx ring.
1165c3e9b4dbSLuiz Otavio O Souza  *
1166c3e9b4dbSLuiz Otavio O Souza  * It can only be called if the user opened all the TX hw rings,
1167c3e9b4dbSLuiz Otavio O Souza  * see NAF_CAN_FORWARD_DOWN flag.
1168c3e9b4dbSLuiz Otavio O Souza  * We can touch the TX netmap rings (slots, head and cur) since
1169c3e9b4dbSLuiz Otavio O Souza  * we are in poll/ioctl system call context, and the application
1170c3e9b4dbSLuiz Otavio O Souza  * is not supposed to touch the ring (using a different thread)
1171c3e9b4dbSLuiz Otavio O Souza  * during the execution of the system call.
1172091fd0abSLuigi Rizzo  */
117317885a7bSLuigi Rizzo static u_int
1174091fd0abSLuigi Rizzo netmap_sw_to_nic(struct netmap_adapter *na)
1175091fd0abSLuigi Rizzo {
1176091fd0abSLuigi Rizzo 	struct netmap_kring *kring = &na->rx_rings[na->num_rx_rings];
117717885a7bSLuigi Rizzo 	struct netmap_slot *rxslot = kring->ring->slot;
117817885a7bSLuigi Rizzo 	u_int i, rxcur = kring->nr_hwcur;
117917885a7bSLuigi Rizzo 	u_int const head = kring->rhead;
118017885a7bSLuigi Rizzo 	u_int const src_lim = kring->nkr_num_slots - 1;
118117885a7bSLuigi Rizzo 	u_int sent = 0;
1182ce3ee1e7SLuigi Rizzo 
118317885a7bSLuigi Rizzo 	/* scan rings to find space, then fill as much as possible */
118417885a7bSLuigi Rizzo 	for (i = 0; i < na->num_tx_rings; i++) {
118517885a7bSLuigi Rizzo 		struct netmap_kring *kdst = &na->tx_rings[i];
118617885a7bSLuigi Rizzo 		struct netmap_ring *rdst = kdst->ring;
118717885a7bSLuigi Rizzo 		u_int const dst_lim = kdst->nkr_num_slots - 1;
1188ce3ee1e7SLuigi Rizzo 
118917885a7bSLuigi Rizzo 		/* XXX do we trust ring or kring->rcur,rtail ? */
119017885a7bSLuigi Rizzo 		for (; rxcur != head && !nm_ring_empty(rdst);
119117885a7bSLuigi Rizzo 		     rxcur = nm_next(rxcur, src_lim) ) {
1192091fd0abSLuigi Rizzo 			struct netmap_slot *src, *dst, tmp;
119337e3a6d3SLuigi Rizzo 			u_int dst_head = rdst->head;
119417885a7bSLuigi Rizzo 
119517885a7bSLuigi Rizzo 			src = &rxslot[rxcur];
119617885a7bSLuigi Rizzo 			if ((src->flags & NS_FORWARD) == 0 && !netmap_fwd)
119717885a7bSLuigi Rizzo 				continue;
119817885a7bSLuigi Rizzo 
119917885a7bSLuigi Rizzo 			sent++;
120017885a7bSLuigi Rizzo 
120137e3a6d3SLuigi Rizzo 			dst = &rdst->slot[dst_head];
120217885a7bSLuigi Rizzo 
1203091fd0abSLuigi Rizzo 			tmp = *src;
120417885a7bSLuigi Rizzo 
1205091fd0abSLuigi Rizzo 			src->buf_idx = dst->buf_idx;
1206091fd0abSLuigi Rizzo 			src->flags = NS_BUF_CHANGED;
1207091fd0abSLuigi Rizzo 
1208091fd0abSLuigi Rizzo 			dst->buf_idx = tmp.buf_idx;
1209091fd0abSLuigi Rizzo 			dst->len = tmp.len;
1210091fd0abSLuigi Rizzo 			dst->flags = NS_BUF_CHANGED;
1211091fd0abSLuigi Rizzo 
121237e3a6d3SLuigi Rizzo 			rdst->head = rdst->cur = nm_next(dst_head, dst_lim);
1213091fd0abSLuigi Rizzo 		}
1214c3e9b4dbSLuiz Otavio O Souza 		/* if (sent) XXX txsync ? it would be just an optimization */
1215091fd0abSLuigi Rizzo 	}
121617885a7bSLuigi Rizzo 	return sent;
1217091fd0abSLuigi Rizzo }
1218091fd0abSLuigi Rizzo 
1219f18be576SLuigi Rizzo 
1220091fd0abSLuigi Rizzo /*
1221ce3ee1e7SLuigi Rizzo  * netmap_txsync_to_host() passes packets up. We are called from a
122202ad4083SLuigi Rizzo  * system call in user process context, and the only contention
122302ad4083SLuigi Rizzo  * can be among multiple user threads erroneously calling
1224091fd0abSLuigi Rizzo  * this routine concurrently.
122568b8534bSLuigi Rizzo  */
122637e3a6d3SLuigi Rizzo static int
122737e3a6d3SLuigi Rizzo netmap_txsync_to_host(struct netmap_kring *kring, int flags)
122868b8534bSLuigi Rizzo {
122937e3a6d3SLuigi Rizzo 	struct netmap_adapter *na = kring->na;
123017885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1231f0ea3689SLuigi Rizzo 	u_int const head = kring->rhead;
1232f9790aebSLuigi Rizzo 	struct mbq q;
123368b8534bSLuigi Rizzo 
123417885a7bSLuigi Rizzo 	/* Take packets from hwcur to head and pass them up.
1235c3e9b4dbSLuiz Otavio O Souza 	 * Force hwcur = head since netmap_grab_packets() stops at head
123668b8534bSLuigi Rizzo 	 */
1237f9790aebSLuigi Rizzo 	mbq_init(&q);
123817885a7bSLuigi Rizzo 	netmap_grab_packets(kring, &q, 1 /* force */);
123917885a7bSLuigi Rizzo 	ND("have %d pkts in queue", mbq_len(&q));
124017885a7bSLuigi Rizzo 	kring->nr_hwcur = head;
124117885a7bSLuigi Rizzo 	kring->nr_hwtail = head + lim;
124217885a7bSLuigi Rizzo 	if (kring->nr_hwtail > lim)
124317885a7bSLuigi Rizzo 		kring->nr_hwtail -= lim + 1;
124468b8534bSLuigi Rizzo 
1245f9790aebSLuigi Rizzo 	netmap_send_up(na->ifp, &q);
124637e3a6d3SLuigi Rizzo 	return 0;
1247f18be576SLuigi Rizzo }
1248f18be576SLuigi Rizzo 
1249f18be576SLuigi Rizzo 
125068b8534bSLuigi Rizzo /*
125102ad4083SLuigi Rizzo  * rxsync backend for packets coming from the host stack.
125217885a7bSLuigi Rizzo  * They have been put in kring->rx_queue by netmap_transmit().
125317885a7bSLuigi Rizzo  * We protect access to the kring using kring->rx_queue.lock
125402ad4083SLuigi Rizzo  *
1255c3e9b4dbSLuiz Otavio O Souza  * also moves to the nic hw rings any packet the user has marked
1256c3e9b4dbSLuiz Otavio O Souza  * for transparent-mode forwarding, then sets the NR_FORWARD
1257c3e9b4dbSLuiz Otavio O Souza  * flag in the kring to let the caller push them out
125868b8534bSLuigi Rizzo  */
12598fd44c93SLuigi Rizzo static int
126037e3a6d3SLuigi Rizzo netmap_rxsync_from_host(struct netmap_kring *kring, int flags)
126168b8534bSLuigi Rizzo {
126237e3a6d3SLuigi Rizzo 	struct netmap_adapter *na = kring->na;
126368b8534bSLuigi Rizzo 	struct netmap_ring *ring = kring->ring;
126417885a7bSLuigi Rizzo 	u_int nm_i, n;
126517885a7bSLuigi Rizzo 	u_int const lim = kring->nkr_num_slots - 1;
1266f0ea3689SLuigi Rizzo 	u_int const head = kring->rhead;
126717885a7bSLuigi Rizzo 	int ret = 0;
1268847bf383SLuigi Rizzo 	struct mbq *q = &kring->rx_queue, fq;
126968b8534bSLuigi Rizzo 
1270847bf383SLuigi Rizzo 	mbq_init(&fq); /* fq holds packets to be freed */
1271847bf383SLuigi Rizzo 
1272997b054cSLuigi Rizzo 	mbq_lock(q);
127317885a7bSLuigi Rizzo 
127417885a7bSLuigi Rizzo 	/* First part: import newly received packets */
127517885a7bSLuigi Rizzo 	n = mbq_len(q);
127617885a7bSLuigi Rizzo 	if (n) { /* grab packets from the queue */
127717885a7bSLuigi Rizzo 		struct mbuf *m;
127817885a7bSLuigi Rizzo 		uint32_t stop_i;
127917885a7bSLuigi Rizzo 
128017885a7bSLuigi Rizzo 		nm_i = kring->nr_hwtail;
1281c3e9b4dbSLuiz Otavio O Souza 		stop_i = nm_prev(kring->nr_hwcur, lim);
128217885a7bSLuigi Rizzo 		while ( nm_i != stop_i && (m = mbq_dequeue(q)) != NULL ) {
128317885a7bSLuigi Rizzo 			int len = MBUF_LEN(m);
128417885a7bSLuigi Rizzo 			struct netmap_slot *slot = &ring->slot[nm_i];
128517885a7bSLuigi Rizzo 
12864bf50f18SLuigi Rizzo 			m_copydata(m, 0, len, NMB(na, slot));
128717885a7bSLuigi Rizzo 			ND("nm %d len %d", nm_i, len);
128817885a7bSLuigi Rizzo 			if (netmap_verbose)
12894bf50f18SLuigi Rizzo                                 D("%s", nm_dump_buf(NMB(na, slot),len, 128, NULL));
129017885a7bSLuigi Rizzo 
129117885a7bSLuigi Rizzo 			slot->len = len;
129217885a7bSLuigi Rizzo 			slot->flags = kring->nkr_slot_flags;
129317885a7bSLuigi Rizzo 			nm_i = nm_next(nm_i, lim);
1294847bf383SLuigi Rizzo 			mbq_enqueue(&fq, m);
129564ae02c3SLuigi Rizzo 		}
129617885a7bSLuigi Rizzo 		kring->nr_hwtail = nm_i;
129764ae02c3SLuigi Rizzo 	}
129817885a7bSLuigi Rizzo 
129917885a7bSLuigi Rizzo 	/*
130017885a7bSLuigi Rizzo 	 * Second part: skip past packets that userspace has released.
130117885a7bSLuigi Rizzo 	 */
130217885a7bSLuigi Rizzo 	nm_i = kring->nr_hwcur;
130317885a7bSLuigi Rizzo 	if (nm_i != head) { /* something was released */
1304c3e9b4dbSLuiz Otavio O Souza 		if (nm_may_forward_down(kring, flags)) {
130517885a7bSLuigi Rizzo 			ret = netmap_sw_to_nic(na);
130637e3a6d3SLuigi Rizzo 			if (ret > 0) {
130737e3a6d3SLuigi Rizzo 				kring->nr_kflags |= NR_FORWARD;
130837e3a6d3SLuigi Rizzo 				ret = 0;
130937e3a6d3SLuigi Rizzo 			}
131037e3a6d3SLuigi Rizzo 		}
131117885a7bSLuigi Rizzo 		kring->nr_hwcur = head;
131264ae02c3SLuigi Rizzo 	}
131317885a7bSLuigi Rizzo 
1314997b054cSLuigi Rizzo 	mbq_unlock(q);
1315847bf383SLuigi Rizzo 
1316847bf383SLuigi Rizzo 	mbq_purge(&fq);
131737e3a6d3SLuigi Rizzo 	mbq_fini(&fq);
1318847bf383SLuigi Rizzo 
131917885a7bSLuigi Rizzo 	return ret;
132068b8534bSLuigi Rizzo }
132168b8534bSLuigi Rizzo 
132268b8534bSLuigi Rizzo 
1323f9790aebSLuigi Rizzo /* Get a netmap adapter for the port.
1324f9790aebSLuigi Rizzo  *
1325f9790aebSLuigi Rizzo  * If it is possible to satisfy the request, return 0
1326f9790aebSLuigi Rizzo  * with *na containing the netmap adapter found.
1327f9790aebSLuigi Rizzo  * Otherwise return an error code, with *na containing NULL.
1328f9790aebSLuigi Rizzo  *
1329f9790aebSLuigi Rizzo  * When the port is attached to a bridge, we always return
1330f9790aebSLuigi Rizzo  * EBUSY.
1331f9790aebSLuigi Rizzo  * Otherwise, if the port is already bound to a file descriptor,
1332f9790aebSLuigi Rizzo  * then we unconditionally return the existing adapter into *na.
1333f9790aebSLuigi Rizzo  * In all the other cases, we return (into *na) either native,
1334f9790aebSLuigi Rizzo  * generic or NULL, according to the following table:
1335f9790aebSLuigi Rizzo  *
1336f9790aebSLuigi Rizzo  *					native_support
1337f9790aebSLuigi Rizzo  * active_fds   dev.netmap.admode         YES     NO
1338f9790aebSLuigi Rizzo  * -------------------------------------------------------
1339f9790aebSLuigi Rizzo  *    >0              *                 NA(ifp) NA(ifp)
1340f9790aebSLuigi Rizzo  *
1341f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_BEST      NATIVE  GENERIC
1342f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_NATIVE    NATIVE   NULL
1343f9790aebSLuigi Rizzo  *     0        NETMAP_ADMODE_GENERIC   GENERIC GENERIC
1344f9790aebSLuigi Rizzo  *
1345f9790aebSLuigi Rizzo  */
134637e3a6d3SLuigi Rizzo static void netmap_hw_dtor(struct netmap_adapter *); /* needed by NM_IS_NATIVE() */
1347f9790aebSLuigi Rizzo int
1348c3e9b4dbSLuiz Otavio O Souza netmap_get_hw_na(struct ifnet *ifp, struct netmap_mem_d *nmd, struct netmap_adapter **na)
1349f9790aebSLuigi Rizzo {
1350f9790aebSLuigi Rizzo 	/* generic support */
1351f9790aebSLuigi Rizzo 	int i = netmap_admode;	/* Take a snapshot. */
1352f9790aebSLuigi Rizzo 	struct netmap_adapter *prev_na;
1353847bf383SLuigi Rizzo 	int error = 0;
1354f9790aebSLuigi Rizzo 
1355f9790aebSLuigi Rizzo 	*na = NULL; /* default */
1356f9790aebSLuigi Rizzo 
1357f9790aebSLuigi Rizzo 	/* reset in case of invalid value */
1358f9790aebSLuigi Rizzo 	if (i < NETMAP_ADMODE_BEST || i >= NETMAP_ADMODE_LAST)
1359f9790aebSLuigi Rizzo 		i = netmap_admode = NETMAP_ADMODE_BEST;
1360f9790aebSLuigi Rizzo 
136137e3a6d3SLuigi Rizzo 	if (NM_NA_VALID(ifp)) {
13624bf50f18SLuigi Rizzo 		prev_na = NA(ifp);
1363f9790aebSLuigi Rizzo 		/* If an adapter already exists, return it if
1364f9790aebSLuigi Rizzo 		 * there are active file descriptors or if
1365f9790aebSLuigi Rizzo 		 * netmap is not forced to use generic
1366f9790aebSLuigi Rizzo 		 * adapters.
1367f9790aebSLuigi Rizzo 		 */
13684bf50f18SLuigi Rizzo 		if (NETMAP_OWNED_BY_ANY(prev_na)
13694bf50f18SLuigi Rizzo 			|| i != NETMAP_ADMODE_GENERIC
13704bf50f18SLuigi Rizzo 			|| prev_na->na_flags & NAF_FORCE_NATIVE
13714bf50f18SLuigi Rizzo #ifdef WITH_PIPES
13724bf50f18SLuigi Rizzo 			/* ugly, but we cannot allow an adapter switch
13734bf50f18SLuigi Rizzo 			 * if some pipe is referring to this one
13744bf50f18SLuigi Rizzo 			 */
13754bf50f18SLuigi Rizzo 			|| prev_na->na_next_pipe > 0
13764bf50f18SLuigi Rizzo #endif
13774bf50f18SLuigi Rizzo 		) {
13784bf50f18SLuigi Rizzo 			*na = prev_na;
1379c3e9b4dbSLuiz Otavio O Souza 			goto assign_mem;
1380f9790aebSLuigi Rizzo 		}
1381f9790aebSLuigi Rizzo 	}
1382f9790aebSLuigi Rizzo 
1383f9790aebSLuigi Rizzo 	/* If there isn't native support and netmap is not allowed
1384f9790aebSLuigi Rizzo 	 * to use generic adapters, we cannot satisfy the request.
1385f9790aebSLuigi Rizzo 	 */
138637e3a6d3SLuigi Rizzo 	if (!NM_IS_NATIVE(ifp) && i == NETMAP_ADMODE_NATIVE)
1387f2637526SLuigi Rizzo 		return EOPNOTSUPP;
1388f9790aebSLuigi Rizzo 
1389f9790aebSLuigi Rizzo 	/* Otherwise, create a generic adapter and return it,
1390f9790aebSLuigi Rizzo 	 * saving the previously used netmap adapter, if any.
1391f9790aebSLuigi Rizzo 	 *
1392f9790aebSLuigi Rizzo 	 * Note that here 'prev_na', if not NULL, MUST be a
1393f9790aebSLuigi Rizzo 	 * native adapter, and CANNOT be a generic one. This is
1394f9790aebSLuigi Rizzo 	 * true because generic adapters are created on demand, and
1395f9790aebSLuigi Rizzo 	 * destroyed when not used anymore. Therefore, if the adapter
1396f9790aebSLuigi Rizzo 	 * currently attached to an interface 'ifp' is generic, it
1397f9790aebSLuigi Rizzo 	 * must be that
1398f9790aebSLuigi Rizzo 	 * (NA(ifp)->active_fds > 0 || NETMAP_OWNED_BY_KERN(NA(ifp))).
1399f9790aebSLuigi Rizzo 	 * Consequently, if NA(ifp) is generic, we will enter one of
1400f9790aebSLuigi Rizzo 	 * the branches above. This ensures that we never override
1401f9790aebSLuigi Rizzo 	 * a generic adapter with another generic adapter.
1402f9790aebSLuigi Rizzo 	 */
1403f9790aebSLuigi Rizzo 	error = generic_netmap_attach(ifp);
1404f9790aebSLuigi Rizzo 	if (error)
1405f9790aebSLuigi Rizzo 		return error;
1406f9790aebSLuigi Rizzo 
1407f9790aebSLuigi Rizzo 	*na = NA(ifp);
1408c3e9b4dbSLuiz Otavio O Souza 
1409c3e9b4dbSLuiz Otavio O Souza assign_mem:
1410c3e9b4dbSLuiz Otavio O Souza 	if (nmd != NULL && !((*na)->na_flags & NAF_MEM_OWNER) &&
1411c3e9b4dbSLuiz Otavio O Souza 	    (*na)->active_fds == 0 && ((*na)->nm_mem != nmd)) {
1412c3e9b4dbSLuiz Otavio O Souza 		netmap_mem_put((*na)->nm_mem);
1413c3e9b4dbSLuiz Otavio O Souza 		(*na)->nm_mem = netmap_mem_get(nmd);
1414f9790aebSLuigi Rizzo 	}
1415f9790aebSLuigi Rizzo 
1416c3e9b4dbSLuiz Otavio O Souza 	return 0;
1417c3e9b4dbSLuiz Otavio O Souza }
1418f9790aebSLuigi Rizzo 
141968b8534bSLuigi Rizzo /*
1420ce3ee1e7SLuigi Rizzo  * MUST BE CALLED UNDER NMG_LOCK()
1421ce3ee1e7SLuigi Rizzo  *
1422f2637526SLuigi Rizzo  * Get a refcounted reference to a netmap adapter attached
1423f2637526SLuigi Rizzo  * to the interface specified by nmr.
1424ce3ee1e7SLuigi Rizzo  * This is always called in the execution of an ioctl().
1425ce3ee1e7SLuigi Rizzo  *
1426f2637526SLuigi Rizzo  * Return ENXIO if the interface specified by the request does
1427f2637526SLuigi Rizzo  * not exist, ENOTSUP if netmap is not supported by the interface,
1428f2637526SLuigi Rizzo  * EBUSY if the interface is already attached to a bridge,
1429f2637526SLuigi Rizzo  * EINVAL if parameters are invalid, ENOMEM if needed resources
1430f2637526SLuigi Rizzo  * could not be allocated.
1431f2637526SLuigi Rizzo  * If successful, hold a reference to the netmap adapter.
1432f18be576SLuigi Rizzo  *
143337e3a6d3SLuigi Rizzo  * If the interface specified by nmr is a system one, also keep
143437e3a6d3SLuigi Rizzo  * a reference to it and return a valid *ifp.
143568b8534bSLuigi Rizzo  */
1436f9790aebSLuigi Rizzo int
143737e3a6d3SLuigi Rizzo netmap_get_na(struct nmreq *nmr, struct netmap_adapter **na,
1438c3e9b4dbSLuiz Otavio O Souza 	      struct ifnet **ifp, struct netmap_mem_d *nmd, int create)
143968b8534bSLuigi Rizzo {
1440f9790aebSLuigi Rizzo 	int error = 0;
1441f0ea3689SLuigi Rizzo 	struct netmap_adapter *ret = NULL;
1442c3e9b4dbSLuiz Otavio O Souza 	int nmd_ref = 0;
1443f9790aebSLuigi Rizzo 
1444f9790aebSLuigi Rizzo 	*na = NULL;     /* default return value */
144537e3a6d3SLuigi Rizzo 	*ifp = NULL;
1446f196ce38SLuigi Rizzo 
1447ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
1448ce3ee1e7SLuigi Rizzo 
1449c3e9b4dbSLuiz Otavio O Souza 	/* if the request contain a memid, try to find the
1450c3e9b4dbSLuiz Otavio O Souza 	 * corresponding memory region
1451c3e9b4dbSLuiz Otavio O Souza 	 */
1452c3e9b4dbSLuiz Otavio O Souza 	if (nmd == NULL && nmr->nr_arg2) {
1453c3e9b4dbSLuiz Otavio O Souza 		nmd = netmap_mem_find(nmr->nr_arg2);
1454c3e9b4dbSLuiz Otavio O Souza 		if (nmd == NULL)
1455c3e9b4dbSLuiz Otavio O Souza 			return EINVAL;
1456c3e9b4dbSLuiz Otavio O Souza 		/* keep the rereference */
1457c3e9b4dbSLuiz Otavio O Souza 		nmd_ref = 1;
1458c3e9b4dbSLuiz Otavio O Souza 	}
1459c3e9b4dbSLuiz Otavio O Souza 
146037e3a6d3SLuigi Rizzo 	/* We cascade through all possible types of netmap adapter.
14614bf50f18SLuigi Rizzo 	 * All netmap_get_*_na() functions return an error and an na,
14624bf50f18SLuigi Rizzo 	 * with the following combinations:
14634bf50f18SLuigi Rizzo 	 *
14644bf50f18SLuigi Rizzo 	 * error    na
14654bf50f18SLuigi Rizzo 	 *   0	   NULL		type doesn't match
14664bf50f18SLuigi Rizzo 	 *  !0	   NULL		type matches, but na creation/lookup failed
14674bf50f18SLuigi Rizzo 	 *   0	  !NULL		type matches and na created/found
14684bf50f18SLuigi Rizzo 	 *  !0    !NULL		impossible
14694bf50f18SLuigi Rizzo 	 */
14704bf50f18SLuigi Rizzo 
147137e3a6d3SLuigi Rizzo 	/* try to see if this is a ptnetmap port */
1472c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_pt_host_na(nmr, na, nmd, create);
147337e3a6d3SLuigi Rizzo 	if (error || *na != NULL)
1474c3e9b4dbSLuiz Otavio O Souza 		goto out;
147537e3a6d3SLuigi Rizzo 
14764bf50f18SLuigi Rizzo 	/* try to see if this is a monitor port */
1477c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_monitor_na(nmr, na, nmd, create);
14784bf50f18SLuigi Rizzo 	if (error || *na != NULL)
1479c3e9b4dbSLuiz Otavio O Souza 		goto out;
14804bf50f18SLuigi Rizzo 
14814bf50f18SLuigi Rizzo 	/* try to see if this is a pipe port */
1482c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_pipe_na(nmr, na, nmd, create);
1483f0ea3689SLuigi Rizzo 	if (error || *na != NULL)
1484c3e9b4dbSLuiz Otavio O Souza 		goto out;
1485ce3ee1e7SLuigi Rizzo 
14864bf50f18SLuigi Rizzo 	/* try to see if this is a bridge port */
1487c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_bdg_na(nmr, na, nmd, create);
1488f0ea3689SLuigi Rizzo 	if (error)
1489c3e9b4dbSLuiz Otavio O Souza 		goto out;
1490f0ea3689SLuigi Rizzo 
1491f0ea3689SLuigi Rizzo 	if (*na != NULL) /* valid match in netmap_get_bdg_na() */
1492847bf383SLuigi Rizzo 		goto out;
1493f0ea3689SLuigi Rizzo 
149489cc2556SLuigi Rizzo 	/*
149589cc2556SLuigi Rizzo 	 * This must be a hardware na, lookup the name in the system.
149689cc2556SLuigi Rizzo 	 * Note that by hardware we actually mean "it shows up in ifconfig".
149789cc2556SLuigi Rizzo 	 * This may still be a tap, a veth/epair, or even a
149889cc2556SLuigi Rizzo 	 * persistent VALE port.
149989cc2556SLuigi Rizzo 	 */
150037e3a6d3SLuigi Rizzo 	*ifp = ifunit_ref(nmr->nr_name);
150137e3a6d3SLuigi Rizzo 	if (*ifp == NULL) {
1502c3e9b4dbSLuiz Otavio O Souza 		error = ENXIO;
1503c3e9b4dbSLuiz Otavio O Souza 		goto out;
1504f196ce38SLuigi Rizzo 	}
1505ce3ee1e7SLuigi Rizzo 
1506c3e9b4dbSLuiz Otavio O Souza 	error = netmap_get_hw_na(*ifp, nmd, &ret);
1507f9790aebSLuigi Rizzo 	if (error)
1508f9790aebSLuigi Rizzo 		goto out;
1509f18be576SLuigi Rizzo 
1510f9790aebSLuigi Rizzo 	*na = ret;
1511f9790aebSLuigi Rizzo 	netmap_adapter_get(ret);
1512f0ea3689SLuigi Rizzo 
1513f9790aebSLuigi Rizzo out:
151437e3a6d3SLuigi Rizzo 	if (error) {
151537e3a6d3SLuigi Rizzo 		if (ret)
1516f0ea3689SLuigi Rizzo 			netmap_adapter_put(ret);
151737e3a6d3SLuigi Rizzo 		if (*ifp) {
151837e3a6d3SLuigi Rizzo 			if_rele(*ifp);
151937e3a6d3SLuigi Rizzo 			*ifp = NULL;
152037e3a6d3SLuigi Rizzo 		}
152137e3a6d3SLuigi Rizzo 	}
1522c3e9b4dbSLuiz Otavio O Souza 	if (nmd_ref)
1523c3e9b4dbSLuiz Otavio O Souza 		netmap_mem_put(nmd);
1524f18be576SLuigi Rizzo 
15255ab0d24dSLuigi Rizzo 	return error;
15265ab0d24dSLuigi Rizzo }
1527ce3ee1e7SLuigi Rizzo 
152837e3a6d3SLuigi Rizzo /* undo netmap_get_na() */
152937e3a6d3SLuigi Rizzo void
153037e3a6d3SLuigi Rizzo netmap_unget_na(struct netmap_adapter *na, struct ifnet *ifp)
153137e3a6d3SLuigi Rizzo {
153237e3a6d3SLuigi Rizzo 	if (ifp)
153337e3a6d3SLuigi Rizzo 		if_rele(ifp);
153437e3a6d3SLuigi Rizzo 	if (na)
153537e3a6d3SLuigi Rizzo 		netmap_adapter_put(na);
153637e3a6d3SLuigi Rizzo }
153737e3a6d3SLuigi Rizzo 
153837e3a6d3SLuigi Rizzo 
153937e3a6d3SLuigi Rizzo #define NM_FAIL_ON(t) do {						\
154037e3a6d3SLuigi Rizzo 	if (unlikely(t)) {						\
154137e3a6d3SLuigi Rizzo 		RD(5, "%s: fail '" #t "' "				\
154237e3a6d3SLuigi Rizzo 			"h %d c %d t %d "				\
154337e3a6d3SLuigi Rizzo 			"rh %d rc %d rt %d "				\
154437e3a6d3SLuigi Rizzo 			"hc %d ht %d",					\
154537e3a6d3SLuigi Rizzo 			kring->name,					\
154637e3a6d3SLuigi Rizzo 			head, cur, ring->tail,				\
154737e3a6d3SLuigi Rizzo 			kring->rhead, kring->rcur, kring->rtail,	\
154837e3a6d3SLuigi Rizzo 			kring->nr_hwcur, kring->nr_hwtail);		\
154937e3a6d3SLuigi Rizzo 		return kring->nkr_num_slots;				\
155037e3a6d3SLuigi Rizzo 	}								\
155137e3a6d3SLuigi Rizzo } while (0)
1552ce3ee1e7SLuigi Rizzo 
1553f9790aebSLuigi Rizzo /*
1554f9790aebSLuigi Rizzo  * validate parameters on entry for *_txsync()
1555f9790aebSLuigi Rizzo  * Returns ring->cur if ok, or something >= kring->nkr_num_slots
155617885a7bSLuigi Rizzo  * in case of error.
1557f9790aebSLuigi Rizzo  *
155817885a7bSLuigi Rizzo  * rhead, rcur and rtail=hwtail are stored from previous round.
155917885a7bSLuigi Rizzo  * hwcur is the next packet to send to the ring.
1560f9790aebSLuigi Rizzo  *
156117885a7bSLuigi Rizzo  * We want
156217885a7bSLuigi Rizzo  *    hwcur <= *rhead <= head <= cur <= tail = *rtail <= hwtail
1563f9790aebSLuigi Rizzo  *
156417885a7bSLuigi Rizzo  * hwcur, rhead, rtail and hwtail are reliable
1565f9790aebSLuigi Rizzo  */
156637e3a6d3SLuigi Rizzo u_int
156737e3a6d3SLuigi Rizzo nm_txsync_prologue(struct netmap_kring *kring, struct netmap_ring *ring)
1568f9790aebSLuigi Rizzo {
156917885a7bSLuigi Rizzo 	u_int head = ring->head; /* read only once */
1570f9790aebSLuigi Rizzo 	u_int cur = ring->cur; /* read only once */
1571f9790aebSLuigi Rizzo 	u_int n = kring->nkr_num_slots;
1572ce3ee1e7SLuigi Rizzo 
157317885a7bSLuigi Rizzo 	ND(5, "%s kcur %d ktail %d head %d cur %d tail %d",
157417885a7bSLuigi Rizzo 		kring->name,
157517885a7bSLuigi Rizzo 		kring->nr_hwcur, kring->nr_hwtail,
157617885a7bSLuigi Rizzo 		ring->head, ring->cur, ring->tail);
157717885a7bSLuigi Rizzo #if 1 /* kernel sanity checks; but we can trust the kring. */
157837e3a6d3SLuigi Rizzo 	NM_FAIL_ON(kring->nr_hwcur >= n || kring->rhead >= n ||
157937e3a6d3SLuigi Rizzo 	    kring->rtail >= n ||  kring->nr_hwtail >= n);
1580f9790aebSLuigi Rizzo #endif /* kernel sanity checks */
158117885a7bSLuigi Rizzo 	/*
158237e3a6d3SLuigi Rizzo 	 * user sanity checks. We only use head,
158337e3a6d3SLuigi Rizzo 	 * A, B, ... are possible positions for head:
158417885a7bSLuigi Rizzo 	 *
158537e3a6d3SLuigi Rizzo 	 *  0    A  rhead   B  rtail   C  n-1
158637e3a6d3SLuigi Rizzo 	 *  0    D  rtail   E  rhead   F  n-1
158717885a7bSLuigi Rizzo 	 *
158817885a7bSLuigi Rizzo 	 * B, F, D are valid. A, C, E are wrong
158917885a7bSLuigi Rizzo 	 */
159017885a7bSLuigi Rizzo 	if (kring->rtail >= kring->rhead) {
159117885a7bSLuigi Rizzo 		/* want rhead <= head <= rtail */
159237e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->rhead || head > kring->rtail);
159317885a7bSLuigi Rizzo 		/* and also head <= cur <= rtail */
159437e3a6d3SLuigi Rizzo 		NM_FAIL_ON(cur < head || cur > kring->rtail);
159517885a7bSLuigi Rizzo 	} else { /* here rtail < rhead */
159617885a7bSLuigi Rizzo 		/* we need head outside rtail .. rhead */
159737e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head > kring->rtail && head < kring->rhead);
159817885a7bSLuigi Rizzo 
159917885a7bSLuigi Rizzo 		/* two cases now: head <= rtail or head >= rhead  */
160017885a7bSLuigi Rizzo 		if (head <= kring->rtail) {
160117885a7bSLuigi Rizzo 			/* want head <= cur <= rtail */
160237e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head || cur > kring->rtail);
160317885a7bSLuigi Rizzo 		} else { /* head >= rhead */
160417885a7bSLuigi Rizzo 			/* cur must be outside rtail..head */
160537e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur > kring->rtail && cur < head);
1606f18be576SLuigi Rizzo 		}
1607f9790aebSLuigi Rizzo 	}
160817885a7bSLuigi Rizzo 	if (ring->tail != kring->rtail) {
1609a2a74091SLuigi Rizzo 		RD(5, "%s tail overwritten was %d need %d", kring->name,
161017885a7bSLuigi Rizzo 			ring->tail, kring->rtail);
161117885a7bSLuigi Rizzo 		ring->tail = kring->rtail;
161217885a7bSLuigi Rizzo 	}
161317885a7bSLuigi Rizzo 	kring->rhead = head;
161417885a7bSLuigi Rizzo 	kring->rcur = cur;
161517885a7bSLuigi Rizzo 	return head;
161668b8534bSLuigi Rizzo }
161768b8534bSLuigi Rizzo 
161868b8534bSLuigi Rizzo 
161968b8534bSLuigi Rizzo /*
1620f9790aebSLuigi Rizzo  * validate parameters on entry for *_rxsync()
162117885a7bSLuigi Rizzo  * Returns ring->head if ok, kring->nkr_num_slots on error.
1622f9790aebSLuigi Rizzo  *
162317885a7bSLuigi Rizzo  * For a valid configuration,
162417885a7bSLuigi Rizzo  * hwcur <= head <= cur <= tail <= hwtail
1625f9790aebSLuigi Rizzo  *
162617885a7bSLuigi Rizzo  * We only consider head and cur.
162717885a7bSLuigi Rizzo  * hwcur and hwtail are reliable.
1628f9790aebSLuigi Rizzo  *
1629f9790aebSLuigi Rizzo  */
163037e3a6d3SLuigi Rizzo u_int
163137e3a6d3SLuigi Rizzo nm_rxsync_prologue(struct netmap_kring *kring, struct netmap_ring *ring)
1632f9790aebSLuigi Rizzo {
163317885a7bSLuigi Rizzo 	uint32_t const n = kring->nkr_num_slots;
163417885a7bSLuigi Rizzo 	uint32_t head, cur;
1635f9790aebSLuigi Rizzo 
1636847bf383SLuigi Rizzo 	ND(5,"%s kc %d kt %d h %d c %d t %d",
163717885a7bSLuigi Rizzo 		kring->name,
163817885a7bSLuigi Rizzo 		kring->nr_hwcur, kring->nr_hwtail,
163917885a7bSLuigi Rizzo 		ring->head, ring->cur, ring->tail);
164017885a7bSLuigi Rizzo 	/*
164117885a7bSLuigi Rizzo 	 * Before storing the new values, we should check they do not
164217885a7bSLuigi Rizzo 	 * move backwards. However:
164317885a7bSLuigi Rizzo 	 * - head is not an issue because the previous value is hwcur;
164417885a7bSLuigi Rizzo 	 * - cur could in principle go back, however it does not matter
164517885a7bSLuigi Rizzo 	 *   because we are processing a brand new rxsync()
164617885a7bSLuigi Rizzo 	 */
164717885a7bSLuigi Rizzo 	cur = kring->rcur = ring->cur;	/* read only once */
164817885a7bSLuigi Rizzo 	head = kring->rhead = ring->head;	/* read only once */
1649f9790aebSLuigi Rizzo #if 1 /* kernel sanity checks */
165037e3a6d3SLuigi Rizzo 	NM_FAIL_ON(kring->nr_hwcur >= n || kring->nr_hwtail >= n);
1651f9790aebSLuigi Rizzo #endif /* kernel sanity checks */
1652f9790aebSLuigi Rizzo 	/* user sanity checks */
165317885a7bSLuigi Rizzo 	if (kring->nr_hwtail >= kring->nr_hwcur) {
165417885a7bSLuigi Rizzo 		/* want hwcur <= rhead <= hwtail */
165537e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->nr_hwcur || head > kring->nr_hwtail);
165617885a7bSLuigi Rizzo 		/* and also rhead <= rcur <= hwtail */
165737e3a6d3SLuigi Rizzo 		NM_FAIL_ON(cur < head || cur > kring->nr_hwtail);
1658f9790aebSLuigi Rizzo 	} else {
165917885a7bSLuigi Rizzo 		/* we need rhead outside hwtail..hwcur */
166037e3a6d3SLuigi Rizzo 		NM_FAIL_ON(head < kring->nr_hwcur && head > kring->nr_hwtail);
166117885a7bSLuigi Rizzo 		/* two cases now: head <= hwtail or head >= hwcur  */
166217885a7bSLuigi Rizzo 		if (head <= kring->nr_hwtail) {
166317885a7bSLuigi Rizzo 			/* want head <= cur <= hwtail */
166437e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head || cur > kring->nr_hwtail);
166517885a7bSLuigi Rizzo 		} else {
166617885a7bSLuigi Rizzo 			/* cur must be outside hwtail..head */
166737e3a6d3SLuigi Rizzo 			NM_FAIL_ON(cur < head && cur > kring->nr_hwtail);
1668f9790aebSLuigi Rizzo 		}
1669f9790aebSLuigi Rizzo 	}
167017885a7bSLuigi Rizzo 	if (ring->tail != kring->rtail) {
167117885a7bSLuigi Rizzo 		RD(5, "%s tail overwritten was %d need %d",
167217885a7bSLuigi Rizzo 			kring->name,
167317885a7bSLuigi Rizzo 			ring->tail, kring->rtail);
167417885a7bSLuigi Rizzo 		ring->tail = kring->rtail;
167517885a7bSLuigi Rizzo 	}
167617885a7bSLuigi Rizzo 	return head;
1677f9790aebSLuigi Rizzo }
1678f9790aebSLuigi Rizzo 
167917885a7bSLuigi Rizzo 
1680f9790aebSLuigi Rizzo /*
168168b8534bSLuigi Rizzo  * Error routine called when txsync/rxsync detects an error.
168217885a7bSLuigi Rizzo  * Can't do much more than resetting head =cur = hwcur, tail = hwtail
168368b8534bSLuigi Rizzo  * Return 1 on reinit.
1684506cc70cSLuigi Rizzo  *
1685506cc70cSLuigi Rizzo  * This routine is only called by the upper half of the kernel.
1686506cc70cSLuigi Rizzo  * It only reads hwcur (which is changed only by the upper half, too)
168717885a7bSLuigi Rizzo  * and hwtail (which may be changed by the lower half, but only on
1688506cc70cSLuigi Rizzo  * a tx ring and only to increase it, so any error will be recovered
1689506cc70cSLuigi Rizzo  * on the next call). For the above, we don't strictly need to call
1690506cc70cSLuigi Rizzo  * it under lock.
169168b8534bSLuigi Rizzo  */
169268b8534bSLuigi Rizzo int
169368b8534bSLuigi Rizzo netmap_ring_reinit(struct netmap_kring *kring)
169468b8534bSLuigi Rizzo {
169568b8534bSLuigi Rizzo 	struct netmap_ring *ring = kring->ring;
169668b8534bSLuigi Rizzo 	u_int i, lim = kring->nkr_num_slots - 1;
169768b8534bSLuigi Rizzo 	int errors = 0;
169868b8534bSLuigi Rizzo 
1699ce3ee1e7SLuigi Rizzo 	// XXX KASSERT nm_kr_tryget
17004bf50f18SLuigi Rizzo 	RD(10, "called for %s", kring->name);
170117885a7bSLuigi Rizzo 	// XXX probably wrong to trust userspace
170217885a7bSLuigi Rizzo 	kring->rhead = ring->head;
170317885a7bSLuigi Rizzo 	kring->rcur  = ring->cur;
170417885a7bSLuigi Rizzo 	kring->rtail = ring->tail;
170517885a7bSLuigi Rizzo 
170668b8534bSLuigi Rizzo 	if (ring->cur > lim)
170768b8534bSLuigi Rizzo 		errors++;
170817885a7bSLuigi Rizzo 	if (ring->head > lim)
170917885a7bSLuigi Rizzo 		errors++;
171017885a7bSLuigi Rizzo 	if (ring->tail > lim)
171117885a7bSLuigi Rizzo 		errors++;
171268b8534bSLuigi Rizzo 	for (i = 0; i <= lim; i++) {
171368b8534bSLuigi Rizzo 		u_int idx = ring->slot[i].buf_idx;
171468b8534bSLuigi Rizzo 		u_int len = ring->slot[i].len;
1715847bf383SLuigi Rizzo 		if (idx < 2 || idx >= kring->na->na_lut.objtotal) {
171617885a7bSLuigi Rizzo 			RD(5, "bad index at slot %d idx %d len %d ", i, idx, len);
171768b8534bSLuigi Rizzo 			ring->slot[i].buf_idx = 0;
171868b8534bSLuigi Rizzo 			ring->slot[i].len = 0;
17194bf50f18SLuigi Rizzo 		} else if (len > NETMAP_BUF_SIZE(kring->na)) {
172068b8534bSLuigi Rizzo 			ring->slot[i].len = 0;
172117885a7bSLuigi Rizzo 			RD(5, "bad len at slot %d idx %d len %d", i, idx, len);
172268b8534bSLuigi Rizzo 		}
172368b8534bSLuigi Rizzo 	}
172468b8534bSLuigi Rizzo 	if (errors) {
17258241616dSLuigi Rizzo 		RD(10, "total %d errors", errors);
172617885a7bSLuigi Rizzo 		RD(10, "%s reinit, cur %d -> %d tail %d -> %d",
172717885a7bSLuigi Rizzo 			kring->name,
172868b8534bSLuigi Rizzo 			ring->cur, kring->nr_hwcur,
172917885a7bSLuigi Rizzo 			ring->tail, kring->nr_hwtail);
173017885a7bSLuigi Rizzo 		ring->head = kring->rhead = kring->nr_hwcur;
173117885a7bSLuigi Rizzo 		ring->cur  = kring->rcur  = kring->nr_hwcur;
173217885a7bSLuigi Rizzo 		ring->tail = kring->rtail = kring->nr_hwtail;
173368b8534bSLuigi Rizzo 	}
173468b8534bSLuigi Rizzo 	return (errors ? 1 : 0);
173568b8534bSLuigi Rizzo }
173668b8534bSLuigi Rizzo 
17374bf50f18SLuigi Rizzo /* interpret the ringid and flags fields of an nmreq, by translating them
17384bf50f18SLuigi Rizzo  * into a pair of intervals of ring indices:
17394bf50f18SLuigi Rizzo  *
17404bf50f18SLuigi Rizzo  * [priv->np_txqfirst, priv->np_txqlast) and
17414bf50f18SLuigi Rizzo  * [priv->np_rxqfirst, priv->np_rxqlast)
17424bf50f18SLuigi Rizzo  *
174368b8534bSLuigi Rizzo  */
17444bf50f18SLuigi Rizzo int
17454bf50f18SLuigi Rizzo netmap_interp_ringid(struct netmap_priv_d *priv, uint16_t ringid, uint32_t flags)
174668b8534bSLuigi Rizzo {
1747f9790aebSLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1748f0ea3689SLuigi Rizzo 	u_int j, i = ringid & NETMAP_RING_MASK;
1749f0ea3689SLuigi Rizzo 	u_int reg = flags & NR_REG_MASK;
175037e3a6d3SLuigi Rizzo 	int excluded_direction[] = { NR_TX_RINGS_ONLY, NR_RX_RINGS_ONLY };
1751847bf383SLuigi Rizzo 	enum txrx t;
175268b8534bSLuigi Rizzo 
1753f0ea3689SLuigi Rizzo 	if (reg == NR_REG_DEFAULT) {
1754f0ea3689SLuigi Rizzo 		/* convert from old ringid to flags */
175568b8534bSLuigi Rizzo 		if (ringid & NETMAP_SW_RING) {
1756f0ea3689SLuigi Rizzo 			reg = NR_REG_SW;
175768b8534bSLuigi Rizzo 		} else if (ringid & NETMAP_HW_RING) {
1758f0ea3689SLuigi Rizzo 			reg = NR_REG_ONE_NIC;
175968b8534bSLuigi Rizzo 		} else {
1760f0ea3689SLuigi Rizzo 			reg = NR_REG_ALL_NIC;
1761f0ea3689SLuigi Rizzo 		}
1762f0ea3689SLuigi Rizzo 		D("deprecated API, old ringid 0x%x -> ringid %x reg %d", ringid, i, reg);
1763f0ea3689SLuigi Rizzo 	}
176437e3a6d3SLuigi Rizzo 
1765c3e9b4dbSLuiz Otavio O Souza 	if ((flags & NR_PTNETMAP_HOST) && ((reg != NR_REG_ALL_NIC &&
1766c3e9b4dbSLuiz Otavio O Souza                     reg != NR_REG_PIPE_MASTER && reg != NR_REG_PIPE_SLAVE) ||
176737e3a6d3SLuigi Rizzo 			flags & (NR_RX_RINGS_ONLY|NR_TX_RINGS_ONLY))) {
176837e3a6d3SLuigi Rizzo 		D("Error: only NR_REG_ALL_NIC supported with netmap passthrough");
176937e3a6d3SLuigi Rizzo 		return EINVAL;
177037e3a6d3SLuigi Rizzo 	}
177137e3a6d3SLuigi Rizzo 
177237e3a6d3SLuigi Rizzo 	for_rx_tx(t) {
177337e3a6d3SLuigi Rizzo 		if (flags & excluded_direction[t]) {
177437e3a6d3SLuigi Rizzo 			priv->np_qfirst[t] = priv->np_qlast[t] = 0;
177537e3a6d3SLuigi Rizzo 			continue;
177637e3a6d3SLuigi Rizzo 		}
1777f0ea3689SLuigi Rizzo 		switch (reg) {
1778f0ea3689SLuigi Rizzo 		case NR_REG_ALL_NIC:
1779f0ea3689SLuigi Rizzo 		case NR_REG_PIPE_MASTER:
1780f0ea3689SLuigi Rizzo 		case NR_REG_PIPE_SLAVE:
1781847bf383SLuigi Rizzo 			priv->np_qfirst[t] = 0;
1782847bf383SLuigi Rizzo 			priv->np_qlast[t] = nma_get_nrings(na, t);
178337e3a6d3SLuigi Rizzo 			ND("ALL/PIPE: %s %d %d", nm_txrx2str(t),
178437e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1785f0ea3689SLuigi Rizzo 			break;
1786f0ea3689SLuigi Rizzo 		case NR_REG_SW:
1787f0ea3689SLuigi Rizzo 		case NR_REG_NIC_SW:
1788f0ea3689SLuigi Rizzo 			if (!(na->na_flags & NAF_HOST_RINGS)) {
1789f0ea3689SLuigi Rizzo 				D("host rings not supported");
1790f0ea3689SLuigi Rizzo 				return EINVAL;
1791f0ea3689SLuigi Rizzo 			}
1792847bf383SLuigi Rizzo 			priv->np_qfirst[t] = (reg == NR_REG_SW ?
1793847bf383SLuigi Rizzo 				nma_get_nrings(na, t) : 0);
1794847bf383SLuigi Rizzo 			priv->np_qlast[t] = nma_get_nrings(na, t) + 1;
179537e3a6d3SLuigi Rizzo 			ND("%s: %s %d %d", reg == NR_REG_SW ? "SW" : "NIC+SW",
179637e3a6d3SLuigi Rizzo 				nm_txrx2str(t),
179737e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1798f0ea3689SLuigi Rizzo 			break;
1799f0ea3689SLuigi Rizzo 		case NR_REG_ONE_NIC:
1800f0ea3689SLuigi Rizzo 			if (i >= na->num_tx_rings && i >= na->num_rx_rings) {
1801f0ea3689SLuigi Rizzo 				D("invalid ring id %d", i);
1802f0ea3689SLuigi Rizzo 				return EINVAL;
1803f0ea3689SLuigi Rizzo 			}
1804f0ea3689SLuigi Rizzo 			/* if not enough rings, use the first one */
1805f0ea3689SLuigi Rizzo 			j = i;
1806847bf383SLuigi Rizzo 			if (j >= nma_get_nrings(na, t))
1807f0ea3689SLuigi Rizzo 				j = 0;
1808847bf383SLuigi Rizzo 			priv->np_qfirst[t] = j;
1809847bf383SLuigi Rizzo 			priv->np_qlast[t] = j + 1;
181037e3a6d3SLuigi Rizzo 			ND("ONE_NIC: %s %d %d", nm_txrx2str(t),
181137e3a6d3SLuigi Rizzo 				priv->np_qfirst[t], priv->np_qlast[t]);
1812f0ea3689SLuigi Rizzo 			break;
1813f0ea3689SLuigi Rizzo 		default:
1814f0ea3689SLuigi Rizzo 			D("invalid regif type %d", reg);
1815f0ea3689SLuigi Rizzo 			return EINVAL;
181668b8534bSLuigi Rizzo 		}
181737e3a6d3SLuigi Rizzo 	}
1818f0ea3689SLuigi Rizzo 	priv->np_flags = (flags & ~NR_REG_MASK) | reg;
18194bf50f18SLuigi Rizzo 
1820c3e9b4dbSLuiz Otavio O Souza 	/* Allow transparent forwarding mode in the host --> nic
1821c3e9b4dbSLuiz Otavio O Souza 	 * direction only if all the TX hw rings have been opened. */
1822c3e9b4dbSLuiz Otavio O Souza 	if (priv->np_qfirst[NR_TX] == 0 &&
1823c3e9b4dbSLuiz Otavio O Souza 			priv->np_qlast[NR_TX] >= na->num_tx_rings) {
1824c3e9b4dbSLuiz Otavio O Souza 		priv->np_sync_flags |= NAF_CAN_FORWARD_DOWN;
1825c3e9b4dbSLuiz Otavio O Souza 	}
1826c3e9b4dbSLuiz Otavio O Souza 
1827ae10d1afSLuigi Rizzo 	if (netmap_verbose) {
1828f0ea3689SLuigi Rizzo 		D("%s: tx [%d,%d) rx [%d,%d) id %d",
18294bf50f18SLuigi Rizzo 			na->name,
1830847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
1831847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
1832847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
1833847bf383SLuigi Rizzo 			priv->np_qlast[NR_RX],
1834f0ea3689SLuigi Rizzo 			i);
1835ae10d1afSLuigi Rizzo 	}
183668b8534bSLuigi Rizzo 	return 0;
183768b8534bSLuigi Rizzo }
183868b8534bSLuigi Rizzo 
18394bf50f18SLuigi Rizzo 
18404bf50f18SLuigi Rizzo /*
18414bf50f18SLuigi Rizzo  * Set the ring ID. For devices with a single queue, a request
18424bf50f18SLuigi Rizzo  * for all rings is the same as a single ring.
18434bf50f18SLuigi Rizzo  */
18444bf50f18SLuigi Rizzo static int
18454bf50f18SLuigi Rizzo netmap_set_ringid(struct netmap_priv_d *priv, uint16_t ringid, uint32_t flags)
18464bf50f18SLuigi Rizzo {
18474bf50f18SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
18484bf50f18SLuigi Rizzo 	int error;
1849847bf383SLuigi Rizzo 	enum txrx t;
18504bf50f18SLuigi Rizzo 
18514bf50f18SLuigi Rizzo 	error = netmap_interp_ringid(priv, ringid, flags);
18524bf50f18SLuigi Rizzo 	if (error) {
18534bf50f18SLuigi Rizzo 		return error;
18544bf50f18SLuigi Rizzo 	}
18554bf50f18SLuigi Rizzo 
18564bf50f18SLuigi Rizzo 	priv->np_txpoll = (ringid & NETMAP_NO_TX_POLL) ? 0 : 1;
18574bf50f18SLuigi Rizzo 
18584bf50f18SLuigi Rizzo 	/* optimization: count the users registered for more than
18594bf50f18SLuigi Rizzo 	 * one ring, which are the ones sleeping on the global queue.
18604bf50f18SLuigi Rizzo 	 * The default netmap_notify() callback will then
18614bf50f18SLuigi Rizzo 	 * avoid signaling the global queue if nobody is using it
18624bf50f18SLuigi Rizzo 	 */
1863847bf383SLuigi Rizzo 	for_rx_tx(t) {
1864847bf383SLuigi Rizzo 		if (nm_si_user(priv, t))
1865847bf383SLuigi Rizzo 			na->si_users[t]++;
1866847bf383SLuigi Rizzo 	}
18674bf50f18SLuigi Rizzo 	return 0;
18684bf50f18SLuigi Rizzo }
18694bf50f18SLuigi Rizzo 
1870847bf383SLuigi Rizzo static void
1871847bf383SLuigi Rizzo netmap_unset_ringid(struct netmap_priv_d *priv)
1872847bf383SLuigi Rizzo {
1873847bf383SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1874847bf383SLuigi Rizzo 	enum txrx t;
1875847bf383SLuigi Rizzo 
1876847bf383SLuigi Rizzo 	for_rx_tx(t) {
1877847bf383SLuigi Rizzo 		if (nm_si_user(priv, t))
1878847bf383SLuigi Rizzo 			na->si_users[t]--;
1879847bf383SLuigi Rizzo 		priv->np_qfirst[t] = priv->np_qlast[t] = 0;
1880847bf383SLuigi Rizzo 	}
1881847bf383SLuigi Rizzo 	priv->np_flags = 0;
1882847bf383SLuigi Rizzo 	priv->np_txpoll = 0;
1883847bf383SLuigi Rizzo }
1884847bf383SLuigi Rizzo 
1885847bf383SLuigi Rizzo 
188637e3a6d3SLuigi Rizzo /* Set the nr_pending_mode for the requested rings.
188737e3a6d3SLuigi Rizzo  * If requested, also try to get exclusive access to the rings, provided
188837e3a6d3SLuigi Rizzo  * the rings we want to bind are not exclusively owned by a previous bind.
1889847bf383SLuigi Rizzo  */
1890847bf383SLuigi Rizzo static int
189137e3a6d3SLuigi Rizzo netmap_krings_get(struct netmap_priv_d *priv)
1892847bf383SLuigi Rizzo {
1893847bf383SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1894847bf383SLuigi Rizzo 	u_int i;
1895847bf383SLuigi Rizzo 	struct netmap_kring *kring;
1896847bf383SLuigi Rizzo 	int excl = (priv->np_flags & NR_EXCLUSIVE);
1897847bf383SLuigi Rizzo 	enum txrx t;
1898847bf383SLuigi Rizzo 
1899847bf383SLuigi Rizzo 	ND("%s: grabbing tx [%d, %d) rx [%d, %d)",
1900847bf383SLuigi Rizzo 			na->name,
1901847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
1902847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
1903847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
1904847bf383SLuigi Rizzo 			priv->np_qlast[NR_RX]);
1905847bf383SLuigi Rizzo 
1906847bf383SLuigi Rizzo 	/* first round: check that all the requested rings
1907847bf383SLuigi Rizzo 	 * are neither alread exclusively owned, nor we
1908847bf383SLuigi Rizzo 	 * want exclusive ownership when they are already in use
1909847bf383SLuigi Rizzo 	 */
1910847bf383SLuigi Rizzo 	for_rx_tx(t) {
1911847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
1912847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
1913847bf383SLuigi Rizzo 			if ((kring->nr_kflags & NKR_EXCLUSIVE) ||
1914847bf383SLuigi Rizzo 			    (kring->users && excl))
1915847bf383SLuigi Rizzo 			{
1916847bf383SLuigi Rizzo 				ND("ring %s busy", kring->name);
1917847bf383SLuigi Rizzo 				return EBUSY;
1918847bf383SLuigi Rizzo 			}
1919847bf383SLuigi Rizzo 		}
1920847bf383SLuigi Rizzo 	}
1921847bf383SLuigi Rizzo 
192237e3a6d3SLuigi Rizzo 	/* second round: increment usage count (possibly marking them
192337e3a6d3SLuigi Rizzo 	 * as exclusive) and set the nr_pending_mode
1924847bf383SLuigi Rizzo 	 */
1925847bf383SLuigi Rizzo 	for_rx_tx(t) {
1926847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
1927847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
1928847bf383SLuigi Rizzo 			kring->users++;
1929847bf383SLuigi Rizzo 			if (excl)
1930847bf383SLuigi Rizzo 				kring->nr_kflags |= NKR_EXCLUSIVE;
193137e3a6d3SLuigi Rizzo 	                kring->nr_pending_mode = NKR_NETMAP_ON;
1932847bf383SLuigi Rizzo 		}
1933847bf383SLuigi Rizzo 	}
1934847bf383SLuigi Rizzo 
1935847bf383SLuigi Rizzo 	return 0;
1936847bf383SLuigi Rizzo 
1937847bf383SLuigi Rizzo }
1938847bf383SLuigi Rizzo 
193937e3a6d3SLuigi Rizzo /* Undo netmap_krings_get(). This is done by clearing the exclusive mode
194037e3a6d3SLuigi Rizzo  * if was asked on regif, and unset the nr_pending_mode if we are the
194137e3a6d3SLuigi Rizzo  * last users of the involved rings. */
1942847bf383SLuigi Rizzo static void
194337e3a6d3SLuigi Rizzo netmap_krings_put(struct netmap_priv_d *priv)
1944847bf383SLuigi Rizzo {
1945847bf383SLuigi Rizzo 	struct netmap_adapter *na = priv->np_na;
1946847bf383SLuigi Rizzo 	u_int i;
1947847bf383SLuigi Rizzo 	struct netmap_kring *kring;
1948847bf383SLuigi Rizzo 	int excl = (priv->np_flags & NR_EXCLUSIVE);
1949847bf383SLuigi Rizzo 	enum txrx t;
1950847bf383SLuigi Rizzo 
1951847bf383SLuigi Rizzo 	ND("%s: releasing tx [%d, %d) rx [%d, %d)",
1952847bf383SLuigi Rizzo 			na->name,
1953847bf383SLuigi Rizzo 			priv->np_qfirst[NR_TX],
1954847bf383SLuigi Rizzo 			priv->np_qlast[NR_TX],
1955847bf383SLuigi Rizzo 			priv->np_qfirst[NR_RX],
1956847bf383SLuigi Rizzo 			priv->np_qlast[MR_RX]);
1957847bf383SLuigi Rizzo 
1958847bf383SLuigi Rizzo 
1959847bf383SLuigi Rizzo 	for_rx_tx(t) {
1960847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
1961847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
1962847bf383SLuigi Rizzo 			if (excl)
1963847bf383SLuigi Rizzo 				kring->nr_kflags &= ~NKR_EXCLUSIVE;
1964847bf383SLuigi Rizzo 			kring->users--;
196537e3a6d3SLuigi Rizzo 			if (kring->users == 0)
196637e3a6d3SLuigi Rizzo 				kring->nr_pending_mode = NKR_NETMAP_OFF;
1967847bf383SLuigi Rizzo 		}
1968847bf383SLuigi Rizzo 	}
1969847bf383SLuigi Rizzo }
1970847bf383SLuigi Rizzo 
1971f18be576SLuigi Rizzo /*
1972f18be576SLuigi Rizzo  * possibly move the interface to netmap-mode.
1973f18be576SLuigi Rizzo  * If success it returns a pointer to netmap_if, otherwise NULL.
1974ce3ee1e7SLuigi Rizzo  * This must be called with NMG_LOCK held.
19754bf50f18SLuigi Rizzo  *
19764bf50f18SLuigi Rizzo  * The following na callbacks are called in the process:
19774bf50f18SLuigi Rizzo  *
19784bf50f18SLuigi Rizzo  * na->nm_config()			[by netmap_update_config]
19794bf50f18SLuigi Rizzo  * (get current number and size of rings)
19804bf50f18SLuigi Rizzo  *
19814bf50f18SLuigi Rizzo  *  	We have a generic one for linux (netmap_linux_config).
19824bf50f18SLuigi Rizzo  *  	The bwrap has to override this, since it has to forward
19834bf50f18SLuigi Rizzo  *  	the request to the wrapped adapter (netmap_bwrap_config).
19844bf50f18SLuigi Rizzo  *
19854bf50f18SLuigi Rizzo  *
1986847bf383SLuigi Rizzo  * na->nm_krings_create()
19874bf50f18SLuigi Rizzo  * (create and init the krings array)
19884bf50f18SLuigi Rizzo  *
19894bf50f18SLuigi Rizzo  * 	One of the following:
19904bf50f18SLuigi Rizzo  *
19914bf50f18SLuigi Rizzo  *	* netmap_hw_krings_create, 			(hw ports)
19924bf50f18SLuigi Rizzo  *		creates the standard layout for the krings
19934bf50f18SLuigi Rizzo  * 		and adds the mbq (used for the host rings).
19944bf50f18SLuigi Rizzo  *
19954bf50f18SLuigi Rizzo  * 	* netmap_vp_krings_create			(VALE ports)
19964bf50f18SLuigi Rizzo  * 		add leases and scratchpads
19974bf50f18SLuigi Rizzo  *
19984bf50f18SLuigi Rizzo  * 	* netmap_pipe_krings_create			(pipes)
19994bf50f18SLuigi Rizzo  * 		create the krings and rings of both ends and
20004bf50f18SLuigi Rizzo  * 		cross-link them
20014bf50f18SLuigi Rizzo  *
20024bf50f18SLuigi Rizzo  *      * netmap_monitor_krings_create 			(monitors)
20034bf50f18SLuigi Rizzo  *      	avoid allocating the mbq
20044bf50f18SLuigi Rizzo  *
20054bf50f18SLuigi Rizzo  *      * netmap_bwrap_krings_create			(bwraps)
20064bf50f18SLuigi Rizzo  *      	create both the brap krings array,
20074bf50f18SLuigi Rizzo  *      	the krings array of the wrapped adapter, and
20084bf50f18SLuigi Rizzo  *      	(if needed) the fake array for the host adapter
20094bf50f18SLuigi Rizzo  *
20104bf50f18SLuigi Rizzo  * na->nm_register(, 1)
20114bf50f18SLuigi Rizzo  * (put the adapter in netmap mode)
20124bf50f18SLuigi Rizzo  *
20134bf50f18SLuigi Rizzo  * 	This may be one of the following:
20144bf50f18SLuigi Rizzo  *
201537e3a6d3SLuigi Rizzo  * 	* netmap_hw_reg				        (hw ports)
20164bf50f18SLuigi Rizzo  * 		checks that the ifp is still there, then calls
20174bf50f18SLuigi Rizzo  * 		the hardware specific callback;
20184bf50f18SLuigi Rizzo  *
20194bf50f18SLuigi Rizzo  * 	* netmap_vp_reg					(VALE ports)
20204bf50f18SLuigi Rizzo  *		If the port is connected to a bridge,
20214bf50f18SLuigi Rizzo  *		set the NAF_NETMAP_ON flag under the
20224bf50f18SLuigi Rizzo  *		bridge write lock.
20234bf50f18SLuigi Rizzo  *
20244bf50f18SLuigi Rizzo  *	* netmap_pipe_reg				(pipes)
20254bf50f18SLuigi Rizzo  *		inform the other pipe end that it is no
2026453130d9SPedro F. Giffuni  *		longer responsible for the lifetime of this
20274bf50f18SLuigi Rizzo  *		pipe end
20284bf50f18SLuigi Rizzo  *
20294bf50f18SLuigi Rizzo  *	* netmap_monitor_reg				(monitors)
20304bf50f18SLuigi Rizzo  *		intercept the sync callbacks of the monitored
20314bf50f18SLuigi Rizzo  *		rings
20324bf50f18SLuigi Rizzo  *
203337e3a6d3SLuigi Rizzo  *	* netmap_bwrap_reg				(bwraps)
20344bf50f18SLuigi Rizzo  *		cross-link the bwrap and hwna rings,
20354bf50f18SLuigi Rizzo  *		forward the request to the hwna, override
20364bf50f18SLuigi Rizzo  *		the hwna notify callback (to get the frames
20374bf50f18SLuigi Rizzo  *		coming from outside go through the bridge).
20384bf50f18SLuigi Rizzo  *
20394bf50f18SLuigi Rizzo  *
2040f18be576SLuigi Rizzo  */
2041847bf383SLuigi Rizzo int
2042f9790aebSLuigi Rizzo netmap_do_regif(struct netmap_priv_d *priv, struct netmap_adapter *na,
2043847bf383SLuigi Rizzo 	uint16_t ringid, uint32_t flags)
2044f18be576SLuigi Rizzo {
2045f18be576SLuigi Rizzo 	struct netmap_if *nifp = NULL;
2046847bf383SLuigi Rizzo 	int error;
2047f18be576SLuigi Rizzo 
2048ce3ee1e7SLuigi Rizzo 	NMG_LOCK_ASSERT();
2049f18be576SLuigi Rizzo 	/* ring configuration may have changed, fetch from the card */
2050f18be576SLuigi Rizzo 	netmap_update_config(na);
2051f9790aebSLuigi Rizzo 	priv->np_na = na;     /* store the reference */
2052f0ea3689SLuigi Rizzo 	error = netmap_set_ringid(priv, ringid, flags);
2053f18be576SLuigi Rizzo 	if (error)
2054847bf383SLuigi Rizzo 		goto err;
2055847bf383SLuigi Rizzo 	error = netmap_mem_finalize(na->nm_mem, na);
2056ce3ee1e7SLuigi Rizzo 	if (error)
2057847bf383SLuigi Rizzo 		goto err;
2058847bf383SLuigi Rizzo 
2059847bf383SLuigi Rizzo 	if (na->active_fds == 0) {
2060847bf383SLuigi Rizzo 		/*
2061847bf383SLuigi Rizzo 		 * If this is the first registration of the adapter,
206237e3a6d3SLuigi Rizzo 		 * create the  in-kernel view of the netmap rings,
2063847bf383SLuigi Rizzo 		 * the netmap krings.
2064847bf383SLuigi Rizzo 		 */
2065847bf383SLuigi Rizzo 
2066847bf383SLuigi Rizzo 		/*
2067847bf383SLuigi Rizzo 		 * Depending on the adapter, this may also create
2068847bf383SLuigi Rizzo 		 * the netmap rings themselves
2069847bf383SLuigi Rizzo 		 */
2070847bf383SLuigi Rizzo 		error = na->nm_krings_create(na);
2071847bf383SLuigi Rizzo 		if (error)
2072847bf383SLuigi Rizzo 			goto err_drop_mem;
2073847bf383SLuigi Rizzo 
2074ce3ee1e7SLuigi Rizzo 	}
2075847bf383SLuigi Rizzo 
207637e3a6d3SLuigi Rizzo 	/* now the krings must exist and we can check whether some
207737e3a6d3SLuigi Rizzo 	 * previous bind has exclusive ownership on them, and set
207837e3a6d3SLuigi Rizzo 	 * nr_pending_mode
2079847bf383SLuigi Rizzo 	 */
208037e3a6d3SLuigi Rizzo 	error = netmap_krings_get(priv);
2081847bf383SLuigi Rizzo 	if (error)
208237e3a6d3SLuigi Rizzo 		goto err_del_krings;
208337e3a6d3SLuigi Rizzo 
208437e3a6d3SLuigi Rizzo 	/* create all needed missing netmap rings */
208537e3a6d3SLuigi Rizzo 	error = netmap_mem_rings_create(na);
208637e3a6d3SLuigi Rizzo 	if (error)
208737e3a6d3SLuigi Rizzo 		goto err_rel_excl;
2088847bf383SLuigi Rizzo 
2089847bf383SLuigi Rizzo 	/* in all cases, create a new netmap if */
2090c3e9b4dbSLuiz Otavio O Souza 	nifp = netmap_mem_if_new(na, priv);
2091847bf383SLuigi Rizzo 	if (nifp == NULL) {
2092f18be576SLuigi Rizzo 		error = ENOMEM;
209337e3a6d3SLuigi Rizzo 		goto err_del_rings;
2094ce3ee1e7SLuigi Rizzo 	}
2095847bf383SLuigi Rizzo 
209637e3a6d3SLuigi Rizzo 	if (na->active_fds == 0) {
209789cc2556SLuigi Rizzo 		/* cache the allocator info in the na */
209837e3a6d3SLuigi Rizzo 		error = netmap_mem_get_lut(na->nm_mem, &na->na_lut);
2099847bf383SLuigi Rizzo 		if (error)
2100847bf383SLuigi Rizzo 			goto err_del_if;
210137e3a6d3SLuigi Rizzo 		ND("lut %p bufs %u size %u", na->na_lut.lut, na->na_lut.objtotal,
210237e3a6d3SLuigi Rizzo 					    na->na_lut.objsize);
2103f18be576SLuigi Rizzo 	}
2104847bf383SLuigi Rizzo 
210537e3a6d3SLuigi Rizzo 	if (nm_kring_pending(priv)) {
210637e3a6d3SLuigi Rizzo 		/* Some kring is switching mode, tell the adapter to
210737e3a6d3SLuigi Rizzo 		 * react on this. */
210837e3a6d3SLuigi Rizzo 		error = na->nm_register(na, 1);
210937e3a6d3SLuigi Rizzo 		if (error)
211037e3a6d3SLuigi Rizzo 			goto err_put_lut;
211137e3a6d3SLuigi Rizzo 	}
211237e3a6d3SLuigi Rizzo 
211337e3a6d3SLuigi Rizzo 	/* Commit the reference. */
211437e3a6d3SLuigi Rizzo 	na->active_fds++;
211537e3a6d3SLuigi Rizzo 
2116ce3ee1e7SLuigi Rizzo 	/*
2117847bf383SLuigi Rizzo 	 * advertise that the interface is ready by setting np_nifp.
2118847bf383SLuigi Rizzo 	 * The barrier is needed because readers (poll, *SYNC and mmap)
2119ce3ee1e7SLuigi Rizzo 	 * check for priv->np_nifp != NULL without locking
2120ce3ee1e7SLuigi Rizzo 	 */
2121847bf383SLuigi Rizzo 	mb(); /* make sure previous writes are visible to all CPUs */
2122ce3ee1e7SLuigi Rizzo 	priv->np_nifp = nifp;
2123847bf383SLuigi Rizzo 
2124847bf383SLuigi Rizzo 	return 0;
2125847bf383SLuigi Rizzo 
212637e3a6d3SLuigi Rizzo err_put_lut:
212737e3a6d3SLuigi Rizzo 	if (na->active_fds == 0)
2128847bf383SLuigi Rizzo 		memset(&na->na_lut, 0, sizeof(na->na_lut));
212937e3a6d3SLuigi Rizzo err_del_if:
2130847bf383SLuigi Rizzo 	netmap_mem_if_delete(na, nifp);
2131847bf383SLuigi Rizzo err_rel_excl:
213237e3a6d3SLuigi Rizzo 	netmap_krings_put(priv);
2133847bf383SLuigi Rizzo err_del_rings:
2134847bf383SLuigi Rizzo 	netmap_mem_rings_delete(na);
2135847bf383SLuigi Rizzo err_del_krings:
2136847bf383SLuigi Rizzo 	if (na->active_fds == 0)
2137847bf383SLuigi Rizzo 		na->nm_krings_delete(na);
2138847bf383SLuigi Rizzo err_drop_mem:
2139847bf383SLuigi Rizzo 	netmap_mem_deref(na->nm_mem, na);
2140847bf383SLuigi Rizzo err:
2141847bf383SLuigi Rizzo 	priv->np_na = NULL;
2142847bf383SLuigi Rizzo 	return error;
2143ce3ee1e7SLuigi Rizzo }
2144847bf383SLuigi Rizzo 
2145847bf383SLuigi Rizzo 
2146847bf383SLuigi Rizzo /*
214737e3a6d3SLuigi Rizzo  * update kring and ring at the end of rxsync/txsync.
2148847bf383SLuigi Rizzo  */
2149847bf383SLuigi Rizzo static inline void
215037e3a6d3SLuigi Rizzo nm_sync_finalize(struct netmap_kring *kring)
2151847bf383SLuigi Rizzo {
215237e3a6d3SLuigi Rizzo 	/*
215337e3a6d3SLuigi Rizzo 	 * Update ring tail to what the kernel knows
215437e3a6d3SLuigi Rizzo 	 * After txsync: head/rhead/hwcur might be behind cur/rcur
215537e3a6d3SLuigi Rizzo 	 * if no carrier.
215637e3a6d3SLuigi Rizzo 	 */
2157847bf383SLuigi Rizzo 	kring->ring->tail = kring->rtail = kring->nr_hwtail;
2158847bf383SLuigi Rizzo 
2159847bf383SLuigi Rizzo 	ND(5, "%s now hwcur %d hwtail %d head %d cur %d tail %d",
2160847bf383SLuigi Rizzo 		kring->name, kring->nr_hwcur, kring->nr_hwtail,
2161847bf383SLuigi Rizzo 		kring->rhead, kring->rcur, kring->rtail);
2162847bf383SLuigi Rizzo }
2163847bf383SLuigi Rizzo 
2164c3e9b4dbSLuiz Otavio O Souza /* set ring timestamp */
2165c3e9b4dbSLuiz Otavio O Souza static inline void
2166c3e9b4dbSLuiz Otavio O Souza ring_timestamp_set(struct netmap_ring *ring)
2167c3e9b4dbSLuiz Otavio O Souza {
2168c3e9b4dbSLuiz Otavio O Souza 	if (netmap_no_timestamp == 0 || ring->flags & NR_TIMESTAMP) {
2169c3e9b4dbSLuiz Otavio O Souza 		microtime(&ring->ts);
2170c3e9b4dbSLuiz Otavio O Souza 	}
2171c3e9b4dbSLuiz Otavio O Souza }
2172c3e9b4dbSLuiz Otavio O Souza 
2173c3e9b4dbSLuiz Otavio O Souza 
217468b8534bSLuigi Rizzo /*
217568b8534bSLuigi Rizzo  * ioctl(2) support for the "netmap" device.
217668b8534bSLuigi Rizzo  *
217768b8534bSLuigi Rizzo  * Following a list of accepted commands:
217868b8534bSLuigi Rizzo  * - NIOCGINFO
217968b8534bSLuigi Rizzo  * - SIOCGIFADDR	just for convenience
218068b8534bSLuigi Rizzo  * - NIOCREGIF
218168b8534bSLuigi Rizzo  * - NIOCTXSYNC
218268b8534bSLuigi Rizzo  * - NIOCRXSYNC
218368b8534bSLuigi Rizzo  *
218468b8534bSLuigi Rizzo  * Return 0 on success, errno otherwise.
218568b8534bSLuigi Rizzo  */
2186f9790aebSLuigi Rizzo int
218737e3a6d3SLuigi Rizzo netmap_ioctl(struct netmap_priv_d *priv, u_long cmd, caddr_t data, struct thread *td)
218868b8534bSLuigi Rizzo {
2189c3e9b4dbSLuiz Otavio O Souza 	struct mbq q;	/* packets from RX hw queues to host stack */
219068b8534bSLuigi Rizzo 	struct nmreq *nmr = (struct nmreq *) data;
2191ce3ee1e7SLuigi Rizzo 	struct netmap_adapter *na = NULL;
2192c3e9b4dbSLuiz Otavio O Souza 	struct netmap_mem_d *nmd = NULL;
219337e3a6d3SLuigi Rizzo 	struct ifnet *ifp = NULL;
219437e3a6d3SLuigi Rizzo 	int error = 0;
2195f0ea3689SLuigi Rizzo 	u_int i, qfirst, qlast;
219668b8534bSLuigi Rizzo 	struct netmap_if *nifp;
2197ce3ee1e7SLuigi Rizzo 	struct netmap_kring *krings;
2198c3e9b4dbSLuiz Otavio O Souza 	int sync_flags;
2199847bf383SLuigi Rizzo 	enum txrx t;
220068b8534bSLuigi Rizzo 
220117885a7bSLuigi Rizzo 	if (cmd == NIOCGINFO || cmd == NIOCREGIF) {
220217885a7bSLuigi Rizzo 		/* truncate name */
220317885a7bSLuigi Rizzo 		nmr->nr_name[sizeof(nmr->nr_name) - 1] = '\0';
220417885a7bSLuigi Rizzo 		if (nmr->nr_version != NETMAP_API) {
220517885a7bSLuigi Rizzo 			D("API mismatch for %s got %d need %d",
220617885a7bSLuigi Rizzo 				nmr->nr_name,
220717885a7bSLuigi Rizzo 				nmr->nr_version, NETMAP_API);
220817885a7bSLuigi Rizzo 			nmr->nr_version = NETMAP_API;
2209f0ea3689SLuigi Rizzo 		}
2210f0ea3689SLuigi Rizzo 		if (nmr->nr_version < NETMAP_MIN_API ||
2211f0ea3689SLuigi Rizzo 		    nmr->nr_version > NETMAP_MAX_API) {
221217885a7bSLuigi Rizzo 			return EINVAL;
221317885a7bSLuigi Rizzo 		}
221417885a7bSLuigi Rizzo 	}
221568b8534bSLuigi Rizzo 
221668b8534bSLuigi Rizzo 	switch (cmd) {
221768b8534bSLuigi Rizzo 	case NIOCGINFO:		/* return capabilities etc */
2218f18be576SLuigi Rizzo 		if (nmr->nr_cmd == NETMAP_BDG_LIST) {
2219f18be576SLuigi Rizzo 			error = netmap_bdg_ctl(nmr, NULL);
2220f18be576SLuigi Rizzo 			break;
2221f18be576SLuigi Rizzo 		}
2222ce3ee1e7SLuigi Rizzo 
2223ce3ee1e7SLuigi Rizzo 		NMG_LOCK();
2224ce3ee1e7SLuigi Rizzo 		do {
2225ce3ee1e7SLuigi Rizzo 			/* memsize is always valid */
2226ce3ee1e7SLuigi Rizzo 			u_int memflags;
2227ce3ee1e7SLuigi Rizzo 
2228ce3ee1e7SLuigi Rizzo 			if (nmr->nr_name[0] != '\0') {
222937e3a6d3SLuigi Rizzo 
2230ce3ee1e7SLuigi Rizzo 				/* get a refcount */
2231c3e9b4dbSLuiz Otavio O Souza 				error = netmap_get_na(nmr, &na, &ifp, NULL, 1 /* create */);
223237e3a6d3SLuigi Rizzo 				if (error) {
223337e3a6d3SLuigi Rizzo 					na = NULL;
223437e3a6d3SLuigi Rizzo 					ifp = NULL;
22358241616dSLuigi Rizzo 					break;
223637e3a6d3SLuigi Rizzo 				}
2237f9790aebSLuigi Rizzo 				nmd = na->nm_mem; /* get memory allocator */
2238c3e9b4dbSLuiz Otavio O Souza 			} else {
2239c3e9b4dbSLuiz Otavio O Souza 				nmd = netmap_mem_find(nmr->nr_arg2 ? nmr->nr_arg2 : 1);
2240c3e9b4dbSLuiz Otavio O Souza 				if (nmd == NULL) {
2241c3e9b4dbSLuiz Otavio O Souza 					error = EINVAL;
2242c3e9b4dbSLuiz Otavio O Souza 					break;
2243c3e9b4dbSLuiz Otavio O Souza 				}
2244ce3ee1e7SLuigi Rizzo 			}
2245ce3ee1e7SLuigi Rizzo 
2246f0ea3689SLuigi Rizzo 			error = netmap_mem_get_info(nmd, &nmr->nr_memsize, &memflags,
2247f0ea3689SLuigi Rizzo 				&nmr->nr_arg2);
2248ce3ee1e7SLuigi Rizzo 			if (error)
2249ce3ee1e7SLuigi Rizzo 				break;
2250ce3ee1e7SLuigi Rizzo 			if (na == NULL) /* only memory info */
2251ce3ee1e7SLuigi Rizzo 				break;
22528241616dSLuigi Rizzo 			nmr->nr_offset = 0;
22538241616dSLuigi Rizzo 			nmr->nr_rx_slots = nmr->nr_tx_slots = 0;
2254ae10d1afSLuigi Rizzo 			netmap_update_config(na);
2255d76bf4ffSLuigi Rizzo 			nmr->nr_rx_rings = na->num_rx_rings;
2256d76bf4ffSLuigi Rizzo 			nmr->nr_tx_rings = na->num_tx_rings;
225764ae02c3SLuigi Rizzo 			nmr->nr_rx_slots = na->num_rx_desc;
225864ae02c3SLuigi Rizzo 			nmr->nr_tx_slots = na->num_tx_desc;
2259ce3ee1e7SLuigi Rizzo 		} while (0);
226037e3a6d3SLuigi Rizzo 		netmap_unget_na(na, ifp);
2261ce3ee1e7SLuigi Rizzo 		NMG_UNLOCK();
226268b8534bSLuigi Rizzo 		break;
226368b8534bSLuigi Rizzo 
226468b8534bSLuigi Rizzo 	case NIOCREGIF:
2265844a6f0cSLuigi Rizzo 		/*
2266844a6f0cSLuigi Rizzo 		 * If nmr->nr_cmd is not zero, this NIOCREGIF is not really
2267844a6f0cSLuigi Rizzo 		 * a regif operation, but a different one, specified by the
2268844a6f0cSLuigi Rizzo 		 * value of nmr->nr_cmd.
2269844a6f0cSLuigi Rizzo 		 */
2270f18be576SLuigi Rizzo 		i = nmr->nr_cmd;
2271f9790aebSLuigi Rizzo 		if (i == NETMAP_BDG_ATTACH || i == NETMAP_BDG_DETACH
22724bf50f18SLuigi Rizzo 				|| i == NETMAP_BDG_VNET_HDR
22734bf50f18SLuigi Rizzo 				|| i == NETMAP_BDG_NEWIF
227437e3a6d3SLuigi Rizzo 				|| i == NETMAP_BDG_DELIF
227537e3a6d3SLuigi Rizzo 				|| i == NETMAP_BDG_POLLING_ON
227637e3a6d3SLuigi Rizzo 				|| i == NETMAP_BDG_POLLING_OFF) {
2277844a6f0cSLuigi Rizzo 			/* possibly attach/detach NIC and VALE switch */
2278f18be576SLuigi Rizzo 			error = netmap_bdg_ctl(nmr, NULL);
2279f18be576SLuigi Rizzo 			break;
228037e3a6d3SLuigi Rizzo 		} else if (i == NETMAP_PT_HOST_CREATE || i == NETMAP_PT_HOST_DELETE) {
2281844a6f0cSLuigi Rizzo 			/* forward the command to the ptnetmap subsystem */
228237e3a6d3SLuigi Rizzo 			error = ptnetmap_ctl(nmr, priv->np_na);
228337e3a6d3SLuigi Rizzo 			break;
228437e3a6d3SLuigi Rizzo 		} else if (i == NETMAP_VNET_HDR_GET) {
2285844a6f0cSLuigi Rizzo 			/* get vnet-header length for this netmap port */
228637e3a6d3SLuigi Rizzo 			struct ifnet *ifp;
228737e3a6d3SLuigi Rizzo 
228837e3a6d3SLuigi Rizzo 			NMG_LOCK();
2289c3e9b4dbSLuiz Otavio O Souza 			error = netmap_get_na(nmr, &na, &ifp, NULL, 0);
229037e3a6d3SLuigi Rizzo 			if (na && !error) {
229137e3a6d3SLuigi Rizzo 				nmr->nr_arg1 = na->virt_hdr_len;
229237e3a6d3SLuigi Rizzo 			}
229337e3a6d3SLuigi Rizzo 			netmap_unget_na(na, ifp);
229437e3a6d3SLuigi Rizzo 			NMG_UNLOCK();
229537e3a6d3SLuigi Rizzo 			break;
2296844a6f0cSLuigi Rizzo 		} else if (i == NETMAP_POOLS_INFO_GET) {
2297844a6f0cSLuigi Rizzo 			/* get information from the memory allocator */
2298c3e9b4dbSLuiz Otavio O Souza 			NMG_LOCK();
2299c3e9b4dbSLuiz Otavio O Souza 			if (priv->np_na && priv->np_na->nm_mem) {
2300c3e9b4dbSLuiz Otavio O Souza 				struct netmap_mem_d *nmd = priv->np_na->nm_mem;
2301c3e9b4dbSLuiz Otavio O Souza 				error = netmap_mem_pools_info_get(nmr, nmd);
2302c3e9b4dbSLuiz Otavio O Souza 			} else {
2303c3e9b4dbSLuiz Otavio O Souza 				error = EINVAL;
2304c3e9b4dbSLuiz Otavio O Souza 			}
2305c3e9b4dbSLuiz Otavio O Souza 			NMG_UNLOCK();
2306844a6f0cSLuigi Rizzo 			break;
2307f18be576SLuigi Rizzo 		} else if (i != 0) {
2308f18be576SLuigi Rizzo 			D("nr_cmd must be 0 not %d", i);
2309f18be576SLuigi Rizzo 			error = EINVAL;
2310f18be576SLuigi Rizzo 			break;
2311f18be576SLuigi Rizzo 		}
2312f18be576SLuigi Rizzo 
23138241616dSLuigi Rizzo 		/* protect access to priv from concurrent NIOCREGIF */
2314ce3ee1e7SLuigi Rizzo 		NMG_LOCK();
2315ce3ee1e7SLuigi Rizzo 		do {
2316ce3ee1e7SLuigi Rizzo 			u_int memflags;
231737e3a6d3SLuigi Rizzo 			struct ifnet *ifp;
2318ce3ee1e7SLuigi Rizzo 
2319847bf383SLuigi Rizzo 			if (priv->np_nifp != NULL) {	/* thread already registered */
2320f0ea3689SLuigi Rizzo 				error = EBUSY;
2321506cc70cSLuigi Rizzo 				break;
2322506cc70cSLuigi Rizzo 			}
2323c3e9b4dbSLuiz Otavio O Souza 
2324c3e9b4dbSLuiz Otavio O Souza 			if (nmr->nr_arg2) {
2325c3e9b4dbSLuiz Otavio O Souza 				/* find the allocator and get a reference */
2326c3e9b4dbSLuiz Otavio O Souza 				nmd = netmap_mem_find(nmr->nr_arg2);
2327c3e9b4dbSLuiz Otavio O Souza 				if (nmd == NULL) {
2328c3e9b4dbSLuiz Otavio O Souza 					error = EINVAL;
2329c3e9b4dbSLuiz Otavio O Souza 					break;
2330c3e9b4dbSLuiz Otavio O Souza 				}
2331c3e9b4dbSLuiz Otavio O Souza 			}
233268b8534bSLuigi Rizzo 			/* find the interface and a reference */
2333c3e9b4dbSLuiz Otavio O Souza 			error = netmap_get_na(nmr, &na, &ifp, nmd,
233437e3a6d3SLuigi Rizzo 					      1 /* create */); /* keep reference */
233568b8534bSLuigi Rizzo 			if (error)
2336ce3ee1e7SLuigi Rizzo 				break;
2337f9790aebSLuigi Rizzo 			if (NETMAP_OWNED_BY_KERN(na)) {
2338ce3ee1e7SLuigi Rizzo 				error = EBUSY;
2339ce3ee1e7SLuigi Rizzo 				break;
2340f196ce38SLuigi Rizzo 			}
234137e3a6d3SLuigi Rizzo 
234237e3a6d3SLuigi Rizzo 			if (na->virt_hdr_len && !(nmr->nr_flags & NR_ACCEPT_VNET_HDR)) {
234337e3a6d3SLuigi Rizzo 				error = EIO;
234437e3a6d3SLuigi Rizzo 				break;
234537e3a6d3SLuigi Rizzo 			}
234637e3a6d3SLuigi Rizzo 
2347847bf383SLuigi Rizzo 			error = netmap_do_regif(priv, na, nmr->nr_ringid, nmr->nr_flags);
2348847bf383SLuigi Rizzo 			if (error) {    /* reg. failed, release priv and ref */
2349ce3ee1e7SLuigi Rizzo 				break;
235068b8534bSLuigi Rizzo 			}
2351847bf383SLuigi Rizzo 			nifp = priv->np_nifp;
2352f0ea3689SLuigi Rizzo 			priv->np_td = td; // XXX kqueue, debugging only
235368b8534bSLuigi Rizzo 
235468b8534bSLuigi Rizzo 			/* return the offset of the netmap_if object */
2355d76bf4ffSLuigi Rizzo 			nmr->nr_rx_rings = na->num_rx_rings;
2356d76bf4ffSLuigi Rizzo 			nmr->nr_tx_rings = na->num_tx_rings;
235764ae02c3SLuigi Rizzo 			nmr->nr_rx_slots = na->num_rx_desc;
235864ae02c3SLuigi Rizzo 			nmr->nr_tx_slots = na->num_tx_desc;
2359f0ea3689SLuigi Rizzo 			error = netmap_mem_get_info(na->nm_mem, &nmr->nr_memsize, &memflags,
2360f0ea3689SLuigi Rizzo 				&nmr->nr_arg2);
2361ce3ee1e7SLuigi Rizzo 			if (error) {
2362847bf383SLuigi Rizzo 				netmap_do_unregif(priv);
2363ce3ee1e7SLuigi Rizzo 				break;
2364ce3ee1e7SLuigi Rizzo 			}
2365ce3ee1e7SLuigi Rizzo 			if (memflags & NETMAP_MEM_PRIVATE) {
23663d819cb6SLuigi Rizzo 				*(uint32_t *)(uintptr_t)&nifp->ni_flags |= NI_PRIV_MEM;
2367ce3ee1e7SLuigi Rizzo 			}
2368847bf383SLuigi Rizzo 			for_rx_tx(t) {
2369847bf383SLuigi Rizzo 				priv->np_si[t] = nm_si_user(priv, t) ?
2370847bf383SLuigi Rizzo 					&na->si[t] : &NMR(na, t)[priv->np_qfirst[t]].si;
2371847bf383SLuigi Rizzo 			}
2372f0ea3689SLuigi Rizzo 
2373f0ea3689SLuigi Rizzo 			if (nmr->nr_arg3) {
237437e3a6d3SLuigi Rizzo 				if (netmap_verbose)
2375f0ea3689SLuigi Rizzo 					D("requested %d extra buffers", nmr->nr_arg3);
2376f0ea3689SLuigi Rizzo 				nmr->nr_arg3 = netmap_extra_alloc(na,
2377f0ea3689SLuigi Rizzo 					&nifp->ni_bufs_head, nmr->nr_arg3);
237837e3a6d3SLuigi Rizzo 				if (netmap_verbose)
2379f0ea3689SLuigi Rizzo 					D("got %d extra buffers", nmr->nr_arg3);
2380f0ea3689SLuigi Rizzo 			}
2381ce3ee1e7SLuigi Rizzo 			nmr->nr_offset = netmap_mem_if_offset(na->nm_mem, nifp);
238237e3a6d3SLuigi Rizzo 
238337e3a6d3SLuigi Rizzo 			/* store ifp reference so that priv destructor may release it */
238437e3a6d3SLuigi Rizzo 			priv->np_ifp = ifp;
2385ce3ee1e7SLuigi Rizzo 		} while (0);
2386c3e9b4dbSLuiz Otavio O Souza 		if (error) {
2387c3e9b4dbSLuiz Otavio O Souza 			netmap_unget_na(na, ifp);
2388c3e9b4dbSLuiz Otavio O Souza 		}
2389c3e9b4dbSLuiz Otavio O Souza 		/* release the reference from netmap_mem_find() or
2390c3e9b4dbSLuiz Otavio O Souza 		 * netmap_mem_ext_create()
2391c3e9b4dbSLuiz Otavio O Souza 		 */
2392c3e9b4dbSLuiz Otavio O Souza 		if (nmd)
2393c3e9b4dbSLuiz Otavio O Souza 			netmap_mem_put(nmd);
2394ce3ee1e7SLuigi Rizzo 		NMG_UNLOCK();
239568b8534bSLuigi Rizzo 		break;
239668b8534bSLuigi Rizzo 
239768b8534bSLuigi Rizzo 	case NIOCTXSYNC:
239868b8534bSLuigi Rizzo 	case NIOCRXSYNC:
23998241616dSLuigi Rizzo 		nifp = priv->np_nifp;
24008241616dSLuigi Rizzo 
24018241616dSLuigi Rizzo 		if (nifp == NULL) {
2402506cc70cSLuigi Rizzo 			error = ENXIO;
2403506cc70cSLuigi Rizzo 			break;
2404506cc70cSLuigi Rizzo 		}
24056641c68bSLuigi Rizzo 		mb(); /* make sure following reads are not from cache */
24068241616dSLuigi Rizzo 
2407f9790aebSLuigi Rizzo 		na = priv->np_na;      /* we have a reference */
24088241616dSLuigi Rizzo 
2409f9790aebSLuigi Rizzo 		if (na == NULL) {
2410f9790aebSLuigi Rizzo 			D("Internal error: nifp != NULL && na == NULL");
24118241616dSLuigi Rizzo 			error = ENXIO;
24128241616dSLuigi Rizzo 			break;
24138241616dSLuigi Rizzo 		}
24148241616dSLuigi Rizzo 
2415c3e9b4dbSLuiz Otavio O Souza 		mbq_init(&q);
2416847bf383SLuigi Rizzo 		t = (cmd == NIOCTXSYNC ? NR_TX : NR_RX);
2417847bf383SLuigi Rizzo 		krings = NMR(na, t);
2418847bf383SLuigi Rizzo 		qfirst = priv->np_qfirst[t];
2419847bf383SLuigi Rizzo 		qlast = priv->np_qlast[t];
2420c3e9b4dbSLuiz Otavio O Souza 		sync_flags = priv->np_sync_flags;
242168b8534bSLuigi Rizzo 
2422f0ea3689SLuigi Rizzo 		for (i = qfirst; i < qlast; i++) {
2423ce3ee1e7SLuigi Rizzo 			struct netmap_kring *kring = krings + i;
242437e3a6d3SLuigi Rizzo 			struct netmap_ring *ring = kring->ring;
242537e3a6d3SLuigi Rizzo 
242637e3a6d3SLuigi Rizzo 			if (unlikely(nm_kr_tryget(kring, 1, &error))) {
242737e3a6d3SLuigi Rizzo 				error = (error ? EIO : 0);
242837e3a6d3SLuigi Rizzo 				continue;
2429ce3ee1e7SLuigi Rizzo 			}
243037e3a6d3SLuigi Rizzo 
243168b8534bSLuigi Rizzo 			if (cmd == NIOCTXSYNC) {
243268b8534bSLuigi Rizzo 				if (netmap_verbose & NM_VERB_TXSYNC)
24333c0caf6cSLuigi Rizzo 					D("pre txsync ring %d cur %d hwcur %d",
243437e3a6d3SLuigi Rizzo 					    i, ring->cur,
243568b8534bSLuigi Rizzo 					    kring->nr_hwcur);
243637e3a6d3SLuigi Rizzo 				if (nm_txsync_prologue(kring, ring) >= kring->nkr_num_slots) {
243717885a7bSLuigi Rizzo 					netmap_ring_reinit(kring);
2438c3e9b4dbSLuiz Otavio O Souza 				} else if (kring->nm_sync(kring, sync_flags | NAF_FORCE_RECLAIM) == 0) {
243937e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
244017885a7bSLuigi Rizzo 				}
244168b8534bSLuigi Rizzo 				if (netmap_verbose & NM_VERB_TXSYNC)
24423c0caf6cSLuigi Rizzo 					D("post txsync ring %d cur %d hwcur %d",
244337e3a6d3SLuigi Rizzo 					    i, ring->cur,
244468b8534bSLuigi Rizzo 					    kring->nr_hwcur);
244568b8534bSLuigi Rizzo 			} else {
244637e3a6d3SLuigi Rizzo 				if (nm_rxsync_prologue(kring, ring) >= kring->nkr_num_slots) {
2447847bf383SLuigi Rizzo 					netmap_ring_reinit(kring);
2448c3e9b4dbSLuiz Otavio O Souza 				}
2449c3e9b4dbSLuiz Otavio O Souza 				if (nm_may_forward_up(kring)) {
2450c3e9b4dbSLuiz Otavio O Souza 					/* transparent forwarding, see netmap_poll() */
2451c3e9b4dbSLuiz Otavio O Souza 					netmap_grab_packets(kring, &q, netmap_fwd);
2452c3e9b4dbSLuiz Otavio O Souza 				}
2453c3e9b4dbSLuiz Otavio O Souza 				if (kring->nm_sync(kring, sync_flags | NAF_FORCE_READ) == 0) {
245437e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
2455847bf383SLuigi Rizzo 				}
2456c3e9b4dbSLuiz Otavio O Souza 				ring_timestamp_set(ring);
245768b8534bSLuigi Rizzo 			}
2458ce3ee1e7SLuigi Rizzo 			nm_kr_put(kring);
245968b8534bSLuigi Rizzo 		}
246068b8534bSLuigi Rizzo 
2461c3e9b4dbSLuiz Otavio O Souza 		if (mbq_peek(&q)) {
2462c3e9b4dbSLuiz Otavio O Souza 			netmap_send_up(na->ifp, &q);
2463c3e9b4dbSLuiz Otavio O Souza 		}
2464c3e9b4dbSLuiz Otavio O Souza 
246568b8534bSLuigi Rizzo 		break;
246668b8534bSLuigi Rizzo 
2467847bf383SLuigi Rizzo #ifdef WITH_VALE
24684bf50f18SLuigi Rizzo 	case NIOCCONFIG:
24694bf50f18SLuigi Rizzo 		error = netmap_bdg_config(nmr);
24704bf50f18SLuigi Rizzo 		break;
2471847bf383SLuigi Rizzo #endif
2472f196ce38SLuigi Rizzo #ifdef __FreeBSD__
247389e3fd52SLuigi Rizzo 	case FIONBIO:
247489e3fd52SLuigi Rizzo 	case FIOASYNC:
247589e3fd52SLuigi Rizzo 		ND("FIONBIO/FIOASYNC are no-ops");
247689e3fd52SLuigi Rizzo 		break;
247789e3fd52SLuigi Rizzo 
247868b8534bSLuigi Rizzo 	case BIOCIMMEDIATE:
247968b8534bSLuigi Rizzo 	case BIOCGHDRCMPLT:
248068b8534bSLuigi Rizzo 	case BIOCSHDRCMPLT:
248168b8534bSLuigi Rizzo 	case BIOCSSEESENT:
248268b8534bSLuigi Rizzo 		D("ignore BIOCIMMEDIATE/BIOCSHDRCMPLT/BIOCSHDRCMPLT/BIOCSSEESENT");
248368b8534bSLuigi Rizzo 		break;
248468b8534bSLuigi Rizzo 
2485babc7c12SLuigi Rizzo 	default:	/* allow device-specific ioctls */
248668b8534bSLuigi Rizzo 	    {
2487b3d37588SLuigi Rizzo 		struct ifnet *ifp = ifunit_ref(nmr->nr_name);
2488b3d37588SLuigi Rizzo 		if (ifp == NULL) {
2489b3d37588SLuigi Rizzo 			error = ENXIO;
2490b3d37588SLuigi Rizzo 		} else {
249168b8534bSLuigi Rizzo 			struct socket so;
2492ce3ee1e7SLuigi Rizzo 
249368b8534bSLuigi Rizzo 			bzero(&so, sizeof(so));
249468b8534bSLuigi Rizzo 			so.so_vnet = ifp->if_vnet;
249568b8534bSLuigi Rizzo 			// so->so_proto not null.
249668b8534bSLuigi Rizzo 			error = ifioctl(&so, cmd, data, td);
2497b3d37588SLuigi Rizzo 			if_rele(ifp);
2498b3d37588SLuigi Rizzo 		}
2499babc7c12SLuigi Rizzo 		break;
250068b8534bSLuigi Rizzo 	    }
2501f196ce38SLuigi Rizzo 
2502f196ce38SLuigi Rizzo #else /* linux */
2503f196ce38SLuigi Rizzo 	default:
2504f196ce38SLuigi Rizzo 		error = EOPNOTSUPP;
2505f196ce38SLuigi Rizzo #endif /* linux */
250668b8534bSLuigi Rizzo 	}
250768b8534bSLuigi Rizzo 
250868b8534bSLuigi Rizzo 	return (error);
250968b8534bSLuigi Rizzo }
251068b8534bSLuigi Rizzo 
251168b8534bSLuigi Rizzo 
251268b8534bSLuigi Rizzo /*
251368b8534bSLuigi Rizzo  * select(2) and poll(2) handlers for the "netmap" device.
251468b8534bSLuigi Rizzo  *
251568b8534bSLuigi Rizzo  * Can be called for one or more queues.
251668b8534bSLuigi Rizzo  * Return true the event mask corresponding to ready events.
251768b8534bSLuigi Rizzo  * If there are no ready events, do a selrecord on either individual
2518ce3ee1e7SLuigi Rizzo  * selinfo or on the global one.
251968b8534bSLuigi Rizzo  * Device-dependent parts (locking and sync of tx/rx rings)
252068b8534bSLuigi Rizzo  * are done through callbacks.
2521f196ce38SLuigi Rizzo  *
252201c7d25fSLuigi Rizzo  * On linux, arguments are really pwait, the poll table, and 'td' is struct file *
252301c7d25fSLuigi Rizzo  * The first one is remapped to pwait as selrecord() uses the name as an
252401c7d25fSLuigi Rizzo  * hidden argument.
252568b8534bSLuigi Rizzo  */
2526f9790aebSLuigi Rizzo int
252737e3a6d3SLuigi Rizzo netmap_poll(struct netmap_priv_d *priv, int events, NM_SELRECORD_T *sr)
252868b8534bSLuigi Rizzo {
252968b8534bSLuigi Rizzo 	struct netmap_adapter *na;
253068b8534bSLuigi Rizzo 	struct netmap_kring *kring;
253137e3a6d3SLuigi Rizzo 	struct netmap_ring *ring;
2532847bf383SLuigi Rizzo 	u_int i, check_all_tx, check_all_rx, want[NR_TXRX], revents = 0;
2533847bf383SLuigi Rizzo #define want_tx want[NR_TX]
2534847bf383SLuigi Rizzo #define want_rx want[NR_RX]
2535c3e9b4dbSLuiz Otavio O Souza 	struct mbq q;	/* packets from RX hw queues to host stack */
2536847bf383SLuigi Rizzo 	enum txrx t;
253701c7d25fSLuigi Rizzo 
2538f9790aebSLuigi Rizzo 	/*
2539f9790aebSLuigi Rizzo 	 * In order to avoid nested locks, we need to "double check"
2540f9790aebSLuigi Rizzo 	 * txsync and rxsync if we decide to do a selrecord().
2541f9790aebSLuigi Rizzo 	 * retry_tx (and retry_rx, later) prevent looping forever.
2542f9790aebSLuigi Rizzo 	 */
254317885a7bSLuigi Rizzo 	int retry_tx = 1, retry_rx = 1;
2544ce3ee1e7SLuigi Rizzo 
2545c3e9b4dbSLuiz Otavio O Souza 	/* Transparent mode: send_down is 1 if we have found some
2546c3e9b4dbSLuiz Otavio O Souza 	 * packets to forward (host RX ring --> NIC) during the rx
2547c3e9b4dbSLuiz Otavio O Souza 	 * scan and we have not sent them down to the NIC yet.
2548c3e9b4dbSLuiz Otavio O Souza 	 * Transparent mode requires to bind all rings to a single
2549c3e9b4dbSLuiz Otavio O Souza 	 * file descriptor.
2550f0ea3689SLuigi Rizzo 	 */
255137e3a6d3SLuigi Rizzo 	int send_down = 0;
2552c3e9b4dbSLuiz Otavio O Souza 	int sync_flags = priv->np_sync_flags;
255337e3a6d3SLuigi Rizzo 
255437e3a6d3SLuigi Rizzo 	mbq_init(&q);
255568b8534bSLuigi Rizzo 
25568241616dSLuigi Rizzo 	if (priv->np_nifp == NULL) {
25578241616dSLuigi Rizzo 		D("No if registered");
25588241616dSLuigi Rizzo 		return POLLERR;
25598241616dSLuigi Rizzo 	}
2560847bf383SLuigi Rizzo 	mb(); /* make sure following reads are not from cache */
25618241616dSLuigi Rizzo 
2562f9790aebSLuigi Rizzo 	na = priv->np_na;
2563f9790aebSLuigi Rizzo 
25644bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na))
256568b8534bSLuigi Rizzo 		return POLLERR;
256668b8534bSLuigi Rizzo 
256768b8534bSLuigi Rizzo 	if (netmap_verbose & 0x8000)
25684bf50f18SLuigi Rizzo 		D("device %s events 0x%x", na->name, events);
256968b8534bSLuigi Rizzo 	want_tx = events & (POLLOUT | POLLWRNORM);
257068b8534bSLuigi Rizzo 	want_rx = events & (POLLIN | POLLRDNORM);
257168b8534bSLuigi Rizzo 
257268b8534bSLuigi Rizzo 	/*
2573f9790aebSLuigi Rizzo 	 * check_all_{tx|rx} are set if the card has more than one queue AND
2574f9790aebSLuigi Rizzo 	 * the file descriptor is bound to all of them. If so, we sleep on
2575ce3ee1e7SLuigi Rizzo 	 * the "global" selinfo, otherwise we sleep on individual selinfo
2576ce3ee1e7SLuigi Rizzo 	 * (FreeBSD only allows two selinfo's per file descriptor).
2577ce3ee1e7SLuigi Rizzo 	 * The interrupt routine in the driver wake one or the other
2578ce3ee1e7SLuigi Rizzo 	 * (or both) depending on which clients are active.
257968b8534bSLuigi Rizzo 	 *
258068b8534bSLuigi Rizzo 	 * rxsync() is only called if we run out of buffers on a POLLIN.
258168b8534bSLuigi Rizzo 	 * txsync() is called if we run out of buffers on POLLOUT, or
258268b8534bSLuigi Rizzo 	 * there are pending packets to send. The latter can be disabled
258368b8534bSLuigi Rizzo 	 * passing NETMAP_NO_TX_POLL in the NIOCREG call.
258468b8534bSLuigi Rizzo 	 */
2585847bf383SLuigi Rizzo 	check_all_tx = nm_si_user(priv, NR_TX);
2586847bf383SLuigi Rizzo 	check_all_rx = nm_si_user(priv, NR_RX);
258764ae02c3SLuigi Rizzo 
258868b8534bSLuigi Rizzo 	/*
2589f9790aebSLuigi Rizzo 	 * We start with a lock free round which is cheap if we have
2590f9790aebSLuigi Rizzo 	 * slots available. If this fails, then lock and call the sync
259168b8534bSLuigi Rizzo 	 * routines.
259268b8534bSLuigi Rizzo 	 */
259337e3a6d3SLuigi Rizzo #if 1 /* new code- call rx if any of the ring needs to release or read buffers */
259437e3a6d3SLuigi Rizzo 	if (want_tx) {
259537e3a6d3SLuigi Rizzo 		t = NR_TX;
259637e3a6d3SLuigi Rizzo 		for (i = priv->np_qfirst[t]; want[t] && i < priv->np_qlast[t]; i++) {
259737e3a6d3SLuigi Rizzo 			kring = &NMR(na, t)[i];
259837e3a6d3SLuigi Rizzo 			/* XXX compare ring->cur and kring->tail */
259937e3a6d3SLuigi Rizzo 			if (!nm_ring_empty(kring->ring)) {
260037e3a6d3SLuigi Rizzo 				revents |= want[t];
260137e3a6d3SLuigi Rizzo 				want[t] = 0;	/* also breaks the loop */
260237e3a6d3SLuigi Rizzo 			}
260337e3a6d3SLuigi Rizzo 		}
260437e3a6d3SLuigi Rizzo 	}
260537e3a6d3SLuigi Rizzo 	if (want_rx) {
260637e3a6d3SLuigi Rizzo 		want_rx = 0; /* look for a reason to run the handlers */
260737e3a6d3SLuigi Rizzo 		t = NR_RX;
260837e3a6d3SLuigi Rizzo 		for (i = priv->np_qfirst[t]; i < priv->np_qlast[t]; i++) {
260937e3a6d3SLuigi Rizzo 			kring = &NMR(na, t)[i];
261037e3a6d3SLuigi Rizzo 			if (kring->ring->cur == kring->ring->tail /* try fetch new buffers */
261137e3a6d3SLuigi Rizzo 			    || kring->rhead != kring->ring->head /* release buffers */) {
261237e3a6d3SLuigi Rizzo 				want_rx = 1;
261337e3a6d3SLuigi Rizzo 			}
261437e3a6d3SLuigi Rizzo 		}
261537e3a6d3SLuigi Rizzo 		if (!want_rx)
261637e3a6d3SLuigi Rizzo 			revents |= events & (POLLIN | POLLRDNORM); /* we have data */
261737e3a6d3SLuigi Rizzo 	}
261837e3a6d3SLuigi Rizzo #else /* old code */
2619847bf383SLuigi Rizzo 	for_rx_tx(t) {
2620847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[t]; want[t] && i < priv->np_qlast[t]; i++) {
2621847bf383SLuigi Rizzo 			kring = &NMR(na, t)[i];
262217885a7bSLuigi Rizzo 			/* XXX compare ring->cur and kring->tail */
262317885a7bSLuigi Rizzo 			if (!nm_ring_empty(kring->ring)) {
2624847bf383SLuigi Rizzo 				revents |= want[t];
2625847bf383SLuigi Rizzo 				want[t] = 0;	/* also breaks the loop */
262668b8534bSLuigi Rizzo 			}
262768b8534bSLuigi Rizzo 		}
262868b8534bSLuigi Rizzo 	}
262937e3a6d3SLuigi Rizzo #endif /* old code */
263068b8534bSLuigi Rizzo 
263168b8534bSLuigi Rizzo 	/*
263217885a7bSLuigi Rizzo 	 * If we want to push packets out (priv->np_txpoll) or
263317885a7bSLuigi Rizzo 	 * want_tx is still set, we must issue txsync calls
263417885a7bSLuigi Rizzo 	 * (on all rings, to avoid that the tx rings stall).
2635f9790aebSLuigi Rizzo 	 * XXX should also check cur != hwcur on the tx rings.
2636f9790aebSLuigi Rizzo 	 * Fortunately, normal tx mode has np_txpoll set.
263768b8534bSLuigi Rizzo 	 */
263868b8534bSLuigi Rizzo 	if (priv->np_txpoll || want_tx) {
263917885a7bSLuigi Rizzo 		/*
264017885a7bSLuigi Rizzo 		 * The first round checks if anyone is ready, if not
264117885a7bSLuigi Rizzo 		 * do a selrecord and another round to handle races.
264217885a7bSLuigi Rizzo 		 * want_tx goes to 0 if any space is found, and is
264317885a7bSLuigi Rizzo 		 * used to skip rings with no pending transmissions.
2644ce3ee1e7SLuigi Rizzo 		 */
2645091fd0abSLuigi Rizzo flush_tx:
264637e3a6d3SLuigi Rizzo 		for (i = priv->np_qfirst[NR_TX]; i < priv->np_qlast[NR_TX]; i++) {
264717885a7bSLuigi Rizzo 			int found = 0;
264817885a7bSLuigi Rizzo 
264968b8534bSLuigi Rizzo 			kring = &na->tx_rings[i];
265037e3a6d3SLuigi Rizzo 			ring = kring->ring;
265137e3a6d3SLuigi Rizzo 
265237e3a6d3SLuigi Rizzo 			if (!send_down && !want_tx && ring->cur == kring->nr_hwcur)
265368b8534bSLuigi Rizzo 				continue;
265437e3a6d3SLuigi Rizzo 
265537e3a6d3SLuigi Rizzo 			if (nm_kr_tryget(kring, 1, &revents))
265617885a7bSLuigi Rizzo 				continue;
265737e3a6d3SLuigi Rizzo 
265837e3a6d3SLuigi Rizzo 			if (nm_txsync_prologue(kring, ring) >= kring->nkr_num_slots) {
265917885a7bSLuigi Rizzo 				netmap_ring_reinit(kring);
266017885a7bSLuigi Rizzo 				revents |= POLLERR;
266117885a7bSLuigi Rizzo 			} else {
2662c3e9b4dbSLuiz Otavio O Souza 				if (kring->nm_sync(kring, sync_flags))
266368b8534bSLuigi Rizzo 					revents |= POLLERR;
2664847bf383SLuigi Rizzo 				else
266537e3a6d3SLuigi Rizzo 					nm_sync_finalize(kring);
266617885a7bSLuigi Rizzo 			}
266768b8534bSLuigi Rizzo 
266817885a7bSLuigi Rizzo 			/*
266917885a7bSLuigi Rizzo 			 * If we found new slots, notify potential
267017885a7bSLuigi Rizzo 			 * listeners on the same ring.
267117885a7bSLuigi Rizzo 			 * Since we just did a txsync, look at the copies
267217885a7bSLuigi Rizzo 			 * of cur,tail in the kring.
2673f9790aebSLuigi Rizzo 			 */
267417885a7bSLuigi Rizzo 			found = kring->rcur != kring->rtail;
267517885a7bSLuigi Rizzo 			nm_kr_put(kring);
267617885a7bSLuigi Rizzo 			if (found) { /* notify other listeners */
267768b8534bSLuigi Rizzo 				revents |= want_tx;
267868b8534bSLuigi Rizzo 				want_tx = 0;
2679847bf383SLuigi Rizzo 				kring->nm_notify(kring, 0);
268068b8534bSLuigi Rizzo 			}
2681ce3ee1e7SLuigi Rizzo 		}
268237e3a6d3SLuigi Rizzo 		/* if there were any packet to forward we must have handled them by now */
268337e3a6d3SLuigi Rizzo 		send_down = 0;
268437e3a6d3SLuigi Rizzo 		if (want_tx && retry_tx && sr) {
268537e3a6d3SLuigi Rizzo 			nm_os_selrecord(sr, check_all_tx ?
2686847bf383SLuigi Rizzo 			    &na->si[NR_TX] : &na->tx_rings[priv->np_qfirst[NR_TX]].si);
2687ce3ee1e7SLuigi Rizzo 			retry_tx = 0;
2688ce3ee1e7SLuigi Rizzo 			goto flush_tx;
268968b8534bSLuigi Rizzo 		}
269068b8534bSLuigi Rizzo 	}
269168b8534bSLuigi Rizzo 
269268b8534bSLuigi Rizzo 	/*
269317885a7bSLuigi Rizzo 	 * If want_rx is still set scan receive rings.
269468b8534bSLuigi Rizzo 	 * Do it on all rings because otherwise we starve.
269568b8534bSLuigi Rizzo 	 */
269668b8534bSLuigi Rizzo 	if (want_rx) {
269789cc2556SLuigi Rizzo 		/* two rounds here for race avoidance */
2698ce3ee1e7SLuigi Rizzo do_retry_rx:
2699847bf383SLuigi Rizzo 		for (i = priv->np_qfirst[NR_RX]; i < priv->np_qlast[NR_RX]; i++) {
270017885a7bSLuigi Rizzo 			int found = 0;
270117885a7bSLuigi Rizzo 
270268b8534bSLuigi Rizzo 			kring = &na->rx_rings[i];
270337e3a6d3SLuigi Rizzo 			ring = kring->ring;
2704ce3ee1e7SLuigi Rizzo 
270537e3a6d3SLuigi Rizzo 			if (unlikely(nm_kr_tryget(kring, 1, &revents)))
270617885a7bSLuigi Rizzo 				continue;
2707ce3ee1e7SLuigi Rizzo 
270837e3a6d3SLuigi Rizzo 			if (nm_rxsync_prologue(kring, ring) >= kring->nkr_num_slots) {
2709847bf383SLuigi Rizzo 				netmap_ring_reinit(kring);
2710847bf383SLuigi Rizzo 				revents |= POLLERR;
2711847bf383SLuigi Rizzo 			}
2712847bf383SLuigi Rizzo 			/* now we can use kring->rcur, rtail */
2713847bf383SLuigi Rizzo 
271417885a7bSLuigi Rizzo 			/*
2715c3e9b4dbSLuiz Otavio O Souza 			 * transparent mode support: collect packets from
2716c3e9b4dbSLuiz Otavio O Souza 			 * hw rxring(s) that have been released by the user
2717ce3ee1e7SLuigi Rizzo 			 */
271837e3a6d3SLuigi Rizzo 			if (nm_may_forward_up(kring)) {
2719091fd0abSLuigi Rizzo 				netmap_grab_packets(kring, &q, netmap_fwd);
2720091fd0abSLuigi Rizzo 			}
272168b8534bSLuigi Rizzo 
2722c3e9b4dbSLuiz Otavio O Souza 			/* Clear the NR_FORWARD flag anyway, it may be set by
2723c3e9b4dbSLuiz Otavio O Souza 			 * the nm_sync() below only on for the host RX ring (see
2724c3e9b4dbSLuiz Otavio O Souza 			 * netmap_rxsync_from_host()). */
272537e3a6d3SLuigi Rizzo 			kring->nr_kflags &= ~NR_FORWARD;
2726c3e9b4dbSLuiz Otavio O Souza 			if (kring->nm_sync(kring, sync_flags))
272768b8534bSLuigi Rizzo 				revents |= POLLERR;
2728847bf383SLuigi Rizzo 			else
272937e3a6d3SLuigi Rizzo 				nm_sync_finalize(kring);
2730c3e9b4dbSLuiz Otavio O Souza 			send_down |= (kring->nr_kflags & NR_FORWARD);
2731c3e9b4dbSLuiz Otavio O Souza 			ring_timestamp_set(ring);
273217885a7bSLuigi Rizzo 			found = kring->rcur != kring->rtail;
273317885a7bSLuigi Rizzo 			nm_kr_put(kring);
273417885a7bSLuigi Rizzo 			if (found) {
273568b8534bSLuigi Rizzo 				revents |= want_rx;
2736ce3ee1e7SLuigi Rizzo 				retry_rx = 0;
2737847bf383SLuigi Rizzo 				kring->nm_notify(kring, 0);
273868b8534bSLuigi Rizzo 			}
273968b8534bSLuigi Rizzo 		}
274017885a7bSLuigi Rizzo 
274137e3a6d3SLuigi Rizzo 		if (retry_rx && sr) {
274237e3a6d3SLuigi Rizzo 			nm_os_selrecord(sr, check_all_rx ?
2743847bf383SLuigi Rizzo 			    &na->si[NR_RX] : &na->rx_rings[priv->np_qfirst[NR_RX]].si);
274437e3a6d3SLuigi Rizzo 		}
2745c3e9b4dbSLuiz Otavio O Souza 		if (send_down || retry_rx) {
274617885a7bSLuigi Rizzo 			retry_rx = 0;
274717885a7bSLuigi Rizzo 			if (send_down)
274817885a7bSLuigi Rizzo 				goto flush_tx; /* and retry_rx */
274917885a7bSLuigi Rizzo 			else
2750ce3ee1e7SLuigi Rizzo 				goto do_retry_rx;
2751ce3ee1e7SLuigi Rizzo 		}
275268b8534bSLuigi Rizzo 	}
2753091fd0abSLuigi Rizzo 
275417885a7bSLuigi Rizzo 	/*
2755c3e9b4dbSLuiz Otavio O Souza 	 * Transparent mode: released bufs (i.e. between kring->nr_hwcur and
2756c3e9b4dbSLuiz Otavio O Souza 	 * ring->head) marked with NS_FORWARD on hw rx rings are passed up
2757c3e9b4dbSLuiz Otavio O Souza 	 * to the host stack.
2758ce3ee1e7SLuigi Rizzo 	 */
2759091fd0abSLuigi Rizzo 
2760c3e9b4dbSLuiz Otavio O Souza 	if (mbq_peek(&q)) {
2761f9790aebSLuigi Rizzo 		netmap_send_up(na->ifp, &q);
276237e3a6d3SLuigi Rizzo 	}
276368b8534bSLuigi Rizzo 
276468b8534bSLuigi Rizzo 	return (revents);
2765847bf383SLuigi Rizzo #undef want_tx
2766847bf383SLuigi Rizzo #undef want_rx
276768b8534bSLuigi Rizzo }
276868b8534bSLuigi Rizzo 
276917885a7bSLuigi Rizzo 
277017885a7bSLuigi Rizzo /*-------------------- driver support routines -------------------*/
277168b8534bSLuigi Rizzo 
277289cc2556SLuigi Rizzo /* default notify callback */
2773f9790aebSLuigi Rizzo static int
2774847bf383SLuigi Rizzo netmap_notify(struct netmap_kring *kring, int flags)
2775f9790aebSLuigi Rizzo {
2776847bf383SLuigi Rizzo 	struct netmap_adapter *na = kring->na;
2777847bf383SLuigi Rizzo 	enum txrx t = kring->tx;
2778f9790aebSLuigi Rizzo 
277937e3a6d3SLuigi Rizzo 	nm_os_selwakeup(&kring->si);
278089cc2556SLuigi Rizzo 	/* optimization: avoid a wake up on the global
278189cc2556SLuigi Rizzo 	 * queue if nobody has registered for more
278289cc2556SLuigi Rizzo 	 * than one ring
278389cc2556SLuigi Rizzo 	 */
2784847bf383SLuigi Rizzo 	if (na->si_users[t] > 0)
278537e3a6d3SLuigi Rizzo 		nm_os_selwakeup(&na->si[t]);
2786847bf383SLuigi Rizzo 
278737e3a6d3SLuigi Rizzo 	return NM_IRQ_COMPLETED;
2788f9790aebSLuigi Rizzo }
2789f9790aebSLuigi Rizzo 
279089cc2556SLuigi Rizzo /* called by all routines that create netmap_adapters.
279137e3a6d3SLuigi Rizzo  * provide some defaults and get a reference to the
279237e3a6d3SLuigi Rizzo  * memory allocator
279389cc2556SLuigi Rizzo  */
2794f9790aebSLuigi Rizzo int
2795f9790aebSLuigi Rizzo netmap_attach_common(struct netmap_adapter *na)
2796f9790aebSLuigi Rizzo {
2797f9790aebSLuigi Rizzo 	if (na->num_tx_rings == 0 || na->num_rx_rings == 0) {
2798f9790aebSLuigi Rizzo 		D("%s: invalid rings tx %d rx %d",
27994bf50f18SLuigi Rizzo 			na->name, na->num_tx_rings, na->num_rx_rings);
2800f9790aebSLuigi Rizzo 		return EINVAL;
2801f9790aebSLuigi Rizzo 	}
280217885a7bSLuigi Rizzo 
280317885a7bSLuigi Rizzo #ifdef __FreeBSD__
280437e3a6d3SLuigi Rizzo 	if (na->na_flags & NAF_HOST_RINGS && na->ifp) {
280537e3a6d3SLuigi Rizzo 		na->if_input = na->ifp->if_input; /* for netmap_send_up */
28064bf50f18SLuigi Rizzo 	}
280737e3a6d3SLuigi Rizzo #endif /* __FreeBSD__ */
2808f9790aebSLuigi Rizzo 	if (na->nm_krings_create == NULL) {
280989cc2556SLuigi Rizzo 		/* we assume that we have been called by a driver,
281089cc2556SLuigi Rizzo 		 * since other port types all provide their own
281189cc2556SLuigi Rizzo 		 * nm_krings_create
281289cc2556SLuigi Rizzo 		 */
2813f9790aebSLuigi Rizzo 		na->nm_krings_create = netmap_hw_krings_create;
281417885a7bSLuigi Rizzo 		na->nm_krings_delete = netmap_hw_krings_delete;
2815f9790aebSLuigi Rizzo 	}
2816f9790aebSLuigi Rizzo 	if (na->nm_notify == NULL)
2817f9790aebSLuigi Rizzo 		na->nm_notify = netmap_notify;
2818f9790aebSLuigi Rizzo 	na->active_fds = 0;
2819f9790aebSLuigi Rizzo 
2820c3e9b4dbSLuiz Otavio O Souza 	if (na->nm_mem == NULL) {
28214bf50f18SLuigi Rizzo 		/* use the global allocator */
2822c3e9b4dbSLuiz Otavio O Souza 		na->nm_mem = netmap_mem_get(&nm_mem);
2823c3e9b4dbSLuiz Otavio O Souza 	}
2824847bf383SLuigi Rizzo #ifdef WITH_VALE
28254bf50f18SLuigi Rizzo 	if (na->nm_bdg_attach == NULL)
28264bf50f18SLuigi Rizzo 		/* no special nm_bdg_attach callback. On VALE
28274bf50f18SLuigi Rizzo 		 * attach, we need to interpose a bwrap
28284bf50f18SLuigi Rizzo 		 */
28294bf50f18SLuigi Rizzo 		na->nm_bdg_attach = netmap_bwrap_attach;
2830847bf383SLuigi Rizzo #endif
283137e3a6d3SLuigi Rizzo 
2832f9790aebSLuigi Rizzo 	return 0;
2833f9790aebSLuigi Rizzo }
2834f9790aebSLuigi Rizzo 
2835f9790aebSLuigi Rizzo 
283689cc2556SLuigi Rizzo /* standard cleanup, called by all destructors */
2837f9790aebSLuigi Rizzo void
2838f9790aebSLuigi Rizzo netmap_detach_common(struct netmap_adapter *na)
2839f9790aebSLuigi Rizzo {
2840f9790aebSLuigi Rizzo 	if (na->tx_rings) { /* XXX should not happen */
2841f9790aebSLuigi Rizzo 		D("freeing leftover tx_rings");
2842f9790aebSLuigi Rizzo 		na->nm_krings_delete(na);
2843f9790aebSLuigi Rizzo 	}
2844f0ea3689SLuigi Rizzo 	netmap_pipe_dealloc(na);
2845847bf383SLuigi Rizzo 	if (na->nm_mem)
2846847bf383SLuigi Rizzo 		netmap_mem_put(na->nm_mem);
2847f9790aebSLuigi Rizzo 	bzero(na, sizeof(*na));
2848c3e9b4dbSLuiz Otavio O Souza 	nm_os_free(na);
2849f9790aebSLuigi Rizzo }
2850f9790aebSLuigi Rizzo 
285137e3a6d3SLuigi Rizzo /* Wrapper for the register callback provided netmap-enabled
285237e3a6d3SLuigi Rizzo  * hardware drivers.
285337e3a6d3SLuigi Rizzo  * nm_iszombie(na) means that the driver module has been
28544bf50f18SLuigi Rizzo  * unloaded, so we cannot call into it.
285537e3a6d3SLuigi Rizzo  * nm_os_ifnet_lock() must guarantee mutual exclusion with
285637e3a6d3SLuigi Rizzo  * module unloading.
28574bf50f18SLuigi Rizzo  */
28584bf50f18SLuigi Rizzo static int
285937e3a6d3SLuigi Rizzo netmap_hw_reg(struct netmap_adapter *na, int onoff)
28604bf50f18SLuigi Rizzo {
28614bf50f18SLuigi Rizzo 	struct netmap_hw_adapter *hwna =
28624bf50f18SLuigi Rizzo 		(struct netmap_hw_adapter*)na;
286337e3a6d3SLuigi Rizzo 	int error = 0;
28644bf50f18SLuigi Rizzo 
286537e3a6d3SLuigi Rizzo 	nm_os_ifnet_lock();
28664bf50f18SLuigi Rizzo 
286737e3a6d3SLuigi Rizzo 	if (nm_iszombie(na)) {
286837e3a6d3SLuigi Rizzo 		if (onoff) {
286937e3a6d3SLuigi Rizzo 			error = ENXIO;
287037e3a6d3SLuigi Rizzo 		} else if (na != NULL) {
287137e3a6d3SLuigi Rizzo 			na->na_flags &= ~NAF_NETMAP_ON;
287237e3a6d3SLuigi Rizzo 		}
287337e3a6d3SLuigi Rizzo 		goto out;
287437e3a6d3SLuigi Rizzo 	}
287537e3a6d3SLuigi Rizzo 
287637e3a6d3SLuigi Rizzo 	error = hwna->nm_hw_register(na, onoff);
287737e3a6d3SLuigi Rizzo 
287837e3a6d3SLuigi Rizzo out:
287937e3a6d3SLuigi Rizzo 	nm_os_ifnet_unlock();
288037e3a6d3SLuigi Rizzo 
288137e3a6d3SLuigi Rizzo 	return error;
288237e3a6d3SLuigi Rizzo }
288337e3a6d3SLuigi Rizzo 
288437e3a6d3SLuigi Rizzo static void
288537e3a6d3SLuigi Rizzo netmap_hw_dtor(struct netmap_adapter *na)
288637e3a6d3SLuigi Rizzo {
288737e3a6d3SLuigi Rizzo 	if (nm_iszombie(na) || na->ifp == NULL)
288837e3a6d3SLuigi Rizzo 		return;
288937e3a6d3SLuigi Rizzo 
289037e3a6d3SLuigi Rizzo 	WNA(na->ifp) = NULL;
28914bf50f18SLuigi Rizzo }
28924bf50f18SLuigi Rizzo 
2893f18be576SLuigi Rizzo 
289468b8534bSLuigi Rizzo /*
2895c3e9b4dbSLuiz Otavio O Souza  * Allocate a netmap_adapter object, and initialize it from the
289637e3a6d3SLuigi Rizzo  * 'arg' passed by the driver on attach.
2897c3e9b4dbSLuiz Otavio O Souza  * We allocate a block of memory of 'size' bytes, which has room
2898c3e9b4dbSLuiz Otavio O Souza  * for struct netmap_adapter plus additional room private to
2899c3e9b4dbSLuiz Otavio O Souza  * the caller.
290068b8534bSLuigi Rizzo  * Return 0 on success, ENOMEM otherwise.
290168b8534bSLuigi Rizzo  */
2902c3e9b4dbSLuiz Otavio O Souza int
2903c3e9b4dbSLuiz Otavio O Souza netmap_attach_ext(struct netmap_adapter *arg, size_t size)
290468b8534bSLuigi Rizzo {
2905f9790aebSLuigi Rizzo 	struct netmap_hw_adapter *hwna = NULL;
290637e3a6d3SLuigi Rizzo 	struct ifnet *ifp = NULL;
290768b8534bSLuigi Rizzo 
2908c3e9b4dbSLuiz Otavio O Souza 	if (size < sizeof(struct netmap_hw_adapter)) {
2909c3e9b4dbSLuiz Otavio O Souza 		D("Invalid netmap adapter size %d", (int)size);
2910c3e9b4dbSLuiz Otavio O Souza 		return EINVAL;
2911c3e9b4dbSLuiz Otavio O Souza 	}
2912c3e9b4dbSLuiz Otavio O Souza 
291337e3a6d3SLuigi Rizzo 	if (arg == NULL || arg->ifp == NULL)
2914ae10d1afSLuigi Rizzo 		goto fail;
291537e3a6d3SLuigi Rizzo 	ifp = arg->ifp;
2916c3e9b4dbSLuiz Otavio O Souza 	hwna = nm_os_malloc(size);
2917f9790aebSLuigi Rizzo 	if (hwna == NULL)
2918ae10d1afSLuigi Rizzo 		goto fail;
2919f9790aebSLuigi Rizzo 	hwna->up = *arg;
2920847bf383SLuigi Rizzo 	hwna->up.na_flags |= NAF_HOST_RINGS | NAF_NATIVE;
29214bf50f18SLuigi Rizzo 	strncpy(hwna->up.name, ifp->if_xname, sizeof(hwna->up.name));
29224bf50f18SLuigi Rizzo 	hwna->nm_hw_register = hwna->up.nm_register;
292337e3a6d3SLuigi Rizzo 	hwna->up.nm_register = netmap_hw_reg;
2924f9790aebSLuigi Rizzo 	if (netmap_attach_common(&hwna->up)) {
2925c3e9b4dbSLuiz Otavio O Souza 		nm_os_free(hwna);
2926f9790aebSLuigi Rizzo 		goto fail;
2927f9790aebSLuigi Rizzo 	}
2928f9790aebSLuigi Rizzo 	netmap_adapter_get(&hwna->up);
2929f9790aebSLuigi Rizzo 
293037e3a6d3SLuigi Rizzo 	NM_ATTACH_NA(ifp, &hwna->up);
293137e3a6d3SLuigi Rizzo 
293264ae02c3SLuigi Rizzo #ifdef linux
2933f18be576SLuigi Rizzo 	if (ifp->netdev_ops) {
2934f18be576SLuigi Rizzo 		/* prepare a clone of the netdev ops */
2935847bf383SLuigi Rizzo #ifndef NETMAP_LINUX_HAVE_NETDEV_OPS
2936f9790aebSLuigi Rizzo 		hwna->nm_ndo.ndo_start_xmit = ifp->netdev_ops;
2937f18be576SLuigi Rizzo #else
2938f9790aebSLuigi Rizzo 		hwna->nm_ndo = *ifp->netdev_ops;
293937e3a6d3SLuigi Rizzo #endif /* NETMAP_LINUX_HAVE_NETDEV_OPS */
2940f18be576SLuigi Rizzo 	}
2941f9790aebSLuigi Rizzo 	hwna->nm_ndo.ndo_start_xmit = linux_netmap_start_xmit;
29424bf50f18SLuigi Rizzo 	if (ifp->ethtool_ops) {
29434bf50f18SLuigi Rizzo 		hwna->nm_eto = *ifp->ethtool_ops;
29444bf50f18SLuigi Rizzo 	}
29454bf50f18SLuigi Rizzo 	hwna->nm_eto.set_ringparam = linux_netmap_set_ringparam;
2946847bf383SLuigi Rizzo #ifdef NETMAP_LINUX_HAVE_SET_CHANNELS
29474bf50f18SLuigi Rizzo 	hwna->nm_eto.set_channels = linux_netmap_set_channels;
294837e3a6d3SLuigi Rizzo #endif /* NETMAP_LINUX_HAVE_SET_CHANNELS */
29494bf50f18SLuigi Rizzo 	if (arg->nm_config == NULL) {
29504bf50f18SLuigi Rizzo 		hwna->up.nm_config = netmap_linux_config;
29514bf50f18SLuigi Rizzo 	}
2952ce3ee1e7SLuigi Rizzo #endif /* linux */
295337e3a6d3SLuigi Rizzo 	if (arg->nm_dtor == NULL) {
295437e3a6d3SLuigi Rizzo 		hwna->up.nm_dtor = netmap_hw_dtor;
295537e3a6d3SLuigi Rizzo 	}
2956f9790aebSLuigi Rizzo 
2957d82f9014SRui Paulo 	if_printf(ifp, "netmap queues/slots: TX %d/%d, RX %d/%d\n",
2958d82f9014SRui Paulo 	    hwna->up.num_tx_rings, hwna->up.num_tx_desc,
2959d82f9014SRui Paulo 	    hwna->up.num_rx_rings, hwna->up.num_rx_desc);
2960ae10d1afSLuigi Rizzo 	return 0;
296168b8534bSLuigi Rizzo 
2962ae10d1afSLuigi Rizzo fail:
2963f9790aebSLuigi Rizzo 	D("fail, arg %p ifp %p na %p", arg, ifp, hwna);
2964f9790aebSLuigi Rizzo 	return (hwna ? EINVAL : ENOMEM);
296568b8534bSLuigi Rizzo }
296668b8534bSLuigi Rizzo 
296768b8534bSLuigi Rizzo 
296837e3a6d3SLuigi Rizzo int
296937e3a6d3SLuigi Rizzo netmap_attach(struct netmap_adapter *arg)
297037e3a6d3SLuigi Rizzo {
2971c3e9b4dbSLuiz Otavio O Souza 	return netmap_attach_ext(arg, sizeof(struct netmap_hw_adapter));
297237e3a6d3SLuigi Rizzo }
297337e3a6d3SLuigi Rizzo 
297437e3a6d3SLuigi Rizzo 
2975f9790aebSLuigi Rizzo void
2976f9790aebSLuigi Rizzo NM_DBG(netmap_adapter_get)(struct netmap_adapter *na)
2977f9790aebSLuigi Rizzo {
2978f9790aebSLuigi Rizzo 	if (!na) {
2979f9790aebSLuigi Rizzo 		return;
2980f9790aebSLuigi Rizzo 	}
2981f9790aebSLuigi Rizzo 
2982f9790aebSLuigi Rizzo 	refcount_acquire(&na->na_refcount);
2983f9790aebSLuigi Rizzo }
2984f9790aebSLuigi Rizzo 
2985f9790aebSLuigi Rizzo 
2986f9790aebSLuigi Rizzo /* returns 1 iff the netmap_adapter is destroyed */
2987f9790aebSLuigi Rizzo int
2988f9790aebSLuigi Rizzo NM_DBG(netmap_adapter_put)(struct netmap_adapter *na)
2989f9790aebSLuigi Rizzo {
2990f9790aebSLuigi Rizzo 	if (!na)
2991f9790aebSLuigi Rizzo 		return 1;
2992f9790aebSLuigi Rizzo 
2993f9790aebSLuigi Rizzo 	if (!refcount_release(&na->na_refcount))
2994f9790aebSLuigi Rizzo 		return 0;
2995f9790aebSLuigi Rizzo 
2996f9790aebSLuigi Rizzo 	if (na->nm_dtor)
2997f9790aebSLuigi Rizzo 		na->nm_dtor(na);
2998f9790aebSLuigi Rizzo 
2999f9790aebSLuigi Rizzo 	netmap_detach_common(na);
3000f9790aebSLuigi Rizzo 
3001f9790aebSLuigi Rizzo 	return 1;
3002f9790aebSLuigi Rizzo }
3003f9790aebSLuigi Rizzo 
300489cc2556SLuigi Rizzo /* nm_krings_create callback for all hardware native adapters */
3005f9790aebSLuigi Rizzo int
3006f9790aebSLuigi Rizzo netmap_hw_krings_create(struct netmap_adapter *na)
3007f9790aebSLuigi Rizzo {
3008f0ea3689SLuigi Rizzo 	int ret = netmap_krings_create(na, 0);
300917885a7bSLuigi Rizzo 	if (ret == 0) {
301017885a7bSLuigi Rizzo 		/* initialize the mbq for the sw rx ring */
301117885a7bSLuigi Rizzo 		mbq_safe_init(&na->rx_rings[na->num_rx_rings].rx_queue);
301217885a7bSLuigi Rizzo 		ND("initialized sw rx queue %d", na->num_rx_rings);
301317885a7bSLuigi Rizzo 	}
301417885a7bSLuigi Rizzo 	return ret;
3015f9790aebSLuigi Rizzo }
3016f9790aebSLuigi Rizzo 
3017f9790aebSLuigi Rizzo 
3018f9790aebSLuigi Rizzo 
301968b8534bSLuigi Rizzo /*
302089cc2556SLuigi Rizzo  * Called on module unload by the netmap-enabled drivers
302168b8534bSLuigi Rizzo  */
302268b8534bSLuigi Rizzo void
302368b8534bSLuigi Rizzo netmap_detach(struct ifnet *ifp)
302468b8534bSLuigi Rizzo {
302568b8534bSLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
302668b8534bSLuigi Rizzo 
302768b8534bSLuigi Rizzo 	if (!na)
302868b8534bSLuigi Rizzo 		return;
302968b8534bSLuigi Rizzo 
3030f9790aebSLuigi Rizzo 	NMG_LOCK();
303137e3a6d3SLuigi Rizzo 	netmap_set_all_rings(na, NM_KR_LOCKED);
303237e3a6d3SLuigi Rizzo 	na->na_flags |= NAF_ZOMBIE;
3033847bf383SLuigi Rizzo 	/*
3034847bf383SLuigi Rizzo 	 * if the netmap adapter is not native, somebody
3035847bf383SLuigi Rizzo 	 * changed it, so we can not release it here.
303637e3a6d3SLuigi Rizzo 	 * The NAF_ZOMBIE flag will notify the new owner that
3037847bf383SLuigi Rizzo 	 * the driver is gone.
3038847bf383SLuigi Rizzo 	 */
3039847bf383SLuigi Rizzo 	if (na->na_flags & NAF_NATIVE) {
304037e3a6d3SLuigi Rizzo 	        netmap_adapter_put(na);
3041847bf383SLuigi Rizzo 	}
304237e3a6d3SLuigi Rizzo 	/* give active users a chance to notice that NAF_ZOMBIE has been
304337e3a6d3SLuigi Rizzo 	 * turned on, so that they can stop and return an error to userspace.
304437e3a6d3SLuigi Rizzo 	 * Note that this becomes a NOP if there are no active users and,
304537e3a6d3SLuigi Rizzo 	 * therefore, the put() above has deleted the na, since now NA(ifp) is
304637e3a6d3SLuigi Rizzo 	 * NULL.
304737e3a6d3SLuigi Rizzo 	 */
3048f9790aebSLuigi Rizzo 	netmap_enable_all_rings(ifp);
3049f9790aebSLuigi Rizzo 	NMG_UNLOCK();
3050ae10d1afSLuigi Rizzo }
3051f18be576SLuigi Rizzo 
3052f18be576SLuigi Rizzo 
305368b8534bSLuigi Rizzo /*
305402ad4083SLuigi Rizzo  * Intercept packets from the network stack and pass them
305502ad4083SLuigi Rizzo  * to netmap as incoming packets on the 'software' ring.
305617885a7bSLuigi Rizzo  *
305717885a7bSLuigi Rizzo  * We only store packets in a bounded mbq and then copy them
305817885a7bSLuigi Rizzo  * in the relevant rxsync routine.
305917885a7bSLuigi Rizzo  *
3060ce3ee1e7SLuigi Rizzo  * We rely on the OS to make sure that the ifp and na do not go
3061ce3ee1e7SLuigi Rizzo  * away (typically the caller checks for IFF_DRV_RUNNING or the like).
3062ce3ee1e7SLuigi Rizzo  * In nm_register() or whenever there is a reinitialization,
3063f9790aebSLuigi Rizzo  * we make sure to make the mode change visible here.
306468b8534bSLuigi Rizzo  */
306568b8534bSLuigi Rizzo int
3066ce3ee1e7SLuigi Rizzo netmap_transmit(struct ifnet *ifp, struct mbuf *m)
306768b8534bSLuigi Rizzo {
306868b8534bSLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
306937e3a6d3SLuigi Rizzo 	struct netmap_kring *kring, *tx_kring;
307017885a7bSLuigi Rizzo 	u_int len = MBUF_LEN(m);
307117885a7bSLuigi Rizzo 	u_int error = ENOBUFS;
307237e3a6d3SLuigi Rizzo 	unsigned int txr;
307317885a7bSLuigi Rizzo 	struct mbq *q;
3074c3e9b4dbSLuiz Otavio O Souza 	int busy;
307568b8534bSLuigi Rizzo 
3076847bf383SLuigi Rizzo 	kring = &na->rx_rings[na->num_rx_rings];
3077ce3ee1e7SLuigi Rizzo 	// XXX [Linux] we do not need this lock
3078ce3ee1e7SLuigi Rizzo 	// if we follow the down/configure/up protocol -gl
3079ce3ee1e7SLuigi Rizzo 	// mtx_lock(&na->core_lock);
308017885a7bSLuigi Rizzo 
30814bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na)) {
30824bf50f18SLuigi Rizzo 		D("%s not in netmap mode anymore", na->name);
3083ce3ee1e7SLuigi Rizzo 		error = ENXIO;
3084ce3ee1e7SLuigi Rizzo 		goto done;
3085ce3ee1e7SLuigi Rizzo 	}
3086ce3ee1e7SLuigi Rizzo 
308737e3a6d3SLuigi Rizzo 	txr = MBUF_TXQ(m);
308837e3a6d3SLuigi Rizzo 	if (txr >= na->num_tx_rings) {
308937e3a6d3SLuigi Rizzo 		txr %= na->num_tx_rings;
309037e3a6d3SLuigi Rizzo 	}
309137e3a6d3SLuigi Rizzo 	tx_kring = &NMR(na, NR_TX)[txr];
309237e3a6d3SLuigi Rizzo 
309337e3a6d3SLuigi Rizzo 	if (tx_kring->nr_mode == NKR_NETMAP_OFF) {
309437e3a6d3SLuigi Rizzo 		return MBUF_TRANSMIT(na, ifp, m);
309537e3a6d3SLuigi Rizzo 	}
309637e3a6d3SLuigi Rizzo 
309717885a7bSLuigi Rizzo 	q = &kring->rx_queue;
309817885a7bSLuigi Rizzo 
3099ce3ee1e7SLuigi Rizzo 	// XXX reconsider long packets if we handle fragments
31004bf50f18SLuigi Rizzo 	if (len > NETMAP_BUF_SIZE(na)) { /* too long for us */
31014bf50f18SLuigi Rizzo 		D("%s from_host, drop packet size %d > %d", na->name,
31024bf50f18SLuigi Rizzo 			len, NETMAP_BUF_SIZE(na));
3103ce3ee1e7SLuigi Rizzo 		goto done;
3104849bec0eSLuigi Rizzo 	}
310517885a7bSLuigi Rizzo 
310637e3a6d3SLuigi Rizzo 	if (nm_os_mbuf_has_offld(m)) {
3107c3e9b4dbSLuiz Otavio O Souza 		RD(1, "%s drop mbuf that needs offloadings", na->name);
310837e3a6d3SLuigi Rizzo 		goto done;
310937e3a6d3SLuigi Rizzo 	}
311037e3a6d3SLuigi Rizzo 
3111c3e9b4dbSLuiz Otavio O Souza 	/* protect against netmap_rxsync_from_host(), netmap_sw_to_nic()
311217885a7bSLuigi Rizzo 	 * and maybe other instances of netmap_transmit (the latter
311317885a7bSLuigi Rizzo 	 * not possible on Linux).
3114c3e9b4dbSLuiz Otavio O Souza 	 * We enqueue the mbuf only if we are sure there is going to be
3115c3e9b4dbSLuiz Otavio O Souza 	 * enough room in the host RX ring, otherwise we drop it.
3116ce3ee1e7SLuigi Rizzo 	 */
3117997b054cSLuigi Rizzo 	mbq_lock(q);
311817885a7bSLuigi Rizzo 
3119c3e9b4dbSLuiz Otavio O Souza 	busy = kring->nr_hwtail - kring->nr_hwcur;
3120c3e9b4dbSLuiz Otavio O Souza 	if (busy < 0)
3121c3e9b4dbSLuiz Otavio O Souza 		busy += kring->nkr_num_slots;
3122c3e9b4dbSLuiz Otavio O Souza 	if (busy + mbq_len(q) >= kring->nkr_num_slots - 1) {
3123c3e9b4dbSLuiz Otavio O Souza 		RD(2, "%s full hwcur %d hwtail %d qlen %d", na->name,
3124c3e9b4dbSLuiz Otavio O Souza 			kring->nr_hwcur, kring->nr_hwtail, mbq_len(q));
3125ce3ee1e7SLuigi Rizzo 	} else {
312617885a7bSLuigi Rizzo 		mbq_enqueue(q, m);
3127c3e9b4dbSLuiz Otavio O Souza 		ND(2, "%s %d bufs in queue", na->name, mbq_len(q));
312817885a7bSLuigi Rizzo 		/* notify outside the lock */
312917885a7bSLuigi Rizzo 		m = NULL;
313068b8534bSLuigi Rizzo 		error = 0;
3131ce3ee1e7SLuigi Rizzo 	}
3132997b054cSLuigi Rizzo 	mbq_unlock(q);
3133ce3ee1e7SLuigi Rizzo 
313468b8534bSLuigi Rizzo done:
313517885a7bSLuigi Rizzo 	if (m)
313668b8534bSLuigi Rizzo 		m_freem(m);
313717885a7bSLuigi Rizzo 	/* unconditionally wake up listeners */
3138847bf383SLuigi Rizzo 	kring->nm_notify(kring, 0);
313989cc2556SLuigi Rizzo 	/* this is normally netmap_notify(), but for nics
314089cc2556SLuigi Rizzo 	 * connected to a bridge it is netmap_bwrap_intr_notify(),
314189cc2556SLuigi Rizzo 	 * that possibly forwards the frames through the switch
314289cc2556SLuigi Rizzo 	 */
314368b8534bSLuigi Rizzo 
314468b8534bSLuigi Rizzo 	return (error);
314568b8534bSLuigi Rizzo }
314668b8534bSLuigi Rizzo 
314768b8534bSLuigi Rizzo 
314868b8534bSLuigi Rizzo /*
314968b8534bSLuigi Rizzo  * netmap_reset() is called by the driver routines when reinitializing
315068b8534bSLuigi Rizzo  * a ring. The driver is in charge of locking to protect the kring.
3151f9790aebSLuigi Rizzo  * If native netmap mode is not set just return NULL.
315237e3a6d3SLuigi Rizzo  * If native netmap mode is set, in particular, we have to set nr_mode to
315337e3a6d3SLuigi Rizzo  * NKR_NETMAP_ON.
315468b8534bSLuigi Rizzo  */
315568b8534bSLuigi Rizzo struct netmap_slot *
3156ce3ee1e7SLuigi Rizzo netmap_reset(struct netmap_adapter *na, enum txrx tx, u_int n,
315768b8534bSLuigi Rizzo 	u_int new_cur)
315868b8534bSLuigi Rizzo {
315968b8534bSLuigi Rizzo 	struct netmap_kring *kring;
3160506cc70cSLuigi Rizzo 	int new_hwofs, lim;
316168b8534bSLuigi Rizzo 
31624bf50f18SLuigi Rizzo 	if (!nm_native_on(na)) {
31634bf50f18SLuigi Rizzo 		ND("interface not in native netmap mode");
316468b8534bSLuigi Rizzo 		return NULL;	/* nothing to reinitialize */
3165ce3ee1e7SLuigi Rizzo 	}
316668b8534bSLuigi Rizzo 
3167ce3ee1e7SLuigi Rizzo 	/* XXX note- in the new scheme, we are not guaranteed to be
3168ce3ee1e7SLuigi Rizzo 	 * under lock (e.g. when called on a device reset).
3169ce3ee1e7SLuigi Rizzo 	 * In this case, we should set a flag and do not trust too
3170ce3ee1e7SLuigi Rizzo 	 * much the values. In practice: TODO
3171ce3ee1e7SLuigi Rizzo 	 * - set a RESET flag somewhere in the kring
3172ce3ee1e7SLuigi Rizzo 	 * - do the processing in a conservative way
3173ce3ee1e7SLuigi Rizzo 	 * - let the *sync() fixup at the end.
3174ce3ee1e7SLuigi Rizzo 	 */
317564ae02c3SLuigi Rizzo 	if (tx == NR_TX) {
31768241616dSLuigi Rizzo 		if (n >= na->num_tx_rings)
31778241616dSLuigi Rizzo 			return NULL;
317837e3a6d3SLuigi Rizzo 
317964ae02c3SLuigi Rizzo 		kring = na->tx_rings + n;
318037e3a6d3SLuigi Rizzo 
318137e3a6d3SLuigi Rizzo 		if (kring->nr_pending_mode == NKR_NETMAP_OFF) {
318237e3a6d3SLuigi Rizzo 			kring->nr_mode = NKR_NETMAP_OFF;
318337e3a6d3SLuigi Rizzo 			return NULL;
318437e3a6d3SLuigi Rizzo 		}
318537e3a6d3SLuigi Rizzo 
318617885a7bSLuigi Rizzo 		// XXX check whether we should use hwcur or rcur
3187506cc70cSLuigi Rizzo 		new_hwofs = kring->nr_hwcur - new_cur;
318864ae02c3SLuigi Rizzo 	} else {
31898241616dSLuigi Rizzo 		if (n >= na->num_rx_rings)
31908241616dSLuigi Rizzo 			return NULL;
319164ae02c3SLuigi Rizzo 		kring = na->rx_rings + n;
319237e3a6d3SLuigi Rizzo 
319337e3a6d3SLuigi Rizzo 		if (kring->nr_pending_mode == NKR_NETMAP_OFF) {
319437e3a6d3SLuigi Rizzo 			kring->nr_mode = NKR_NETMAP_OFF;
319537e3a6d3SLuigi Rizzo 			return NULL;
319637e3a6d3SLuigi Rizzo 		}
319737e3a6d3SLuigi Rizzo 
319817885a7bSLuigi Rizzo 		new_hwofs = kring->nr_hwtail - new_cur;
319964ae02c3SLuigi Rizzo 	}
320064ae02c3SLuigi Rizzo 	lim = kring->nkr_num_slots - 1;
3201506cc70cSLuigi Rizzo 	if (new_hwofs > lim)
3202506cc70cSLuigi Rizzo 		new_hwofs -= lim + 1;
3203506cc70cSLuigi Rizzo 
3204ce3ee1e7SLuigi Rizzo 	/* Always set the new offset value and realign the ring. */
320517885a7bSLuigi Rizzo 	if (netmap_verbose)
320617885a7bSLuigi Rizzo 	    D("%s %s%d hwofs %d -> %d, hwtail %d -> %d",
32074bf50f18SLuigi Rizzo 		na->name,
320817885a7bSLuigi Rizzo 		tx == NR_TX ? "TX" : "RX", n,
3209ce3ee1e7SLuigi Rizzo 		kring->nkr_hwofs, new_hwofs,
321017885a7bSLuigi Rizzo 		kring->nr_hwtail,
321117885a7bSLuigi Rizzo 		tx == NR_TX ? lim : kring->nr_hwtail);
3212506cc70cSLuigi Rizzo 	kring->nkr_hwofs = new_hwofs;
321317885a7bSLuigi Rizzo 	if (tx == NR_TX) {
321417885a7bSLuigi Rizzo 		kring->nr_hwtail = kring->nr_hwcur + lim;
321517885a7bSLuigi Rizzo 		if (kring->nr_hwtail > lim)
321617885a7bSLuigi Rizzo 			kring->nr_hwtail -= lim + 1;
321717885a7bSLuigi Rizzo 	}
3218506cc70cSLuigi Rizzo 
3219f196ce38SLuigi Rizzo #if 0 // def linux
3220f196ce38SLuigi Rizzo 	/* XXX check that the mappings are correct */
3221f196ce38SLuigi Rizzo 	/* need ring_nr, adapter->pdev, direction */
3222f196ce38SLuigi Rizzo 	buffer_info->dma = dma_map_single(&pdev->dev, addr, adapter->rx_buffer_len, DMA_FROM_DEVICE);
3223f196ce38SLuigi Rizzo 	if (dma_mapping_error(&adapter->pdev->dev, buffer_info->dma)) {
3224f196ce38SLuigi Rizzo 		D("error mapping rx netmap buffer %d", i);
3225f196ce38SLuigi Rizzo 		// XXX fix error handling
3226f196ce38SLuigi Rizzo 	}
3227f196ce38SLuigi Rizzo 
3228f196ce38SLuigi Rizzo #endif /* linux */
322968b8534bSLuigi Rizzo 	/*
3230ce3ee1e7SLuigi Rizzo 	 * Wakeup on the individual and global selwait
3231506cc70cSLuigi Rizzo 	 * We do the wakeup here, but the ring is not yet reconfigured.
3232506cc70cSLuigi Rizzo 	 * However, we are under lock so there are no races.
323368b8534bSLuigi Rizzo 	 */
323437e3a6d3SLuigi Rizzo 	kring->nr_mode = NKR_NETMAP_ON;
3235847bf383SLuigi Rizzo 	kring->nm_notify(kring, 0);
323668b8534bSLuigi Rizzo 	return kring->ring->slot;
323768b8534bSLuigi Rizzo }
323868b8534bSLuigi Rizzo 
323968b8534bSLuigi Rizzo 
3240ce3ee1e7SLuigi Rizzo /*
3241f9790aebSLuigi Rizzo  * Dispatch rx/tx interrupts to the netmap rings.
3242ce3ee1e7SLuigi Rizzo  *
3243ce3ee1e7SLuigi Rizzo  * "work_done" is non-null on the RX path, NULL for the TX path.
3244ce3ee1e7SLuigi Rizzo  * We rely on the OS to make sure that there is only one active
3245ce3ee1e7SLuigi Rizzo  * instance per queue, and that there is appropriate locking.
3246849bec0eSLuigi Rizzo  *
3247f9790aebSLuigi Rizzo  * The 'notify' routine depends on what the ring is attached to.
3248f9790aebSLuigi Rizzo  * - for a netmap file descriptor, do a selwakeup on the individual
3249f9790aebSLuigi Rizzo  *   waitqueue, plus one on the global one if needed
32504bf50f18SLuigi Rizzo  *   (see netmap_notify)
32514bf50f18SLuigi Rizzo  * - for a nic connected to a switch, call the proper forwarding routine
32524bf50f18SLuigi Rizzo  *   (see netmap_bwrap_intr_notify)
3253f9790aebSLuigi Rizzo  */
325437e3a6d3SLuigi Rizzo int
325537e3a6d3SLuigi Rizzo netmap_common_irq(struct netmap_adapter *na, u_int q, u_int *work_done)
3256f9790aebSLuigi Rizzo {
3257f9790aebSLuigi Rizzo 	struct netmap_kring *kring;
3258847bf383SLuigi Rizzo 	enum txrx t = (work_done ? NR_RX : NR_TX);
3259f9790aebSLuigi Rizzo 
3260f9790aebSLuigi Rizzo 	q &= NETMAP_RING_MASK;
3261f9790aebSLuigi Rizzo 
3262f9790aebSLuigi Rizzo 	if (netmap_verbose) {
3263f9790aebSLuigi Rizzo 	        RD(5, "received %s queue %d", work_done ? "RX" : "TX" , q);
3264f9790aebSLuigi Rizzo 	}
3265f9790aebSLuigi Rizzo 
3266847bf383SLuigi Rizzo 	if (q >= nma_get_nrings(na, t))
326737e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS; // not a physical queue
3268847bf383SLuigi Rizzo 
3269847bf383SLuigi Rizzo 	kring = NMR(na, t) + q;
3270847bf383SLuigi Rizzo 
327137e3a6d3SLuigi Rizzo 	if (kring->nr_mode == NKR_NETMAP_OFF) {
327237e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
327337e3a6d3SLuigi Rizzo 	}
327437e3a6d3SLuigi Rizzo 
3275847bf383SLuigi Rizzo 	if (t == NR_RX) {
3276f9790aebSLuigi Rizzo 		kring->nr_kflags |= NKR_PENDINTR;	// XXX atomic ?
3277f9790aebSLuigi Rizzo 		*work_done = 1; /* do not fire napi again */
3278f9790aebSLuigi Rizzo 	}
327937e3a6d3SLuigi Rizzo 
328037e3a6d3SLuigi Rizzo 	return kring->nm_notify(kring, 0);
3281f9790aebSLuigi Rizzo }
3282f9790aebSLuigi Rizzo 
328317885a7bSLuigi Rizzo 
3284f9790aebSLuigi Rizzo /*
3285f9790aebSLuigi Rizzo  * Default functions to handle rx/tx interrupts from a physical device.
3286f9790aebSLuigi Rizzo  * "work_done" is non-null on the RX path, NULL for the TX path.
3287f9790aebSLuigi Rizzo  *
328837e3a6d3SLuigi Rizzo  * If the card is not in netmap mode, simply return NM_IRQ_PASS,
3289ce3ee1e7SLuigi Rizzo  * so that the caller proceeds with regular processing.
329037e3a6d3SLuigi Rizzo  * Otherwise call netmap_common_irq().
3291ce3ee1e7SLuigi Rizzo  *
3292ce3ee1e7SLuigi Rizzo  * If the card is connected to a netmap file descriptor,
3293ce3ee1e7SLuigi Rizzo  * do a selwakeup on the individual queue, plus one on the global one
3294ce3ee1e7SLuigi Rizzo  * if needed (multiqueue card _and_ there are multiqueue listeners),
329537e3a6d3SLuigi Rizzo  * and return NR_IRQ_COMPLETED.
3296ce3ee1e7SLuigi Rizzo  *
3297ce3ee1e7SLuigi Rizzo  * Finally, if called on rx from an interface connected to a switch,
329837e3a6d3SLuigi Rizzo  * calls the proper forwarding routine.
32991a26580eSLuigi Rizzo  */
3300babc7c12SLuigi Rizzo int
3301ce3ee1e7SLuigi Rizzo netmap_rx_irq(struct ifnet *ifp, u_int q, u_int *work_done)
33021a26580eSLuigi Rizzo {
33034bf50f18SLuigi Rizzo 	struct netmap_adapter *na = NA(ifp);
33044bf50f18SLuigi Rizzo 
33054bf50f18SLuigi Rizzo 	/*
33064bf50f18SLuigi Rizzo 	 * XXX emulated netmap mode sets NAF_SKIP_INTR so
33074bf50f18SLuigi Rizzo 	 * we still use the regular driver even though the previous
33084bf50f18SLuigi Rizzo 	 * check fails. It is unclear whether we should use
33094bf50f18SLuigi Rizzo 	 * nm_native_on() here.
33104bf50f18SLuigi Rizzo 	 */
33114bf50f18SLuigi Rizzo 	if (!nm_netmap_on(na))
331237e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
3313849bec0eSLuigi Rizzo 
33144bf50f18SLuigi Rizzo 	if (na->na_flags & NAF_SKIP_INTR) {
33158241616dSLuigi Rizzo 		ND("use regular interrupt");
331637e3a6d3SLuigi Rizzo 		return NM_IRQ_PASS;
33178241616dSLuigi Rizzo 	}
33188241616dSLuigi Rizzo 
331937e3a6d3SLuigi Rizzo 	return netmap_common_irq(na, q, work_done);
33201a26580eSLuigi Rizzo }
33211a26580eSLuigi Rizzo 
332264ae02c3SLuigi Rizzo 
332301c7d25fSLuigi Rizzo /*
3324f9790aebSLuigi Rizzo  * Module loader and unloader
3325f196ce38SLuigi Rizzo  *
3326f9790aebSLuigi Rizzo  * netmap_init() creates the /dev/netmap device and initializes
3327f9790aebSLuigi Rizzo  * all global variables. Returns 0 on success, errno on failure
3328f9790aebSLuigi Rizzo  * (but there is no chance)
3329f9790aebSLuigi Rizzo  *
3330f9790aebSLuigi Rizzo  * netmap_fini() destroys everything.
3331f196ce38SLuigi Rizzo  */
3332babc7c12SLuigi Rizzo 
3333babc7c12SLuigi Rizzo static struct cdev *netmap_dev; /* /dev/netmap character device. */
3334f9790aebSLuigi Rizzo extern struct cdevsw netmap_cdevsw;
3335babc7c12SLuigi Rizzo 
333617885a7bSLuigi Rizzo 
3337f9790aebSLuigi Rizzo void
333868b8534bSLuigi Rizzo netmap_fini(void)
333968b8534bSLuigi Rizzo {
3340f9790aebSLuigi Rizzo 	if (netmap_dev)
334168b8534bSLuigi Rizzo 		destroy_dev(netmap_dev);
334237e3a6d3SLuigi Rizzo 	/* we assume that there are no longer netmap users */
334337e3a6d3SLuigi Rizzo 	nm_os_ifnet_fini();
334437e3a6d3SLuigi Rizzo 	netmap_uninit_bridges();
3345ce3ee1e7SLuigi Rizzo 	netmap_mem_fini();
3346ce3ee1e7SLuigi Rizzo 	NMG_LOCK_DESTROY();
3347c3e9b4dbSLuiz Otavio O Souza 	nm_prinf("netmap: unloaded module.\n");
334868b8534bSLuigi Rizzo }
334968b8534bSLuigi Rizzo 
335017885a7bSLuigi Rizzo 
3351f9790aebSLuigi Rizzo int
3352f9790aebSLuigi Rizzo netmap_init(void)
335368b8534bSLuigi Rizzo {
3354f9790aebSLuigi Rizzo 	int error;
335568b8534bSLuigi Rizzo 
3356f9790aebSLuigi Rizzo 	NMG_LOCK_INIT();
335768b8534bSLuigi Rizzo 
3358f9790aebSLuigi Rizzo 	error = netmap_mem_init();
3359f9790aebSLuigi Rizzo 	if (error != 0)
3360f9790aebSLuigi Rizzo 		goto fail;
3361c929ca72SLuigi Rizzo 	/*
3362c929ca72SLuigi Rizzo 	 * MAKEDEV_ETERNAL_KLD avoids an expensive check on syscalls
3363c929ca72SLuigi Rizzo 	 * when the module is compiled in.
3364c929ca72SLuigi Rizzo 	 * XXX could use make_dev_credv() to get error number
3365c929ca72SLuigi Rizzo 	 */
33660e73f29aSLuigi Rizzo 	netmap_dev = make_dev_credf(MAKEDEV_ETERNAL_KLD,
336711c0b69cSAdrian Chadd 		&netmap_cdevsw, 0, NULL, UID_ROOT, GID_WHEEL, 0600,
33680e73f29aSLuigi Rizzo 			      "netmap");
3369f9790aebSLuigi Rizzo 	if (!netmap_dev)
3370f9790aebSLuigi Rizzo 		goto fail;
3371f9790aebSLuigi Rizzo 
3372847bf383SLuigi Rizzo 	error = netmap_init_bridges();
3373847bf383SLuigi Rizzo 	if (error)
3374847bf383SLuigi Rizzo 		goto fail;
3375847bf383SLuigi Rizzo 
33764bf50f18SLuigi Rizzo #ifdef __FreeBSD__
337737e3a6d3SLuigi Rizzo 	nm_os_vi_init_index();
33784bf50f18SLuigi Rizzo #endif
3379847bf383SLuigi Rizzo 
338037e3a6d3SLuigi Rizzo 	error = nm_os_ifnet_init();
338137e3a6d3SLuigi Rizzo 	if (error)
338237e3a6d3SLuigi Rizzo 		goto fail;
338337e3a6d3SLuigi Rizzo 
3384c3e9b4dbSLuiz Otavio O Souza 	nm_prinf("netmap: loaded module\n");
3385f9790aebSLuigi Rizzo 	return (0);
3386f9790aebSLuigi Rizzo fail:
338768b8534bSLuigi Rizzo 	netmap_fini();
3388f9790aebSLuigi Rizzo 	return (EINVAL); /* may be incorrect */
338968b8534bSLuigi Rizzo }
3390