11cafed39SJonathan Lemon /*- 2d4b5cae4SRobert Watson * Copyright (c) 2007-2009 Robert N. M. Watson 32d22f334SRobert Watson * Copyright (c) 2010 Juniper Networks, Inc. 4e3b6e33cSJake Burkholder * All rights reserved. 5e3b6e33cSJake Burkholder * 62d22f334SRobert Watson * This software was developed by Robert N. M. Watson under contract 72d22f334SRobert Watson * to Juniper Networks, Inc. 82d22f334SRobert Watson * 9e3b6e33cSJake Burkholder * Redistribution and use in source and binary forms, with or without 10e3b6e33cSJake Burkholder * modification, are permitted provided that the following conditions 11e3b6e33cSJake Burkholder * are met: 12e3b6e33cSJake Burkholder * 1. Redistributions of source code must retain the above copyright 131cafed39SJonathan Lemon * notice, this list of conditions and the following disclaimer. 14e3b6e33cSJake Burkholder * 2. Redistributions in binary form must reproduce the above copyright 15e3b6e33cSJake Burkholder * notice, this list of conditions and the following disclaimer in the 16e3b6e33cSJake Burkholder * documentation and/or other materials provided with the distribution. 17e3b6e33cSJake Burkholder * 181cafed39SJonathan Lemon * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 191cafed39SJonathan Lemon * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 201cafed39SJonathan Lemon * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 211cafed39SJonathan Lemon * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 221cafed39SJonathan Lemon * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 231cafed39SJonathan Lemon * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 241cafed39SJonathan Lemon * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 251cafed39SJonathan Lemon * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 261cafed39SJonathan Lemon * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 271cafed39SJonathan Lemon * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 281cafed39SJonathan Lemon * SUCH DAMAGE. 29e3b6e33cSJake Burkholder */ 30e3b6e33cSJake Burkholder 31d4b5cae4SRobert Watson #include <sys/cdefs.h> 32d4b5cae4SRobert Watson __FBSDID("$FreeBSD$"); 33d4b5cae4SRobert Watson 34d4b5cae4SRobert Watson /* 35d4b5cae4SRobert Watson * netisr is a packet dispatch service, allowing synchronous (directly 36d4b5cae4SRobert Watson * dispatched) and asynchronous (deferred dispatch) processing of packets by 37d4b5cae4SRobert Watson * registered protocol handlers. Callers pass a protocol identifier and 38d4b5cae4SRobert Watson * packet to netisr, along with a direct dispatch hint, and work will either 390a32e29fSRobert Watson * be immediately processed by the registered handler, or passed to a 400a32e29fSRobert Watson * software interrupt (SWI) thread for deferred dispatch. Callers will 410a32e29fSRobert Watson * generally select one or the other based on: 42d4b5cae4SRobert Watson * 430a32e29fSRobert Watson * - Whether directly dispatching a netisr handler lead to code reentrance or 44d4b5cae4SRobert Watson * lock recursion, such as entering the socket code from the socket code. 450a32e29fSRobert Watson * - Whether directly dispatching a netisr handler lead to recursive 46d4b5cae4SRobert Watson * processing, such as when decapsulating several wrapped layers of tunnel 47d4b5cae4SRobert Watson * information (IPSEC within IPSEC within ...). 48d4b5cae4SRobert Watson * 49d4b5cae4SRobert Watson * Maintaining ordering for protocol streams is a critical design concern. 50d4b5cae4SRobert Watson * Enforcing ordering limits the opportunity for concurrency, but maintains 51d4b5cae4SRobert Watson * the strong ordering requirements found in some protocols, such as TCP. Of 52d4b5cae4SRobert Watson * related concern is CPU affinity--it is desirable to process all data 53d4b5cae4SRobert Watson * associated with a particular stream on the same CPU over time in order to 54d4b5cae4SRobert Watson * avoid acquiring locks associated with the connection on different CPUs, 55d4b5cae4SRobert Watson * keep connection data in one cache, and to generally encourage associated 56d4b5cae4SRobert Watson * user threads to live on the same CPU as the stream. It's also desirable 57d4b5cae4SRobert Watson * to avoid lock migration and contention where locks are associated with 58d4b5cae4SRobert Watson * more than one flow. 59d4b5cae4SRobert Watson * 60d4b5cae4SRobert Watson * netisr supports several policy variations, represented by the 610a32e29fSRobert Watson * NETISR_POLICY_* constants, allowing protocols to play various roles in 62d4b5cae4SRobert Watson * identifying flows, assigning work to CPUs, etc. These are described in 630a32e29fSRobert Watson * netisr.h. 64d4b5cae4SRobert Watson */ 65d4b5cae4SRobert Watson 66d4b5cae4SRobert Watson #include "opt_ddb.h" 67f0796cd2SGleb Smirnoff #include "opt_device_polling.h" 681d8cd39eSRobert Watson 69e3b6e33cSJake Burkholder #include <sys/param.h> 70e3b6e33cSJake Burkholder #include <sys/bus.h> 71e3b6e33cSJake Burkholder #include <sys/kernel.h> 721cafed39SJonathan Lemon #include <sys/kthread.h> 73d4b5cae4SRobert Watson #include <sys/interrupt.h> 741cafed39SJonathan Lemon #include <sys/lock.h> 751cafed39SJonathan Lemon #include <sys/mbuf.h> 76d4b5cae4SRobert Watson #include <sys/mutex.h> 7753402767SRobert Watson #include <sys/pcpu.h> 78d4b5cae4SRobert Watson #include <sys/proc.h> 79d4b5cae4SRobert Watson #include <sys/rmlock.h> 80d4b5cae4SRobert Watson #include <sys/sched.h> 81d4b5cae4SRobert Watson #include <sys/smp.h> 821cafed39SJonathan Lemon #include <sys/socket.h> 83d4b5cae4SRobert Watson #include <sys/sysctl.h> 84d4b5cae4SRobert Watson #include <sys/systm.h> 85d4b5cae4SRobert Watson 86d4b5cae4SRobert Watson #ifdef DDB 87d4b5cae4SRobert Watson #include <ddb/ddb.h> 88d4b5cae4SRobert Watson #endif 891cafed39SJonathan Lemon 901cafed39SJonathan Lemon #include <net/if.h> 911cafed39SJonathan Lemon #include <net/if_var.h> 92e3b6e33cSJake Burkholder #include <net/netisr.h> 93530c0060SRobert Watson #include <net/vnet.h> 94e3b6e33cSJake Burkholder 95d4b5cae4SRobert Watson /*- 96d4b5cae4SRobert Watson * Synchronize use and modification of the registered netisr data structures; 97d4b5cae4SRobert Watson * acquire a read lock while modifying the set of registered protocols to 98d4b5cae4SRobert Watson * prevent partially registered or unregistered protocols from being run. 99d4b5cae4SRobert Watson * 100d4b5cae4SRobert Watson * The following data structures and fields are protected by this lock: 101d4b5cae4SRobert Watson * 102d4b5cae4SRobert Watson * - The np array, including all fields of struct netisr_proto. 103d4b5cae4SRobert Watson * - The nws array, including all fields of struct netisr_worker. 104d4b5cae4SRobert Watson * - The nws_array array. 105d4b5cae4SRobert Watson * 106d4b5cae4SRobert Watson * Note: the NETISR_LOCKING define controls whether read locks are acquired 107d4b5cae4SRobert Watson * in packet processing paths requiring netisr registration stability. This 1080a32e29fSRobert Watson * is disabled by default as it can lead to measurable performance 109d4b5cae4SRobert Watson * degradation even with rmlocks (3%-6% for loopback ping-pong traffic), and 110d4b5cae4SRobert Watson * because netisr registration and unregistration is extremely rare at 111d4b5cae4SRobert Watson * runtime. If it becomes more common, this decision should be revisited. 112d4b5cae4SRobert Watson * 113d4b5cae4SRobert Watson * XXXRW: rmlocks don't support assertions. 114d4b5cae4SRobert Watson */ 115d4b5cae4SRobert Watson static struct rmlock netisr_rmlock; 116d4b5cae4SRobert Watson #define NETISR_LOCK_INIT() rm_init_flags(&netisr_rmlock, "netisr", \ 117d4b5cae4SRobert Watson RM_NOWITNESS) 118d4b5cae4SRobert Watson #define NETISR_LOCK_ASSERT() 119d4b5cae4SRobert Watson #define NETISR_RLOCK(tracker) rm_rlock(&netisr_rmlock, (tracker)) 120d4b5cae4SRobert Watson #define NETISR_RUNLOCK(tracker) rm_runlock(&netisr_rmlock, (tracker)) 121d4b5cae4SRobert Watson #define NETISR_WLOCK() rm_wlock(&netisr_rmlock) 122d4b5cae4SRobert Watson #define NETISR_WUNLOCK() rm_wunlock(&netisr_rmlock) 123d4b5cae4SRobert Watson /* #define NETISR_LOCKING */ 124e3b6e33cSJake Burkholder 125d4b5cae4SRobert Watson SYSCTL_NODE(_net, OID_AUTO, isr, CTLFLAG_RW, 0, "netisr"); 1261cafed39SJonathan Lemon 127d4b5cae4SRobert Watson /*- 128d4b5cae4SRobert Watson * Three direct dispatch policies are supported: 129d4b5cae4SRobert Watson * 130d4b5cae4SRobert Watson * - Always defer: all work is scheduled for a netisr, regardless of context. 131d4b5cae4SRobert Watson * (!direct) 132d4b5cae4SRobert Watson * 133d4b5cae4SRobert Watson * - Hybrid: if the executing context allows direct dispatch, and we're 134d4b5cae4SRobert Watson * running on the CPU the work would be done on, then direct dispatch if it 135d4b5cae4SRobert Watson * wouldn't violate ordering constraints on the workstream. 136d4b5cae4SRobert Watson * (direct && !direct_force) 137d4b5cae4SRobert Watson * 138d4b5cae4SRobert Watson * - Always direct: if the executing context allows direct dispatch, always 139d4b5cae4SRobert Watson * direct dispatch. (direct && direct_force) 140d4b5cae4SRobert Watson * 141d4b5cae4SRobert Watson * Notice that changing the global policy could lead to short periods of 142d4b5cae4SRobert Watson * misordered processing, but this is considered acceptable as compared to 143d4b5cae4SRobert Watson * the complexity of enforcing ordering during policy changes. 144d4b5cae4SRobert Watson */ 145d4b5cae4SRobert Watson static int netisr_direct_force = 1; /* Always direct dispatch. */ 146d4b5cae4SRobert Watson TUNABLE_INT("net.isr.direct_force", &netisr_direct_force); 147d4b5cae4SRobert Watson SYSCTL_INT(_net_isr, OID_AUTO, direct_force, CTLFLAG_RW, 148d4b5cae4SRobert Watson &netisr_direct_force, 0, "Force direct dispatch"); 149e3b6e33cSJake Burkholder 150d4b5cae4SRobert Watson static int netisr_direct = 1; /* Enable direct dispatch. */ 151cea2165bSRobert Watson TUNABLE_INT("net.isr.direct", &netisr_direct); 152d4b5cae4SRobert Watson SYSCTL_INT(_net_isr, OID_AUTO, direct, CTLFLAG_RW, 153d4b5cae4SRobert Watson &netisr_direct, 0, "Enable direct dispatch"); 1541cafed39SJonathan Lemon 1551cafed39SJonathan Lemon /* 156d4b5cae4SRobert Watson * Allow the administrator to limit the number of threads (CPUs) to use for 157d4b5cae4SRobert Watson * netisr. We don't check netisr_maxthreads before creating the thread for 158d4b5cae4SRobert Watson * CPU 0, so in practice we ignore values <= 1. This must be set at boot. 159d4b5cae4SRobert Watson * We will create at most one thread per CPU. 1605fd04e38SRobert Watson */ 1619e6e01ebSRobert Watson static int netisr_maxthreads = -1; /* Max number of threads. */ 162d4b5cae4SRobert Watson TUNABLE_INT("net.isr.maxthreads", &netisr_maxthreads); 16378494902SPawel Jakub Dawidek SYSCTL_INT(_net_isr, OID_AUTO, maxthreads, CTLFLAG_RDTUN, 164d4b5cae4SRobert Watson &netisr_maxthreads, 0, 165d4b5cae4SRobert Watson "Use at most this many CPUs for netisr processing"); 1665fd04e38SRobert Watson 167d4b5cae4SRobert Watson static int netisr_bindthreads = 0; /* Bind threads to CPUs. */ 168d4b5cae4SRobert Watson TUNABLE_INT("net.isr.bindthreads", &netisr_bindthreads); 16978494902SPawel Jakub Dawidek SYSCTL_INT(_net_isr, OID_AUTO, bindthreads, CTLFLAG_RDTUN, 170d4b5cae4SRobert Watson &netisr_bindthreads, 0, "Bind netisr threads to CPUs."); 171d4b5cae4SRobert Watson 172d4b5cae4SRobert Watson /* 1730a32e29fSRobert Watson * Limit per-workstream mbuf queue limits s to at most net.isr.maxqlimit, 1740a32e29fSRobert Watson * both for initial configuration and later modification using 1750a32e29fSRobert Watson * netisr_setqlimit(). 176d4b5cae4SRobert Watson */ 177d4b5cae4SRobert Watson #define NETISR_DEFAULT_MAXQLIMIT 10240 178d4b5cae4SRobert Watson static u_int netisr_maxqlimit = NETISR_DEFAULT_MAXQLIMIT; 179d4b5cae4SRobert Watson TUNABLE_INT("net.isr.maxqlimit", &netisr_maxqlimit); 18078494902SPawel Jakub Dawidek SYSCTL_INT(_net_isr, OID_AUTO, maxqlimit, CTLFLAG_RDTUN, 181d4b5cae4SRobert Watson &netisr_maxqlimit, 0, 182d4b5cae4SRobert Watson "Maximum netisr per-protocol, per-CPU queue depth."); 183d4b5cae4SRobert Watson 184d4b5cae4SRobert Watson /* 1850a32e29fSRobert Watson * The default per-workstream mbuf queue limit for protocols that don't 1860a32e29fSRobert Watson * initialize the nh_qlimit field of their struct netisr_handler. If this is 1870a32e29fSRobert Watson * set above netisr_maxqlimit, we truncate it to the maximum during boot. 188d4b5cae4SRobert Watson */ 189d4b5cae4SRobert Watson #define NETISR_DEFAULT_DEFAULTQLIMIT 256 190d4b5cae4SRobert Watson static u_int netisr_defaultqlimit = NETISR_DEFAULT_DEFAULTQLIMIT; 191d4b5cae4SRobert Watson TUNABLE_INT("net.isr.defaultqlimit", &netisr_defaultqlimit); 19278494902SPawel Jakub Dawidek SYSCTL_INT(_net_isr, OID_AUTO, defaultqlimit, CTLFLAG_RDTUN, 193d4b5cae4SRobert Watson &netisr_defaultqlimit, 0, 194d4b5cae4SRobert Watson "Default netisr per-protocol, per-CPU queue limit if not set by protocol"); 195d4b5cae4SRobert Watson 196d4b5cae4SRobert Watson /* 197d4b5cae4SRobert Watson * Each protocol is described by a struct netisr_proto, which holds all 198d4b5cae4SRobert Watson * global per-protocol information. This data structure is set up by 199d4b5cae4SRobert Watson * netisr_register(), and derived from the public struct netisr_handler. 200d4b5cae4SRobert Watson */ 201d4b5cae4SRobert Watson struct netisr_proto { 202d4b5cae4SRobert Watson const char *np_name; /* Character string protocol name. */ 203d4b5cae4SRobert Watson netisr_handler_t *np_handler; /* Protocol handler. */ 204d4b5cae4SRobert Watson netisr_m2flow_t *np_m2flow; /* Query flow for untagged packet. */ 205d4b5cae4SRobert Watson netisr_m2cpuid_t *np_m2cpuid; /* Query CPU to process packet on. */ 206ed655c8cSBjoern A. Zeeb netisr_drainedcpu_t *np_drainedcpu; /* Callback when drained a queue. */ 207d4b5cae4SRobert Watson u_int np_qlimit; /* Maximum per-CPU queue depth. */ 208d4b5cae4SRobert Watson u_int np_policy; /* Work placement policy. */ 209d4b5cae4SRobert Watson }; 210d4b5cae4SRobert Watson 211ed54411cSRobert Watson #define NETISR_MAXPROT 16 /* Compile-time limit. */ 212d4b5cae4SRobert Watson 213d4b5cae4SRobert Watson /* 214d4b5cae4SRobert Watson * The np array describes all registered protocols, indexed by protocol 215d4b5cae4SRobert Watson * number. 216d4b5cae4SRobert Watson */ 217d4b5cae4SRobert Watson static struct netisr_proto np[NETISR_MAXPROT]; 218d4b5cae4SRobert Watson 219d4b5cae4SRobert Watson /* 220d4b5cae4SRobert Watson * Protocol-specific work for each workstream is described by struct 221d4b5cae4SRobert Watson * netisr_work. Each work descriptor consists of an mbuf queue and 222d4b5cae4SRobert Watson * statistics. 223d4b5cae4SRobert Watson */ 224d4b5cae4SRobert Watson struct netisr_work { 225d4b5cae4SRobert Watson /* 226d4b5cae4SRobert Watson * Packet queue, linked by m_nextpkt. 227d4b5cae4SRobert Watson */ 228d4b5cae4SRobert Watson struct mbuf *nw_head; 229d4b5cae4SRobert Watson struct mbuf *nw_tail; 230d4b5cae4SRobert Watson u_int nw_len; 231d4b5cae4SRobert Watson u_int nw_qlimit; 232d4b5cae4SRobert Watson u_int nw_watermark; 233d4b5cae4SRobert Watson 234d4b5cae4SRobert Watson /* 235d4b5cae4SRobert Watson * Statistics -- written unlocked, but mostly from curcpu. 236d4b5cae4SRobert Watson */ 237d4b5cae4SRobert Watson u_int64_t nw_dispatched; /* Number of direct dispatches. */ 238d4b5cae4SRobert Watson u_int64_t nw_hybrid_dispatched; /* "" hybrid dispatches. */ 239d4b5cae4SRobert Watson u_int64_t nw_qdrops; /* "" drops. */ 240d4b5cae4SRobert Watson u_int64_t nw_queued; /* "" enqueues. */ 241d4b5cae4SRobert Watson u_int64_t nw_handled; /* "" handled in worker. */ 242d4b5cae4SRobert Watson }; 243d4b5cae4SRobert Watson 244d4b5cae4SRobert Watson /* 2450a32e29fSRobert Watson * Workstreams hold a queue of ordered work across each protocol, and are 246d4b5cae4SRobert Watson * described by netisr_workstream. Each workstream is associated with a 247d4b5cae4SRobert Watson * worker thread, which in turn is pinned to a CPU. Work associated with a 248d4b5cae4SRobert Watson * workstream can be processd in other threads during direct dispatch; 249d4b5cae4SRobert Watson * concurrent processing is prevented by the NWS_RUNNING flag, which 2500a32e29fSRobert Watson * indicates that a thread is already processing the work queue. It is 2510a32e29fSRobert Watson * important to prevent a directly dispatched packet from "skipping ahead" of 2520a32e29fSRobert Watson * work already in the workstream queue. 253d4b5cae4SRobert Watson */ 254d4b5cae4SRobert Watson struct netisr_workstream { 255d4b5cae4SRobert Watson struct intr_event *nws_intr_event; /* Handler for stream. */ 256d4b5cae4SRobert Watson void *nws_swi_cookie; /* swi(9) cookie for stream. */ 257d4b5cae4SRobert Watson struct mtx nws_mtx; /* Synchronize work. */ 258d4b5cae4SRobert Watson u_int nws_cpu; /* CPU pinning. */ 259d4b5cae4SRobert Watson u_int nws_flags; /* Wakeup flags. */ 260d4b5cae4SRobert Watson u_int nws_pendingbits; /* Scheduled protocols. */ 261d4b5cae4SRobert Watson 262d4b5cae4SRobert Watson /* 263d4b5cae4SRobert Watson * Each protocol has per-workstream data. 264d4b5cae4SRobert Watson */ 265d4b5cae4SRobert Watson struct netisr_work nws_work[NETISR_MAXPROT]; 266d4b5cae4SRobert Watson } __aligned(CACHE_LINE_SIZE); 267d4b5cae4SRobert Watson 268d4b5cae4SRobert Watson /* 26953402767SRobert Watson * Per-CPU workstream data. 270d4b5cae4SRobert Watson */ 27153402767SRobert Watson DPCPU_DEFINE(struct netisr_workstream, nws); 272d4b5cae4SRobert Watson 273d4b5cae4SRobert Watson /* 274d4b5cae4SRobert Watson * Map contiguous values between 0 and nws_count into CPU IDs appropriate for 27553402767SRobert Watson * accessing workstreams. This allows constructions of the form 27653402767SRobert Watson * DPCPU_ID_GET(nws_array[arbitraryvalue % nws_count], nws). 277d4b5cae4SRobert Watson */ 278d4b5cae4SRobert Watson static u_int nws_array[MAXCPU]; 279d4b5cae4SRobert Watson 280d4b5cae4SRobert Watson /* 281d4b5cae4SRobert Watson * Number of registered workstreams. Will be at most the number of running 282d4b5cae4SRobert Watson * CPUs once fully started. 283d4b5cae4SRobert Watson */ 284d4b5cae4SRobert Watson static u_int nws_count; 285d4b5cae4SRobert Watson SYSCTL_INT(_net_isr, OID_AUTO, numthreads, CTLFLAG_RD, 286d4b5cae4SRobert Watson &nws_count, 0, "Number of extant netisr threads."); 287d4b5cae4SRobert Watson 288d4b5cae4SRobert Watson /* 289d4b5cae4SRobert Watson * Per-workstream flags. 290d4b5cae4SRobert Watson */ 291d4b5cae4SRobert Watson #define NWS_RUNNING 0x00000001 /* Currently running in a thread. */ 292d4b5cae4SRobert Watson #define NWS_DISPATCHING 0x00000002 /* Currently being direct-dispatched. */ 293d4b5cae4SRobert Watson #define NWS_SCHEDULED 0x00000004 /* Signal issued. */ 294d4b5cae4SRobert Watson 295d4b5cae4SRobert Watson /* 296d4b5cae4SRobert Watson * Synchronization for each workstream: a mutex protects all mutable fields 297d4b5cae4SRobert Watson * in each stream, including per-protocol state (mbuf queues). The SWI is 298d4b5cae4SRobert Watson * woken up if asynchronous dispatch is required. 299d4b5cae4SRobert Watson */ 300d4b5cae4SRobert Watson #define NWS_LOCK(s) mtx_lock(&(s)->nws_mtx) 301d4b5cae4SRobert Watson #define NWS_LOCK_ASSERT(s) mtx_assert(&(s)->nws_mtx, MA_OWNED) 302d4b5cae4SRobert Watson #define NWS_UNLOCK(s) mtx_unlock(&(s)->nws_mtx) 303d4b5cae4SRobert Watson #define NWS_SIGNAL(s) swi_sched((s)->nws_swi_cookie, 0) 304d4b5cae4SRobert Watson 305d4b5cae4SRobert Watson /* 306d4b5cae4SRobert Watson * Utility routines for protocols that implement their own mapping of flows 307d4b5cae4SRobert Watson * to CPUs. 308d4b5cae4SRobert Watson */ 309d4b5cae4SRobert Watson u_int 310d4b5cae4SRobert Watson netisr_get_cpucount(void) 311d4b5cae4SRobert Watson { 312d4b5cae4SRobert Watson 313d4b5cae4SRobert Watson return (nws_count); 3145fd04e38SRobert Watson } 315d4b5cae4SRobert Watson 316d4b5cae4SRobert Watson u_int 317d4b5cae4SRobert Watson netisr_get_cpuid(u_int cpunumber) 318d4b5cae4SRobert Watson { 319d4b5cae4SRobert Watson 320d4b5cae4SRobert Watson KASSERT(cpunumber < nws_count, ("%s: %u > %u", __func__, cpunumber, 321d4b5cae4SRobert Watson nws_count)); 322d4b5cae4SRobert Watson 323d4b5cae4SRobert Watson return (nws_array[cpunumber]); 3245fd04e38SRobert Watson } 3255fd04e38SRobert Watson 3265fd04e38SRobert Watson /* 3270a32e29fSRobert Watson * The default implementation of flow -> CPU ID mapping. 328d4b5cae4SRobert Watson * 329d4b5cae4SRobert Watson * Non-static so that protocols can use it to map their own work to specific 330d4b5cae4SRobert Watson * CPUs in a manner consistent to netisr for affinity purposes. 331d4b5cae4SRobert Watson */ 332d4b5cae4SRobert Watson u_int 333d4b5cae4SRobert Watson netisr_default_flow2cpu(u_int flowid) 334d4b5cae4SRobert Watson { 335d4b5cae4SRobert Watson 336d4b5cae4SRobert Watson return (nws_array[flowid % nws_count]); 337d4b5cae4SRobert Watson } 338d4b5cae4SRobert Watson 339d4b5cae4SRobert Watson /* 340d4b5cae4SRobert Watson * Register a new netisr handler, which requires initializing per-protocol 341d4b5cae4SRobert Watson * fields for each workstream. All netisr work is briefly suspended while 342d4b5cae4SRobert Watson * the protocol is installed. 3431cafed39SJonathan Lemon */ 3441cafed39SJonathan Lemon void 345d4b5cae4SRobert Watson netisr_register(const struct netisr_handler *nhp) 3461cafed39SJonathan Lemon { 347d4b5cae4SRobert Watson struct netisr_work *npwp; 348d4b5cae4SRobert Watson const char *name; 349d4b5cae4SRobert Watson u_int i, proto; 3501cafed39SJonathan Lemon 351d4b5cae4SRobert Watson proto = nhp->nh_proto; 352d4b5cae4SRobert Watson name = nhp->nh_name; 35359dd72d0SRobert Watson 3547902224cSSam Leffler /* 355d4b5cae4SRobert Watson * Test that the requested registration is valid. 3567902224cSSam Leffler */ 357d4b5cae4SRobert Watson KASSERT(nhp->nh_name != NULL, 358d4b5cae4SRobert Watson ("%s: nh_name NULL for %u", __func__, proto)); 359d4b5cae4SRobert Watson KASSERT(nhp->nh_handler != NULL, 360d4b5cae4SRobert Watson ("%s: nh_handler NULL for %s", __func__, name)); 361d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_SOURCE || 362d4b5cae4SRobert Watson nhp->nh_policy == NETISR_POLICY_FLOW || 363d4b5cae4SRobert Watson nhp->nh_policy == NETISR_POLICY_CPU, 364d4b5cae4SRobert Watson ("%s: unsupported nh_policy %u for %s", __func__, 365d4b5cae4SRobert Watson nhp->nh_policy, name)); 366d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_FLOW || 367d4b5cae4SRobert Watson nhp->nh_m2flow == NULL, 368d4b5cae4SRobert Watson ("%s: nh_policy != FLOW but m2flow defined for %s", __func__, 369d4b5cae4SRobert Watson name)); 370d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_CPU || nhp->nh_m2cpuid == NULL, 371d4b5cae4SRobert Watson ("%s: nh_policy != CPU but m2cpuid defined for %s", __func__, 372d4b5cae4SRobert Watson name)); 373d4b5cae4SRobert Watson KASSERT(nhp->nh_policy != NETISR_POLICY_CPU || nhp->nh_m2cpuid != NULL, 374d4b5cae4SRobert Watson ("%s: nh_policy == CPU but m2cpuid not defined for %s", __func__, 375d4b5cae4SRobert Watson name)); 376d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 377d4b5cae4SRobert Watson ("%s(%u, %s): protocol too big", __func__, proto, name)); 378d4b5cae4SRobert Watson 379d4b5cae4SRobert Watson /* 380d4b5cae4SRobert Watson * Test that no existing registration exists for this protocol. 381d4b5cae4SRobert Watson */ 382d4b5cae4SRobert Watson NETISR_WLOCK(); 383d4b5cae4SRobert Watson KASSERT(np[proto].np_name == NULL, 384d4b5cae4SRobert Watson ("%s(%u, %s): name present", __func__, proto, name)); 385d4b5cae4SRobert Watson KASSERT(np[proto].np_handler == NULL, 386d4b5cae4SRobert Watson ("%s(%u, %s): handler present", __func__, proto, name)); 387d4b5cae4SRobert Watson 388d4b5cae4SRobert Watson np[proto].np_name = name; 389d4b5cae4SRobert Watson np[proto].np_handler = nhp->nh_handler; 390d4b5cae4SRobert Watson np[proto].np_m2flow = nhp->nh_m2flow; 391d4b5cae4SRobert Watson np[proto].np_m2cpuid = nhp->nh_m2cpuid; 392ed655c8cSBjoern A. Zeeb np[proto].np_drainedcpu = nhp->nh_drainedcpu; 393d4b5cae4SRobert Watson if (nhp->nh_qlimit == 0) 394d4b5cae4SRobert Watson np[proto].np_qlimit = netisr_defaultqlimit; 395d4b5cae4SRobert Watson else if (nhp->nh_qlimit > netisr_maxqlimit) { 396d4b5cae4SRobert Watson printf("%s: %s requested queue limit %u capped to " 397d4b5cae4SRobert Watson "net.isr.maxqlimit %u\n", __func__, name, nhp->nh_qlimit, 398d4b5cae4SRobert Watson netisr_maxqlimit); 399d4b5cae4SRobert Watson np[proto].np_qlimit = netisr_maxqlimit; 400d4b5cae4SRobert Watson } else 401d4b5cae4SRobert Watson np[proto].np_qlimit = nhp->nh_qlimit; 402d4b5cae4SRobert Watson np[proto].np_policy = nhp->nh_policy; 4039e6e01ebSRobert Watson for (i = 0; i <= mp_maxid; i++) { 40453402767SRobert Watson if (CPU_ABSENT(i)) 40553402767SRobert Watson continue; 40653402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 407d4b5cae4SRobert Watson bzero(npwp, sizeof(*npwp)); 408d4b5cae4SRobert Watson npwp->nw_qlimit = np[proto].np_qlimit; 4091cafed39SJonathan Lemon } 410d4b5cae4SRobert Watson NETISR_WUNLOCK(); 4111cafed39SJonathan Lemon } 4121cafed39SJonathan Lemon 4131cafed39SJonathan Lemon /* 414d4b5cae4SRobert Watson * Clear drop counters across all workstreams for a protocol. 415d4b5cae4SRobert Watson */ 416d4b5cae4SRobert Watson void 417d4b5cae4SRobert Watson netisr_clearqdrops(const struct netisr_handler *nhp) 418d4b5cae4SRobert Watson { 419d4b5cae4SRobert Watson struct netisr_work *npwp; 420d4b5cae4SRobert Watson #ifdef INVARIANTS 421d4b5cae4SRobert Watson const char *name; 422d4b5cae4SRobert Watson #endif 423d4b5cae4SRobert Watson u_int i, proto; 424d4b5cae4SRobert Watson 425d4b5cae4SRobert Watson proto = nhp->nh_proto; 426d4b5cae4SRobert Watson #ifdef INVARIANTS 427d4b5cae4SRobert Watson name = nhp->nh_name; 428d4b5cae4SRobert Watson #endif 429d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 430d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 431d4b5cae4SRobert Watson 432d4b5cae4SRobert Watson NETISR_WLOCK(); 433d4b5cae4SRobert Watson KASSERT(np[proto].np_handler != NULL, 434d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 435d4b5cae4SRobert Watson name)); 436d4b5cae4SRobert Watson 4379e6e01ebSRobert Watson for (i = 0; i <= mp_maxid; i++) { 43853402767SRobert Watson if (CPU_ABSENT(i)) 43953402767SRobert Watson continue; 44053402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 441d4b5cae4SRobert Watson npwp->nw_qdrops = 0; 442d4b5cae4SRobert Watson } 443d4b5cae4SRobert Watson NETISR_WUNLOCK(); 444d4b5cae4SRobert Watson } 445d4b5cae4SRobert Watson 446d4b5cae4SRobert Watson /* 4470a32e29fSRobert Watson * Query current drop counters across all workstreams for a protocol. 448d4b5cae4SRobert Watson */ 449d4b5cae4SRobert Watson void 450d4b5cae4SRobert Watson netisr_getqdrops(const struct netisr_handler *nhp, u_int64_t *qdropp) 451d4b5cae4SRobert Watson { 452d4b5cae4SRobert Watson struct netisr_work *npwp; 453d4b5cae4SRobert Watson struct rm_priotracker tracker; 454d4b5cae4SRobert Watson #ifdef INVARIANTS 455d4b5cae4SRobert Watson const char *name; 456d4b5cae4SRobert Watson #endif 457d4b5cae4SRobert Watson u_int i, proto; 458d4b5cae4SRobert Watson 459d4b5cae4SRobert Watson *qdropp = 0; 460d4b5cae4SRobert Watson proto = nhp->nh_proto; 461d4b5cae4SRobert Watson #ifdef INVARIANTS 462d4b5cae4SRobert Watson name = nhp->nh_name; 463d4b5cae4SRobert Watson #endif 464d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 465d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 466d4b5cae4SRobert Watson 467d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 468d4b5cae4SRobert Watson KASSERT(np[proto].np_handler != NULL, 469d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 470d4b5cae4SRobert Watson name)); 471d4b5cae4SRobert Watson 4729e6e01ebSRobert Watson for (i = 0; i <= mp_maxid; i++) { 47353402767SRobert Watson if (CPU_ABSENT(i)) 47453402767SRobert Watson continue; 47553402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 476d4b5cae4SRobert Watson *qdropp += npwp->nw_qdrops; 477d4b5cae4SRobert Watson } 478d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 479d4b5cae4SRobert Watson } 480d4b5cae4SRobert Watson 481d4b5cae4SRobert Watson /* 4820a32e29fSRobert Watson * Query current per-workstream queue limit for a protocol. 483d4b5cae4SRobert Watson */ 484d4b5cae4SRobert Watson void 485d4b5cae4SRobert Watson netisr_getqlimit(const struct netisr_handler *nhp, u_int *qlimitp) 486d4b5cae4SRobert Watson { 487d4b5cae4SRobert Watson struct rm_priotracker tracker; 488d4b5cae4SRobert Watson #ifdef INVARIANTS 489d4b5cae4SRobert Watson const char *name; 490d4b5cae4SRobert Watson #endif 491d4b5cae4SRobert Watson u_int proto; 492d4b5cae4SRobert Watson 493d4b5cae4SRobert Watson proto = nhp->nh_proto; 494d4b5cae4SRobert Watson #ifdef INVARIANTS 495d4b5cae4SRobert Watson name = nhp->nh_name; 496d4b5cae4SRobert Watson #endif 497d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 498d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 499d4b5cae4SRobert Watson 500d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 501d4b5cae4SRobert Watson KASSERT(np[proto].np_handler != NULL, 502d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 503d4b5cae4SRobert Watson name)); 504d4b5cae4SRobert Watson *qlimitp = np[proto].np_qlimit; 505d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 506d4b5cae4SRobert Watson } 507d4b5cae4SRobert Watson 508d4b5cae4SRobert Watson /* 509d4b5cae4SRobert Watson * Update the queue limit across per-workstream queues for a protocol. We 510d4b5cae4SRobert Watson * simply change the limits, and don't drain overflowed packets as they will 511d4b5cae4SRobert Watson * (hopefully) take care of themselves shortly. 5121cafed39SJonathan Lemon */ 5131cafed39SJonathan Lemon int 514d4b5cae4SRobert Watson netisr_setqlimit(const struct netisr_handler *nhp, u_int qlimit) 5151cafed39SJonathan Lemon { 516d4b5cae4SRobert Watson struct netisr_work *npwp; 517d4b5cae4SRobert Watson #ifdef INVARIANTS 518d4b5cae4SRobert Watson const char *name; 519d4b5cae4SRobert Watson #endif 520d4b5cae4SRobert Watson u_int i, proto; 5211cafed39SJonathan Lemon 522d4b5cae4SRobert Watson if (qlimit > netisr_maxqlimit) 523d4b5cae4SRobert Watson return (EINVAL); 524d4b5cae4SRobert Watson 525d4b5cae4SRobert Watson proto = nhp->nh_proto; 526d4b5cae4SRobert Watson #ifdef INVARIANTS 527d4b5cae4SRobert Watson name = nhp->nh_name; 528d4b5cae4SRobert Watson #endif 529d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 530d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 531d4b5cae4SRobert Watson 532d4b5cae4SRobert Watson NETISR_WLOCK(); 533d4b5cae4SRobert Watson KASSERT(np[proto].np_handler != NULL, 534d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 535d4b5cae4SRobert Watson name)); 536d4b5cae4SRobert Watson 537d4b5cae4SRobert Watson np[proto].np_qlimit = qlimit; 5389e6e01ebSRobert Watson for (i = 0; i <= mp_maxid; i++) { 53953402767SRobert Watson if (CPU_ABSENT(i)) 54053402767SRobert Watson continue; 54153402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 542d4b5cae4SRobert Watson npwp->nw_qlimit = qlimit; 543fb68148fSJonathan Lemon } 544d4b5cae4SRobert Watson NETISR_WUNLOCK(); 5453161f583SAndre Oppermann return (0); 546e3b6e33cSJake Burkholder } 547e3b6e33cSJake Burkholder 548d4b5cae4SRobert Watson /* 549d4b5cae4SRobert Watson * Drain all packets currently held in a particular protocol work queue. 550d4b5cae4SRobert Watson */ 551e3b6e33cSJake Burkholder static void 552d4b5cae4SRobert Watson netisr_drain_proto(struct netisr_work *npwp) 553e3b6e33cSJake Burkholder { 554d4b5cae4SRobert Watson struct mbuf *m; 555d4b5cae4SRobert Watson 556d4b5cae4SRobert Watson /* 557d4b5cae4SRobert Watson * We would assert the lock on the workstream but it's not passed in. 558d4b5cae4SRobert Watson */ 559d4b5cae4SRobert Watson while ((m = npwp->nw_head) != NULL) { 560d4b5cae4SRobert Watson npwp->nw_head = m->m_nextpkt; 561d4b5cae4SRobert Watson m->m_nextpkt = NULL; 562d4b5cae4SRobert Watson if (npwp->nw_head == NULL) 563d4b5cae4SRobert Watson npwp->nw_tail = NULL; 564d4b5cae4SRobert Watson npwp->nw_len--; 565d4b5cae4SRobert Watson m_freem(m); 566d4b5cae4SRobert Watson } 567d4b5cae4SRobert Watson KASSERT(npwp->nw_tail == NULL, ("%s: tail", __func__)); 568d4b5cae4SRobert Watson KASSERT(npwp->nw_len == 0, ("%s: len", __func__)); 569d4b5cae4SRobert Watson } 570d4b5cae4SRobert Watson 571d4b5cae4SRobert Watson /* 572d4b5cae4SRobert Watson * Remove the registration of a network protocol, which requires clearing 573d4b5cae4SRobert Watson * per-protocol fields across all workstreams, including freeing all mbufs in 574d4b5cae4SRobert Watson * the queues at time of unregister. All work in netisr is briefly suspended 575d4b5cae4SRobert Watson * while this takes place. 576d4b5cae4SRobert Watson */ 577d4b5cae4SRobert Watson void 578d4b5cae4SRobert Watson netisr_unregister(const struct netisr_handler *nhp) 579d4b5cae4SRobert Watson { 580d4b5cae4SRobert Watson struct netisr_work *npwp; 581d4b5cae4SRobert Watson #ifdef INVARIANTS 582d4b5cae4SRobert Watson const char *name; 583d4b5cae4SRobert Watson #endif 584d4b5cae4SRobert Watson u_int i, proto; 585d4b5cae4SRobert Watson 586d4b5cae4SRobert Watson proto = nhp->nh_proto; 587d4b5cae4SRobert Watson #ifdef INVARIANTS 588d4b5cae4SRobert Watson name = nhp->nh_name; 589d4b5cae4SRobert Watson #endif 590d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 591d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 592d4b5cae4SRobert Watson 593d4b5cae4SRobert Watson NETISR_WLOCK(); 594d4b5cae4SRobert Watson KASSERT(np[proto].np_handler != NULL, 595d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 596d4b5cae4SRobert Watson name)); 597d4b5cae4SRobert Watson 598d4b5cae4SRobert Watson np[proto].np_name = NULL; 599d4b5cae4SRobert Watson np[proto].np_handler = NULL; 600d4b5cae4SRobert Watson np[proto].np_m2flow = NULL; 601d4b5cae4SRobert Watson np[proto].np_m2cpuid = NULL; 602d4b5cae4SRobert Watson np[proto].np_qlimit = 0; 603d4b5cae4SRobert Watson np[proto].np_policy = 0; 6049e6e01ebSRobert Watson for (i = 0; i <= mp_maxid; i++) { 60553402767SRobert Watson if (CPU_ABSENT(i)) 60653402767SRobert Watson continue; 60753402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 608d4b5cae4SRobert Watson netisr_drain_proto(npwp); 609d4b5cae4SRobert Watson bzero(npwp, sizeof(*npwp)); 610d4b5cae4SRobert Watson } 611d4b5cae4SRobert Watson NETISR_WUNLOCK(); 612d4b5cae4SRobert Watson } 613d4b5cae4SRobert Watson 614d4b5cae4SRobert Watson /* 615d4b5cae4SRobert Watson * Look up the workstream given a packet and source identifier. Do this by 616d4b5cae4SRobert Watson * checking the protocol's policy, and optionally call out to the protocol 617d4b5cae4SRobert Watson * for assistance if required. 618d4b5cae4SRobert Watson */ 619d4b5cae4SRobert Watson static struct mbuf * 620d4b5cae4SRobert Watson netisr_select_cpuid(struct netisr_proto *npp, uintptr_t source, 621d4b5cae4SRobert Watson struct mbuf *m, u_int *cpuidp) 622d4b5cae4SRobert Watson { 623d4b5cae4SRobert Watson struct ifnet *ifp; 624d4b5cae4SRobert Watson 625d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 626d4b5cae4SRobert Watson 627d4b5cae4SRobert Watson /* 628d4b5cae4SRobert Watson * In the event we have only one worker, shortcut and deliver to it 629d4b5cae4SRobert Watson * without further ado. 630d4b5cae4SRobert Watson */ 631d4b5cae4SRobert Watson if (nws_count == 1) { 632d4b5cae4SRobert Watson *cpuidp = nws_array[0]; 633d4b5cae4SRobert Watson return (m); 634d4b5cae4SRobert Watson } 635d4b5cae4SRobert Watson 636d4b5cae4SRobert Watson /* 637d4b5cae4SRobert Watson * What happens next depends on the policy selected by the protocol. 638d4b5cae4SRobert Watson * If we want to support per-interface policies, we should do that 639d4b5cae4SRobert Watson * here first. 640d4b5cae4SRobert Watson */ 641d4b5cae4SRobert Watson switch (npp->np_policy) { 642d4b5cae4SRobert Watson case NETISR_POLICY_CPU: 643d4b5cae4SRobert Watson return (npp->np_m2cpuid(m, source, cpuidp)); 644d4b5cae4SRobert Watson 645d4b5cae4SRobert Watson case NETISR_POLICY_FLOW: 646d4b5cae4SRobert Watson if (!(m->m_flags & M_FLOWID) && npp->np_m2flow != NULL) { 647d4b5cae4SRobert Watson m = npp->np_m2flow(m, source); 648d4b5cae4SRobert Watson if (m == NULL) 649d4b5cae4SRobert Watson return (NULL); 650d4b5cae4SRobert Watson } 651d4b5cae4SRobert Watson if (m->m_flags & M_FLOWID) { 652d4b5cae4SRobert Watson *cpuidp = 653d4b5cae4SRobert Watson netisr_default_flow2cpu(m->m_pkthdr.flowid); 654d4b5cae4SRobert Watson return (m); 655d4b5cae4SRobert Watson } 656d4b5cae4SRobert Watson /* FALLTHROUGH */ 657d4b5cae4SRobert Watson 658d4b5cae4SRobert Watson case NETISR_POLICY_SOURCE: 659d4b5cae4SRobert Watson ifp = m->m_pkthdr.rcvif; 660d4b5cae4SRobert Watson if (ifp != NULL) 661d4b5cae4SRobert Watson *cpuidp = nws_array[(ifp->if_index + source) % 662d4b5cae4SRobert Watson nws_count]; 663d4b5cae4SRobert Watson else 664d4b5cae4SRobert Watson *cpuidp = nws_array[source % nws_count]; 665d4b5cae4SRobert Watson return (m); 666d4b5cae4SRobert Watson 667d4b5cae4SRobert Watson default: 668d4b5cae4SRobert Watson panic("%s: invalid policy %u for %s", __func__, 669d4b5cae4SRobert Watson npp->np_policy, npp->np_name); 670d4b5cae4SRobert Watson } 671d4b5cae4SRobert Watson } 672d4b5cae4SRobert Watson 673d4b5cae4SRobert Watson /* 674d4b5cae4SRobert Watson * Process packets associated with a workstream and protocol. For reasons of 675d4b5cae4SRobert Watson * fairness, we process up to one complete netisr queue at a time, moving the 676d4b5cae4SRobert Watson * queue to a stack-local queue for processing, but do not loop refreshing 677d4b5cae4SRobert Watson * from the global queue. The caller is responsible for deciding whether to 678d4b5cae4SRobert Watson * loop, and for setting the NWS_RUNNING flag. The passed workstream will be 679d4b5cae4SRobert Watson * locked on entry and relocked before return, but will be released while 680d4b5cae4SRobert Watson * processing. The number of packets processed is returned. 681d4b5cae4SRobert Watson */ 682d4b5cae4SRobert Watson static u_int 683d4b5cae4SRobert Watson netisr_process_workstream_proto(struct netisr_workstream *nwsp, u_int proto) 684d4b5cae4SRobert Watson { 685d4b5cae4SRobert Watson struct netisr_work local_npw, *npwp; 686d4b5cae4SRobert Watson u_int handled; 687d4b5cae4SRobert Watson struct mbuf *m; 688d4b5cae4SRobert Watson 689d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 690d4b5cae4SRobert Watson NWS_LOCK_ASSERT(nwsp); 691d4b5cae4SRobert Watson 692d4b5cae4SRobert Watson KASSERT(nwsp->nws_flags & NWS_RUNNING, 693d4b5cae4SRobert Watson ("%s(%u): not running", __func__, proto)); 694d4b5cae4SRobert Watson KASSERT(proto >= 0 && proto < NETISR_MAXPROT, 695d4b5cae4SRobert Watson ("%s(%u): invalid proto\n", __func__, proto)); 696d4b5cae4SRobert Watson 697d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 698d4b5cae4SRobert Watson if (npwp->nw_len == 0) 699d4b5cae4SRobert Watson return (0); 700d4b5cae4SRobert Watson 701d4b5cae4SRobert Watson /* 702d4b5cae4SRobert Watson * Move the global work queue to a thread-local work queue. 703d4b5cae4SRobert Watson * 704d4b5cae4SRobert Watson * Notice that this means the effective maximum length of the queue 705d4b5cae4SRobert Watson * is actually twice that of the maximum queue length specified in 706d4b5cae4SRobert Watson * the protocol registration call. 707d4b5cae4SRobert Watson */ 708d4b5cae4SRobert Watson handled = npwp->nw_len; 709d4b5cae4SRobert Watson local_npw = *npwp; 710d4b5cae4SRobert Watson npwp->nw_head = NULL; 711d4b5cae4SRobert Watson npwp->nw_tail = NULL; 712d4b5cae4SRobert Watson npwp->nw_len = 0; 713d4b5cae4SRobert Watson nwsp->nws_pendingbits &= ~(1 << proto); 714d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 715d4b5cae4SRobert Watson while ((m = local_npw.nw_head) != NULL) { 716d4b5cae4SRobert Watson local_npw.nw_head = m->m_nextpkt; 717d4b5cae4SRobert Watson m->m_nextpkt = NULL; 718d4b5cae4SRobert Watson if (local_npw.nw_head == NULL) 719d4b5cae4SRobert Watson local_npw.nw_tail = NULL; 720d4b5cae4SRobert Watson local_npw.nw_len--; 721d4b5cae4SRobert Watson VNET_ASSERT(m->m_pkthdr.rcvif != NULL); 722d4b5cae4SRobert Watson CURVNET_SET(m->m_pkthdr.rcvif->if_vnet); 723d4b5cae4SRobert Watson np[proto].np_handler(m); 724d4b5cae4SRobert Watson CURVNET_RESTORE(); 725d4b5cae4SRobert Watson } 726d4b5cae4SRobert Watson KASSERT(local_npw.nw_len == 0, 727d4b5cae4SRobert Watson ("%s(%u): len %u", __func__, proto, local_npw.nw_len)); 728ed655c8cSBjoern A. Zeeb if (np[proto].np_drainedcpu) 729ed655c8cSBjoern A. Zeeb np[proto].np_drainedcpu(nwsp->nws_cpu); 730d4b5cae4SRobert Watson NWS_LOCK(nwsp); 731d4b5cae4SRobert Watson npwp->nw_handled += handled; 732d4b5cae4SRobert Watson return (handled); 733d4b5cae4SRobert Watson } 734d4b5cae4SRobert Watson 735d4b5cae4SRobert Watson /* 7360a32e29fSRobert Watson * SWI handler for netisr -- processes packets in a set of workstreams that 737d4b5cae4SRobert Watson * it owns, woken up by calls to NWS_SIGNAL(). If this workstream is already 738d4b5cae4SRobert Watson * being direct dispatched, go back to sleep and wait for the dispatching 739d4b5cae4SRobert Watson * thread to wake us up again. 740d4b5cae4SRobert Watson */ 741d4b5cae4SRobert Watson static void 742d4b5cae4SRobert Watson swi_net(void *arg) 743d4b5cae4SRobert Watson { 744d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 745d4b5cae4SRobert Watson struct rm_priotracker tracker; 746d4b5cae4SRobert Watson #endif 747d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 748d4b5cae4SRobert Watson u_int bits, prot; 749d4b5cae4SRobert Watson 750d4b5cae4SRobert Watson nwsp = arg; 751d4b5cae4SRobert Watson 7521cafed39SJonathan Lemon #ifdef DEVICE_POLLING 753d4b5cae4SRobert Watson KASSERT(nws_count == 1, 754d4b5cae4SRobert Watson ("%s: device_polling but nws_count != 1", __func__)); 755d4b5cae4SRobert Watson netisr_poll(); 756d4b5cae4SRobert Watson #endif 757d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 758d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 759d4b5cae4SRobert Watson #endif 760d4b5cae4SRobert Watson NWS_LOCK(nwsp); 761d4b5cae4SRobert Watson KASSERT(!(nwsp->nws_flags & NWS_RUNNING), ("swi_net: running")); 762d4b5cae4SRobert Watson if (nwsp->nws_flags & NWS_DISPATCHING) 763d4b5cae4SRobert Watson goto out; 764d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_RUNNING; 765d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_SCHEDULED; 766d4b5cae4SRobert Watson while ((bits = nwsp->nws_pendingbits) != 0) { 767d4b5cae4SRobert Watson while ((prot = ffs(bits)) != 0) { 768d4b5cae4SRobert Watson prot--; 769d4b5cae4SRobert Watson bits &= ~(1 << prot); 770d4b5cae4SRobert Watson (void)netisr_process_workstream_proto(nwsp, prot); 771d4b5cae4SRobert Watson } 772d4b5cae4SRobert Watson } 773d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_RUNNING; 774d4b5cae4SRobert Watson out: 775d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 776d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 777d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 778d4b5cae4SRobert Watson #endif 779d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 780d4b5cae4SRobert Watson netisr_pollmore(); 781d4b5cae4SRobert Watson #endif 782d4b5cae4SRobert Watson } 783d4b5cae4SRobert Watson 784d4b5cae4SRobert Watson static int 785d4b5cae4SRobert Watson netisr_queue_workstream(struct netisr_workstream *nwsp, u_int proto, 786d4b5cae4SRobert Watson struct netisr_work *npwp, struct mbuf *m, int *dosignalp) 787d4b5cae4SRobert Watson { 788d4b5cae4SRobert Watson 789d4b5cae4SRobert Watson NWS_LOCK_ASSERT(nwsp); 790d4b5cae4SRobert Watson 791d4b5cae4SRobert Watson *dosignalp = 0; 792d4b5cae4SRobert Watson if (npwp->nw_len < npwp->nw_qlimit) { 793d4b5cae4SRobert Watson m->m_nextpkt = NULL; 794d4b5cae4SRobert Watson if (npwp->nw_head == NULL) { 795d4b5cae4SRobert Watson npwp->nw_head = m; 796d4b5cae4SRobert Watson npwp->nw_tail = m; 797d4b5cae4SRobert Watson } else { 798d4b5cae4SRobert Watson npwp->nw_tail->m_nextpkt = m; 799d4b5cae4SRobert Watson npwp->nw_tail = m; 800d4b5cae4SRobert Watson } 801d4b5cae4SRobert Watson npwp->nw_len++; 802d4b5cae4SRobert Watson if (npwp->nw_len > npwp->nw_watermark) 803d4b5cae4SRobert Watson npwp->nw_watermark = npwp->nw_len; 8040a32e29fSRobert Watson 8050a32e29fSRobert Watson /* 8060a32e29fSRobert Watson * We must set the bit regardless of NWS_RUNNING, so that 8070a32e29fSRobert Watson * swi_net() keeps calling netisr_process_workstream_proto(). 8080a32e29fSRobert Watson */ 809d4b5cae4SRobert Watson nwsp->nws_pendingbits |= (1 << proto); 810d4b5cae4SRobert Watson if (!(nwsp->nws_flags & 811d4b5cae4SRobert Watson (NWS_RUNNING | NWS_DISPATCHING | NWS_SCHEDULED))) { 812d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_SCHEDULED; 813d4b5cae4SRobert Watson *dosignalp = 1; /* Defer until unlocked. */ 814d4b5cae4SRobert Watson } 815d4b5cae4SRobert Watson npwp->nw_queued++; 816d4b5cae4SRobert Watson return (0); 817d4b5cae4SRobert Watson } else { 818ba3b25b3SBjoern A. Zeeb m_freem(m); 819d4b5cae4SRobert Watson npwp->nw_qdrops++; 820d4b5cae4SRobert Watson return (ENOBUFS); 821d4b5cae4SRobert Watson } 822d4b5cae4SRobert Watson } 823d4b5cae4SRobert Watson 824d4b5cae4SRobert Watson static int 825d4b5cae4SRobert Watson netisr_queue_internal(u_int proto, struct mbuf *m, u_int cpuid) 826d4b5cae4SRobert Watson { 827d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 828d4b5cae4SRobert Watson struct netisr_work *npwp; 829d4b5cae4SRobert Watson int dosignal, error; 830d4b5cae4SRobert Watson 831d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 832d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 833d4b5cae4SRobert Watson #endif 8349e6e01ebSRobert Watson KASSERT(cpuid <= mp_maxid, ("%s: cpuid too big (%u, %u)", __func__, 8359e6e01ebSRobert Watson cpuid, mp_maxid)); 83653402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 837d4b5cae4SRobert Watson 838d4b5cae4SRobert Watson dosignal = 0; 839d4b5cae4SRobert Watson error = 0; 84053402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 841d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 842d4b5cae4SRobert Watson NWS_LOCK(nwsp); 843d4b5cae4SRobert Watson error = netisr_queue_workstream(nwsp, proto, npwp, m, &dosignal); 844d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 845d4b5cae4SRobert Watson if (dosignal) 846d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 847d4b5cae4SRobert Watson return (error); 848d4b5cae4SRobert Watson } 849d4b5cae4SRobert Watson 850d4b5cae4SRobert Watson int 851d4b5cae4SRobert Watson netisr_queue_src(u_int proto, uintptr_t source, struct mbuf *m) 852d4b5cae4SRobert Watson { 853d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 854d4b5cae4SRobert Watson struct rm_priotracker tracker; 855d4b5cae4SRobert Watson #endif 856d4b5cae4SRobert Watson u_int cpuid; 857d4b5cae4SRobert Watson int error; 858d4b5cae4SRobert Watson 859d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 860d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 861d4b5cae4SRobert Watson 862d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 863d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 864d4b5cae4SRobert Watson #endif 865d4b5cae4SRobert Watson KASSERT(np[proto].np_handler != NULL, 866d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 867d4b5cae4SRobert Watson 868d4b5cae4SRobert Watson m = netisr_select_cpuid(&np[proto], source, m, &cpuid); 86953402767SRobert Watson if (m != NULL) { 87053402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, 87153402767SRobert Watson cpuid)); 872d4b5cae4SRobert Watson error = netisr_queue_internal(proto, m, cpuid); 87353402767SRobert Watson } else 874d4b5cae4SRobert Watson error = ENOBUFS; 875d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 876d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 877d4b5cae4SRobert Watson #endif 878d4b5cae4SRobert Watson return (error); 879d4b5cae4SRobert Watson } 880d4b5cae4SRobert Watson 881d4b5cae4SRobert Watson int 882d4b5cae4SRobert Watson netisr_queue(u_int proto, struct mbuf *m) 883d4b5cae4SRobert Watson { 884d4b5cae4SRobert Watson 885d4b5cae4SRobert Watson return (netisr_queue_src(proto, 0, m)); 886d4b5cae4SRobert Watson } 887d4b5cae4SRobert Watson 888d4b5cae4SRobert Watson /* 8890a32e29fSRobert Watson * Dispatch a packet for netisr processing; direct dispatch is permitted by 890d4b5cae4SRobert Watson * calling context. 891d4b5cae4SRobert Watson */ 892d4b5cae4SRobert Watson int 893d4b5cae4SRobert Watson netisr_dispatch_src(u_int proto, uintptr_t source, struct mbuf *m) 894d4b5cae4SRobert Watson { 895d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 896d4b5cae4SRobert Watson struct rm_priotracker tracker; 897d4b5cae4SRobert Watson #endif 898d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 899d4b5cae4SRobert Watson struct netisr_work *npwp; 900d4b5cae4SRobert Watson int dosignal, error; 901d4b5cae4SRobert Watson u_int cpuid; 902d4b5cae4SRobert Watson 903d4b5cae4SRobert Watson /* 904d4b5cae4SRobert Watson * If direct dispatch is entirely disabled, fall back on queueing. 905d4b5cae4SRobert Watson */ 906d4b5cae4SRobert Watson if (!netisr_direct) 907d4b5cae4SRobert Watson return (netisr_queue_src(proto, source, m)); 908d4b5cae4SRobert Watson 909d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 910d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 911d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 912d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 913d4b5cae4SRobert Watson #endif 914d4b5cae4SRobert Watson KASSERT(np[proto].np_handler != NULL, 915d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 916d4b5cae4SRobert Watson 917d4b5cae4SRobert Watson /* 918d4b5cae4SRobert Watson * If direct dispatch is forced, then unconditionally dispatch 919d4b5cae4SRobert Watson * without a formal CPU selection. Borrow the current CPU's stats, 920d4b5cae4SRobert Watson * even if there's no worker on it. In this case we don't update 921d4b5cae4SRobert Watson * nws_flags because all netisr processing will be source ordered due 922d4b5cae4SRobert Watson * to always being forced to directly dispatch. 923d4b5cae4SRobert Watson */ 924d4b5cae4SRobert Watson if (netisr_direct_force) { 92553402767SRobert Watson nwsp = DPCPU_PTR(nws); 926d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 927d4b5cae4SRobert Watson npwp->nw_dispatched++; 928d4b5cae4SRobert Watson npwp->nw_handled++; 929d4b5cae4SRobert Watson np[proto].np_handler(m); 930d4b5cae4SRobert Watson error = 0; 931d4b5cae4SRobert Watson goto out_unlock; 932d4b5cae4SRobert Watson } 933d4b5cae4SRobert Watson 934d4b5cae4SRobert Watson /* 935d4b5cae4SRobert Watson * Otherwise, we execute in a hybrid mode where we will try to direct 936d4b5cae4SRobert Watson * dispatch if we're on the right CPU and the netisr worker isn't 937d4b5cae4SRobert Watson * already running. 938d4b5cae4SRobert Watson */ 939d4b5cae4SRobert Watson m = netisr_select_cpuid(&np[proto], source, m, &cpuid); 940d4b5cae4SRobert Watson if (m == NULL) { 941d4b5cae4SRobert Watson error = ENOBUFS; 942d4b5cae4SRobert Watson goto out_unlock; 943d4b5cae4SRobert Watson } 94453402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 945d4b5cae4SRobert Watson sched_pin(); 946d4b5cae4SRobert Watson if (cpuid != curcpu) 947d4b5cae4SRobert Watson goto queue_fallback; 94853402767SRobert Watson nwsp = DPCPU_PTR(nws); 949d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 950d4b5cae4SRobert Watson 951d4b5cae4SRobert Watson /*- 952d4b5cae4SRobert Watson * We are willing to direct dispatch only if three conditions hold: 953d4b5cae4SRobert Watson * 954d4b5cae4SRobert Watson * (1) The netisr worker isn't already running, 955d4b5cae4SRobert Watson * (2) Another thread isn't already directly dispatching, and 956d4b5cae4SRobert Watson * (3) The netisr hasn't already been woken up. 957d4b5cae4SRobert Watson */ 958d4b5cae4SRobert Watson NWS_LOCK(nwsp); 959d4b5cae4SRobert Watson if (nwsp->nws_flags & (NWS_RUNNING | NWS_DISPATCHING | NWS_SCHEDULED)) { 960d4b5cae4SRobert Watson error = netisr_queue_workstream(nwsp, proto, npwp, m, 961d4b5cae4SRobert Watson &dosignal); 96253402767SRobert Watson NWS_UNLOCK(nwsp); 963d4b5cae4SRobert Watson if (dosignal) 964d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 965d4b5cae4SRobert Watson goto out_unpin; 966d4b5cae4SRobert Watson } 967d4b5cae4SRobert Watson 968d4b5cae4SRobert Watson /* 969d4b5cae4SRobert Watson * The current thread is now effectively the netisr worker, so set 970d4b5cae4SRobert Watson * the dispatching flag to prevent concurrent processing of the 971d4b5cae4SRobert Watson * stream from another thread (even the netisr worker), which could 972d4b5cae4SRobert Watson * otherwise lead to effective misordering of the stream. 973d4b5cae4SRobert Watson */ 974d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_DISPATCHING; 975d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 976d4b5cae4SRobert Watson np[proto].np_handler(m); 977d4b5cae4SRobert Watson NWS_LOCK(nwsp); 978d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_DISPATCHING; 979d4b5cae4SRobert Watson npwp->nw_handled++; 980d4b5cae4SRobert Watson npwp->nw_hybrid_dispatched++; 981d4b5cae4SRobert Watson 982d4b5cae4SRobert Watson /* 983d4b5cae4SRobert Watson * If other work was enqueued by another thread while we were direct 984d4b5cae4SRobert Watson * dispatching, we need to signal the netisr worker to do that work. 985d4b5cae4SRobert Watson * In the future, we might want to do some of that work in the 986d4b5cae4SRobert Watson * current thread, rather than trigger further context switches. If 987d4b5cae4SRobert Watson * so, we'll want to establish a reasonable bound on the work done in 988d4b5cae4SRobert Watson * the "borrowed" context. 989d4b5cae4SRobert Watson */ 990d4b5cae4SRobert Watson if (nwsp->nws_pendingbits != 0) { 991d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_SCHEDULED; 992d4b5cae4SRobert Watson dosignal = 1; 993d4b5cae4SRobert Watson } else 994d4b5cae4SRobert Watson dosignal = 0; 995d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 996d4b5cae4SRobert Watson if (dosignal) 997d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 998d4b5cae4SRobert Watson error = 0; 999d4b5cae4SRobert Watson goto out_unpin; 1000d4b5cae4SRobert Watson 1001d4b5cae4SRobert Watson queue_fallback: 1002d4b5cae4SRobert Watson error = netisr_queue_internal(proto, m, cpuid); 1003d4b5cae4SRobert Watson out_unpin: 1004d4b5cae4SRobert Watson sched_unpin(); 1005d4b5cae4SRobert Watson out_unlock: 1006d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 1007d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 1008d4b5cae4SRobert Watson #endif 1009d4b5cae4SRobert Watson return (error); 1010d4b5cae4SRobert Watson } 1011d4b5cae4SRobert Watson 1012d4b5cae4SRobert Watson int 1013d4b5cae4SRobert Watson netisr_dispatch(u_int proto, struct mbuf *m) 1014d4b5cae4SRobert Watson { 1015d4b5cae4SRobert Watson 1016d4b5cae4SRobert Watson return (netisr_dispatch_src(proto, 0, m)); 1017d4b5cae4SRobert Watson } 1018d4b5cae4SRobert Watson 1019d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 1020d4b5cae4SRobert Watson /* 1021d4b5cae4SRobert Watson * Kernel polling borrows a netisr thread to run interface polling in; this 1022d4b5cae4SRobert Watson * function allows kernel polling to request that the netisr thread be 1023d4b5cae4SRobert Watson * scheduled even if no packets are pending for protocols. 1024d4b5cae4SRobert Watson */ 1025d4b5cae4SRobert Watson void 1026d4b5cae4SRobert Watson netisr_sched_poll(void) 1027d4b5cae4SRobert Watson { 1028d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1029d4b5cae4SRobert Watson 103053402767SRobert Watson nwsp = DPCPU_ID_PTR(nws_array[0], nws); 1031d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 1032d4b5cae4SRobert Watson } 10331cafed39SJonathan Lemon #endif 1034e3b6e33cSJake Burkholder 1035d4b5cae4SRobert Watson static void 1036d4b5cae4SRobert Watson netisr_start_swi(u_int cpuid, struct pcpu *pc) 1037d4b5cae4SRobert Watson { 1038d4b5cae4SRobert Watson char swiname[12]; 1039d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1040d4b5cae4SRobert Watson int error; 1041d4b5cae4SRobert Watson 104253402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 104353402767SRobert Watson 104453402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 1045d4b5cae4SRobert Watson mtx_init(&nwsp->nws_mtx, "netisr_mtx", NULL, MTX_DEF); 1046d4b5cae4SRobert Watson nwsp->nws_cpu = cpuid; 1047d4b5cae4SRobert Watson snprintf(swiname, sizeof(swiname), "netisr %u", cpuid); 1048d4b5cae4SRobert Watson error = swi_add(&nwsp->nws_intr_event, swiname, swi_net, nwsp, 1049d4b5cae4SRobert Watson SWI_NET, INTR_MPSAFE, &nwsp->nws_swi_cookie); 1050d4b5cae4SRobert Watson if (error) 1051d4b5cae4SRobert Watson panic("%s: swi_add %d", __func__, error); 1052d4b5cae4SRobert Watson pc->pc_netisr = nwsp->nws_intr_event; 1053d4b5cae4SRobert Watson if (netisr_bindthreads) { 1054d4b5cae4SRobert Watson error = intr_event_bind(nwsp->nws_intr_event, cpuid); 1055d4b5cae4SRobert Watson if (error != 0) 1056d4b5cae4SRobert Watson printf("%s: cpu %u: intr_event_bind: %d", __func__, 1057d4b5cae4SRobert Watson cpuid, error); 1058e3b6e33cSJake Burkholder } 1059d4b5cae4SRobert Watson NETISR_WLOCK(); 1060d4b5cae4SRobert Watson nws_array[nws_count] = nwsp->nws_cpu; 1061d4b5cae4SRobert Watson nws_count++; 1062d4b5cae4SRobert Watson NETISR_WUNLOCK(); 1063e3b6e33cSJake Burkholder } 1064e3b6e33cSJake Burkholder 1065d4b5cae4SRobert Watson /* 1066d4b5cae4SRobert Watson * Initialize the netisr subsystem. We rely on BSS and static initialization 1067d4b5cae4SRobert Watson * of most fields in global data structures. 1068d4b5cae4SRobert Watson * 1069d4b5cae4SRobert Watson * Start a worker thread for the boot CPU so that we can support network 1070d4b5cae4SRobert Watson * traffic immediately in case the network stack is used before additional 1071d4b5cae4SRobert Watson * CPUs are started (for example, diskless boot). 1072d4b5cae4SRobert Watson */ 1073e3b6e33cSJake Burkholder static void 1074d4b5cae4SRobert Watson netisr_init(void *arg) 1075e3b6e33cSJake Burkholder { 1076e3b6e33cSJake Burkholder 1077d4b5cae4SRobert Watson KASSERT(curcpu == 0, ("%s: not on CPU 0", __func__)); 1078d4b5cae4SRobert Watson 1079d4b5cae4SRobert Watson NETISR_LOCK_INIT(); 10809e6e01ebSRobert Watson if (netisr_maxthreads < 1) 1081d4b5cae4SRobert Watson netisr_maxthreads = 1; 10829e6e01ebSRobert Watson if (netisr_maxthreads > mp_ncpus) { 1083912f6323SRobert Watson printf("netisr_init: forcing maxthreads from %d to %d\n", 10849e6e01ebSRobert Watson netisr_maxthreads, mp_ncpus); 10859e6e01ebSRobert Watson netisr_maxthreads = mp_ncpus; 1086ed54411cSRobert Watson } 1087ed54411cSRobert Watson if (netisr_defaultqlimit > netisr_maxqlimit) { 1088912f6323SRobert Watson printf("netisr_init: forcing defaultqlimit from %d to %d\n", 10899e6e01ebSRobert Watson netisr_defaultqlimit, netisr_maxqlimit); 1090d4b5cae4SRobert Watson netisr_defaultqlimit = netisr_maxqlimit; 1091ed54411cSRobert Watson } 1092d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 1093d4b5cae4SRobert Watson /* 1094d4b5cae4SRobert Watson * The device polling code is not yet aware of how to deal with 1095d4b5cae4SRobert Watson * multiple netisr threads, so for the time being compiling in device 1096d4b5cae4SRobert Watson * polling disables parallel netisr workers. 1097d4b5cae4SRobert Watson */ 1098ed54411cSRobert Watson if (netisr_maxthreads != 1 || netisr_bindthreads != 0) { 1099912f6323SRobert Watson printf("netisr_init: forcing maxthreads to 1 and " 1100912f6323SRobert Watson "bindthreads to 0 for device polling\n"); 1101d4b5cae4SRobert Watson netisr_maxthreads = 1; 1102d4b5cae4SRobert Watson netisr_bindthreads = 0; 1103ed54411cSRobert Watson } 1104d4b5cae4SRobert Watson #endif 1105d4b5cae4SRobert Watson 1106d4b5cae4SRobert Watson netisr_start_swi(curcpu, pcpu_find(curcpu)); 1107e3b6e33cSJake Burkholder } 1108d4b5cae4SRobert Watson SYSINIT(netisr_init, SI_SUB_SOFTINTR, SI_ORDER_FIRST, netisr_init, NULL); 1109d4b5cae4SRobert Watson 1110d4b5cae4SRobert Watson /* 1111d4b5cae4SRobert Watson * Start worker threads for additional CPUs. No attempt to gracefully handle 1112d4b5cae4SRobert Watson * work reassignment, we don't yet support dynamic reconfiguration. 1113d4b5cae4SRobert Watson */ 1114d4b5cae4SRobert Watson static void 1115d4b5cae4SRobert Watson netisr_start(void *arg) 1116d4b5cae4SRobert Watson { 1117d4b5cae4SRobert Watson struct pcpu *pc; 1118d4b5cae4SRobert Watson 1119d4b5cae4SRobert Watson SLIST_FOREACH(pc, &cpuhead, pc_allcpu) { 1120d4b5cae4SRobert Watson if (nws_count >= netisr_maxthreads) 1121d4b5cae4SRobert Watson break; 1122d4b5cae4SRobert Watson /* XXXRW: Is skipping absent CPUs still required here? */ 1123d4b5cae4SRobert Watson if (CPU_ABSENT(pc->pc_cpuid)) 1124d4b5cae4SRobert Watson continue; 1125d4b5cae4SRobert Watson /* Worker will already be present for boot CPU. */ 1126d4b5cae4SRobert Watson if (pc->pc_netisr != NULL) 1127d4b5cae4SRobert Watson continue; 1128d4b5cae4SRobert Watson netisr_start_swi(pc->pc_cpuid, pc); 1129d4b5cae4SRobert Watson } 1130d4b5cae4SRobert Watson } 1131d4b5cae4SRobert Watson SYSINIT(netisr_start, SI_SUB_SMP, SI_ORDER_MIDDLE, netisr_start, NULL); 1132d4b5cae4SRobert Watson 11332d22f334SRobert Watson /* 11342d22f334SRobert Watson * Sysctl monitoring for netisr: query a list of registered protocols. 11352d22f334SRobert Watson */ 11362d22f334SRobert Watson static int 11372d22f334SRobert Watson sysctl_netisr_proto(SYSCTL_HANDLER_ARGS) 11382d22f334SRobert Watson { 11392d22f334SRobert Watson struct rm_priotracker tracker; 11402d22f334SRobert Watson struct sysctl_netisr_proto *snpp, *snp_array; 11412d22f334SRobert Watson struct netisr_proto *npp; 11422d22f334SRobert Watson u_int counter, proto; 11432d22f334SRobert Watson int error; 11442d22f334SRobert Watson 11452d22f334SRobert Watson if (req->newptr != NULL) 11462d22f334SRobert Watson return (EINVAL); 11472d22f334SRobert Watson snp_array = malloc(sizeof(*snp_array) * NETISR_MAXPROT, M_TEMP, 11482d22f334SRobert Watson M_ZERO | M_WAITOK); 11492d22f334SRobert Watson counter = 0; 11502d22f334SRobert Watson NETISR_RLOCK(&tracker); 11512d22f334SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 11522d22f334SRobert Watson npp = &np[proto]; 11532d22f334SRobert Watson if (npp->np_name == NULL) 11542d22f334SRobert Watson continue; 11552d22f334SRobert Watson snpp = &snp_array[counter]; 11562d22f334SRobert Watson snpp->snp_version = sizeof(*snpp); 11572d22f334SRobert Watson strlcpy(snpp->snp_name, npp->np_name, NETISR_NAMEMAXLEN); 11582d22f334SRobert Watson snpp->snp_proto = proto; 11592d22f334SRobert Watson snpp->snp_qlimit = npp->np_qlimit; 11602d22f334SRobert Watson snpp->snp_policy = npp->np_policy; 11612d22f334SRobert Watson if (npp->np_m2flow != NULL) 11622d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_M2FLOW; 11632d22f334SRobert Watson if (npp->np_m2cpuid != NULL) 11642d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_M2CPUID; 11652d22f334SRobert Watson if (npp->np_drainedcpu != NULL) 11662d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_DRAINEDCPU; 11672d22f334SRobert Watson counter++; 11682d22f334SRobert Watson } 11692d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 11702d22f334SRobert Watson KASSERT(counter < NETISR_MAXPROT, 11712d22f334SRobert Watson ("sysctl_netisr_proto: counter too big (%d)", counter)); 11722d22f334SRobert Watson error = SYSCTL_OUT(req, snp_array, sizeof(*snp_array) * counter); 11732d22f334SRobert Watson free(snp_array, M_TEMP); 11742d22f334SRobert Watson return (error); 11752d22f334SRobert Watson } 11762d22f334SRobert Watson 11772d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, proto, 11782d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_proto, 11792d22f334SRobert Watson "S,sysctl_netisr_proto", 11802d22f334SRobert Watson "Return list of protocols registered with netisr"); 11812d22f334SRobert Watson 11822d22f334SRobert Watson /* 11832d22f334SRobert Watson * Sysctl monitoring for netisr: query a list of workstreams. 11842d22f334SRobert Watson */ 11852d22f334SRobert Watson static int 11862d22f334SRobert Watson sysctl_netisr_workstream(SYSCTL_HANDLER_ARGS) 11872d22f334SRobert Watson { 11882d22f334SRobert Watson struct rm_priotracker tracker; 11892d22f334SRobert Watson struct sysctl_netisr_workstream *snwsp, *snws_array; 11902d22f334SRobert Watson struct netisr_workstream *nwsp; 11912d22f334SRobert Watson u_int counter, cpuid; 11922d22f334SRobert Watson int error; 11932d22f334SRobert Watson 11942d22f334SRobert Watson if (req->newptr != NULL) 11952d22f334SRobert Watson return (EINVAL); 11962d22f334SRobert Watson snws_array = malloc(sizeof(*snws_array) * MAXCPU, M_TEMP, 11972d22f334SRobert Watson M_ZERO | M_WAITOK); 11982d22f334SRobert Watson counter = 0; 11992d22f334SRobert Watson NETISR_RLOCK(&tracker); 12002d22f334SRobert Watson for (cpuid = 0; cpuid < MAXCPU; cpuid++) { 12012d22f334SRobert Watson if (CPU_ABSENT(cpuid)) 12022d22f334SRobert Watson continue; 12032d22f334SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 12042d22f334SRobert Watson if (nwsp->nws_intr_event == NULL) 12052d22f334SRobert Watson continue; 12062d22f334SRobert Watson NWS_LOCK(nwsp); 12072d22f334SRobert Watson snwsp = &snws_array[counter]; 12082d22f334SRobert Watson snwsp->snws_version = sizeof(*snwsp); 12092d22f334SRobert Watson 12102d22f334SRobert Watson /* 12112d22f334SRobert Watson * For now, we equate workstream IDs and CPU IDs in the 12122d22f334SRobert Watson * kernel, but expose them independently to userspace in case 12132d22f334SRobert Watson * that assumption changes in the future. 12142d22f334SRobert Watson */ 12152d22f334SRobert Watson snwsp->snws_wsid = cpuid; 12162d22f334SRobert Watson snwsp->snws_cpu = cpuid; 12172d22f334SRobert Watson if (nwsp->nws_intr_event != NULL) 12182d22f334SRobert Watson snwsp->snws_flags |= NETISR_SNWS_FLAGS_INTR; 12192d22f334SRobert Watson NWS_UNLOCK(nwsp); 12202d22f334SRobert Watson counter++; 12212d22f334SRobert Watson } 12222d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 12232d22f334SRobert Watson KASSERT(counter < MAXCPU, 12242d22f334SRobert Watson ("sysctl_netisr_workstream: counter too big (%d)", counter)); 12252d22f334SRobert Watson error = SYSCTL_OUT(req, snws_array, sizeof(*snws_array) * counter); 12262d22f334SRobert Watson free(snws_array, M_TEMP); 12272d22f334SRobert Watson return (error); 12282d22f334SRobert Watson } 12292d22f334SRobert Watson 12302d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, workstream, 12312d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_workstream, 12322d22f334SRobert Watson "S,sysctl_netisr_workstream", 12332d22f334SRobert Watson "Return list of workstreams implemented by netisr"); 12342d22f334SRobert Watson 12352d22f334SRobert Watson /* 12362d22f334SRobert Watson * Sysctl monitoring for netisr: query per-protocol data across all 12372d22f334SRobert Watson * workstreams. 12382d22f334SRobert Watson */ 12392d22f334SRobert Watson static int 12402d22f334SRobert Watson sysctl_netisr_work(SYSCTL_HANDLER_ARGS) 12412d22f334SRobert Watson { 12422d22f334SRobert Watson struct rm_priotracker tracker; 12432d22f334SRobert Watson struct sysctl_netisr_work *snwp, *snw_array; 12442d22f334SRobert Watson struct netisr_workstream *nwsp; 12452d22f334SRobert Watson struct netisr_proto *npp; 12462d22f334SRobert Watson struct netisr_work *nwp; 12472d22f334SRobert Watson u_int counter, cpuid, proto; 12482d22f334SRobert Watson int error; 12492d22f334SRobert Watson 12502d22f334SRobert Watson if (req->newptr != NULL) 12512d22f334SRobert Watson return (EINVAL); 12522d22f334SRobert Watson snw_array = malloc(sizeof(*snw_array) * MAXCPU * NETISR_MAXPROT, 12532d22f334SRobert Watson M_TEMP, M_ZERO | M_WAITOK); 12542d22f334SRobert Watson counter = 0; 12552d22f334SRobert Watson NETISR_RLOCK(&tracker); 12562d22f334SRobert Watson for (cpuid = 0; cpuid < MAXCPU; cpuid++) { 12572d22f334SRobert Watson if (CPU_ABSENT(cpuid)) 12582d22f334SRobert Watson continue; 12592d22f334SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 12602d22f334SRobert Watson if (nwsp->nws_intr_event == NULL) 12612d22f334SRobert Watson continue; 12622d22f334SRobert Watson NWS_LOCK(nwsp); 12632d22f334SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 12642d22f334SRobert Watson npp = &np[proto]; 12652d22f334SRobert Watson if (npp->np_name == NULL) 12662d22f334SRobert Watson continue; 12672d22f334SRobert Watson nwp = &nwsp->nws_work[proto]; 12682d22f334SRobert Watson snwp = &snw_array[counter]; 12692d22f334SRobert Watson snwp->snw_version = sizeof(*snwp); 12702d22f334SRobert Watson snwp->snw_wsid = cpuid; /* See comment above. */ 12712d22f334SRobert Watson snwp->snw_proto = proto; 12722d22f334SRobert Watson snwp->snw_len = nwp->nw_len; 12732d22f334SRobert Watson snwp->snw_watermark = nwp->nw_watermark; 12742d22f334SRobert Watson snwp->snw_dispatched = nwp->nw_dispatched; 12752d22f334SRobert Watson snwp->snw_hybrid_dispatched = 12762d22f334SRobert Watson nwp->nw_hybrid_dispatched; 12772d22f334SRobert Watson snwp->snw_qdrops = nwp->nw_qdrops; 12782d22f334SRobert Watson snwp->snw_queued = nwp->nw_queued; 12792d22f334SRobert Watson snwp->snw_handled = nwp->nw_handled; 12802d22f334SRobert Watson counter++; 12812d22f334SRobert Watson } 12822d22f334SRobert Watson NWS_UNLOCK(nwsp); 12832d22f334SRobert Watson } 12842d22f334SRobert Watson KASSERT(counter < MAXCPU * NETISR_MAXPROT, 12852d22f334SRobert Watson ("sysctl_netisr_work: counter too big (%d)", counter)); 12862d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 12872d22f334SRobert Watson error = SYSCTL_OUT(req, snw_array, sizeof(*snw_array) * counter); 12882d22f334SRobert Watson free(snw_array, M_TEMP); 12892d22f334SRobert Watson return (error); 12902d22f334SRobert Watson } 12912d22f334SRobert Watson 12922d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, work, 12932d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_work, 12942d22f334SRobert Watson "S,sysctl_netisr_work", 12952d22f334SRobert Watson "Return list of per-workstream, per-protocol work in netisr"); 12962d22f334SRobert Watson 1297d4b5cae4SRobert Watson #ifdef DDB 1298d4b5cae4SRobert Watson DB_SHOW_COMMAND(netisr, db_show_netisr) 1299d4b5cae4SRobert Watson { 1300d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1301d4b5cae4SRobert Watson struct netisr_work *nwp; 1302d4b5cae4SRobert Watson int first, proto; 130353402767SRobert Watson u_int cpuid; 1304d4b5cae4SRobert Watson 1305d4b5cae4SRobert Watson db_printf("%3s %6s %5s %5s %5s %8s %8s %8s %8s\n", "CPU", "Proto", 1306d4b5cae4SRobert Watson "Len", "WMark", "Max", "Disp", "HDisp", "Drop", "Queue"); 13079e6e01ebSRobert Watson for (cpuid = 0; cpuid <= mp_maxid; cpuid++) { 130853402767SRobert Watson if (CPU_ABSENT(cpuid)) 130953402767SRobert Watson continue; 131053402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 1311d4b5cae4SRobert Watson if (nwsp->nws_intr_event == NULL) 1312d4b5cae4SRobert Watson continue; 1313d4b5cae4SRobert Watson first = 1; 1314d4b5cae4SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1315d4b5cae4SRobert Watson if (np[proto].np_handler == NULL) 1316d4b5cae4SRobert Watson continue; 1317d4b5cae4SRobert Watson nwp = &nwsp->nws_work[proto]; 1318d4b5cae4SRobert Watson if (first) { 131953402767SRobert Watson db_printf("%3d ", cpuid); 1320d4b5cae4SRobert Watson first = 0; 1321d4b5cae4SRobert Watson } else 1322d4b5cae4SRobert Watson db_printf("%3s ", ""); 1323d4b5cae4SRobert Watson db_printf( 1324d4b5cae4SRobert Watson "%6s %5d %5d %5d %8ju %8ju %8ju %8ju\n", 1325d4b5cae4SRobert Watson np[proto].np_name, nwp->nw_len, 1326d4b5cae4SRobert Watson nwp->nw_watermark, nwp->nw_qlimit, 1327d4b5cae4SRobert Watson nwp->nw_dispatched, nwp->nw_hybrid_dispatched, 1328d4b5cae4SRobert Watson nwp->nw_qdrops, nwp->nw_queued); 1329d4b5cae4SRobert Watson } 1330d4b5cae4SRobert Watson } 1331d4b5cae4SRobert Watson } 1332d4b5cae4SRobert Watson #endif 1333