11cafed39SJonathan Lemon /*- 2d4b5cae4SRobert Watson * Copyright (c) 2007-2009 Robert N. M. Watson 3f2d2d694SRobert Watson * Copyright (c) 2010-2011 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> 738ec07310SGleb Smirnoff #include <sys/malloc.h> 74d4b5cae4SRobert Watson #include <sys/interrupt.h> 751cafed39SJonathan Lemon #include <sys/lock.h> 761cafed39SJonathan Lemon #include <sys/mbuf.h> 77d4b5cae4SRobert Watson #include <sys/mutex.h> 7853402767SRobert Watson #include <sys/pcpu.h> 79d4b5cae4SRobert Watson #include <sys/proc.h> 80d4b5cae4SRobert Watson #include <sys/rmlock.h> 81d4b5cae4SRobert Watson #include <sys/sched.h> 82d4b5cae4SRobert Watson #include <sys/smp.h> 831cafed39SJonathan Lemon #include <sys/socket.h> 84d4b5cae4SRobert Watson #include <sys/sysctl.h> 85d4b5cae4SRobert Watson #include <sys/systm.h> 86d4b5cae4SRobert Watson 87d4b5cae4SRobert Watson #ifdef DDB 88d4b5cae4SRobert Watson #include <ddb/ddb.h> 89d4b5cae4SRobert Watson #endif 901cafed39SJonathan Lemon 91938448cdSRobert Watson #define _WANT_NETISR_INTERNAL /* Enable definitions from netisr_internal.h */ 921cafed39SJonathan Lemon #include <net/if.h> 931cafed39SJonathan Lemon #include <net/if_var.h> 94e3b6e33cSJake Burkholder #include <net/netisr.h> 95938448cdSRobert Watson #include <net/netisr_internal.h> 96530c0060SRobert Watson #include <net/vnet.h> 97e3b6e33cSJake Burkholder 98d4b5cae4SRobert Watson /*- 99d4b5cae4SRobert Watson * Synchronize use and modification of the registered netisr data structures; 100d4b5cae4SRobert Watson * acquire a read lock while modifying the set of registered protocols to 101d4b5cae4SRobert Watson * prevent partially registered or unregistered protocols from being run. 102d4b5cae4SRobert Watson * 103d4b5cae4SRobert Watson * The following data structures and fields are protected by this lock: 104d4b5cae4SRobert Watson * 105938448cdSRobert Watson * - The netisr_proto array, including all fields of struct netisr_proto. 106d4b5cae4SRobert Watson * - The nws array, including all fields of struct netisr_worker. 107d4b5cae4SRobert Watson * - The nws_array array. 108d4b5cae4SRobert Watson * 109d4b5cae4SRobert Watson * Note: the NETISR_LOCKING define controls whether read locks are acquired 110d4b5cae4SRobert Watson * in packet processing paths requiring netisr registration stability. This 1110a32e29fSRobert Watson * is disabled by default as it can lead to measurable performance 112d4b5cae4SRobert Watson * degradation even with rmlocks (3%-6% for loopback ping-pong traffic), and 113d4b5cae4SRobert Watson * because netisr registration and unregistration is extremely rare at 114d4b5cae4SRobert Watson * runtime. If it becomes more common, this decision should be revisited. 115d4b5cae4SRobert Watson * 116d4b5cae4SRobert Watson * XXXRW: rmlocks don't support assertions. 117d4b5cae4SRobert Watson */ 118d4b5cae4SRobert Watson static struct rmlock netisr_rmlock; 119d4b5cae4SRobert Watson #define NETISR_LOCK_INIT() rm_init_flags(&netisr_rmlock, "netisr", \ 120d4b5cae4SRobert Watson RM_NOWITNESS) 121d4b5cae4SRobert Watson #define NETISR_LOCK_ASSERT() 122d4b5cae4SRobert Watson #define NETISR_RLOCK(tracker) rm_rlock(&netisr_rmlock, (tracker)) 123d4b5cae4SRobert Watson #define NETISR_RUNLOCK(tracker) rm_runlock(&netisr_rmlock, (tracker)) 124d4b5cae4SRobert Watson #define NETISR_WLOCK() rm_wlock(&netisr_rmlock) 125d4b5cae4SRobert Watson #define NETISR_WUNLOCK() rm_wunlock(&netisr_rmlock) 126d4b5cae4SRobert Watson /* #define NETISR_LOCKING */ 127e3b6e33cSJake Burkholder 1286472ac3dSEd Schouten static SYSCTL_NODE(_net, OID_AUTO, isr, CTLFLAG_RW, 0, "netisr"); 1291cafed39SJonathan Lemon 130d4b5cae4SRobert Watson /*- 131f2d2d694SRobert Watson * Three global direct dispatch policies are supported: 132d4b5cae4SRobert Watson * 133da162ca8SSergey Kandaurov * NETISR_DISPATCH_DEFERRED: All work is deferred for a netisr, regardless of 134f2d2d694SRobert Watson * context (may be overriden by protocols). 135d4b5cae4SRobert Watson * 136f2d2d694SRobert Watson * NETISR_DISPATCH_HYBRID: If the executing context allows direct dispatch, 137f2d2d694SRobert Watson * and we're running on the CPU the work would be performed on, then direct 138f2d2d694SRobert Watson * dispatch it if it wouldn't violate ordering constraints on the workstream. 139d4b5cae4SRobert Watson * 140f2d2d694SRobert Watson * NETISR_DISPATCH_DIRECT: If the executing context allows direct dispatch, 141f2d2d694SRobert Watson * always direct dispatch. (The default.) 142d4b5cae4SRobert Watson * 143d4b5cae4SRobert Watson * Notice that changing the global policy could lead to short periods of 144d4b5cae4SRobert Watson * misordered processing, but this is considered acceptable as compared to 145f2d2d694SRobert Watson * the complexity of enforcing ordering during policy changes. Protocols can 146f2d2d694SRobert Watson * override the global policy (when they're not doing that, they select 147f2d2d694SRobert Watson * NETISR_DISPATCH_DEFAULT). 148d4b5cae4SRobert Watson */ 149f2d2d694SRobert Watson #define NETISR_DISPATCH_POLICY_DEFAULT NETISR_DISPATCH_DIRECT 150f2d2d694SRobert Watson #define NETISR_DISPATCH_POLICY_MAXSTR 20 /* Used for temporary buffers. */ 151f2d2d694SRobert Watson static u_int netisr_dispatch_policy = NETISR_DISPATCH_POLICY_DEFAULT; 152f2d2d694SRobert Watson static int sysctl_netisr_dispatch_policy(SYSCTL_HANDLER_ARGS); 153af3b2549SHans Petter Selasky SYSCTL_PROC(_net_isr, OID_AUTO, dispatch, CTLTYPE_STRING | CTLFLAG_RWTUN, 154af3b2549SHans Petter Selasky 0, 0, sysctl_netisr_dispatch_policy, "A", 155f2d2d694SRobert Watson "netisr dispatch policy"); 156e3b6e33cSJake Burkholder 157f2d2d694SRobert Watson /* 158d4b5cae4SRobert Watson * Allow the administrator to limit the number of threads (CPUs) to use for 159d4b5cae4SRobert Watson * netisr. We don't check netisr_maxthreads before creating the thread for 160a9467c3cSHiren Panchasara * CPU 0. This must be set at boot. We will create at most one thread per CPU. 161a9467c3cSHiren Panchasara * By default we initialize this to 1 which would assign just 1 cpu (cpu0) and 162a9467c3cSHiren Panchasara * therefore only 1 workstream. If set to -1, netisr would use all cpus 163a9467c3cSHiren Panchasara * (mp_ncpus) and therefore would have those many workstreams. One workstream 164a9467c3cSHiren Panchasara * per thread (CPU). 1655fd04e38SRobert Watson */ 166a9467c3cSHiren Panchasara static int netisr_maxthreads = 1; /* Max number of threads. */ 16778494902SPawel Jakub Dawidek SYSCTL_INT(_net_isr, OID_AUTO, maxthreads, CTLFLAG_RDTUN, 168d4b5cae4SRobert Watson &netisr_maxthreads, 0, 169d4b5cae4SRobert Watson "Use at most this many CPUs for netisr processing"); 1705fd04e38SRobert Watson 171d4b5cae4SRobert Watson static int netisr_bindthreads = 0; /* Bind threads to CPUs. */ 17278494902SPawel Jakub Dawidek SYSCTL_INT(_net_isr, OID_AUTO, bindthreads, CTLFLAG_RDTUN, 173d4b5cae4SRobert Watson &netisr_bindthreads, 0, "Bind netisr threads to CPUs."); 174d4b5cae4SRobert Watson 175d4b5cae4SRobert Watson /* 1760a32e29fSRobert Watson * Limit per-workstream mbuf queue limits s to at most net.isr.maxqlimit, 1770a32e29fSRobert Watson * both for initial configuration and later modification using 1780a32e29fSRobert Watson * netisr_setqlimit(). 179d4b5cae4SRobert Watson */ 180d4b5cae4SRobert Watson #define NETISR_DEFAULT_MAXQLIMIT 10240 181d4b5cae4SRobert Watson static u_int netisr_maxqlimit = NETISR_DEFAULT_MAXQLIMIT; 182f88910cdSMatthew D Fleming SYSCTL_UINT(_net_isr, OID_AUTO, maxqlimit, CTLFLAG_RDTUN, 183d4b5cae4SRobert Watson &netisr_maxqlimit, 0, 184d4b5cae4SRobert Watson "Maximum netisr per-protocol, per-CPU queue depth."); 185d4b5cae4SRobert Watson 186d4b5cae4SRobert Watson /* 1870a32e29fSRobert Watson * The default per-workstream mbuf queue limit for protocols that don't 1880a32e29fSRobert Watson * initialize the nh_qlimit field of their struct netisr_handler. If this is 1890a32e29fSRobert Watson * set above netisr_maxqlimit, we truncate it to the maximum during boot. 190d4b5cae4SRobert Watson */ 191d4b5cae4SRobert Watson #define NETISR_DEFAULT_DEFAULTQLIMIT 256 192d4b5cae4SRobert Watson static u_int netisr_defaultqlimit = NETISR_DEFAULT_DEFAULTQLIMIT; 193f88910cdSMatthew D Fleming SYSCTL_UINT(_net_isr, OID_AUTO, defaultqlimit, CTLFLAG_RDTUN, 194d4b5cae4SRobert Watson &netisr_defaultqlimit, 0, 195d4b5cae4SRobert Watson "Default netisr per-protocol, per-CPU queue limit if not set by protocol"); 196d4b5cae4SRobert Watson 197d4b5cae4SRobert Watson /* 198938448cdSRobert Watson * Store and export the compile-time constant NETISR_MAXPROT limit on the 199938448cdSRobert Watson * number of protocols that can register with netisr at a time. This is 200938448cdSRobert Watson * required for crashdump analysis, as it sizes netisr_proto[]. 201d4b5cae4SRobert Watson */ 202938448cdSRobert Watson static u_int netisr_maxprot = NETISR_MAXPROT; 203f88910cdSMatthew D Fleming SYSCTL_UINT(_net_isr, OID_AUTO, maxprot, CTLFLAG_RD, 204938448cdSRobert Watson &netisr_maxprot, 0, 205938448cdSRobert Watson "Compile-time limit on the number of protocols supported by netisr."); 206d4b5cae4SRobert Watson 207d4b5cae4SRobert Watson /* 208938448cdSRobert Watson * The netisr_proto array describes all registered protocols, indexed by 209938448cdSRobert Watson * protocol number. See netisr_internal.h for more details. 210d4b5cae4SRobert Watson */ 211938448cdSRobert Watson static struct netisr_proto netisr_proto[NETISR_MAXPROT]; 212d4b5cae4SRobert Watson 213d4b5cae4SRobert Watson /* 214938448cdSRobert Watson * Per-CPU workstream data. See netisr_internal.h for more details. 215d4b5cae4SRobert Watson */ 21653402767SRobert Watson DPCPU_DEFINE(struct netisr_workstream, nws); 217d4b5cae4SRobert Watson 218d4b5cae4SRobert Watson /* 219d4b5cae4SRobert Watson * Map contiguous values between 0 and nws_count into CPU IDs appropriate for 22053402767SRobert Watson * accessing workstreams. This allows constructions of the form 22153402767SRobert Watson * DPCPU_ID_GET(nws_array[arbitraryvalue % nws_count], nws). 222d4b5cae4SRobert Watson */ 223d4b5cae4SRobert Watson static u_int nws_array[MAXCPU]; 224d4b5cae4SRobert Watson 225d4b5cae4SRobert Watson /* 226d4b5cae4SRobert Watson * Number of registered workstreams. Will be at most the number of running 227d4b5cae4SRobert Watson * CPUs once fully started. 228d4b5cae4SRobert Watson */ 229d4b5cae4SRobert Watson static u_int nws_count; 230f88910cdSMatthew D Fleming SYSCTL_UINT(_net_isr, OID_AUTO, numthreads, CTLFLAG_RD, 231d4b5cae4SRobert Watson &nws_count, 0, "Number of extant netisr threads."); 232d4b5cae4SRobert Watson 233d4b5cae4SRobert Watson /* 234d4b5cae4SRobert Watson * Synchronization for each workstream: a mutex protects all mutable fields 235d4b5cae4SRobert Watson * in each stream, including per-protocol state (mbuf queues). The SWI is 236d4b5cae4SRobert Watson * woken up if asynchronous dispatch is required. 237d4b5cae4SRobert Watson */ 238d4b5cae4SRobert Watson #define NWS_LOCK(s) mtx_lock(&(s)->nws_mtx) 239d4b5cae4SRobert Watson #define NWS_LOCK_ASSERT(s) mtx_assert(&(s)->nws_mtx, MA_OWNED) 240d4b5cae4SRobert Watson #define NWS_UNLOCK(s) mtx_unlock(&(s)->nws_mtx) 241d4b5cae4SRobert Watson #define NWS_SIGNAL(s) swi_sched((s)->nws_swi_cookie, 0) 242d4b5cae4SRobert Watson 243d4b5cae4SRobert Watson /* 244d4b5cae4SRobert Watson * Utility routines for protocols that implement their own mapping of flows 245d4b5cae4SRobert Watson * to CPUs. 246d4b5cae4SRobert Watson */ 247d4b5cae4SRobert Watson u_int 248d4b5cae4SRobert Watson netisr_get_cpucount(void) 249d4b5cae4SRobert Watson { 250d4b5cae4SRobert Watson 251d4b5cae4SRobert Watson return (nws_count); 2525fd04e38SRobert Watson } 253d4b5cae4SRobert Watson 254d4b5cae4SRobert Watson u_int 255d4b5cae4SRobert Watson netisr_get_cpuid(u_int cpunumber) 256d4b5cae4SRobert Watson { 257d4b5cae4SRobert Watson 258d4b5cae4SRobert Watson KASSERT(cpunumber < nws_count, ("%s: %u > %u", __func__, cpunumber, 259d4b5cae4SRobert Watson nws_count)); 260d4b5cae4SRobert Watson 261d4b5cae4SRobert Watson return (nws_array[cpunumber]); 2625fd04e38SRobert Watson } 2635fd04e38SRobert Watson 2645fd04e38SRobert Watson /* 2650a32e29fSRobert Watson * The default implementation of flow -> CPU ID mapping. 266d4b5cae4SRobert Watson * 267d4b5cae4SRobert Watson * Non-static so that protocols can use it to map their own work to specific 268d4b5cae4SRobert Watson * CPUs in a manner consistent to netisr for affinity purposes. 269d4b5cae4SRobert Watson */ 270d4b5cae4SRobert Watson u_int 271d4b5cae4SRobert Watson netisr_default_flow2cpu(u_int flowid) 272d4b5cae4SRobert Watson { 273d4b5cae4SRobert Watson 274d4b5cae4SRobert Watson return (nws_array[flowid % nws_count]); 275d4b5cae4SRobert Watson } 276d4b5cae4SRobert Watson 277d4b5cae4SRobert Watson /* 278f2d2d694SRobert Watson * Dispatch tunable and sysctl configuration. 279f2d2d694SRobert Watson */ 280f2d2d694SRobert Watson struct netisr_dispatch_table_entry { 281f2d2d694SRobert Watson u_int ndte_policy; 282f2d2d694SRobert Watson const char *ndte_policy_str; 283f2d2d694SRobert Watson }; 284f2d2d694SRobert Watson static const struct netisr_dispatch_table_entry netisr_dispatch_table[] = { 285f2d2d694SRobert Watson { NETISR_DISPATCH_DEFAULT, "default" }, 286f2d2d694SRobert Watson { NETISR_DISPATCH_DEFERRED, "deferred" }, 287f2d2d694SRobert Watson { NETISR_DISPATCH_HYBRID, "hybrid" }, 288f2d2d694SRobert Watson { NETISR_DISPATCH_DIRECT, "direct" }, 289f2d2d694SRobert Watson }; 290f2d2d694SRobert Watson 291f2d2d694SRobert Watson static void 292f2d2d694SRobert Watson netisr_dispatch_policy_to_str(u_int dispatch_policy, char *buffer, 293f2d2d694SRobert Watson u_int buflen) 294f2d2d694SRobert Watson { 295f2d2d694SRobert Watson const struct netisr_dispatch_table_entry *ndtep; 296f2d2d694SRobert Watson const char *str; 297f2d2d694SRobert Watson u_int i; 298f2d2d694SRobert Watson 299f2d2d694SRobert Watson str = "unknown"; 3008dfea464SPedro F. Giffuni for (i = 0; i < nitems(netisr_dispatch_table); i++) { 301f2d2d694SRobert Watson ndtep = &netisr_dispatch_table[i]; 302f2d2d694SRobert Watson if (ndtep->ndte_policy == dispatch_policy) { 303f2d2d694SRobert Watson str = ndtep->ndte_policy_str; 304f2d2d694SRobert Watson break; 305f2d2d694SRobert Watson } 306f2d2d694SRobert Watson } 307f2d2d694SRobert Watson snprintf(buffer, buflen, "%s", str); 308f2d2d694SRobert Watson } 309f2d2d694SRobert Watson 310f2d2d694SRobert Watson static int 311f2d2d694SRobert Watson netisr_dispatch_policy_from_str(const char *str, u_int *dispatch_policyp) 312f2d2d694SRobert Watson { 313f2d2d694SRobert Watson const struct netisr_dispatch_table_entry *ndtep; 314f2d2d694SRobert Watson u_int i; 315f2d2d694SRobert Watson 3168dfea464SPedro F. Giffuni for (i = 0; i < nitems(netisr_dispatch_table); i++) { 317f2d2d694SRobert Watson ndtep = &netisr_dispatch_table[i]; 318f2d2d694SRobert Watson if (strcmp(ndtep->ndte_policy_str, str) == 0) { 319f2d2d694SRobert Watson *dispatch_policyp = ndtep->ndte_policy; 320f2d2d694SRobert Watson return (0); 321f2d2d694SRobert Watson } 322f2d2d694SRobert Watson } 323f2d2d694SRobert Watson return (EINVAL); 324f2d2d694SRobert Watson } 325f2d2d694SRobert Watson 326f2d2d694SRobert Watson static int 327f2d2d694SRobert Watson sysctl_netisr_dispatch_policy(SYSCTL_HANDLER_ARGS) 328f2d2d694SRobert Watson { 329f2d2d694SRobert Watson char tmp[NETISR_DISPATCH_POLICY_MAXSTR]; 330f2d2d694SRobert Watson u_int dispatch_policy; 331f2d2d694SRobert Watson int error; 332f2d2d694SRobert Watson 333f2d2d694SRobert Watson netisr_dispatch_policy_to_str(netisr_dispatch_policy, tmp, 334f2d2d694SRobert Watson sizeof(tmp)); 335f2d2d694SRobert Watson error = sysctl_handle_string(oidp, tmp, sizeof(tmp), req); 336f2d2d694SRobert Watson if (error == 0 && req->newptr != NULL) { 337f2d2d694SRobert Watson error = netisr_dispatch_policy_from_str(tmp, 338f2d2d694SRobert Watson &dispatch_policy); 339f2d2d694SRobert Watson if (error == 0 && dispatch_policy == NETISR_DISPATCH_DEFAULT) 340f2d2d694SRobert Watson error = EINVAL; 341933e681dSDavide Italiano if (error == 0) 342f2d2d694SRobert Watson netisr_dispatch_policy = dispatch_policy; 343f2d2d694SRobert Watson } 344f2d2d694SRobert Watson return (error); 345f2d2d694SRobert Watson } 346f2d2d694SRobert Watson 347f2d2d694SRobert Watson /* 348d4b5cae4SRobert Watson * Register a new netisr handler, which requires initializing per-protocol 349d4b5cae4SRobert Watson * fields for each workstream. All netisr work is briefly suspended while 350d4b5cae4SRobert Watson * the protocol is installed. 3511cafed39SJonathan Lemon */ 3521cafed39SJonathan Lemon void 353d4b5cae4SRobert Watson netisr_register(const struct netisr_handler *nhp) 3541cafed39SJonathan Lemon { 355d4b5cae4SRobert Watson struct netisr_work *npwp; 356d4b5cae4SRobert Watson const char *name; 357d4b5cae4SRobert Watson u_int i, proto; 3581cafed39SJonathan Lemon 359d4b5cae4SRobert Watson proto = nhp->nh_proto; 360d4b5cae4SRobert Watson name = nhp->nh_name; 36159dd72d0SRobert Watson 3627902224cSSam Leffler /* 363d4b5cae4SRobert Watson * Test that the requested registration is valid. 3647902224cSSam Leffler */ 365d4b5cae4SRobert Watson KASSERT(nhp->nh_name != NULL, 366d4b5cae4SRobert Watson ("%s: nh_name NULL for %u", __func__, proto)); 367d4b5cae4SRobert Watson KASSERT(nhp->nh_handler != NULL, 368d4b5cae4SRobert Watson ("%s: nh_handler NULL for %s", __func__, name)); 369d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_SOURCE || 370d4b5cae4SRobert Watson nhp->nh_policy == NETISR_POLICY_FLOW || 371d4b5cae4SRobert Watson nhp->nh_policy == NETISR_POLICY_CPU, 372d4b5cae4SRobert Watson ("%s: unsupported nh_policy %u for %s", __func__, 373d4b5cae4SRobert Watson nhp->nh_policy, name)); 374d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_FLOW || 375d4b5cae4SRobert Watson nhp->nh_m2flow == NULL, 376d4b5cae4SRobert Watson ("%s: nh_policy != FLOW but m2flow defined for %s", __func__, 377d4b5cae4SRobert Watson name)); 378d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_CPU || nhp->nh_m2cpuid == NULL, 379d4b5cae4SRobert Watson ("%s: nh_policy != CPU but m2cpuid defined for %s", __func__, 380d4b5cae4SRobert Watson name)); 381d4b5cae4SRobert Watson KASSERT(nhp->nh_policy != NETISR_POLICY_CPU || nhp->nh_m2cpuid != NULL, 382d4b5cae4SRobert Watson ("%s: nh_policy == CPU but m2cpuid not defined for %s", __func__, 383d4b5cae4SRobert Watson name)); 384f2d2d694SRobert Watson KASSERT(nhp->nh_dispatch == NETISR_DISPATCH_DEFAULT || 385f2d2d694SRobert Watson nhp->nh_dispatch == NETISR_DISPATCH_DEFERRED || 386f2d2d694SRobert Watson nhp->nh_dispatch == NETISR_DISPATCH_HYBRID || 387f2d2d694SRobert Watson nhp->nh_dispatch == NETISR_DISPATCH_DIRECT, 388f2d2d694SRobert Watson ("%s: invalid nh_dispatch (%u)", __func__, nhp->nh_dispatch)); 389f2d2d694SRobert Watson 390d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 391d4b5cae4SRobert Watson ("%s(%u, %s): protocol too big", __func__, proto, name)); 392d4b5cae4SRobert Watson 393d4b5cae4SRobert Watson /* 394d4b5cae4SRobert Watson * Test that no existing registration exists for this protocol. 395d4b5cae4SRobert Watson */ 396d4b5cae4SRobert Watson NETISR_WLOCK(); 397938448cdSRobert Watson KASSERT(netisr_proto[proto].np_name == NULL, 398d4b5cae4SRobert Watson ("%s(%u, %s): name present", __func__, proto, name)); 399938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler == NULL, 400d4b5cae4SRobert Watson ("%s(%u, %s): handler present", __func__, proto, name)); 401d4b5cae4SRobert Watson 402938448cdSRobert Watson netisr_proto[proto].np_name = name; 403938448cdSRobert Watson netisr_proto[proto].np_handler = nhp->nh_handler; 404938448cdSRobert Watson netisr_proto[proto].np_m2flow = nhp->nh_m2flow; 405938448cdSRobert Watson netisr_proto[proto].np_m2cpuid = nhp->nh_m2cpuid; 406938448cdSRobert Watson netisr_proto[proto].np_drainedcpu = nhp->nh_drainedcpu; 407d4b5cae4SRobert Watson if (nhp->nh_qlimit == 0) 408938448cdSRobert Watson netisr_proto[proto].np_qlimit = netisr_defaultqlimit; 409d4b5cae4SRobert Watson else if (nhp->nh_qlimit > netisr_maxqlimit) { 410d4b5cae4SRobert Watson printf("%s: %s requested queue limit %u capped to " 411d4b5cae4SRobert Watson "net.isr.maxqlimit %u\n", __func__, name, nhp->nh_qlimit, 412d4b5cae4SRobert Watson netisr_maxqlimit); 413938448cdSRobert Watson netisr_proto[proto].np_qlimit = netisr_maxqlimit; 414d4b5cae4SRobert Watson } else 415938448cdSRobert Watson netisr_proto[proto].np_qlimit = nhp->nh_qlimit; 416938448cdSRobert Watson netisr_proto[proto].np_policy = nhp->nh_policy; 417f2d2d694SRobert Watson netisr_proto[proto].np_dispatch = nhp->nh_dispatch; 4183aa6d94eSJohn Baldwin CPU_FOREACH(i) { 41953402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 420d4b5cae4SRobert Watson bzero(npwp, sizeof(*npwp)); 421938448cdSRobert Watson npwp->nw_qlimit = netisr_proto[proto].np_qlimit; 4221cafed39SJonathan Lemon } 423d4b5cae4SRobert Watson NETISR_WUNLOCK(); 4241cafed39SJonathan Lemon } 4251cafed39SJonathan Lemon 4261cafed39SJonathan Lemon /* 427d4b5cae4SRobert Watson * Clear drop counters across all workstreams for a protocol. 428d4b5cae4SRobert Watson */ 429d4b5cae4SRobert Watson void 430d4b5cae4SRobert Watson netisr_clearqdrops(const struct netisr_handler *nhp) 431d4b5cae4SRobert Watson { 432d4b5cae4SRobert Watson struct netisr_work *npwp; 433d4b5cae4SRobert Watson #ifdef INVARIANTS 434d4b5cae4SRobert Watson const char *name; 435d4b5cae4SRobert Watson #endif 436d4b5cae4SRobert Watson u_int i, proto; 437d4b5cae4SRobert Watson 438d4b5cae4SRobert Watson proto = nhp->nh_proto; 439d4b5cae4SRobert Watson #ifdef INVARIANTS 440d4b5cae4SRobert Watson name = nhp->nh_name; 441d4b5cae4SRobert Watson #endif 442d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 443d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 444d4b5cae4SRobert Watson 445d4b5cae4SRobert Watson NETISR_WLOCK(); 446938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 447d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 448d4b5cae4SRobert Watson name)); 449d4b5cae4SRobert Watson 4503aa6d94eSJohn Baldwin CPU_FOREACH(i) { 45153402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 452d4b5cae4SRobert Watson npwp->nw_qdrops = 0; 453d4b5cae4SRobert Watson } 454d4b5cae4SRobert Watson NETISR_WUNLOCK(); 455d4b5cae4SRobert Watson } 456d4b5cae4SRobert Watson 457d4b5cae4SRobert Watson /* 4580a32e29fSRobert Watson * Query current drop counters across all workstreams for a protocol. 459d4b5cae4SRobert Watson */ 460d4b5cae4SRobert Watson void 461d4b5cae4SRobert Watson netisr_getqdrops(const struct netisr_handler *nhp, u_int64_t *qdropp) 462d4b5cae4SRobert Watson { 463d4b5cae4SRobert Watson struct netisr_work *npwp; 464d4b5cae4SRobert Watson struct rm_priotracker tracker; 465d4b5cae4SRobert Watson #ifdef INVARIANTS 466d4b5cae4SRobert Watson const char *name; 467d4b5cae4SRobert Watson #endif 468d4b5cae4SRobert Watson u_int i, proto; 469d4b5cae4SRobert Watson 470d4b5cae4SRobert Watson *qdropp = 0; 471d4b5cae4SRobert Watson proto = nhp->nh_proto; 472d4b5cae4SRobert Watson #ifdef INVARIANTS 473d4b5cae4SRobert Watson name = nhp->nh_name; 474d4b5cae4SRobert Watson #endif 475d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 476d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 477d4b5cae4SRobert Watson 478d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 479938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 480d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 481d4b5cae4SRobert Watson name)); 482d4b5cae4SRobert Watson 4833aa6d94eSJohn Baldwin CPU_FOREACH(i) { 48453402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 485d4b5cae4SRobert Watson *qdropp += npwp->nw_qdrops; 486d4b5cae4SRobert Watson } 487d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 488d4b5cae4SRobert Watson } 489d4b5cae4SRobert Watson 490d4b5cae4SRobert Watson /* 4910a32e29fSRobert Watson * Query current per-workstream queue limit for a protocol. 492d4b5cae4SRobert Watson */ 493d4b5cae4SRobert Watson void 494d4b5cae4SRobert Watson netisr_getqlimit(const struct netisr_handler *nhp, u_int *qlimitp) 495d4b5cae4SRobert Watson { 496d4b5cae4SRobert Watson struct rm_priotracker tracker; 497d4b5cae4SRobert Watson #ifdef INVARIANTS 498d4b5cae4SRobert Watson const char *name; 499d4b5cae4SRobert Watson #endif 500d4b5cae4SRobert Watson u_int proto; 501d4b5cae4SRobert Watson 502d4b5cae4SRobert Watson proto = nhp->nh_proto; 503d4b5cae4SRobert Watson #ifdef INVARIANTS 504d4b5cae4SRobert Watson name = nhp->nh_name; 505d4b5cae4SRobert Watson #endif 506d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 507d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 508d4b5cae4SRobert Watson 509d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 510938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 511d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 512d4b5cae4SRobert Watson name)); 513938448cdSRobert Watson *qlimitp = netisr_proto[proto].np_qlimit; 514d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 515d4b5cae4SRobert Watson } 516d4b5cae4SRobert Watson 517d4b5cae4SRobert Watson /* 518d4b5cae4SRobert Watson * Update the queue limit across per-workstream queues for a protocol. We 519d4b5cae4SRobert Watson * simply change the limits, and don't drain overflowed packets as they will 520d4b5cae4SRobert Watson * (hopefully) take care of themselves shortly. 5211cafed39SJonathan Lemon */ 5221cafed39SJonathan Lemon int 523d4b5cae4SRobert Watson netisr_setqlimit(const struct netisr_handler *nhp, u_int qlimit) 5241cafed39SJonathan Lemon { 525d4b5cae4SRobert Watson struct netisr_work *npwp; 526d4b5cae4SRobert Watson #ifdef INVARIANTS 527d4b5cae4SRobert Watson const char *name; 528d4b5cae4SRobert Watson #endif 529d4b5cae4SRobert Watson u_int i, proto; 5301cafed39SJonathan Lemon 531d4b5cae4SRobert Watson if (qlimit > netisr_maxqlimit) 532d4b5cae4SRobert Watson return (EINVAL); 533d4b5cae4SRobert Watson 534d4b5cae4SRobert Watson proto = nhp->nh_proto; 535d4b5cae4SRobert Watson #ifdef INVARIANTS 536d4b5cae4SRobert Watson name = nhp->nh_name; 537d4b5cae4SRobert Watson #endif 538d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 539d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 540d4b5cae4SRobert Watson 541d4b5cae4SRobert Watson NETISR_WLOCK(); 542938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 543d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 544d4b5cae4SRobert Watson name)); 545d4b5cae4SRobert Watson 546938448cdSRobert Watson netisr_proto[proto].np_qlimit = qlimit; 5473aa6d94eSJohn Baldwin CPU_FOREACH(i) { 54853402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 549d4b5cae4SRobert Watson npwp->nw_qlimit = qlimit; 550fb68148fSJonathan Lemon } 551d4b5cae4SRobert Watson NETISR_WUNLOCK(); 5523161f583SAndre Oppermann return (0); 553e3b6e33cSJake Burkholder } 554e3b6e33cSJake Burkholder 555d4b5cae4SRobert Watson /* 556d4b5cae4SRobert Watson * Drain all packets currently held in a particular protocol work queue. 557d4b5cae4SRobert Watson */ 558e3b6e33cSJake Burkholder static void 559d4b5cae4SRobert Watson netisr_drain_proto(struct netisr_work *npwp) 560e3b6e33cSJake Burkholder { 561d4b5cae4SRobert Watson struct mbuf *m; 562d4b5cae4SRobert Watson 563d4b5cae4SRobert Watson /* 564d4b5cae4SRobert Watson * We would assert the lock on the workstream but it's not passed in. 565d4b5cae4SRobert Watson */ 566d4b5cae4SRobert Watson while ((m = npwp->nw_head) != NULL) { 567d4b5cae4SRobert Watson npwp->nw_head = m->m_nextpkt; 568d4b5cae4SRobert Watson m->m_nextpkt = NULL; 569d4b5cae4SRobert Watson if (npwp->nw_head == NULL) 570d4b5cae4SRobert Watson npwp->nw_tail = NULL; 571d4b5cae4SRobert Watson npwp->nw_len--; 572d4b5cae4SRobert Watson m_freem(m); 573d4b5cae4SRobert Watson } 574d4b5cae4SRobert Watson KASSERT(npwp->nw_tail == NULL, ("%s: tail", __func__)); 575d4b5cae4SRobert Watson KASSERT(npwp->nw_len == 0, ("%s: len", __func__)); 576d4b5cae4SRobert Watson } 577d4b5cae4SRobert Watson 578d4b5cae4SRobert Watson /* 579d4b5cae4SRobert Watson * Remove the registration of a network protocol, which requires clearing 580d4b5cae4SRobert Watson * per-protocol fields across all workstreams, including freeing all mbufs in 581d4b5cae4SRobert Watson * the queues at time of unregister. All work in netisr is briefly suspended 582d4b5cae4SRobert Watson * while this takes place. 583d4b5cae4SRobert Watson */ 584d4b5cae4SRobert Watson void 585d4b5cae4SRobert Watson netisr_unregister(const struct netisr_handler *nhp) 586d4b5cae4SRobert Watson { 587d4b5cae4SRobert Watson struct netisr_work *npwp; 588d4b5cae4SRobert Watson #ifdef INVARIANTS 589d4b5cae4SRobert Watson const char *name; 590d4b5cae4SRobert Watson #endif 591d4b5cae4SRobert Watson u_int i, proto; 592d4b5cae4SRobert Watson 593d4b5cae4SRobert Watson proto = nhp->nh_proto; 594d4b5cae4SRobert Watson #ifdef INVARIANTS 595d4b5cae4SRobert Watson name = nhp->nh_name; 596d4b5cae4SRobert Watson #endif 597d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 598d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 599d4b5cae4SRobert Watson 600d4b5cae4SRobert Watson NETISR_WLOCK(); 601938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 602d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 603d4b5cae4SRobert Watson name)); 604d4b5cae4SRobert Watson 605938448cdSRobert Watson netisr_proto[proto].np_name = NULL; 606938448cdSRobert Watson netisr_proto[proto].np_handler = NULL; 607938448cdSRobert Watson netisr_proto[proto].np_m2flow = NULL; 608938448cdSRobert Watson netisr_proto[proto].np_m2cpuid = NULL; 609938448cdSRobert Watson netisr_proto[proto].np_qlimit = 0; 610938448cdSRobert Watson netisr_proto[proto].np_policy = 0; 6113aa6d94eSJohn Baldwin CPU_FOREACH(i) { 61253402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 613d4b5cae4SRobert Watson netisr_drain_proto(npwp); 614d4b5cae4SRobert Watson bzero(npwp, sizeof(*npwp)); 615d4b5cae4SRobert Watson } 616d4b5cae4SRobert Watson NETISR_WUNLOCK(); 617d4b5cae4SRobert Watson } 618d4b5cae4SRobert Watson 619d4b5cae4SRobert Watson /* 620f2d2d694SRobert Watson * Compose the global and per-protocol policies on dispatch, and return the 621f2d2d694SRobert Watson * dispatch policy to use. 622f2d2d694SRobert Watson */ 623f2d2d694SRobert Watson static u_int 624f2d2d694SRobert Watson netisr_get_dispatch(struct netisr_proto *npp) 625f2d2d694SRobert Watson { 626f2d2d694SRobert Watson 627f2d2d694SRobert Watson /* 628f2d2d694SRobert Watson * Protocol-specific configuration overrides the global default. 629f2d2d694SRobert Watson */ 630f2d2d694SRobert Watson if (npp->np_dispatch != NETISR_DISPATCH_DEFAULT) 631f2d2d694SRobert Watson return (npp->np_dispatch); 632f2d2d694SRobert Watson return (netisr_dispatch_policy); 633f2d2d694SRobert Watson } 634f2d2d694SRobert Watson 635f2d2d694SRobert Watson /* 636d4b5cae4SRobert Watson * Look up the workstream given a packet and source identifier. Do this by 637d4b5cae4SRobert Watson * checking the protocol's policy, and optionally call out to the protocol 638d4b5cae4SRobert Watson * for assistance if required. 639d4b5cae4SRobert Watson */ 640d4b5cae4SRobert Watson static struct mbuf * 641f2d2d694SRobert Watson netisr_select_cpuid(struct netisr_proto *npp, u_int dispatch_policy, 642f2d2d694SRobert Watson uintptr_t source, struct mbuf *m, u_int *cpuidp) 643d4b5cae4SRobert Watson { 644d4b5cae4SRobert Watson struct ifnet *ifp; 645f2d2d694SRobert Watson u_int policy; 646d4b5cae4SRobert Watson 647d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 648d4b5cae4SRobert Watson 649d4b5cae4SRobert Watson /* 650d4b5cae4SRobert Watson * In the event we have only one worker, shortcut and deliver to it 651d4b5cae4SRobert Watson * without further ado. 652d4b5cae4SRobert Watson */ 653d4b5cae4SRobert Watson if (nws_count == 1) { 654d4b5cae4SRobert Watson *cpuidp = nws_array[0]; 655d4b5cae4SRobert Watson return (m); 656d4b5cae4SRobert Watson } 657d4b5cae4SRobert Watson 658d4b5cae4SRobert Watson /* 659d4b5cae4SRobert Watson * What happens next depends on the policy selected by the protocol. 660d4b5cae4SRobert Watson * If we want to support per-interface policies, we should do that 661d4b5cae4SRobert Watson * here first. 662d4b5cae4SRobert Watson */ 663f2d2d694SRobert Watson policy = npp->np_policy; 664f2d2d694SRobert Watson if (policy == NETISR_POLICY_CPU) { 665f2d2d694SRobert Watson m = npp->np_m2cpuid(m, source, cpuidp); 666f2d2d694SRobert Watson if (m == NULL) 667f2d2d694SRobert Watson return (NULL); 668d4b5cae4SRobert Watson 669f2d2d694SRobert Watson /* 670f2d2d694SRobert Watson * It's possible for a protocol not to have a good idea about 671f2d2d694SRobert Watson * where to process a packet, in which case we fall back on 672f2d2d694SRobert Watson * the netisr code to decide. In the hybrid case, return the 673f2d2d694SRobert Watson * current CPU ID, which will force an immediate direct 674f2d2d694SRobert Watson * dispatch. In the queued case, fall back on the SOURCE 675f2d2d694SRobert Watson * policy. 676f2d2d694SRobert Watson */ 677f2d2d694SRobert Watson if (*cpuidp != NETISR_CPUID_NONE) 678f2d2d694SRobert Watson return (m); 679f2d2d694SRobert Watson if (dispatch_policy == NETISR_DISPATCH_HYBRID) { 680f2d2d694SRobert Watson *cpuidp = curcpu; 681f2d2d694SRobert Watson return (m); 682f2d2d694SRobert Watson } 683f2d2d694SRobert Watson policy = NETISR_POLICY_SOURCE; 684f2d2d694SRobert Watson } 685f2d2d694SRobert Watson 686f2d2d694SRobert Watson if (policy == NETISR_POLICY_FLOW) { 687c2529042SHans Petter Selasky if (M_HASHTYPE_GET(m) == M_HASHTYPE_NONE && 688c2529042SHans Petter Selasky npp->np_m2flow != NULL) { 689d4b5cae4SRobert Watson m = npp->np_m2flow(m, source); 690d4b5cae4SRobert Watson if (m == NULL) 691d4b5cae4SRobert Watson return (NULL); 692d4b5cae4SRobert Watson } 693c2529042SHans Petter Selasky if (M_HASHTYPE_GET(m) != M_HASHTYPE_NONE) { 694d4b5cae4SRobert Watson *cpuidp = 695d4b5cae4SRobert Watson netisr_default_flow2cpu(m->m_pkthdr.flowid); 696d4b5cae4SRobert Watson return (m); 697d4b5cae4SRobert Watson } 698f2d2d694SRobert Watson policy = NETISR_POLICY_SOURCE; 699f2d2d694SRobert Watson } 700d4b5cae4SRobert Watson 701f2d2d694SRobert Watson KASSERT(policy == NETISR_POLICY_SOURCE, 702f2d2d694SRobert Watson ("%s: invalid policy %u for %s", __func__, npp->np_policy, 703f2d2d694SRobert Watson npp->np_name)); 704f2d2d694SRobert Watson 705d4b5cae4SRobert Watson ifp = m->m_pkthdr.rcvif; 706d4b5cae4SRobert Watson if (ifp != NULL) 707f2d2d694SRobert Watson *cpuidp = nws_array[(ifp->if_index + source) % nws_count]; 708d4b5cae4SRobert Watson else 709d4b5cae4SRobert Watson *cpuidp = nws_array[source % nws_count]; 710d4b5cae4SRobert Watson return (m); 711d4b5cae4SRobert Watson } 712d4b5cae4SRobert Watson 713d4b5cae4SRobert Watson /* 714d4b5cae4SRobert Watson * Process packets associated with a workstream and protocol. For reasons of 715d4b5cae4SRobert Watson * fairness, we process up to one complete netisr queue at a time, moving the 716d4b5cae4SRobert Watson * queue to a stack-local queue for processing, but do not loop refreshing 717d4b5cae4SRobert Watson * from the global queue. The caller is responsible for deciding whether to 718d4b5cae4SRobert Watson * loop, and for setting the NWS_RUNNING flag. The passed workstream will be 719d4b5cae4SRobert Watson * locked on entry and relocked before return, but will be released while 720d4b5cae4SRobert Watson * processing. The number of packets processed is returned. 721d4b5cae4SRobert Watson */ 722d4b5cae4SRobert Watson static u_int 723d4b5cae4SRobert Watson netisr_process_workstream_proto(struct netisr_workstream *nwsp, u_int proto) 724d4b5cae4SRobert Watson { 725d4b5cae4SRobert Watson struct netisr_work local_npw, *npwp; 726d4b5cae4SRobert Watson u_int handled; 727d4b5cae4SRobert Watson struct mbuf *m; 728d4b5cae4SRobert Watson 729d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 730d4b5cae4SRobert Watson NWS_LOCK_ASSERT(nwsp); 731d4b5cae4SRobert Watson 732d4b5cae4SRobert Watson KASSERT(nwsp->nws_flags & NWS_RUNNING, 733d4b5cae4SRobert Watson ("%s(%u): not running", __func__, proto)); 734d4b5cae4SRobert Watson KASSERT(proto >= 0 && proto < NETISR_MAXPROT, 735d4b5cae4SRobert Watson ("%s(%u): invalid proto\n", __func__, proto)); 736d4b5cae4SRobert Watson 737d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 738d4b5cae4SRobert Watson if (npwp->nw_len == 0) 739d4b5cae4SRobert Watson return (0); 740d4b5cae4SRobert Watson 741d4b5cae4SRobert Watson /* 742d4b5cae4SRobert Watson * Move the global work queue to a thread-local work queue. 743d4b5cae4SRobert Watson * 744d4b5cae4SRobert Watson * Notice that this means the effective maximum length of the queue 745d4b5cae4SRobert Watson * is actually twice that of the maximum queue length specified in 746d4b5cae4SRobert Watson * the protocol registration call. 747d4b5cae4SRobert Watson */ 748d4b5cae4SRobert Watson handled = npwp->nw_len; 749d4b5cae4SRobert Watson local_npw = *npwp; 750d4b5cae4SRobert Watson npwp->nw_head = NULL; 751d4b5cae4SRobert Watson npwp->nw_tail = NULL; 752d4b5cae4SRobert Watson npwp->nw_len = 0; 753d4b5cae4SRobert Watson nwsp->nws_pendingbits &= ~(1 << proto); 754d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 755d4b5cae4SRobert Watson while ((m = local_npw.nw_head) != NULL) { 756d4b5cae4SRobert Watson local_npw.nw_head = m->m_nextpkt; 757d4b5cae4SRobert Watson m->m_nextpkt = NULL; 758d4b5cae4SRobert Watson if (local_npw.nw_head == NULL) 759d4b5cae4SRobert Watson local_npw.nw_tail = NULL; 760d4b5cae4SRobert Watson local_npw.nw_len--; 7610028e524SBjoern A. Zeeb VNET_ASSERT(m->m_pkthdr.rcvif != NULL, 7620028e524SBjoern A. Zeeb ("%s:%d rcvif == NULL: m=%p", __func__, __LINE__, m)); 763d4b5cae4SRobert Watson CURVNET_SET(m->m_pkthdr.rcvif->if_vnet); 764938448cdSRobert Watson netisr_proto[proto].np_handler(m); 765d4b5cae4SRobert Watson CURVNET_RESTORE(); 766d4b5cae4SRobert Watson } 767d4b5cae4SRobert Watson KASSERT(local_npw.nw_len == 0, 768d4b5cae4SRobert Watson ("%s(%u): len %u", __func__, proto, local_npw.nw_len)); 769938448cdSRobert Watson if (netisr_proto[proto].np_drainedcpu) 770938448cdSRobert Watson netisr_proto[proto].np_drainedcpu(nwsp->nws_cpu); 771d4b5cae4SRobert Watson NWS_LOCK(nwsp); 772d4b5cae4SRobert Watson npwp->nw_handled += handled; 773d4b5cae4SRobert Watson return (handled); 774d4b5cae4SRobert Watson } 775d4b5cae4SRobert Watson 776d4b5cae4SRobert Watson /* 7770a32e29fSRobert Watson * SWI handler for netisr -- processes packets in a set of workstreams that 778d4b5cae4SRobert Watson * it owns, woken up by calls to NWS_SIGNAL(). If this workstream is already 779d4b5cae4SRobert Watson * being direct dispatched, go back to sleep and wait for the dispatching 780d4b5cae4SRobert Watson * thread to wake us up again. 781d4b5cae4SRobert Watson */ 782d4b5cae4SRobert Watson static void 783d4b5cae4SRobert Watson swi_net(void *arg) 784d4b5cae4SRobert Watson { 785d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 786d4b5cae4SRobert Watson struct rm_priotracker tracker; 787d4b5cae4SRobert Watson #endif 788d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 789d4b5cae4SRobert Watson u_int bits, prot; 790d4b5cae4SRobert Watson 791d4b5cae4SRobert Watson nwsp = arg; 792d4b5cae4SRobert Watson 7931cafed39SJonathan Lemon #ifdef DEVICE_POLLING 794d4b5cae4SRobert Watson KASSERT(nws_count == 1, 795d4b5cae4SRobert Watson ("%s: device_polling but nws_count != 1", __func__)); 796d4b5cae4SRobert Watson netisr_poll(); 797d4b5cae4SRobert Watson #endif 798d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 799d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 800d4b5cae4SRobert Watson #endif 801d4b5cae4SRobert Watson NWS_LOCK(nwsp); 802d4b5cae4SRobert Watson KASSERT(!(nwsp->nws_flags & NWS_RUNNING), ("swi_net: running")); 803d4b5cae4SRobert Watson if (nwsp->nws_flags & NWS_DISPATCHING) 804d4b5cae4SRobert Watson goto out; 805d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_RUNNING; 806d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_SCHEDULED; 807d4b5cae4SRobert Watson while ((bits = nwsp->nws_pendingbits) != 0) { 808d4b5cae4SRobert Watson while ((prot = ffs(bits)) != 0) { 809d4b5cae4SRobert Watson prot--; 810d4b5cae4SRobert Watson bits &= ~(1 << prot); 811d4b5cae4SRobert Watson (void)netisr_process_workstream_proto(nwsp, prot); 812d4b5cae4SRobert Watson } 813d4b5cae4SRobert Watson } 814d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_RUNNING; 815d4b5cae4SRobert Watson out: 816d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 817d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 818d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 819d4b5cae4SRobert Watson #endif 820d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 821d4b5cae4SRobert Watson netisr_pollmore(); 822d4b5cae4SRobert Watson #endif 823d4b5cae4SRobert Watson } 824d4b5cae4SRobert Watson 825d4b5cae4SRobert Watson static int 826d4b5cae4SRobert Watson netisr_queue_workstream(struct netisr_workstream *nwsp, u_int proto, 827d4b5cae4SRobert Watson struct netisr_work *npwp, struct mbuf *m, int *dosignalp) 828d4b5cae4SRobert Watson { 829d4b5cae4SRobert Watson 830d4b5cae4SRobert Watson NWS_LOCK_ASSERT(nwsp); 831d4b5cae4SRobert Watson 832d4b5cae4SRobert Watson *dosignalp = 0; 833d4b5cae4SRobert Watson if (npwp->nw_len < npwp->nw_qlimit) { 834d4b5cae4SRobert Watson m->m_nextpkt = NULL; 835d4b5cae4SRobert Watson if (npwp->nw_head == NULL) { 836d4b5cae4SRobert Watson npwp->nw_head = m; 837d4b5cae4SRobert Watson npwp->nw_tail = m; 838d4b5cae4SRobert Watson } else { 839d4b5cae4SRobert Watson npwp->nw_tail->m_nextpkt = m; 840d4b5cae4SRobert Watson npwp->nw_tail = m; 841d4b5cae4SRobert Watson } 842d4b5cae4SRobert Watson npwp->nw_len++; 843d4b5cae4SRobert Watson if (npwp->nw_len > npwp->nw_watermark) 844d4b5cae4SRobert Watson npwp->nw_watermark = npwp->nw_len; 8450a32e29fSRobert Watson 8460a32e29fSRobert Watson /* 8470a32e29fSRobert Watson * We must set the bit regardless of NWS_RUNNING, so that 8480a32e29fSRobert Watson * swi_net() keeps calling netisr_process_workstream_proto(). 8490a32e29fSRobert Watson */ 850d4b5cae4SRobert Watson nwsp->nws_pendingbits |= (1 << proto); 851d4b5cae4SRobert Watson if (!(nwsp->nws_flags & 852d4b5cae4SRobert Watson (NWS_RUNNING | NWS_DISPATCHING | NWS_SCHEDULED))) { 853d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_SCHEDULED; 854d4b5cae4SRobert Watson *dosignalp = 1; /* Defer until unlocked. */ 855d4b5cae4SRobert Watson } 856d4b5cae4SRobert Watson npwp->nw_queued++; 857d4b5cae4SRobert Watson return (0); 858d4b5cae4SRobert Watson } else { 859ba3b25b3SBjoern A. Zeeb m_freem(m); 860d4b5cae4SRobert Watson npwp->nw_qdrops++; 861d4b5cae4SRobert Watson return (ENOBUFS); 862d4b5cae4SRobert Watson } 863d4b5cae4SRobert Watson } 864d4b5cae4SRobert Watson 865d4b5cae4SRobert Watson static int 866d4b5cae4SRobert Watson netisr_queue_internal(u_int proto, struct mbuf *m, u_int cpuid) 867d4b5cae4SRobert Watson { 868d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 869d4b5cae4SRobert Watson struct netisr_work *npwp; 870d4b5cae4SRobert Watson int dosignal, error; 871d4b5cae4SRobert Watson 872d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 873d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 874d4b5cae4SRobert Watson #endif 8759e6e01ebSRobert Watson KASSERT(cpuid <= mp_maxid, ("%s: cpuid too big (%u, %u)", __func__, 8769e6e01ebSRobert Watson cpuid, mp_maxid)); 87753402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 878d4b5cae4SRobert Watson 879d4b5cae4SRobert Watson dosignal = 0; 880d4b5cae4SRobert Watson error = 0; 88153402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 882d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 883d4b5cae4SRobert Watson NWS_LOCK(nwsp); 884d4b5cae4SRobert Watson error = netisr_queue_workstream(nwsp, proto, npwp, m, &dosignal); 885d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 886d4b5cae4SRobert Watson if (dosignal) 887d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 888d4b5cae4SRobert Watson return (error); 889d4b5cae4SRobert Watson } 890d4b5cae4SRobert Watson 891d4b5cae4SRobert Watson int 892d4b5cae4SRobert Watson netisr_queue_src(u_int proto, uintptr_t source, struct mbuf *m) 893d4b5cae4SRobert Watson { 894d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 895d4b5cae4SRobert Watson struct rm_priotracker tracker; 896d4b5cae4SRobert Watson #endif 897d4b5cae4SRobert Watson u_int cpuid; 898d4b5cae4SRobert Watson int error; 899d4b5cae4SRobert Watson 900d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 901d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 902d4b5cae4SRobert Watson 903d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 904d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 905d4b5cae4SRobert Watson #endif 906938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 907d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 908d4b5cae4SRobert Watson 909f2d2d694SRobert Watson m = netisr_select_cpuid(&netisr_proto[proto], NETISR_DISPATCH_DEFERRED, 910f2d2d694SRobert Watson source, m, &cpuid); 91153402767SRobert Watson if (m != NULL) { 91253402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, 91353402767SRobert Watson cpuid)); 914d4b5cae4SRobert Watson error = netisr_queue_internal(proto, m, cpuid); 91553402767SRobert Watson } else 916d4b5cae4SRobert Watson error = ENOBUFS; 917d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 918d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 919d4b5cae4SRobert Watson #endif 920d4b5cae4SRobert Watson return (error); 921d4b5cae4SRobert Watson } 922d4b5cae4SRobert Watson 923d4b5cae4SRobert Watson int 924d4b5cae4SRobert Watson netisr_queue(u_int proto, struct mbuf *m) 925d4b5cae4SRobert Watson { 926d4b5cae4SRobert Watson 927d4b5cae4SRobert Watson return (netisr_queue_src(proto, 0, m)); 928d4b5cae4SRobert Watson } 929d4b5cae4SRobert Watson 930d4b5cae4SRobert Watson /* 9310a32e29fSRobert Watson * Dispatch a packet for netisr processing; direct dispatch is permitted by 932d4b5cae4SRobert Watson * calling context. 933d4b5cae4SRobert Watson */ 934d4b5cae4SRobert Watson int 935d4b5cae4SRobert Watson netisr_dispatch_src(u_int proto, uintptr_t source, struct mbuf *m) 936d4b5cae4SRobert Watson { 937d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 938d4b5cae4SRobert Watson struct rm_priotracker tracker; 939d4b5cae4SRobert Watson #endif 940d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 941f2d2d694SRobert Watson struct netisr_proto *npp; 942d4b5cae4SRobert Watson struct netisr_work *npwp; 943d4b5cae4SRobert Watson int dosignal, error; 944f2d2d694SRobert Watson u_int cpuid, dispatch_policy; 945d4b5cae4SRobert Watson 946d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 947d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 948d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 949d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 950d4b5cae4SRobert Watson #endif 951f2d2d694SRobert Watson npp = &netisr_proto[proto]; 952f2d2d694SRobert Watson KASSERT(npp->np_handler != NULL, ("%s: invalid proto %u", __func__, 953f2d2d694SRobert Watson proto)); 954f2d2d694SRobert Watson 955f2d2d694SRobert Watson dispatch_policy = netisr_get_dispatch(npp); 956f2d2d694SRobert Watson if (dispatch_policy == NETISR_DISPATCH_DEFERRED) 957f2d2d694SRobert Watson return (netisr_queue_src(proto, source, m)); 958d4b5cae4SRobert Watson 959d4b5cae4SRobert Watson /* 960d4b5cae4SRobert Watson * If direct dispatch is forced, then unconditionally dispatch 961d4b5cae4SRobert Watson * without a formal CPU selection. Borrow the current CPU's stats, 962d4b5cae4SRobert Watson * even if there's no worker on it. In this case we don't update 963d4b5cae4SRobert Watson * nws_flags because all netisr processing will be source ordered due 964d4b5cae4SRobert Watson * to always being forced to directly dispatch. 965d4b5cae4SRobert Watson */ 966f2d2d694SRobert Watson if (dispatch_policy == NETISR_DISPATCH_DIRECT) { 96753402767SRobert Watson nwsp = DPCPU_PTR(nws); 968d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 969d4b5cae4SRobert Watson npwp->nw_dispatched++; 970d4b5cae4SRobert Watson npwp->nw_handled++; 971938448cdSRobert Watson netisr_proto[proto].np_handler(m); 972d4b5cae4SRobert Watson error = 0; 973d4b5cae4SRobert Watson goto out_unlock; 974d4b5cae4SRobert Watson } 975d4b5cae4SRobert Watson 976f2d2d694SRobert Watson KASSERT(dispatch_policy == NETISR_DISPATCH_HYBRID, 977f2d2d694SRobert Watson ("%s: unknown dispatch policy (%u)", __func__, dispatch_policy)); 978f2d2d694SRobert Watson 979d4b5cae4SRobert Watson /* 980d4b5cae4SRobert Watson * Otherwise, we execute in a hybrid mode where we will try to direct 981d4b5cae4SRobert Watson * dispatch if we're on the right CPU and the netisr worker isn't 982d4b5cae4SRobert Watson * already running. 983d4b5cae4SRobert Watson */ 984f2d2d694SRobert Watson sched_pin(); 985f2d2d694SRobert Watson m = netisr_select_cpuid(&netisr_proto[proto], NETISR_DISPATCH_HYBRID, 986f2d2d694SRobert Watson source, m, &cpuid); 987d4b5cae4SRobert Watson if (m == NULL) { 988d4b5cae4SRobert Watson error = ENOBUFS; 989f2d2d694SRobert Watson goto out_unpin; 990d4b5cae4SRobert Watson } 99153402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 992d4b5cae4SRobert Watson if (cpuid != curcpu) 993d4b5cae4SRobert Watson goto queue_fallback; 99453402767SRobert Watson nwsp = DPCPU_PTR(nws); 995d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 996d4b5cae4SRobert Watson 997d4b5cae4SRobert Watson /*- 998d4b5cae4SRobert Watson * We are willing to direct dispatch only if three conditions hold: 999d4b5cae4SRobert Watson * 1000d4b5cae4SRobert Watson * (1) The netisr worker isn't already running, 1001d4b5cae4SRobert Watson * (2) Another thread isn't already directly dispatching, and 1002d4b5cae4SRobert Watson * (3) The netisr hasn't already been woken up. 1003d4b5cae4SRobert Watson */ 1004d4b5cae4SRobert Watson NWS_LOCK(nwsp); 1005d4b5cae4SRobert Watson if (nwsp->nws_flags & (NWS_RUNNING | NWS_DISPATCHING | NWS_SCHEDULED)) { 1006d4b5cae4SRobert Watson error = netisr_queue_workstream(nwsp, proto, npwp, m, 1007d4b5cae4SRobert Watson &dosignal); 100853402767SRobert Watson NWS_UNLOCK(nwsp); 1009d4b5cae4SRobert Watson if (dosignal) 1010d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 1011d4b5cae4SRobert Watson goto out_unpin; 1012d4b5cae4SRobert Watson } 1013d4b5cae4SRobert Watson 1014d4b5cae4SRobert Watson /* 1015d4b5cae4SRobert Watson * The current thread is now effectively the netisr worker, so set 1016d4b5cae4SRobert Watson * the dispatching flag to prevent concurrent processing of the 1017d4b5cae4SRobert Watson * stream from another thread (even the netisr worker), which could 1018d4b5cae4SRobert Watson * otherwise lead to effective misordering of the stream. 1019d4b5cae4SRobert Watson */ 1020d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_DISPATCHING; 1021d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 1022938448cdSRobert Watson netisr_proto[proto].np_handler(m); 1023d4b5cae4SRobert Watson NWS_LOCK(nwsp); 1024d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_DISPATCHING; 1025d4b5cae4SRobert Watson npwp->nw_handled++; 1026d4b5cae4SRobert Watson npwp->nw_hybrid_dispatched++; 1027d4b5cae4SRobert Watson 1028d4b5cae4SRobert Watson /* 1029d4b5cae4SRobert Watson * If other work was enqueued by another thread while we were direct 1030d4b5cae4SRobert Watson * dispatching, we need to signal the netisr worker to do that work. 1031d4b5cae4SRobert Watson * In the future, we might want to do some of that work in the 1032d4b5cae4SRobert Watson * current thread, rather than trigger further context switches. If 1033d4b5cae4SRobert Watson * so, we'll want to establish a reasonable bound on the work done in 1034d4b5cae4SRobert Watson * the "borrowed" context. 1035d4b5cae4SRobert Watson */ 1036d4b5cae4SRobert Watson if (nwsp->nws_pendingbits != 0) { 1037d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_SCHEDULED; 1038d4b5cae4SRobert Watson dosignal = 1; 1039d4b5cae4SRobert Watson } else 1040d4b5cae4SRobert Watson dosignal = 0; 1041d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 1042d4b5cae4SRobert Watson if (dosignal) 1043d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 1044d4b5cae4SRobert Watson error = 0; 1045d4b5cae4SRobert Watson goto out_unpin; 1046d4b5cae4SRobert Watson 1047d4b5cae4SRobert Watson queue_fallback: 1048d4b5cae4SRobert Watson error = netisr_queue_internal(proto, m, cpuid); 1049d4b5cae4SRobert Watson out_unpin: 1050d4b5cae4SRobert Watson sched_unpin(); 1051d4b5cae4SRobert Watson out_unlock: 1052d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 1053d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 1054d4b5cae4SRobert Watson #endif 1055d4b5cae4SRobert Watson return (error); 1056d4b5cae4SRobert Watson } 1057d4b5cae4SRobert Watson 1058d4b5cae4SRobert Watson int 1059d4b5cae4SRobert Watson netisr_dispatch(u_int proto, struct mbuf *m) 1060d4b5cae4SRobert Watson { 1061d4b5cae4SRobert Watson 1062d4b5cae4SRobert Watson return (netisr_dispatch_src(proto, 0, m)); 1063d4b5cae4SRobert Watson } 1064d4b5cae4SRobert Watson 1065d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 1066d4b5cae4SRobert Watson /* 1067d4b5cae4SRobert Watson * Kernel polling borrows a netisr thread to run interface polling in; this 1068d4b5cae4SRobert Watson * function allows kernel polling to request that the netisr thread be 1069d4b5cae4SRobert Watson * scheduled even if no packets are pending for protocols. 1070d4b5cae4SRobert Watson */ 1071d4b5cae4SRobert Watson void 1072d4b5cae4SRobert Watson netisr_sched_poll(void) 1073d4b5cae4SRobert Watson { 1074d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1075d4b5cae4SRobert Watson 107653402767SRobert Watson nwsp = DPCPU_ID_PTR(nws_array[0], nws); 1077d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 1078d4b5cae4SRobert Watson } 10791cafed39SJonathan Lemon #endif 1080e3b6e33cSJake Burkholder 1081d4b5cae4SRobert Watson static void 1082d4b5cae4SRobert Watson netisr_start_swi(u_int cpuid, struct pcpu *pc) 1083d4b5cae4SRobert Watson { 1084d4b5cae4SRobert Watson char swiname[12]; 1085d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1086d4b5cae4SRobert Watson int error; 1087d4b5cae4SRobert Watson 108853402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 108953402767SRobert Watson 109053402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 1091d4b5cae4SRobert Watson mtx_init(&nwsp->nws_mtx, "netisr_mtx", NULL, MTX_DEF); 1092d4b5cae4SRobert Watson nwsp->nws_cpu = cpuid; 1093d4b5cae4SRobert Watson snprintf(swiname, sizeof(swiname), "netisr %u", cpuid); 1094d4b5cae4SRobert Watson error = swi_add(&nwsp->nws_intr_event, swiname, swi_net, nwsp, 1095d4b5cae4SRobert Watson SWI_NET, INTR_MPSAFE, &nwsp->nws_swi_cookie); 1096d4b5cae4SRobert Watson if (error) 1097d4b5cae4SRobert Watson panic("%s: swi_add %d", __func__, error); 1098d4b5cae4SRobert Watson pc->pc_netisr = nwsp->nws_intr_event; 1099d4b5cae4SRobert Watson if (netisr_bindthreads) { 1100d4b5cae4SRobert Watson error = intr_event_bind(nwsp->nws_intr_event, cpuid); 1101d4b5cae4SRobert Watson if (error != 0) 1102d4b5cae4SRobert Watson printf("%s: cpu %u: intr_event_bind: %d", __func__, 1103d4b5cae4SRobert Watson cpuid, error); 1104e3b6e33cSJake Burkholder } 1105d4b5cae4SRobert Watson NETISR_WLOCK(); 1106d4b5cae4SRobert Watson nws_array[nws_count] = nwsp->nws_cpu; 1107d4b5cae4SRobert Watson nws_count++; 1108d4b5cae4SRobert Watson NETISR_WUNLOCK(); 1109e3b6e33cSJake Burkholder } 1110e3b6e33cSJake Burkholder 1111d4b5cae4SRobert Watson /* 1112d4b5cae4SRobert Watson * Initialize the netisr subsystem. We rely on BSS and static initialization 1113d4b5cae4SRobert Watson * of most fields in global data structures. 1114d4b5cae4SRobert Watson * 1115d4b5cae4SRobert Watson * Start a worker thread for the boot CPU so that we can support network 1116d4b5cae4SRobert Watson * traffic immediately in case the network stack is used before additional 1117d4b5cae4SRobert Watson * CPUs are started (for example, diskless boot). 1118d4b5cae4SRobert Watson */ 1119e3b6e33cSJake Burkholder static void 1120d4b5cae4SRobert Watson netisr_init(void *arg) 1121e3b6e33cSJake Burkholder { 1122*fdce57a0SJohn Baldwin #ifdef EARLY_AP_STARTUP 1123*fdce57a0SJohn Baldwin struct pcpu *pc; 1124*fdce57a0SJohn Baldwin #endif 1125*fdce57a0SJohn Baldwin 1126d4b5cae4SRobert Watson KASSERT(curcpu == 0, ("%s: not on CPU 0", __func__)); 1127d4b5cae4SRobert Watson 1128d4b5cae4SRobert Watson NETISR_LOCK_INIT(); 1129a9467c3cSHiren Panchasara if (netisr_maxthreads == 0 || netisr_maxthreads < -1 ) 1130a9467c3cSHiren Panchasara netisr_maxthreads = 1; /* default behavior */ 1131a9467c3cSHiren Panchasara else if (netisr_maxthreads == -1) 1132a9467c3cSHiren Panchasara netisr_maxthreads = mp_ncpus; /* use max cpus */ 11339e6e01ebSRobert Watson if (netisr_maxthreads > mp_ncpus) { 1134912f6323SRobert Watson printf("netisr_init: forcing maxthreads from %d to %d\n", 11359e6e01ebSRobert Watson netisr_maxthreads, mp_ncpus); 11369e6e01ebSRobert Watson netisr_maxthreads = mp_ncpus; 1137ed54411cSRobert Watson } 1138ed54411cSRobert Watson if (netisr_defaultqlimit > netisr_maxqlimit) { 1139912f6323SRobert Watson printf("netisr_init: forcing defaultqlimit from %d to %d\n", 11409e6e01ebSRobert Watson netisr_defaultqlimit, netisr_maxqlimit); 1141d4b5cae4SRobert Watson netisr_defaultqlimit = netisr_maxqlimit; 1142ed54411cSRobert Watson } 1143d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 1144d4b5cae4SRobert Watson /* 1145d4b5cae4SRobert Watson * The device polling code is not yet aware of how to deal with 1146d4b5cae4SRobert Watson * multiple netisr threads, so for the time being compiling in device 1147d4b5cae4SRobert Watson * polling disables parallel netisr workers. 1148d4b5cae4SRobert Watson */ 114951d4054eSGeorge V. Neville-Neil if (netisr_maxthreads != 1 || netisr_bindthreads != 0) { 1150912f6323SRobert Watson printf("netisr_init: forcing maxthreads to 1 and " 1151912f6323SRobert Watson "bindthreads to 0 for device polling\n"); 1152d4b5cae4SRobert Watson netisr_maxthreads = 1; 1153d4b5cae4SRobert Watson netisr_bindthreads = 0; 1154ed54411cSRobert Watson } 1155d4b5cae4SRobert Watson #endif 1156*fdce57a0SJohn Baldwin 1157*fdce57a0SJohn Baldwin #ifdef EARLY_AP_STARTUP 1158*fdce57a0SJohn Baldwin STAILQ_FOREACH(pc, &cpuhead, pc_allcpu) { 1159*fdce57a0SJohn Baldwin if (nws_count >= netisr_maxthreads) 1160*fdce57a0SJohn Baldwin break; 1161*fdce57a0SJohn Baldwin netisr_start_swi(pc->pc_cpuid, pc); 1162*fdce57a0SJohn Baldwin } 1163*fdce57a0SJohn Baldwin #else 1164d4b5cae4SRobert Watson netisr_start_swi(curcpu, pcpu_find(curcpu)); 1165*fdce57a0SJohn Baldwin #endif 1166e3b6e33cSJake Burkholder } 1167d4b5cae4SRobert Watson SYSINIT(netisr_init, SI_SUB_SOFTINTR, SI_ORDER_FIRST, netisr_init, NULL); 1168d4b5cae4SRobert Watson 1169*fdce57a0SJohn Baldwin #ifndef EARLY_AP_STARTUP 1170d4b5cae4SRobert Watson /* 1171d4b5cae4SRobert Watson * Start worker threads for additional CPUs. No attempt to gracefully handle 1172d4b5cae4SRobert Watson * work reassignment, we don't yet support dynamic reconfiguration. 1173d4b5cae4SRobert Watson */ 1174d4b5cae4SRobert Watson static void 1175d4b5cae4SRobert Watson netisr_start(void *arg) 1176d4b5cae4SRobert Watson { 1177d4b5cae4SRobert Watson struct pcpu *pc; 1178d4b5cae4SRobert Watson 1179d098f930SNathan Whitehorn STAILQ_FOREACH(pc, &cpuhead, pc_allcpu) { 1180d4b5cae4SRobert Watson if (nws_count >= netisr_maxthreads) 1181d4b5cae4SRobert Watson break; 1182d4b5cae4SRobert Watson /* Worker will already be present for boot CPU. */ 1183d4b5cae4SRobert Watson if (pc->pc_netisr != NULL) 1184d4b5cae4SRobert Watson continue; 1185d4b5cae4SRobert Watson netisr_start_swi(pc->pc_cpuid, pc); 1186d4b5cae4SRobert Watson } 1187d4b5cae4SRobert Watson } 1188d4b5cae4SRobert Watson SYSINIT(netisr_start, SI_SUB_SMP, SI_ORDER_MIDDLE, netisr_start, NULL); 1189*fdce57a0SJohn Baldwin #endif 1190d4b5cae4SRobert Watson 11912d22f334SRobert Watson /* 11922d22f334SRobert Watson * Sysctl monitoring for netisr: query a list of registered protocols. 11932d22f334SRobert Watson */ 11942d22f334SRobert Watson static int 11952d22f334SRobert Watson sysctl_netisr_proto(SYSCTL_HANDLER_ARGS) 11962d22f334SRobert Watson { 11972d22f334SRobert Watson struct rm_priotracker tracker; 11982d22f334SRobert Watson struct sysctl_netisr_proto *snpp, *snp_array; 11992d22f334SRobert Watson struct netisr_proto *npp; 12002d22f334SRobert Watson u_int counter, proto; 12012d22f334SRobert Watson int error; 12022d22f334SRobert Watson 12032d22f334SRobert Watson if (req->newptr != NULL) 12042d22f334SRobert Watson return (EINVAL); 12052d22f334SRobert Watson snp_array = malloc(sizeof(*snp_array) * NETISR_MAXPROT, M_TEMP, 12062d22f334SRobert Watson M_ZERO | M_WAITOK); 12072d22f334SRobert Watson counter = 0; 12082d22f334SRobert Watson NETISR_RLOCK(&tracker); 12092d22f334SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1210938448cdSRobert Watson npp = &netisr_proto[proto]; 12112d22f334SRobert Watson if (npp->np_name == NULL) 12122d22f334SRobert Watson continue; 12132d22f334SRobert Watson snpp = &snp_array[counter]; 12142d22f334SRobert Watson snpp->snp_version = sizeof(*snpp); 12152d22f334SRobert Watson strlcpy(snpp->snp_name, npp->np_name, NETISR_NAMEMAXLEN); 12162d22f334SRobert Watson snpp->snp_proto = proto; 12172d22f334SRobert Watson snpp->snp_qlimit = npp->np_qlimit; 12182d22f334SRobert Watson snpp->snp_policy = npp->np_policy; 1219f2d2d694SRobert Watson snpp->snp_dispatch = npp->np_dispatch; 12202d22f334SRobert Watson if (npp->np_m2flow != NULL) 12212d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_M2FLOW; 12222d22f334SRobert Watson if (npp->np_m2cpuid != NULL) 12232d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_M2CPUID; 12242d22f334SRobert Watson if (npp->np_drainedcpu != NULL) 12252d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_DRAINEDCPU; 12262d22f334SRobert Watson counter++; 12272d22f334SRobert Watson } 12282d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 12297f450febSRobert Watson KASSERT(counter <= NETISR_MAXPROT, 12302d22f334SRobert Watson ("sysctl_netisr_proto: counter too big (%d)", counter)); 12312d22f334SRobert Watson error = SYSCTL_OUT(req, snp_array, sizeof(*snp_array) * counter); 12322d22f334SRobert Watson free(snp_array, M_TEMP); 12332d22f334SRobert Watson return (error); 12342d22f334SRobert Watson } 12352d22f334SRobert Watson 12362d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, proto, 12372d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_proto, 12382d22f334SRobert Watson "S,sysctl_netisr_proto", 12392d22f334SRobert Watson "Return list of protocols registered with netisr"); 12402d22f334SRobert Watson 12412d22f334SRobert Watson /* 12422d22f334SRobert Watson * Sysctl monitoring for netisr: query a list of workstreams. 12432d22f334SRobert Watson */ 12442d22f334SRobert Watson static int 12452d22f334SRobert Watson sysctl_netisr_workstream(SYSCTL_HANDLER_ARGS) 12462d22f334SRobert Watson { 12472d22f334SRobert Watson struct rm_priotracker tracker; 12482d22f334SRobert Watson struct sysctl_netisr_workstream *snwsp, *snws_array; 12492d22f334SRobert Watson struct netisr_workstream *nwsp; 12502d22f334SRobert Watson u_int counter, cpuid; 12512d22f334SRobert Watson int error; 12522d22f334SRobert Watson 12532d22f334SRobert Watson if (req->newptr != NULL) 12542d22f334SRobert Watson return (EINVAL); 12552d22f334SRobert Watson snws_array = malloc(sizeof(*snws_array) * MAXCPU, M_TEMP, 12562d22f334SRobert Watson M_ZERO | M_WAITOK); 12572d22f334SRobert Watson counter = 0; 12582d22f334SRobert Watson NETISR_RLOCK(&tracker); 12593aa6d94eSJohn Baldwin CPU_FOREACH(cpuid) { 12602d22f334SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 12612d22f334SRobert Watson if (nwsp->nws_intr_event == NULL) 12622d22f334SRobert Watson continue; 12632d22f334SRobert Watson NWS_LOCK(nwsp); 12642d22f334SRobert Watson snwsp = &snws_array[counter]; 12652d22f334SRobert Watson snwsp->snws_version = sizeof(*snwsp); 12662d22f334SRobert Watson 12672d22f334SRobert Watson /* 12682d22f334SRobert Watson * For now, we equate workstream IDs and CPU IDs in the 12692d22f334SRobert Watson * kernel, but expose them independently to userspace in case 12702d22f334SRobert Watson * that assumption changes in the future. 12712d22f334SRobert Watson */ 12722d22f334SRobert Watson snwsp->snws_wsid = cpuid; 12732d22f334SRobert Watson snwsp->snws_cpu = cpuid; 12742d22f334SRobert Watson if (nwsp->nws_intr_event != NULL) 12752d22f334SRobert Watson snwsp->snws_flags |= NETISR_SNWS_FLAGS_INTR; 12762d22f334SRobert Watson NWS_UNLOCK(nwsp); 12772d22f334SRobert Watson counter++; 12782d22f334SRobert Watson } 12792d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 12807f450febSRobert Watson KASSERT(counter <= MAXCPU, 12812d22f334SRobert Watson ("sysctl_netisr_workstream: counter too big (%d)", counter)); 12822d22f334SRobert Watson error = SYSCTL_OUT(req, snws_array, sizeof(*snws_array) * counter); 12832d22f334SRobert Watson free(snws_array, M_TEMP); 12842d22f334SRobert Watson return (error); 12852d22f334SRobert Watson } 12862d22f334SRobert Watson 12872d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, workstream, 12882d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_workstream, 12892d22f334SRobert Watson "S,sysctl_netisr_workstream", 12902d22f334SRobert Watson "Return list of workstreams implemented by netisr"); 12912d22f334SRobert Watson 12922d22f334SRobert Watson /* 12932d22f334SRobert Watson * Sysctl monitoring for netisr: query per-protocol data across all 12942d22f334SRobert Watson * workstreams. 12952d22f334SRobert Watson */ 12962d22f334SRobert Watson static int 12972d22f334SRobert Watson sysctl_netisr_work(SYSCTL_HANDLER_ARGS) 12982d22f334SRobert Watson { 12992d22f334SRobert Watson struct rm_priotracker tracker; 13002d22f334SRobert Watson struct sysctl_netisr_work *snwp, *snw_array; 13012d22f334SRobert Watson struct netisr_workstream *nwsp; 13022d22f334SRobert Watson struct netisr_proto *npp; 13032d22f334SRobert Watson struct netisr_work *nwp; 13042d22f334SRobert Watson u_int counter, cpuid, proto; 13052d22f334SRobert Watson int error; 13062d22f334SRobert Watson 13072d22f334SRobert Watson if (req->newptr != NULL) 13082d22f334SRobert Watson return (EINVAL); 13092d22f334SRobert Watson snw_array = malloc(sizeof(*snw_array) * MAXCPU * NETISR_MAXPROT, 13102d22f334SRobert Watson M_TEMP, M_ZERO | M_WAITOK); 13112d22f334SRobert Watson counter = 0; 13122d22f334SRobert Watson NETISR_RLOCK(&tracker); 13133aa6d94eSJohn Baldwin CPU_FOREACH(cpuid) { 13142d22f334SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 13152d22f334SRobert Watson if (nwsp->nws_intr_event == NULL) 13162d22f334SRobert Watson continue; 13172d22f334SRobert Watson NWS_LOCK(nwsp); 13182d22f334SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1319938448cdSRobert Watson npp = &netisr_proto[proto]; 13202d22f334SRobert Watson if (npp->np_name == NULL) 13212d22f334SRobert Watson continue; 13222d22f334SRobert Watson nwp = &nwsp->nws_work[proto]; 13232d22f334SRobert Watson snwp = &snw_array[counter]; 13242d22f334SRobert Watson snwp->snw_version = sizeof(*snwp); 13252d22f334SRobert Watson snwp->snw_wsid = cpuid; /* See comment above. */ 13262d22f334SRobert Watson snwp->snw_proto = proto; 13272d22f334SRobert Watson snwp->snw_len = nwp->nw_len; 13282d22f334SRobert Watson snwp->snw_watermark = nwp->nw_watermark; 13292d22f334SRobert Watson snwp->snw_dispatched = nwp->nw_dispatched; 13302d22f334SRobert Watson snwp->snw_hybrid_dispatched = 13312d22f334SRobert Watson nwp->nw_hybrid_dispatched; 13322d22f334SRobert Watson snwp->snw_qdrops = nwp->nw_qdrops; 13332d22f334SRobert Watson snwp->snw_queued = nwp->nw_queued; 13342d22f334SRobert Watson snwp->snw_handled = nwp->nw_handled; 13352d22f334SRobert Watson counter++; 13362d22f334SRobert Watson } 13372d22f334SRobert Watson NWS_UNLOCK(nwsp); 13382d22f334SRobert Watson } 13397f450febSRobert Watson KASSERT(counter <= MAXCPU * NETISR_MAXPROT, 13402d22f334SRobert Watson ("sysctl_netisr_work: counter too big (%d)", counter)); 13412d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 13422d22f334SRobert Watson error = SYSCTL_OUT(req, snw_array, sizeof(*snw_array) * counter); 13432d22f334SRobert Watson free(snw_array, M_TEMP); 13442d22f334SRobert Watson return (error); 13452d22f334SRobert Watson } 13462d22f334SRobert Watson 13472d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, work, 13482d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_work, 13492d22f334SRobert Watson "S,sysctl_netisr_work", 13502d22f334SRobert Watson "Return list of per-workstream, per-protocol work in netisr"); 13512d22f334SRobert Watson 1352d4b5cae4SRobert Watson #ifdef DDB 1353d4b5cae4SRobert Watson DB_SHOW_COMMAND(netisr, db_show_netisr) 1354d4b5cae4SRobert Watson { 1355d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1356d4b5cae4SRobert Watson struct netisr_work *nwp; 1357d4b5cae4SRobert Watson int first, proto; 135853402767SRobert Watson u_int cpuid; 1359d4b5cae4SRobert Watson 1360d4b5cae4SRobert Watson db_printf("%3s %6s %5s %5s %5s %8s %8s %8s %8s\n", "CPU", "Proto", 1361d4b5cae4SRobert Watson "Len", "WMark", "Max", "Disp", "HDisp", "Drop", "Queue"); 13623aa6d94eSJohn Baldwin CPU_FOREACH(cpuid) { 136353402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 1364d4b5cae4SRobert Watson if (nwsp->nws_intr_event == NULL) 1365d4b5cae4SRobert Watson continue; 1366d4b5cae4SRobert Watson first = 1; 1367d4b5cae4SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1368938448cdSRobert Watson if (netisr_proto[proto].np_handler == NULL) 1369d4b5cae4SRobert Watson continue; 1370d4b5cae4SRobert Watson nwp = &nwsp->nws_work[proto]; 1371d4b5cae4SRobert Watson if (first) { 137253402767SRobert Watson db_printf("%3d ", cpuid); 1373d4b5cae4SRobert Watson first = 0; 1374d4b5cae4SRobert Watson } else 1375d4b5cae4SRobert Watson db_printf("%3s ", ""); 1376d4b5cae4SRobert Watson db_printf( 1377d4b5cae4SRobert Watson "%6s %5d %5d %5d %8ju %8ju %8ju %8ju\n", 1378938448cdSRobert Watson netisr_proto[proto].np_name, nwp->nw_len, 1379d4b5cae4SRobert Watson nwp->nw_watermark, nwp->nw_qlimit, 1380d4b5cae4SRobert Watson nwp->nw_dispatched, nwp->nw_hybrid_dispatched, 1381d4b5cae4SRobert Watson nwp->nw_qdrops, nwp->nw_queued); 1382d4b5cae4SRobert Watson } 1383d4b5cae4SRobert Watson } 1384d4b5cae4SRobert Watson } 1385d4b5cae4SRobert Watson #endif 1386