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> 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 90938448cdSRobert Watson #define _WANT_NETISR_INTERNAL /* Enable definitions from netisr_internal.h */ 911cafed39SJonathan Lemon #include <net/if.h> 921cafed39SJonathan Lemon #include <net/if_var.h> 93e3b6e33cSJake Burkholder #include <net/netisr.h> 94938448cdSRobert Watson #include <net/netisr_internal.h> 95530c0060SRobert Watson #include <net/vnet.h> 96e3b6e33cSJake Burkholder 97d4b5cae4SRobert Watson /*- 98d4b5cae4SRobert Watson * Synchronize use and modification of the registered netisr data structures; 99d4b5cae4SRobert Watson * acquire a read lock while modifying the set of registered protocols to 100d4b5cae4SRobert Watson * prevent partially registered or unregistered protocols from being run. 101d4b5cae4SRobert Watson * 102d4b5cae4SRobert Watson * The following data structures and fields are protected by this lock: 103d4b5cae4SRobert Watson * 104938448cdSRobert Watson * - The netisr_proto array, including all fields of struct netisr_proto. 105d4b5cae4SRobert Watson * - The nws array, including all fields of struct netisr_worker. 106d4b5cae4SRobert Watson * - The nws_array array. 107d4b5cae4SRobert Watson * 108d4b5cae4SRobert Watson * Note: the NETISR_LOCKING define controls whether read locks are acquired 109d4b5cae4SRobert Watson * in packet processing paths requiring netisr registration stability. This 1100a32e29fSRobert Watson * is disabled by default as it can lead to measurable performance 111d4b5cae4SRobert Watson * degradation even with rmlocks (3%-6% for loopback ping-pong traffic), and 112d4b5cae4SRobert Watson * because netisr registration and unregistration is extremely rare at 113d4b5cae4SRobert Watson * runtime. If it becomes more common, this decision should be revisited. 114d4b5cae4SRobert Watson * 115d4b5cae4SRobert Watson * XXXRW: rmlocks don't support assertions. 116d4b5cae4SRobert Watson */ 117d4b5cae4SRobert Watson static struct rmlock netisr_rmlock; 118d4b5cae4SRobert Watson #define NETISR_LOCK_INIT() rm_init_flags(&netisr_rmlock, "netisr", \ 119d4b5cae4SRobert Watson RM_NOWITNESS) 120d4b5cae4SRobert Watson #define NETISR_LOCK_ASSERT() 121d4b5cae4SRobert Watson #define NETISR_RLOCK(tracker) rm_rlock(&netisr_rmlock, (tracker)) 122d4b5cae4SRobert Watson #define NETISR_RUNLOCK(tracker) rm_runlock(&netisr_rmlock, (tracker)) 123d4b5cae4SRobert Watson #define NETISR_WLOCK() rm_wlock(&netisr_rmlock) 124d4b5cae4SRobert Watson #define NETISR_WUNLOCK() rm_wunlock(&netisr_rmlock) 125d4b5cae4SRobert Watson /* #define NETISR_LOCKING */ 126e3b6e33cSJake Burkholder 1276472ac3dSEd Schouten static SYSCTL_NODE(_net, OID_AUTO, isr, CTLFLAG_RW, 0, "netisr"); 1281cafed39SJonathan Lemon 129d4b5cae4SRobert Watson /*- 130f2d2d694SRobert Watson * Three global direct dispatch policies are supported: 131d4b5cae4SRobert Watson * 132da162ca8SSergey Kandaurov * NETISR_DISPATCH_DEFERRED: All work is deferred for a netisr, regardless of 133f2d2d694SRobert Watson * context (may be overriden by protocols). 134d4b5cae4SRobert Watson * 135f2d2d694SRobert Watson * NETISR_DISPATCH_HYBRID: If the executing context allows direct dispatch, 136f2d2d694SRobert Watson * and we're running on the CPU the work would be performed on, then direct 137f2d2d694SRobert Watson * dispatch it if it wouldn't violate ordering constraints on the workstream. 138d4b5cae4SRobert Watson * 139f2d2d694SRobert Watson * NETISR_DISPATCH_DIRECT: If the executing context allows direct dispatch, 140f2d2d694SRobert Watson * always direct dispatch. (The default.) 141d4b5cae4SRobert Watson * 142d4b5cae4SRobert Watson * Notice that changing the global policy could lead to short periods of 143d4b5cae4SRobert Watson * misordered processing, but this is considered acceptable as compared to 144f2d2d694SRobert Watson * the complexity of enforcing ordering during policy changes. Protocols can 145f2d2d694SRobert Watson * override the global policy (when they're not doing that, they select 146f2d2d694SRobert Watson * NETISR_DISPATCH_DEFAULT). 147d4b5cae4SRobert Watson */ 148f2d2d694SRobert Watson #define NETISR_DISPATCH_POLICY_DEFAULT NETISR_DISPATCH_DIRECT 149f2d2d694SRobert Watson #define NETISR_DISPATCH_POLICY_MAXSTR 20 /* Used for temporary buffers. */ 150f2d2d694SRobert Watson static u_int netisr_dispatch_policy = NETISR_DISPATCH_POLICY_DEFAULT; 151f2d2d694SRobert Watson static int sysctl_netisr_dispatch_policy(SYSCTL_HANDLER_ARGS); 152af3b2549SHans Petter Selasky SYSCTL_PROC(_net_isr, OID_AUTO, dispatch, CTLTYPE_STRING | CTLFLAG_RWTUN, 153af3b2549SHans Petter Selasky 0, 0, sysctl_netisr_dispatch_policy, "A", 154f2d2d694SRobert Watson "netisr dispatch policy"); 155e3b6e33cSJake Burkholder 156f2d2d694SRobert Watson /* 157d4b5cae4SRobert Watson * Allow the administrator to limit the number of threads (CPUs) to use for 158d4b5cae4SRobert Watson * netisr. We don't check netisr_maxthreads before creating the thread for 159d4b5cae4SRobert Watson * CPU 0, so in practice we ignore values <= 1. This must be set at boot. 160d4b5cae4SRobert Watson * We will create at most one thread per CPU. 1615fd04e38SRobert Watson */ 1629e6e01ebSRobert Watson static int netisr_maxthreads = -1; /* Max number of threads. */ 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. */ 16878494902SPawel Jakub Dawidek SYSCTL_INT(_net_isr, OID_AUTO, bindthreads, CTLFLAG_RDTUN, 169d4b5cae4SRobert Watson &netisr_bindthreads, 0, "Bind netisr threads to CPUs."); 170d4b5cae4SRobert Watson 171d4b5cae4SRobert Watson /* 1720a32e29fSRobert Watson * Limit per-workstream mbuf queue limits s to at most net.isr.maxqlimit, 1730a32e29fSRobert Watson * both for initial configuration and later modification using 1740a32e29fSRobert Watson * netisr_setqlimit(). 175d4b5cae4SRobert Watson */ 176d4b5cae4SRobert Watson #define NETISR_DEFAULT_MAXQLIMIT 10240 177d4b5cae4SRobert Watson static u_int netisr_maxqlimit = NETISR_DEFAULT_MAXQLIMIT; 178f88910cdSMatthew D Fleming SYSCTL_UINT(_net_isr, OID_AUTO, maxqlimit, CTLFLAG_RDTUN, 179d4b5cae4SRobert Watson &netisr_maxqlimit, 0, 180d4b5cae4SRobert Watson "Maximum netisr per-protocol, per-CPU queue depth."); 181d4b5cae4SRobert Watson 182d4b5cae4SRobert Watson /* 1830a32e29fSRobert Watson * The default per-workstream mbuf queue limit for protocols that don't 1840a32e29fSRobert Watson * initialize the nh_qlimit field of their struct netisr_handler. If this is 1850a32e29fSRobert Watson * set above netisr_maxqlimit, we truncate it to the maximum during boot. 186d4b5cae4SRobert Watson */ 187d4b5cae4SRobert Watson #define NETISR_DEFAULT_DEFAULTQLIMIT 256 188d4b5cae4SRobert Watson static u_int netisr_defaultqlimit = NETISR_DEFAULT_DEFAULTQLIMIT; 189f88910cdSMatthew D Fleming SYSCTL_UINT(_net_isr, OID_AUTO, defaultqlimit, CTLFLAG_RDTUN, 190d4b5cae4SRobert Watson &netisr_defaultqlimit, 0, 191d4b5cae4SRobert Watson "Default netisr per-protocol, per-CPU queue limit if not set by protocol"); 192d4b5cae4SRobert Watson 193d4b5cae4SRobert Watson /* 194938448cdSRobert Watson * Store and export the compile-time constant NETISR_MAXPROT limit on the 195938448cdSRobert Watson * number of protocols that can register with netisr at a time. This is 196938448cdSRobert Watson * required for crashdump analysis, as it sizes netisr_proto[]. 197d4b5cae4SRobert Watson */ 198938448cdSRobert Watson static u_int netisr_maxprot = NETISR_MAXPROT; 199f88910cdSMatthew D Fleming SYSCTL_UINT(_net_isr, OID_AUTO, maxprot, CTLFLAG_RD, 200938448cdSRobert Watson &netisr_maxprot, 0, 201938448cdSRobert Watson "Compile-time limit on the number of protocols supported by netisr."); 202d4b5cae4SRobert Watson 203d4b5cae4SRobert Watson /* 204938448cdSRobert Watson * The netisr_proto array describes all registered protocols, indexed by 205938448cdSRobert Watson * protocol number. See netisr_internal.h for more details. 206d4b5cae4SRobert Watson */ 207938448cdSRobert Watson static struct netisr_proto netisr_proto[NETISR_MAXPROT]; 208d4b5cae4SRobert Watson 209d4b5cae4SRobert Watson /* 210938448cdSRobert Watson * Per-CPU workstream data. See netisr_internal.h for more details. 211d4b5cae4SRobert Watson */ 21253402767SRobert Watson DPCPU_DEFINE(struct netisr_workstream, nws); 213d4b5cae4SRobert Watson 214d4b5cae4SRobert Watson /* 215d4b5cae4SRobert Watson * Map contiguous values between 0 and nws_count into CPU IDs appropriate for 21653402767SRobert Watson * accessing workstreams. This allows constructions of the form 21753402767SRobert Watson * DPCPU_ID_GET(nws_array[arbitraryvalue % nws_count], nws). 218d4b5cae4SRobert Watson */ 219d4b5cae4SRobert Watson static u_int nws_array[MAXCPU]; 220d4b5cae4SRobert Watson 221d4b5cae4SRobert Watson /* 222d4b5cae4SRobert Watson * Number of registered workstreams. Will be at most the number of running 223d4b5cae4SRobert Watson * CPUs once fully started. 224d4b5cae4SRobert Watson */ 225d4b5cae4SRobert Watson static u_int nws_count; 226f88910cdSMatthew D Fleming SYSCTL_UINT(_net_isr, OID_AUTO, numthreads, CTLFLAG_RD, 227d4b5cae4SRobert Watson &nws_count, 0, "Number of extant netisr threads."); 228d4b5cae4SRobert Watson 229d4b5cae4SRobert Watson /* 230d4b5cae4SRobert Watson * Synchronization for each workstream: a mutex protects all mutable fields 231d4b5cae4SRobert Watson * in each stream, including per-protocol state (mbuf queues). The SWI is 232d4b5cae4SRobert Watson * woken up if asynchronous dispatch is required. 233d4b5cae4SRobert Watson */ 234d4b5cae4SRobert Watson #define NWS_LOCK(s) mtx_lock(&(s)->nws_mtx) 235d4b5cae4SRobert Watson #define NWS_LOCK_ASSERT(s) mtx_assert(&(s)->nws_mtx, MA_OWNED) 236d4b5cae4SRobert Watson #define NWS_UNLOCK(s) mtx_unlock(&(s)->nws_mtx) 237d4b5cae4SRobert Watson #define NWS_SIGNAL(s) swi_sched((s)->nws_swi_cookie, 0) 238d4b5cae4SRobert Watson 239d4b5cae4SRobert Watson /* 240d4b5cae4SRobert Watson * Utility routines for protocols that implement their own mapping of flows 241d4b5cae4SRobert Watson * to CPUs. 242d4b5cae4SRobert Watson */ 243d4b5cae4SRobert Watson u_int 244d4b5cae4SRobert Watson netisr_get_cpucount(void) 245d4b5cae4SRobert Watson { 246d4b5cae4SRobert Watson 247d4b5cae4SRobert Watson return (nws_count); 2485fd04e38SRobert Watson } 249d4b5cae4SRobert Watson 250d4b5cae4SRobert Watson u_int 251d4b5cae4SRobert Watson netisr_get_cpuid(u_int cpunumber) 252d4b5cae4SRobert Watson { 253d4b5cae4SRobert Watson 254d4b5cae4SRobert Watson KASSERT(cpunumber < nws_count, ("%s: %u > %u", __func__, cpunumber, 255d4b5cae4SRobert Watson nws_count)); 256d4b5cae4SRobert Watson 257d4b5cae4SRobert Watson return (nws_array[cpunumber]); 2585fd04e38SRobert Watson } 2595fd04e38SRobert Watson 2605fd04e38SRobert Watson /* 2610a32e29fSRobert Watson * The default implementation of flow -> CPU ID mapping. 262d4b5cae4SRobert Watson * 263d4b5cae4SRobert Watson * Non-static so that protocols can use it to map their own work to specific 264d4b5cae4SRobert Watson * CPUs in a manner consistent to netisr for affinity purposes. 265d4b5cae4SRobert Watson */ 266d4b5cae4SRobert Watson u_int 267d4b5cae4SRobert Watson netisr_default_flow2cpu(u_int flowid) 268d4b5cae4SRobert Watson { 269d4b5cae4SRobert Watson 270d4b5cae4SRobert Watson return (nws_array[flowid % nws_count]); 271d4b5cae4SRobert Watson } 272d4b5cae4SRobert Watson 273d4b5cae4SRobert Watson /* 274f2d2d694SRobert Watson * Dispatch tunable and sysctl configuration. 275f2d2d694SRobert Watson */ 276f2d2d694SRobert Watson struct netisr_dispatch_table_entry { 277f2d2d694SRobert Watson u_int ndte_policy; 278f2d2d694SRobert Watson const char *ndte_policy_str; 279f2d2d694SRobert Watson }; 280f2d2d694SRobert Watson static const struct netisr_dispatch_table_entry netisr_dispatch_table[] = { 281f2d2d694SRobert Watson { NETISR_DISPATCH_DEFAULT, "default" }, 282f2d2d694SRobert Watson { NETISR_DISPATCH_DEFERRED, "deferred" }, 283f2d2d694SRobert Watson { NETISR_DISPATCH_HYBRID, "hybrid" }, 284f2d2d694SRobert Watson { NETISR_DISPATCH_DIRECT, "direct" }, 285f2d2d694SRobert Watson }; 286f2d2d694SRobert Watson static const u_int netisr_dispatch_table_len = 287f2d2d694SRobert Watson (sizeof(netisr_dispatch_table) / sizeof(netisr_dispatch_table[0])); 288f2d2d694SRobert Watson 289f2d2d694SRobert Watson static void 290f2d2d694SRobert Watson netisr_dispatch_policy_to_str(u_int dispatch_policy, char *buffer, 291f2d2d694SRobert Watson u_int buflen) 292f2d2d694SRobert Watson { 293f2d2d694SRobert Watson const struct netisr_dispatch_table_entry *ndtep; 294f2d2d694SRobert Watson const char *str; 295f2d2d694SRobert Watson u_int i; 296f2d2d694SRobert Watson 297f2d2d694SRobert Watson str = "unknown"; 298f2d2d694SRobert Watson for (i = 0; i < netisr_dispatch_table_len; i++) { 299f2d2d694SRobert Watson ndtep = &netisr_dispatch_table[i]; 300f2d2d694SRobert Watson if (ndtep->ndte_policy == dispatch_policy) { 301f2d2d694SRobert Watson str = ndtep->ndte_policy_str; 302f2d2d694SRobert Watson break; 303f2d2d694SRobert Watson } 304f2d2d694SRobert Watson } 305f2d2d694SRobert Watson snprintf(buffer, buflen, "%s", str); 306f2d2d694SRobert Watson } 307f2d2d694SRobert Watson 308f2d2d694SRobert Watson static int 309f2d2d694SRobert Watson netisr_dispatch_policy_from_str(const char *str, u_int *dispatch_policyp) 310f2d2d694SRobert Watson { 311f2d2d694SRobert Watson const struct netisr_dispatch_table_entry *ndtep; 312f2d2d694SRobert Watson u_int i; 313f2d2d694SRobert Watson 314f2d2d694SRobert Watson for (i = 0; i < netisr_dispatch_table_len; i++) { 315f2d2d694SRobert Watson ndtep = &netisr_dispatch_table[i]; 316f2d2d694SRobert Watson if (strcmp(ndtep->ndte_policy_str, str) == 0) { 317f2d2d694SRobert Watson *dispatch_policyp = ndtep->ndte_policy; 318f2d2d694SRobert Watson return (0); 319f2d2d694SRobert Watson } 320f2d2d694SRobert Watson } 321f2d2d694SRobert Watson return (EINVAL); 322f2d2d694SRobert Watson } 323f2d2d694SRobert Watson 324f2d2d694SRobert Watson static int 325f2d2d694SRobert Watson sysctl_netisr_dispatch_policy(SYSCTL_HANDLER_ARGS) 326f2d2d694SRobert Watson { 327f2d2d694SRobert Watson char tmp[NETISR_DISPATCH_POLICY_MAXSTR]; 328f2d2d694SRobert Watson u_int dispatch_policy; 329f2d2d694SRobert Watson int error; 330f2d2d694SRobert Watson 331f2d2d694SRobert Watson netisr_dispatch_policy_to_str(netisr_dispatch_policy, tmp, 332f2d2d694SRobert Watson sizeof(tmp)); 333f2d2d694SRobert Watson error = sysctl_handle_string(oidp, tmp, sizeof(tmp), req); 334f2d2d694SRobert Watson if (error == 0 && req->newptr != NULL) { 335f2d2d694SRobert Watson error = netisr_dispatch_policy_from_str(tmp, 336f2d2d694SRobert Watson &dispatch_policy); 337f2d2d694SRobert Watson if (error == 0 && dispatch_policy == NETISR_DISPATCH_DEFAULT) 338f2d2d694SRobert Watson error = EINVAL; 339933e681dSDavide Italiano if (error == 0) 340f2d2d694SRobert Watson netisr_dispatch_policy = dispatch_policy; 341f2d2d694SRobert Watson } 342f2d2d694SRobert Watson return (error); 343f2d2d694SRobert Watson } 344f2d2d694SRobert Watson 345f2d2d694SRobert Watson /* 346d4b5cae4SRobert Watson * Register a new netisr handler, which requires initializing per-protocol 347d4b5cae4SRobert Watson * fields for each workstream. All netisr work is briefly suspended while 348d4b5cae4SRobert Watson * the protocol is installed. 3491cafed39SJonathan Lemon */ 3501cafed39SJonathan Lemon void 351d4b5cae4SRobert Watson netisr_register(const struct netisr_handler *nhp) 3521cafed39SJonathan Lemon { 353d4b5cae4SRobert Watson struct netisr_work *npwp; 354d4b5cae4SRobert Watson const char *name; 355d4b5cae4SRobert Watson u_int i, proto; 3561cafed39SJonathan Lemon 357d4b5cae4SRobert Watson proto = nhp->nh_proto; 358d4b5cae4SRobert Watson name = nhp->nh_name; 35959dd72d0SRobert Watson 3607902224cSSam Leffler /* 361d4b5cae4SRobert Watson * Test that the requested registration is valid. 3627902224cSSam Leffler */ 363d4b5cae4SRobert Watson KASSERT(nhp->nh_name != NULL, 364d4b5cae4SRobert Watson ("%s: nh_name NULL for %u", __func__, proto)); 365d4b5cae4SRobert Watson KASSERT(nhp->nh_handler != NULL, 366d4b5cae4SRobert Watson ("%s: nh_handler NULL for %s", __func__, name)); 367d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_SOURCE || 368d4b5cae4SRobert Watson nhp->nh_policy == NETISR_POLICY_FLOW || 369d4b5cae4SRobert Watson nhp->nh_policy == NETISR_POLICY_CPU, 370d4b5cae4SRobert Watson ("%s: unsupported nh_policy %u for %s", __func__, 371d4b5cae4SRobert Watson nhp->nh_policy, name)); 372d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_FLOW || 373d4b5cae4SRobert Watson nhp->nh_m2flow == NULL, 374d4b5cae4SRobert Watson ("%s: nh_policy != FLOW but m2flow defined for %s", __func__, 375d4b5cae4SRobert Watson name)); 376d4b5cae4SRobert Watson KASSERT(nhp->nh_policy == NETISR_POLICY_CPU || nhp->nh_m2cpuid == NULL, 377d4b5cae4SRobert Watson ("%s: nh_policy != CPU but m2cpuid defined for %s", __func__, 378d4b5cae4SRobert Watson name)); 379d4b5cae4SRobert Watson KASSERT(nhp->nh_policy != NETISR_POLICY_CPU || nhp->nh_m2cpuid != NULL, 380d4b5cae4SRobert Watson ("%s: nh_policy == CPU but m2cpuid not defined for %s", __func__, 381d4b5cae4SRobert Watson name)); 382f2d2d694SRobert Watson KASSERT(nhp->nh_dispatch == NETISR_DISPATCH_DEFAULT || 383f2d2d694SRobert Watson nhp->nh_dispatch == NETISR_DISPATCH_DEFERRED || 384f2d2d694SRobert Watson nhp->nh_dispatch == NETISR_DISPATCH_HYBRID || 385f2d2d694SRobert Watson nhp->nh_dispatch == NETISR_DISPATCH_DIRECT, 386f2d2d694SRobert Watson ("%s: invalid nh_dispatch (%u)", __func__, nhp->nh_dispatch)); 387f2d2d694SRobert Watson 388d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 389d4b5cae4SRobert Watson ("%s(%u, %s): protocol too big", __func__, proto, name)); 390d4b5cae4SRobert Watson 391d4b5cae4SRobert Watson /* 392d4b5cae4SRobert Watson * Test that no existing registration exists for this protocol. 393d4b5cae4SRobert Watson */ 394d4b5cae4SRobert Watson NETISR_WLOCK(); 395938448cdSRobert Watson KASSERT(netisr_proto[proto].np_name == NULL, 396d4b5cae4SRobert Watson ("%s(%u, %s): name present", __func__, proto, name)); 397938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler == NULL, 398d4b5cae4SRobert Watson ("%s(%u, %s): handler present", __func__, proto, name)); 399d4b5cae4SRobert Watson 400938448cdSRobert Watson netisr_proto[proto].np_name = name; 401938448cdSRobert Watson netisr_proto[proto].np_handler = nhp->nh_handler; 402938448cdSRobert Watson netisr_proto[proto].np_m2flow = nhp->nh_m2flow; 403938448cdSRobert Watson netisr_proto[proto].np_m2cpuid = nhp->nh_m2cpuid; 404938448cdSRobert Watson netisr_proto[proto].np_drainedcpu = nhp->nh_drainedcpu; 405d4b5cae4SRobert Watson if (nhp->nh_qlimit == 0) 406938448cdSRobert Watson netisr_proto[proto].np_qlimit = netisr_defaultqlimit; 407d4b5cae4SRobert Watson else if (nhp->nh_qlimit > netisr_maxqlimit) { 408d4b5cae4SRobert Watson printf("%s: %s requested queue limit %u capped to " 409d4b5cae4SRobert Watson "net.isr.maxqlimit %u\n", __func__, name, nhp->nh_qlimit, 410d4b5cae4SRobert Watson netisr_maxqlimit); 411938448cdSRobert Watson netisr_proto[proto].np_qlimit = netisr_maxqlimit; 412d4b5cae4SRobert Watson } else 413938448cdSRobert Watson netisr_proto[proto].np_qlimit = nhp->nh_qlimit; 414938448cdSRobert Watson netisr_proto[proto].np_policy = nhp->nh_policy; 415f2d2d694SRobert Watson netisr_proto[proto].np_dispatch = nhp->nh_dispatch; 4163aa6d94eSJohn Baldwin CPU_FOREACH(i) { 41753402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 418d4b5cae4SRobert Watson bzero(npwp, sizeof(*npwp)); 419938448cdSRobert Watson npwp->nw_qlimit = netisr_proto[proto].np_qlimit; 4201cafed39SJonathan Lemon } 421d4b5cae4SRobert Watson NETISR_WUNLOCK(); 4221cafed39SJonathan Lemon } 4231cafed39SJonathan Lemon 4241cafed39SJonathan Lemon /* 425d4b5cae4SRobert Watson * Clear drop counters across all workstreams for a protocol. 426d4b5cae4SRobert Watson */ 427d4b5cae4SRobert Watson void 428d4b5cae4SRobert Watson netisr_clearqdrops(const struct netisr_handler *nhp) 429d4b5cae4SRobert Watson { 430d4b5cae4SRobert Watson struct netisr_work *npwp; 431d4b5cae4SRobert Watson #ifdef INVARIANTS 432d4b5cae4SRobert Watson const char *name; 433d4b5cae4SRobert Watson #endif 434d4b5cae4SRobert Watson u_int i, proto; 435d4b5cae4SRobert Watson 436d4b5cae4SRobert Watson proto = nhp->nh_proto; 437d4b5cae4SRobert Watson #ifdef INVARIANTS 438d4b5cae4SRobert Watson name = nhp->nh_name; 439d4b5cae4SRobert Watson #endif 440d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 441d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 442d4b5cae4SRobert Watson 443d4b5cae4SRobert Watson NETISR_WLOCK(); 444938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 445d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 446d4b5cae4SRobert Watson name)); 447d4b5cae4SRobert Watson 4483aa6d94eSJohn Baldwin CPU_FOREACH(i) { 44953402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 450d4b5cae4SRobert Watson npwp->nw_qdrops = 0; 451d4b5cae4SRobert Watson } 452d4b5cae4SRobert Watson NETISR_WUNLOCK(); 453d4b5cae4SRobert Watson } 454d4b5cae4SRobert Watson 455d4b5cae4SRobert Watson /* 4560a32e29fSRobert Watson * Query current drop counters across all workstreams for a protocol. 457d4b5cae4SRobert Watson */ 458d4b5cae4SRobert Watson void 459d4b5cae4SRobert Watson netisr_getqdrops(const struct netisr_handler *nhp, u_int64_t *qdropp) 460d4b5cae4SRobert Watson { 461d4b5cae4SRobert Watson struct netisr_work *npwp; 462d4b5cae4SRobert Watson struct rm_priotracker tracker; 463d4b5cae4SRobert Watson #ifdef INVARIANTS 464d4b5cae4SRobert Watson const char *name; 465d4b5cae4SRobert Watson #endif 466d4b5cae4SRobert Watson u_int i, proto; 467d4b5cae4SRobert Watson 468d4b5cae4SRobert Watson *qdropp = 0; 469d4b5cae4SRobert Watson proto = nhp->nh_proto; 470d4b5cae4SRobert Watson #ifdef INVARIANTS 471d4b5cae4SRobert Watson name = nhp->nh_name; 472d4b5cae4SRobert Watson #endif 473d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 474d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 475d4b5cae4SRobert Watson 476d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 477938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 478d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 479d4b5cae4SRobert Watson name)); 480d4b5cae4SRobert Watson 4813aa6d94eSJohn Baldwin CPU_FOREACH(i) { 48253402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 483d4b5cae4SRobert Watson *qdropp += npwp->nw_qdrops; 484d4b5cae4SRobert Watson } 485d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 486d4b5cae4SRobert Watson } 487d4b5cae4SRobert Watson 488d4b5cae4SRobert Watson /* 4890a32e29fSRobert Watson * Query current per-workstream queue limit for a protocol. 490d4b5cae4SRobert Watson */ 491d4b5cae4SRobert Watson void 492d4b5cae4SRobert Watson netisr_getqlimit(const struct netisr_handler *nhp, u_int *qlimitp) 493d4b5cae4SRobert Watson { 494d4b5cae4SRobert Watson struct rm_priotracker tracker; 495d4b5cae4SRobert Watson #ifdef INVARIANTS 496d4b5cae4SRobert Watson const char *name; 497d4b5cae4SRobert Watson #endif 498d4b5cae4SRobert Watson u_int proto; 499d4b5cae4SRobert Watson 500d4b5cae4SRobert Watson proto = nhp->nh_proto; 501d4b5cae4SRobert Watson #ifdef INVARIANTS 502d4b5cae4SRobert Watson name = nhp->nh_name; 503d4b5cae4SRobert Watson #endif 504d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 505d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 506d4b5cae4SRobert Watson 507d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 508938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 509d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 510d4b5cae4SRobert Watson name)); 511938448cdSRobert Watson *qlimitp = netisr_proto[proto].np_qlimit; 512d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 513d4b5cae4SRobert Watson } 514d4b5cae4SRobert Watson 515d4b5cae4SRobert Watson /* 516d4b5cae4SRobert Watson * Update the queue limit across per-workstream queues for a protocol. We 517d4b5cae4SRobert Watson * simply change the limits, and don't drain overflowed packets as they will 518d4b5cae4SRobert Watson * (hopefully) take care of themselves shortly. 5191cafed39SJonathan Lemon */ 5201cafed39SJonathan Lemon int 521d4b5cae4SRobert Watson netisr_setqlimit(const struct netisr_handler *nhp, u_int qlimit) 5221cafed39SJonathan Lemon { 523d4b5cae4SRobert Watson struct netisr_work *npwp; 524d4b5cae4SRobert Watson #ifdef INVARIANTS 525d4b5cae4SRobert Watson const char *name; 526d4b5cae4SRobert Watson #endif 527d4b5cae4SRobert Watson u_int i, proto; 5281cafed39SJonathan Lemon 529d4b5cae4SRobert Watson if (qlimit > netisr_maxqlimit) 530d4b5cae4SRobert Watson return (EINVAL); 531d4b5cae4SRobert Watson 532d4b5cae4SRobert Watson proto = nhp->nh_proto; 533d4b5cae4SRobert Watson #ifdef INVARIANTS 534d4b5cae4SRobert Watson name = nhp->nh_name; 535d4b5cae4SRobert Watson #endif 536d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 537d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 538d4b5cae4SRobert Watson 539d4b5cae4SRobert Watson NETISR_WLOCK(); 540938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 541d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 542d4b5cae4SRobert Watson name)); 543d4b5cae4SRobert Watson 544938448cdSRobert Watson netisr_proto[proto].np_qlimit = qlimit; 5453aa6d94eSJohn Baldwin CPU_FOREACH(i) { 54653402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 547d4b5cae4SRobert Watson npwp->nw_qlimit = qlimit; 548fb68148fSJonathan Lemon } 549d4b5cae4SRobert Watson NETISR_WUNLOCK(); 5503161f583SAndre Oppermann return (0); 551e3b6e33cSJake Burkholder } 552e3b6e33cSJake Burkholder 553d4b5cae4SRobert Watson /* 554d4b5cae4SRobert Watson * Drain all packets currently held in a particular protocol work queue. 555d4b5cae4SRobert Watson */ 556e3b6e33cSJake Burkholder static void 557d4b5cae4SRobert Watson netisr_drain_proto(struct netisr_work *npwp) 558e3b6e33cSJake Burkholder { 559d4b5cae4SRobert Watson struct mbuf *m; 560d4b5cae4SRobert Watson 561d4b5cae4SRobert Watson /* 562d4b5cae4SRobert Watson * We would assert the lock on the workstream but it's not passed in. 563d4b5cae4SRobert Watson */ 564d4b5cae4SRobert Watson while ((m = npwp->nw_head) != NULL) { 565d4b5cae4SRobert Watson npwp->nw_head = m->m_nextpkt; 566d4b5cae4SRobert Watson m->m_nextpkt = NULL; 567d4b5cae4SRobert Watson if (npwp->nw_head == NULL) 568d4b5cae4SRobert Watson npwp->nw_tail = NULL; 569d4b5cae4SRobert Watson npwp->nw_len--; 570d4b5cae4SRobert Watson m_freem(m); 571d4b5cae4SRobert Watson } 572d4b5cae4SRobert Watson KASSERT(npwp->nw_tail == NULL, ("%s: tail", __func__)); 573d4b5cae4SRobert Watson KASSERT(npwp->nw_len == 0, ("%s: len", __func__)); 574d4b5cae4SRobert Watson } 575d4b5cae4SRobert Watson 576d4b5cae4SRobert Watson /* 577d4b5cae4SRobert Watson * Remove the registration of a network protocol, which requires clearing 578d4b5cae4SRobert Watson * per-protocol fields across all workstreams, including freeing all mbufs in 579d4b5cae4SRobert Watson * the queues at time of unregister. All work in netisr is briefly suspended 580d4b5cae4SRobert Watson * while this takes place. 581d4b5cae4SRobert Watson */ 582d4b5cae4SRobert Watson void 583d4b5cae4SRobert Watson netisr_unregister(const struct netisr_handler *nhp) 584d4b5cae4SRobert Watson { 585d4b5cae4SRobert Watson struct netisr_work *npwp; 586d4b5cae4SRobert Watson #ifdef INVARIANTS 587d4b5cae4SRobert Watson const char *name; 588d4b5cae4SRobert Watson #endif 589d4b5cae4SRobert Watson u_int i, proto; 590d4b5cae4SRobert Watson 591d4b5cae4SRobert Watson proto = nhp->nh_proto; 592d4b5cae4SRobert Watson #ifdef INVARIANTS 593d4b5cae4SRobert Watson name = nhp->nh_name; 594d4b5cae4SRobert Watson #endif 595d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 596d4b5cae4SRobert Watson ("%s(%u): protocol too big for %s", __func__, proto, name)); 597d4b5cae4SRobert Watson 598d4b5cae4SRobert Watson NETISR_WLOCK(); 599938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 600d4b5cae4SRobert Watson ("%s(%u): protocol not registered for %s", __func__, proto, 601d4b5cae4SRobert Watson name)); 602d4b5cae4SRobert Watson 603938448cdSRobert Watson netisr_proto[proto].np_name = NULL; 604938448cdSRobert Watson netisr_proto[proto].np_handler = NULL; 605938448cdSRobert Watson netisr_proto[proto].np_m2flow = NULL; 606938448cdSRobert Watson netisr_proto[proto].np_m2cpuid = NULL; 607938448cdSRobert Watson netisr_proto[proto].np_qlimit = 0; 608938448cdSRobert Watson netisr_proto[proto].np_policy = 0; 6093aa6d94eSJohn Baldwin CPU_FOREACH(i) { 61053402767SRobert Watson npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 611d4b5cae4SRobert Watson netisr_drain_proto(npwp); 612d4b5cae4SRobert Watson bzero(npwp, sizeof(*npwp)); 613d4b5cae4SRobert Watson } 614d4b5cae4SRobert Watson NETISR_WUNLOCK(); 615d4b5cae4SRobert Watson } 616d4b5cae4SRobert Watson 617d4b5cae4SRobert Watson /* 618f2d2d694SRobert Watson * Compose the global and per-protocol policies on dispatch, and return the 619f2d2d694SRobert Watson * dispatch policy to use. 620f2d2d694SRobert Watson */ 621f2d2d694SRobert Watson static u_int 622f2d2d694SRobert Watson netisr_get_dispatch(struct netisr_proto *npp) 623f2d2d694SRobert Watson { 624f2d2d694SRobert Watson 625f2d2d694SRobert Watson /* 626f2d2d694SRobert Watson * Protocol-specific configuration overrides the global default. 627f2d2d694SRobert Watson */ 628f2d2d694SRobert Watson if (npp->np_dispatch != NETISR_DISPATCH_DEFAULT) 629f2d2d694SRobert Watson return (npp->np_dispatch); 630f2d2d694SRobert Watson return (netisr_dispatch_policy); 631f2d2d694SRobert Watson } 632f2d2d694SRobert Watson 633f2d2d694SRobert Watson /* 634d4b5cae4SRobert Watson * Look up the workstream given a packet and source identifier. Do this by 635d4b5cae4SRobert Watson * checking the protocol's policy, and optionally call out to the protocol 636d4b5cae4SRobert Watson * for assistance if required. 637d4b5cae4SRobert Watson */ 638d4b5cae4SRobert Watson static struct mbuf * 639f2d2d694SRobert Watson netisr_select_cpuid(struct netisr_proto *npp, u_int dispatch_policy, 640f2d2d694SRobert Watson uintptr_t source, struct mbuf *m, u_int *cpuidp) 641d4b5cae4SRobert Watson { 642d4b5cae4SRobert Watson struct ifnet *ifp; 643f2d2d694SRobert Watson u_int policy; 644d4b5cae4SRobert Watson 645d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 646d4b5cae4SRobert Watson 647d4b5cae4SRobert Watson /* 648d4b5cae4SRobert Watson * In the event we have only one worker, shortcut and deliver to it 649d4b5cae4SRobert Watson * without further ado. 650d4b5cae4SRobert Watson */ 651d4b5cae4SRobert Watson if (nws_count == 1) { 652d4b5cae4SRobert Watson *cpuidp = nws_array[0]; 653d4b5cae4SRobert Watson return (m); 654d4b5cae4SRobert Watson } 655d4b5cae4SRobert Watson 656d4b5cae4SRobert Watson /* 657d4b5cae4SRobert Watson * What happens next depends on the policy selected by the protocol. 658d4b5cae4SRobert Watson * If we want to support per-interface policies, we should do that 659d4b5cae4SRobert Watson * here first. 660d4b5cae4SRobert Watson */ 661f2d2d694SRobert Watson policy = npp->np_policy; 662f2d2d694SRobert Watson if (policy == NETISR_POLICY_CPU) { 663f2d2d694SRobert Watson m = npp->np_m2cpuid(m, source, cpuidp); 664f2d2d694SRobert Watson if (m == NULL) 665f2d2d694SRobert Watson return (NULL); 666d4b5cae4SRobert Watson 667f2d2d694SRobert Watson /* 668f2d2d694SRobert Watson * It's possible for a protocol not to have a good idea about 669f2d2d694SRobert Watson * where to process a packet, in which case we fall back on 670f2d2d694SRobert Watson * the netisr code to decide. In the hybrid case, return the 671f2d2d694SRobert Watson * current CPU ID, which will force an immediate direct 672f2d2d694SRobert Watson * dispatch. In the queued case, fall back on the SOURCE 673f2d2d694SRobert Watson * policy. 674f2d2d694SRobert Watson */ 675f2d2d694SRobert Watson if (*cpuidp != NETISR_CPUID_NONE) 676f2d2d694SRobert Watson return (m); 677f2d2d694SRobert Watson if (dispatch_policy == NETISR_DISPATCH_HYBRID) { 678f2d2d694SRobert Watson *cpuidp = curcpu; 679f2d2d694SRobert Watson return (m); 680f2d2d694SRobert Watson } 681f2d2d694SRobert Watson policy = NETISR_POLICY_SOURCE; 682f2d2d694SRobert Watson } 683f2d2d694SRobert Watson 684f2d2d694SRobert Watson if (policy == NETISR_POLICY_FLOW) { 685*c2529042SHans Petter Selasky if (M_HASHTYPE_GET(m) == M_HASHTYPE_NONE && 686*c2529042SHans Petter Selasky npp->np_m2flow != NULL) { 687d4b5cae4SRobert Watson m = npp->np_m2flow(m, source); 688d4b5cae4SRobert Watson if (m == NULL) 689d4b5cae4SRobert Watson return (NULL); 690d4b5cae4SRobert Watson } 691*c2529042SHans Petter Selasky if (M_HASHTYPE_GET(m) != M_HASHTYPE_NONE) { 692d4b5cae4SRobert Watson *cpuidp = 693d4b5cae4SRobert Watson netisr_default_flow2cpu(m->m_pkthdr.flowid); 694d4b5cae4SRobert Watson return (m); 695d4b5cae4SRobert Watson } 696f2d2d694SRobert Watson policy = NETISR_POLICY_SOURCE; 697f2d2d694SRobert Watson } 698d4b5cae4SRobert Watson 699f2d2d694SRobert Watson KASSERT(policy == NETISR_POLICY_SOURCE, 700f2d2d694SRobert Watson ("%s: invalid policy %u for %s", __func__, npp->np_policy, 701f2d2d694SRobert Watson npp->np_name)); 702f2d2d694SRobert Watson 703d4b5cae4SRobert Watson ifp = m->m_pkthdr.rcvif; 704d4b5cae4SRobert Watson if (ifp != NULL) 705f2d2d694SRobert Watson *cpuidp = nws_array[(ifp->if_index + source) % nws_count]; 706d4b5cae4SRobert Watson else 707d4b5cae4SRobert Watson *cpuidp = nws_array[source % nws_count]; 708d4b5cae4SRobert Watson return (m); 709d4b5cae4SRobert Watson } 710d4b5cae4SRobert Watson 711d4b5cae4SRobert Watson /* 712d4b5cae4SRobert Watson * Process packets associated with a workstream and protocol. For reasons of 713d4b5cae4SRobert Watson * fairness, we process up to one complete netisr queue at a time, moving the 714d4b5cae4SRobert Watson * queue to a stack-local queue for processing, but do not loop refreshing 715d4b5cae4SRobert Watson * from the global queue. The caller is responsible for deciding whether to 716d4b5cae4SRobert Watson * loop, and for setting the NWS_RUNNING flag. The passed workstream will be 717d4b5cae4SRobert Watson * locked on entry and relocked before return, but will be released while 718d4b5cae4SRobert Watson * processing. The number of packets processed is returned. 719d4b5cae4SRobert Watson */ 720d4b5cae4SRobert Watson static u_int 721d4b5cae4SRobert Watson netisr_process_workstream_proto(struct netisr_workstream *nwsp, u_int proto) 722d4b5cae4SRobert Watson { 723d4b5cae4SRobert Watson struct netisr_work local_npw, *npwp; 724d4b5cae4SRobert Watson u_int handled; 725d4b5cae4SRobert Watson struct mbuf *m; 726d4b5cae4SRobert Watson 727d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 728d4b5cae4SRobert Watson NWS_LOCK_ASSERT(nwsp); 729d4b5cae4SRobert Watson 730d4b5cae4SRobert Watson KASSERT(nwsp->nws_flags & NWS_RUNNING, 731d4b5cae4SRobert Watson ("%s(%u): not running", __func__, proto)); 732d4b5cae4SRobert Watson KASSERT(proto >= 0 && proto < NETISR_MAXPROT, 733d4b5cae4SRobert Watson ("%s(%u): invalid proto\n", __func__, proto)); 734d4b5cae4SRobert Watson 735d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 736d4b5cae4SRobert Watson if (npwp->nw_len == 0) 737d4b5cae4SRobert Watson return (0); 738d4b5cae4SRobert Watson 739d4b5cae4SRobert Watson /* 740d4b5cae4SRobert Watson * Move the global work queue to a thread-local work queue. 741d4b5cae4SRobert Watson * 742d4b5cae4SRobert Watson * Notice that this means the effective maximum length of the queue 743d4b5cae4SRobert Watson * is actually twice that of the maximum queue length specified in 744d4b5cae4SRobert Watson * the protocol registration call. 745d4b5cae4SRobert Watson */ 746d4b5cae4SRobert Watson handled = npwp->nw_len; 747d4b5cae4SRobert Watson local_npw = *npwp; 748d4b5cae4SRobert Watson npwp->nw_head = NULL; 749d4b5cae4SRobert Watson npwp->nw_tail = NULL; 750d4b5cae4SRobert Watson npwp->nw_len = 0; 751d4b5cae4SRobert Watson nwsp->nws_pendingbits &= ~(1 << proto); 752d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 753d4b5cae4SRobert Watson while ((m = local_npw.nw_head) != NULL) { 754d4b5cae4SRobert Watson local_npw.nw_head = m->m_nextpkt; 755d4b5cae4SRobert Watson m->m_nextpkt = NULL; 756d4b5cae4SRobert Watson if (local_npw.nw_head == NULL) 757d4b5cae4SRobert Watson local_npw.nw_tail = NULL; 758d4b5cae4SRobert Watson local_npw.nw_len--; 7590028e524SBjoern A. Zeeb VNET_ASSERT(m->m_pkthdr.rcvif != NULL, 7600028e524SBjoern A. Zeeb ("%s:%d rcvif == NULL: m=%p", __func__, __LINE__, m)); 761d4b5cae4SRobert Watson CURVNET_SET(m->m_pkthdr.rcvif->if_vnet); 762938448cdSRobert Watson netisr_proto[proto].np_handler(m); 763d4b5cae4SRobert Watson CURVNET_RESTORE(); 764d4b5cae4SRobert Watson } 765d4b5cae4SRobert Watson KASSERT(local_npw.nw_len == 0, 766d4b5cae4SRobert Watson ("%s(%u): len %u", __func__, proto, local_npw.nw_len)); 767938448cdSRobert Watson if (netisr_proto[proto].np_drainedcpu) 768938448cdSRobert Watson netisr_proto[proto].np_drainedcpu(nwsp->nws_cpu); 769d4b5cae4SRobert Watson NWS_LOCK(nwsp); 770d4b5cae4SRobert Watson npwp->nw_handled += handled; 771d4b5cae4SRobert Watson return (handled); 772d4b5cae4SRobert Watson } 773d4b5cae4SRobert Watson 774d4b5cae4SRobert Watson /* 7750a32e29fSRobert Watson * SWI handler for netisr -- processes packets in a set of workstreams that 776d4b5cae4SRobert Watson * it owns, woken up by calls to NWS_SIGNAL(). If this workstream is already 777d4b5cae4SRobert Watson * being direct dispatched, go back to sleep and wait for the dispatching 778d4b5cae4SRobert Watson * thread to wake us up again. 779d4b5cae4SRobert Watson */ 780d4b5cae4SRobert Watson static void 781d4b5cae4SRobert Watson swi_net(void *arg) 782d4b5cae4SRobert Watson { 783d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 784d4b5cae4SRobert Watson struct rm_priotracker tracker; 785d4b5cae4SRobert Watson #endif 786d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 787d4b5cae4SRobert Watson u_int bits, prot; 788d4b5cae4SRobert Watson 789d4b5cae4SRobert Watson nwsp = arg; 790d4b5cae4SRobert Watson 7911cafed39SJonathan Lemon #ifdef DEVICE_POLLING 792d4b5cae4SRobert Watson KASSERT(nws_count == 1, 793d4b5cae4SRobert Watson ("%s: device_polling but nws_count != 1", __func__)); 794d4b5cae4SRobert Watson netisr_poll(); 795d4b5cae4SRobert Watson #endif 796d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 797d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 798d4b5cae4SRobert Watson #endif 799d4b5cae4SRobert Watson NWS_LOCK(nwsp); 800d4b5cae4SRobert Watson KASSERT(!(nwsp->nws_flags & NWS_RUNNING), ("swi_net: running")); 801d4b5cae4SRobert Watson if (nwsp->nws_flags & NWS_DISPATCHING) 802d4b5cae4SRobert Watson goto out; 803d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_RUNNING; 804d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_SCHEDULED; 805d4b5cae4SRobert Watson while ((bits = nwsp->nws_pendingbits) != 0) { 806d4b5cae4SRobert Watson while ((prot = ffs(bits)) != 0) { 807d4b5cae4SRobert Watson prot--; 808d4b5cae4SRobert Watson bits &= ~(1 << prot); 809d4b5cae4SRobert Watson (void)netisr_process_workstream_proto(nwsp, prot); 810d4b5cae4SRobert Watson } 811d4b5cae4SRobert Watson } 812d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_RUNNING; 813d4b5cae4SRobert Watson out: 814d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 815d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 816d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 817d4b5cae4SRobert Watson #endif 818d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 819d4b5cae4SRobert Watson netisr_pollmore(); 820d4b5cae4SRobert Watson #endif 821d4b5cae4SRobert Watson } 822d4b5cae4SRobert Watson 823d4b5cae4SRobert Watson static int 824d4b5cae4SRobert Watson netisr_queue_workstream(struct netisr_workstream *nwsp, u_int proto, 825d4b5cae4SRobert Watson struct netisr_work *npwp, struct mbuf *m, int *dosignalp) 826d4b5cae4SRobert Watson { 827d4b5cae4SRobert Watson 828d4b5cae4SRobert Watson NWS_LOCK_ASSERT(nwsp); 829d4b5cae4SRobert Watson 830d4b5cae4SRobert Watson *dosignalp = 0; 831d4b5cae4SRobert Watson if (npwp->nw_len < npwp->nw_qlimit) { 832d4b5cae4SRobert Watson m->m_nextpkt = NULL; 833d4b5cae4SRobert Watson if (npwp->nw_head == NULL) { 834d4b5cae4SRobert Watson npwp->nw_head = m; 835d4b5cae4SRobert Watson npwp->nw_tail = m; 836d4b5cae4SRobert Watson } else { 837d4b5cae4SRobert Watson npwp->nw_tail->m_nextpkt = m; 838d4b5cae4SRobert Watson npwp->nw_tail = m; 839d4b5cae4SRobert Watson } 840d4b5cae4SRobert Watson npwp->nw_len++; 841d4b5cae4SRobert Watson if (npwp->nw_len > npwp->nw_watermark) 842d4b5cae4SRobert Watson npwp->nw_watermark = npwp->nw_len; 8430a32e29fSRobert Watson 8440a32e29fSRobert Watson /* 8450a32e29fSRobert Watson * We must set the bit regardless of NWS_RUNNING, so that 8460a32e29fSRobert Watson * swi_net() keeps calling netisr_process_workstream_proto(). 8470a32e29fSRobert Watson */ 848d4b5cae4SRobert Watson nwsp->nws_pendingbits |= (1 << proto); 849d4b5cae4SRobert Watson if (!(nwsp->nws_flags & 850d4b5cae4SRobert Watson (NWS_RUNNING | NWS_DISPATCHING | NWS_SCHEDULED))) { 851d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_SCHEDULED; 852d4b5cae4SRobert Watson *dosignalp = 1; /* Defer until unlocked. */ 853d4b5cae4SRobert Watson } 854d4b5cae4SRobert Watson npwp->nw_queued++; 855d4b5cae4SRobert Watson return (0); 856d4b5cae4SRobert Watson } else { 857ba3b25b3SBjoern A. Zeeb m_freem(m); 858d4b5cae4SRobert Watson npwp->nw_qdrops++; 859d4b5cae4SRobert Watson return (ENOBUFS); 860d4b5cae4SRobert Watson } 861d4b5cae4SRobert Watson } 862d4b5cae4SRobert Watson 863d4b5cae4SRobert Watson static int 864d4b5cae4SRobert Watson netisr_queue_internal(u_int proto, struct mbuf *m, u_int cpuid) 865d4b5cae4SRobert Watson { 866d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 867d4b5cae4SRobert Watson struct netisr_work *npwp; 868d4b5cae4SRobert Watson int dosignal, error; 869d4b5cae4SRobert Watson 870d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 871d4b5cae4SRobert Watson NETISR_LOCK_ASSERT(); 872d4b5cae4SRobert Watson #endif 8739e6e01ebSRobert Watson KASSERT(cpuid <= mp_maxid, ("%s: cpuid too big (%u, %u)", __func__, 8749e6e01ebSRobert Watson cpuid, mp_maxid)); 87553402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 876d4b5cae4SRobert Watson 877d4b5cae4SRobert Watson dosignal = 0; 878d4b5cae4SRobert Watson error = 0; 87953402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 880d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 881d4b5cae4SRobert Watson NWS_LOCK(nwsp); 882d4b5cae4SRobert Watson error = netisr_queue_workstream(nwsp, proto, npwp, m, &dosignal); 883d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 884d4b5cae4SRobert Watson if (dosignal) 885d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 886d4b5cae4SRobert Watson return (error); 887d4b5cae4SRobert Watson } 888d4b5cae4SRobert Watson 889d4b5cae4SRobert Watson int 890d4b5cae4SRobert Watson netisr_queue_src(u_int proto, uintptr_t source, struct mbuf *m) 891d4b5cae4SRobert Watson { 892d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 893d4b5cae4SRobert Watson struct rm_priotracker tracker; 894d4b5cae4SRobert Watson #endif 895d4b5cae4SRobert Watson u_int cpuid; 896d4b5cae4SRobert Watson int error; 897d4b5cae4SRobert Watson 898d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 899d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 900d4b5cae4SRobert Watson 901d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 902d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 903d4b5cae4SRobert Watson #endif 904938448cdSRobert Watson KASSERT(netisr_proto[proto].np_handler != NULL, 905d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 906d4b5cae4SRobert Watson 907f2d2d694SRobert Watson m = netisr_select_cpuid(&netisr_proto[proto], NETISR_DISPATCH_DEFERRED, 908f2d2d694SRobert Watson source, m, &cpuid); 90953402767SRobert Watson if (m != NULL) { 91053402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, 91153402767SRobert Watson cpuid)); 912d4b5cae4SRobert Watson error = netisr_queue_internal(proto, m, cpuid); 91353402767SRobert Watson } else 914d4b5cae4SRobert Watson error = ENOBUFS; 915d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 916d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 917d4b5cae4SRobert Watson #endif 918d4b5cae4SRobert Watson return (error); 919d4b5cae4SRobert Watson } 920d4b5cae4SRobert Watson 921d4b5cae4SRobert Watson int 922d4b5cae4SRobert Watson netisr_queue(u_int proto, struct mbuf *m) 923d4b5cae4SRobert Watson { 924d4b5cae4SRobert Watson 925d4b5cae4SRobert Watson return (netisr_queue_src(proto, 0, m)); 926d4b5cae4SRobert Watson } 927d4b5cae4SRobert Watson 928d4b5cae4SRobert Watson /* 9290a32e29fSRobert Watson * Dispatch a packet for netisr processing; direct dispatch is permitted by 930d4b5cae4SRobert Watson * calling context. 931d4b5cae4SRobert Watson */ 932d4b5cae4SRobert Watson int 933d4b5cae4SRobert Watson netisr_dispatch_src(u_int proto, uintptr_t source, struct mbuf *m) 934d4b5cae4SRobert Watson { 935d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 936d4b5cae4SRobert Watson struct rm_priotracker tracker; 937d4b5cae4SRobert Watson #endif 938d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 939f2d2d694SRobert Watson struct netisr_proto *npp; 940d4b5cae4SRobert Watson struct netisr_work *npwp; 941d4b5cae4SRobert Watson int dosignal, error; 942f2d2d694SRobert Watson u_int cpuid, dispatch_policy; 943d4b5cae4SRobert Watson 944d4b5cae4SRobert Watson KASSERT(proto < NETISR_MAXPROT, 945d4b5cae4SRobert Watson ("%s: invalid proto %u", __func__, proto)); 946d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 947d4b5cae4SRobert Watson NETISR_RLOCK(&tracker); 948d4b5cae4SRobert Watson #endif 949f2d2d694SRobert Watson npp = &netisr_proto[proto]; 950f2d2d694SRobert Watson KASSERT(npp->np_handler != NULL, ("%s: invalid proto %u", __func__, 951f2d2d694SRobert Watson proto)); 952f2d2d694SRobert Watson 953f2d2d694SRobert Watson dispatch_policy = netisr_get_dispatch(npp); 954f2d2d694SRobert Watson if (dispatch_policy == NETISR_DISPATCH_DEFERRED) 955f2d2d694SRobert Watson return (netisr_queue_src(proto, source, m)); 956d4b5cae4SRobert Watson 957d4b5cae4SRobert Watson /* 958d4b5cae4SRobert Watson * If direct dispatch is forced, then unconditionally dispatch 959d4b5cae4SRobert Watson * without a formal CPU selection. Borrow the current CPU's stats, 960d4b5cae4SRobert Watson * even if there's no worker on it. In this case we don't update 961d4b5cae4SRobert Watson * nws_flags because all netisr processing will be source ordered due 962d4b5cae4SRobert Watson * to always being forced to directly dispatch. 963d4b5cae4SRobert Watson */ 964f2d2d694SRobert Watson if (dispatch_policy == NETISR_DISPATCH_DIRECT) { 96553402767SRobert Watson nwsp = DPCPU_PTR(nws); 966d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 967d4b5cae4SRobert Watson npwp->nw_dispatched++; 968d4b5cae4SRobert Watson npwp->nw_handled++; 969938448cdSRobert Watson netisr_proto[proto].np_handler(m); 970d4b5cae4SRobert Watson error = 0; 971d4b5cae4SRobert Watson goto out_unlock; 972d4b5cae4SRobert Watson } 973d4b5cae4SRobert Watson 974f2d2d694SRobert Watson KASSERT(dispatch_policy == NETISR_DISPATCH_HYBRID, 975f2d2d694SRobert Watson ("%s: unknown dispatch policy (%u)", __func__, dispatch_policy)); 976f2d2d694SRobert Watson 977d4b5cae4SRobert Watson /* 978d4b5cae4SRobert Watson * Otherwise, we execute in a hybrid mode where we will try to direct 979d4b5cae4SRobert Watson * dispatch if we're on the right CPU and the netisr worker isn't 980d4b5cae4SRobert Watson * already running. 981d4b5cae4SRobert Watson */ 982f2d2d694SRobert Watson sched_pin(); 983f2d2d694SRobert Watson m = netisr_select_cpuid(&netisr_proto[proto], NETISR_DISPATCH_HYBRID, 984f2d2d694SRobert Watson source, m, &cpuid); 985d4b5cae4SRobert Watson if (m == NULL) { 986d4b5cae4SRobert Watson error = ENOBUFS; 987f2d2d694SRobert Watson goto out_unpin; 988d4b5cae4SRobert Watson } 98953402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 990d4b5cae4SRobert Watson if (cpuid != curcpu) 991d4b5cae4SRobert Watson goto queue_fallback; 99253402767SRobert Watson nwsp = DPCPU_PTR(nws); 993d4b5cae4SRobert Watson npwp = &nwsp->nws_work[proto]; 994d4b5cae4SRobert Watson 995d4b5cae4SRobert Watson /*- 996d4b5cae4SRobert Watson * We are willing to direct dispatch only if three conditions hold: 997d4b5cae4SRobert Watson * 998d4b5cae4SRobert Watson * (1) The netisr worker isn't already running, 999d4b5cae4SRobert Watson * (2) Another thread isn't already directly dispatching, and 1000d4b5cae4SRobert Watson * (3) The netisr hasn't already been woken up. 1001d4b5cae4SRobert Watson */ 1002d4b5cae4SRobert Watson NWS_LOCK(nwsp); 1003d4b5cae4SRobert Watson if (nwsp->nws_flags & (NWS_RUNNING | NWS_DISPATCHING | NWS_SCHEDULED)) { 1004d4b5cae4SRobert Watson error = netisr_queue_workstream(nwsp, proto, npwp, m, 1005d4b5cae4SRobert Watson &dosignal); 100653402767SRobert Watson NWS_UNLOCK(nwsp); 1007d4b5cae4SRobert Watson if (dosignal) 1008d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 1009d4b5cae4SRobert Watson goto out_unpin; 1010d4b5cae4SRobert Watson } 1011d4b5cae4SRobert Watson 1012d4b5cae4SRobert Watson /* 1013d4b5cae4SRobert Watson * The current thread is now effectively the netisr worker, so set 1014d4b5cae4SRobert Watson * the dispatching flag to prevent concurrent processing of the 1015d4b5cae4SRobert Watson * stream from another thread (even the netisr worker), which could 1016d4b5cae4SRobert Watson * otherwise lead to effective misordering of the stream. 1017d4b5cae4SRobert Watson */ 1018d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_DISPATCHING; 1019d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 1020938448cdSRobert Watson netisr_proto[proto].np_handler(m); 1021d4b5cae4SRobert Watson NWS_LOCK(nwsp); 1022d4b5cae4SRobert Watson nwsp->nws_flags &= ~NWS_DISPATCHING; 1023d4b5cae4SRobert Watson npwp->nw_handled++; 1024d4b5cae4SRobert Watson npwp->nw_hybrid_dispatched++; 1025d4b5cae4SRobert Watson 1026d4b5cae4SRobert Watson /* 1027d4b5cae4SRobert Watson * If other work was enqueued by another thread while we were direct 1028d4b5cae4SRobert Watson * dispatching, we need to signal the netisr worker to do that work. 1029d4b5cae4SRobert Watson * In the future, we might want to do some of that work in the 1030d4b5cae4SRobert Watson * current thread, rather than trigger further context switches. If 1031d4b5cae4SRobert Watson * so, we'll want to establish a reasonable bound on the work done in 1032d4b5cae4SRobert Watson * the "borrowed" context. 1033d4b5cae4SRobert Watson */ 1034d4b5cae4SRobert Watson if (nwsp->nws_pendingbits != 0) { 1035d4b5cae4SRobert Watson nwsp->nws_flags |= NWS_SCHEDULED; 1036d4b5cae4SRobert Watson dosignal = 1; 1037d4b5cae4SRobert Watson } else 1038d4b5cae4SRobert Watson dosignal = 0; 1039d4b5cae4SRobert Watson NWS_UNLOCK(nwsp); 1040d4b5cae4SRobert Watson if (dosignal) 1041d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 1042d4b5cae4SRobert Watson error = 0; 1043d4b5cae4SRobert Watson goto out_unpin; 1044d4b5cae4SRobert Watson 1045d4b5cae4SRobert Watson queue_fallback: 1046d4b5cae4SRobert Watson error = netisr_queue_internal(proto, m, cpuid); 1047d4b5cae4SRobert Watson out_unpin: 1048d4b5cae4SRobert Watson sched_unpin(); 1049d4b5cae4SRobert Watson out_unlock: 1050d4b5cae4SRobert Watson #ifdef NETISR_LOCKING 1051d4b5cae4SRobert Watson NETISR_RUNLOCK(&tracker); 1052d4b5cae4SRobert Watson #endif 1053d4b5cae4SRobert Watson return (error); 1054d4b5cae4SRobert Watson } 1055d4b5cae4SRobert Watson 1056d4b5cae4SRobert Watson int 1057d4b5cae4SRobert Watson netisr_dispatch(u_int proto, struct mbuf *m) 1058d4b5cae4SRobert Watson { 1059d4b5cae4SRobert Watson 1060d4b5cae4SRobert Watson return (netisr_dispatch_src(proto, 0, m)); 1061d4b5cae4SRobert Watson } 1062d4b5cae4SRobert Watson 1063d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 1064d4b5cae4SRobert Watson /* 1065d4b5cae4SRobert Watson * Kernel polling borrows a netisr thread to run interface polling in; this 1066d4b5cae4SRobert Watson * function allows kernel polling to request that the netisr thread be 1067d4b5cae4SRobert Watson * scheduled even if no packets are pending for protocols. 1068d4b5cae4SRobert Watson */ 1069d4b5cae4SRobert Watson void 1070d4b5cae4SRobert Watson netisr_sched_poll(void) 1071d4b5cae4SRobert Watson { 1072d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1073d4b5cae4SRobert Watson 107453402767SRobert Watson nwsp = DPCPU_ID_PTR(nws_array[0], nws); 1075d4b5cae4SRobert Watson NWS_SIGNAL(nwsp); 1076d4b5cae4SRobert Watson } 10771cafed39SJonathan Lemon #endif 1078e3b6e33cSJake Burkholder 1079d4b5cae4SRobert Watson static void 1080d4b5cae4SRobert Watson netisr_start_swi(u_int cpuid, struct pcpu *pc) 1081d4b5cae4SRobert Watson { 1082d4b5cae4SRobert Watson char swiname[12]; 1083d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1084d4b5cae4SRobert Watson int error; 1085d4b5cae4SRobert Watson 108653402767SRobert Watson KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 108753402767SRobert Watson 108853402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 1089d4b5cae4SRobert Watson mtx_init(&nwsp->nws_mtx, "netisr_mtx", NULL, MTX_DEF); 1090d4b5cae4SRobert Watson nwsp->nws_cpu = cpuid; 1091d4b5cae4SRobert Watson snprintf(swiname, sizeof(swiname), "netisr %u", cpuid); 1092d4b5cae4SRobert Watson error = swi_add(&nwsp->nws_intr_event, swiname, swi_net, nwsp, 1093d4b5cae4SRobert Watson SWI_NET, INTR_MPSAFE, &nwsp->nws_swi_cookie); 1094d4b5cae4SRobert Watson if (error) 1095d4b5cae4SRobert Watson panic("%s: swi_add %d", __func__, error); 1096d4b5cae4SRobert Watson pc->pc_netisr = nwsp->nws_intr_event; 1097d4b5cae4SRobert Watson if (netisr_bindthreads) { 1098d4b5cae4SRobert Watson error = intr_event_bind(nwsp->nws_intr_event, cpuid); 1099d4b5cae4SRobert Watson if (error != 0) 1100d4b5cae4SRobert Watson printf("%s: cpu %u: intr_event_bind: %d", __func__, 1101d4b5cae4SRobert Watson cpuid, error); 1102e3b6e33cSJake Burkholder } 1103d4b5cae4SRobert Watson NETISR_WLOCK(); 1104d4b5cae4SRobert Watson nws_array[nws_count] = nwsp->nws_cpu; 1105d4b5cae4SRobert Watson nws_count++; 1106d4b5cae4SRobert Watson NETISR_WUNLOCK(); 1107e3b6e33cSJake Burkholder } 1108e3b6e33cSJake Burkholder 1109d4b5cae4SRobert Watson /* 1110d4b5cae4SRobert Watson * Initialize the netisr subsystem. We rely on BSS and static initialization 1111d4b5cae4SRobert Watson * of most fields in global data structures. 1112d4b5cae4SRobert Watson * 1113d4b5cae4SRobert Watson * Start a worker thread for the boot CPU so that we can support network 1114d4b5cae4SRobert Watson * traffic immediately in case the network stack is used before additional 1115d4b5cae4SRobert Watson * CPUs are started (for example, diskless boot). 1116d4b5cae4SRobert Watson */ 1117e3b6e33cSJake Burkholder static void 1118d4b5cae4SRobert Watson netisr_init(void *arg) 1119e3b6e33cSJake Burkholder { 1120d4b5cae4SRobert Watson KASSERT(curcpu == 0, ("%s: not on CPU 0", __func__)); 1121d4b5cae4SRobert Watson 1122d4b5cae4SRobert Watson NETISR_LOCK_INIT(); 11239e6e01ebSRobert Watson if (netisr_maxthreads < 1) 1124d4b5cae4SRobert Watson netisr_maxthreads = 1; 11259e6e01ebSRobert Watson if (netisr_maxthreads > mp_ncpus) { 1126912f6323SRobert Watson printf("netisr_init: forcing maxthreads from %d to %d\n", 11279e6e01ebSRobert Watson netisr_maxthreads, mp_ncpus); 11289e6e01ebSRobert Watson netisr_maxthreads = mp_ncpus; 1129ed54411cSRobert Watson } 1130ed54411cSRobert Watson if (netisr_defaultqlimit > netisr_maxqlimit) { 1131912f6323SRobert Watson printf("netisr_init: forcing defaultqlimit from %d to %d\n", 11329e6e01ebSRobert Watson netisr_defaultqlimit, netisr_maxqlimit); 1133d4b5cae4SRobert Watson netisr_defaultqlimit = netisr_maxqlimit; 1134ed54411cSRobert Watson } 1135d4b5cae4SRobert Watson #ifdef DEVICE_POLLING 1136d4b5cae4SRobert Watson /* 1137d4b5cae4SRobert Watson * The device polling code is not yet aware of how to deal with 1138d4b5cae4SRobert Watson * multiple netisr threads, so for the time being compiling in device 1139d4b5cae4SRobert Watson * polling disables parallel netisr workers. 1140d4b5cae4SRobert Watson */ 1141ed54411cSRobert Watson if (netisr_maxthreads != 1 || netisr_bindthreads != 0) { 1142912f6323SRobert Watson printf("netisr_init: forcing maxthreads to 1 and " 1143912f6323SRobert Watson "bindthreads to 0 for device polling\n"); 1144d4b5cae4SRobert Watson netisr_maxthreads = 1; 1145d4b5cae4SRobert Watson netisr_bindthreads = 0; 1146ed54411cSRobert Watson } 1147d4b5cae4SRobert Watson #endif 1148d4b5cae4SRobert Watson netisr_start_swi(curcpu, pcpu_find(curcpu)); 1149e3b6e33cSJake Burkholder } 1150d4b5cae4SRobert Watson SYSINIT(netisr_init, SI_SUB_SOFTINTR, SI_ORDER_FIRST, netisr_init, NULL); 1151d4b5cae4SRobert Watson 1152d4b5cae4SRobert Watson /* 1153d4b5cae4SRobert Watson * Start worker threads for additional CPUs. No attempt to gracefully handle 1154d4b5cae4SRobert Watson * work reassignment, we don't yet support dynamic reconfiguration. 1155d4b5cae4SRobert Watson */ 1156d4b5cae4SRobert Watson static void 1157d4b5cae4SRobert Watson netisr_start(void *arg) 1158d4b5cae4SRobert Watson { 1159d4b5cae4SRobert Watson struct pcpu *pc; 1160d4b5cae4SRobert Watson 1161d098f930SNathan Whitehorn STAILQ_FOREACH(pc, &cpuhead, pc_allcpu) { 1162d4b5cae4SRobert Watson if (nws_count >= netisr_maxthreads) 1163d4b5cae4SRobert Watson break; 1164d4b5cae4SRobert Watson /* XXXRW: Is skipping absent CPUs still required here? */ 1165d4b5cae4SRobert Watson if (CPU_ABSENT(pc->pc_cpuid)) 1166d4b5cae4SRobert Watson continue; 1167d4b5cae4SRobert Watson /* Worker will already be present for boot CPU. */ 1168d4b5cae4SRobert Watson if (pc->pc_netisr != NULL) 1169d4b5cae4SRobert Watson continue; 1170d4b5cae4SRobert Watson netisr_start_swi(pc->pc_cpuid, pc); 1171d4b5cae4SRobert Watson } 1172d4b5cae4SRobert Watson } 1173d4b5cae4SRobert Watson SYSINIT(netisr_start, SI_SUB_SMP, SI_ORDER_MIDDLE, netisr_start, NULL); 1174d4b5cae4SRobert Watson 11752d22f334SRobert Watson /* 11762d22f334SRobert Watson * Sysctl monitoring for netisr: query a list of registered protocols. 11772d22f334SRobert Watson */ 11782d22f334SRobert Watson static int 11792d22f334SRobert Watson sysctl_netisr_proto(SYSCTL_HANDLER_ARGS) 11802d22f334SRobert Watson { 11812d22f334SRobert Watson struct rm_priotracker tracker; 11822d22f334SRobert Watson struct sysctl_netisr_proto *snpp, *snp_array; 11832d22f334SRobert Watson struct netisr_proto *npp; 11842d22f334SRobert Watson u_int counter, proto; 11852d22f334SRobert Watson int error; 11862d22f334SRobert Watson 11872d22f334SRobert Watson if (req->newptr != NULL) 11882d22f334SRobert Watson return (EINVAL); 11892d22f334SRobert Watson snp_array = malloc(sizeof(*snp_array) * NETISR_MAXPROT, M_TEMP, 11902d22f334SRobert Watson M_ZERO | M_WAITOK); 11912d22f334SRobert Watson counter = 0; 11922d22f334SRobert Watson NETISR_RLOCK(&tracker); 11932d22f334SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1194938448cdSRobert Watson npp = &netisr_proto[proto]; 11952d22f334SRobert Watson if (npp->np_name == NULL) 11962d22f334SRobert Watson continue; 11972d22f334SRobert Watson snpp = &snp_array[counter]; 11982d22f334SRobert Watson snpp->snp_version = sizeof(*snpp); 11992d22f334SRobert Watson strlcpy(snpp->snp_name, npp->np_name, NETISR_NAMEMAXLEN); 12002d22f334SRobert Watson snpp->snp_proto = proto; 12012d22f334SRobert Watson snpp->snp_qlimit = npp->np_qlimit; 12022d22f334SRobert Watson snpp->snp_policy = npp->np_policy; 1203f2d2d694SRobert Watson snpp->snp_dispatch = npp->np_dispatch; 12042d22f334SRobert Watson if (npp->np_m2flow != NULL) 12052d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_M2FLOW; 12062d22f334SRobert Watson if (npp->np_m2cpuid != NULL) 12072d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_M2CPUID; 12082d22f334SRobert Watson if (npp->np_drainedcpu != NULL) 12092d22f334SRobert Watson snpp->snp_flags |= NETISR_SNP_FLAGS_DRAINEDCPU; 12102d22f334SRobert Watson counter++; 12112d22f334SRobert Watson } 12122d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 12137f450febSRobert Watson KASSERT(counter <= NETISR_MAXPROT, 12142d22f334SRobert Watson ("sysctl_netisr_proto: counter too big (%d)", counter)); 12152d22f334SRobert Watson error = SYSCTL_OUT(req, snp_array, sizeof(*snp_array) * counter); 12162d22f334SRobert Watson free(snp_array, M_TEMP); 12172d22f334SRobert Watson return (error); 12182d22f334SRobert Watson } 12192d22f334SRobert Watson 12202d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, proto, 12212d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_proto, 12222d22f334SRobert Watson "S,sysctl_netisr_proto", 12232d22f334SRobert Watson "Return list of protocols registered with netisr"); 12242d22f334SRobert Watson 12252d22f334SRobert Watson /* 12262d22f334SRobert Watson * Sysctl monitoring for netisr: query a list of workstreams. 12272d22f334SRobert Watson */ 12282d22f334SRobert Watson static int 12292d22f334SRobert Watson sysctl_netisr_workstream(SYSCTL_HANDLER_ARGS) 12302d22f334SRobert Watson { 12312d22f334SRobert Watson struct rm_priotracker tracker; 12322d22f334SRobert Watson struct sysctl_netisr_workstream *snwsp, *snws_array; 12332d22f334SRobert Watson struct netisr_workstream *nwsp; 12342d22f334SRobert Watson u_int counter, cpuid; 12352d22f334SRobert Watson int error; 12362d22f334SRobert Watson 12372d22f334SRobert Watson if (req->newptr != NULL) 12382d22f334SRobert Watson return (EINVAL); 12392d22f334SRobert Watson snws_array = malloc(sizeof(*snws_array) * MAXCPU, M_TEMP, 12402d22f334SRobert Watson M_ZERO | M_WAITOK); 12412d22f334SRobert Watson counter = 0; 12422d22f334SRobert Watson NETISR_RLOCK(&tracker); 12433aa6d94eSJohn Baldwin CPU_FOREACH(cpuid) { 12442d22f334SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 12452d22f334SRobert Watson if (nwsp->nws_intr_event == NULL) 12462d22f334SRobert Watson continue; 12472d22f334SRobert Watson NWS_LOCK(nwsp); 12482d22f334SRobert Watson snwsp = &snws_array[counter]; 12492d22f334SRobert Watson snwsp->snws_version = sizeof(*snwsp); 12502d22f334SRobert Watson 12512d22f334SRobert Watson /* 12522d22f334SRobert Watson * For now, we equate workstream IDs and CPU IDs in the 12532d22f334SRobert Watson * kernel, but expose them independently to userspace in case 12542d22f334SRobert Watson * that assumption changes in the future. 12552d22f334SRobert Watson */ 12562d22f334SRobert Watson snwsp->snws_wsid = cpuid; 12572d22f334SRobert Watson snwsp->snws_cpu = cpuid; 12582d22f334SRobert Watson if (nwsp->nws_intr_event != NULL) 12592d22f334SRobert Watson snwsp->snws_flags |= NETISR_SNWS_FLAGS_INTR; 12602d22f334SRobert Watson NWS_UNLOCK(nwsp); 12612d22f334SRobert Watson counter++; 12622d22f334SRobert Watson } 12632d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 12647f450febSRobert Watson KASSERT(counter <= MAXCPU, 12652d22f334SRobert Watson ("sysctl_netisr_workstream: counter too big (%d)", counter)); 12662d22f334SRobert Watson error = SYSCTL_OUT(req, snws_array, sizeof(*snws_array) * counter); 12672d22f334SRobert Watson free(snws_array, M_TEMP); 12682d22f334SRobert Watson return (error); 12692d22f334SRobert Watson } 12702d22f334SRobert Watson 12712d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, workstream, 12722d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_workstream, 12732d22f334SRobert Watson "S,sysctl_netisr_workstream", 12742d22f334SRobert Watson "Return list of workstreams implemented by netisr"); 12752d22f334SRobert Watson 12762d22f334SRobert Watson /* 12772d22f334SRobert Watson * Sysctl monitoring for netisr: query per-protocol data across all 12782d22f334SRobert Watson * workstreams. 12792d22f334SRobert Watson */ 12802d22f334SRobert Watson static int 12812d22f334SRobert Watson sysctl_netisr_work(SYSCTL_HANDLER_ARGS) 12822d22f334SRobert Watson { 12832d22f334SRobert Watson struct rm_priotracker tracker; 12842d22f334SRobert Watson struct sysctl_netisr_work *snwp, *snw_array; 12852d22f334SRobert Watson struct netisr_workstream *nwsp; 12862d22f334SRobert Watson struct netisr_proto *npp; 12872d22f334SRobert Watson struct netisr_work *nwp; 12882d22f334SRobert Watson u_int counter, cpuid, proto; 12892d22f334SRobert Watson int error; 12902d22f334SRobert Watson 12912d22f334SRobert Watson if (req->newptr != NULL) 12922d22f334SRobert Watson return (EINVAL); 12932d22f334SRobert Watson snw_array = malloc(sizeof(*snw_array) * MAXCPU * NETISR_MAXPROT, 12942d22f334SRobert Watson M_TEMP, M_ZERO | M_WAITOK); 12952d22f334SRobert Watson counter = 0; 12962d22f334SRobert Watson NETISR_RLOCK(&tracker); 12973aa6d94eSJohn Baldwin CPU_FOREACH(cpuid) { 12982d22f334SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 12992d22f334SRobert Watson if (nwsp->nws_intr_event == NULL) 13002d22f334SRobert Watson continue; 13012d22f334SRobert Watson NWS_LOCK(nwsp); 13022d22f334SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1303938448cdSRobert Watson npp = &netisr_proto[proto]; 13042d22f334SRobert Watson if (npp->np_name == NULL) 13052d22f334SRobert Watson continue; 13062d22f334SRobert Watson nwp = &nwsp->nws_work[proto]; 13072d22f334SRobert Watson snwp = &snw_array[counter]; 13082d22f334SRobert Watson snwp->snw_version = sizeof(*snwp); 13092d22f334SRobert Watson snwp->snw_wsid = cpuid; /* See comment above. */ 13102d22f334SRobert Watson snwp->snw_proto = proto; 13112d22f334SRobert Watson snwp->snw_len = nwp->nw_len; 13122d22f334SRobert Watson snwp->snw_watermark = nwp->nw_watermark; 13132d22f334SRobert Watson snwp->snw_dispatched = nwp->nw_dispatched; 13142d22f334SRobert Watson snwp->snw_hybrid_dispatched = 13152d22f334SRobert Watson nwp->nw_hybrid_dispatched; 13162d22f334SRobert Watson snwp->snw_qdrops = nwp->nw_qdrops; 13172d22f334SRobert Watson snwp->snw_queued = nwp->nw_queued; 13182d22f334SRobert Watson snwp->snw_handled = nwp->nw_handled; 13192d22f334SRobert Watson counter++; 13202d22f334SRobert Watson } 13212d22f334SRobert Watson NWS_UNLOCK(nwsp); 13222d22f334SRobert Watson } 13237f450febSRobert Watson KASSERT(counter <= MAXCPU * NETISR_MAXPROT, 13242d22f334SRobert Watson ("sysctl_netisr_work: counter too big (%d)", counter)); 13252d22f334SRobert Watson NETISR_RUNLOCK(&tracker); 13262d22f334SRobert Watson error = SYSCTL_OUT(req, snw_array, sizeof(*snw_array) * counter); 13272d22f334SRobert Watson free(snw_array, M_TEMP); 13282d22f334SRobert Watson return (error); 13292d22f334SRobert Watson } 13302d22f334SRobert Watson 13312d22f334SRobert Watson SYSCTL_PROC(_net_isr, OID_AUTO, work, 13322d22f334SRobert Watson CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_work, 13332d22f334SRobert Watson "S,sysctl_netisr_work", 13342d22f334SRobert Watson "Return list of per-workstream, per-protocol work in netisr"); 13352d22f334SRobert Watson 1336d4b5cae4SRobert Watson #ifdef DDB 1337d4b5cae4SRobert Watson DB_SHOW_COMMAND(netisr, db_show_netisr) 1338d4b5cae4SRobert Watson { 1339d4b5cae4SRobert Watson struct netisr_workstream *nwsp; 1340d4b5cae4SRobert Watson struct netisr_work *nwp; 1341d4b5cae4SRobert Watson int first, proto; 134253402767SRobert Watson u_int cpuid; 1343d4b5cae4SRobert Watson 1344d4b5cae4SRobert Watson db_printf("%3s %6s %5s %5s %5s %8s %8s %8s %8s\n", "CPU", "Proto", 1345d4b5cae4SRobert Watson "Len", "WMark", "Max", "Disp", "HDisp", "Drop", "Queue"); 13463aa6d94eSJohn Baldwin CPU_FOREACH(cpuid) { 134753402767SRobert Watson nwsp = DPCPU_ID_PTR(cpuid, nws); 1348d4b5cae4SRobert Watson if (nwsp->nws_intr_event == NULL) 1349d4b5cae4SRobert Watson continue; 1350d4b5cae4SRobert Watson first = 1; 1351d4b5cae4SRobert Watson for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1352938448cdSRobert Watson if (netisr_proto[proto].np_handler == NULL) 1353d4b5cae4SRobert Watson continue; 1354d4b5cae4SRobert Watson nwp = &nwsp->nws_work[proto]; 1355d4b5cae4SRobert Watson if (first) { 135653402767SRobert Watson db_printf("%3d ", cpuid); 1357d4b5cae4SRobert Watson first = 0; 1358d4b5cae4SRobert Watson } else 1359d4b5cae4SRobert Watson db_printf("%3s ", ""); 1360d4b5cae4SRobert Watson db_printf( 1361d4b5cae4SRobert Watson "%6s %5d %5d %5d %8ju %8ju %8ju %8ju\n", 1362938448cdSRobert Watson netisr_proto[proto].np_name, nwp->nw_len, 1363d4b5cae4SRobert Watson nwp->nw_watermark, nwp->nw_qlimit, 1364d4b5cae4SRobert Watson nwp->nw_dispatched, nwp->nw_hybrid_dispatched, 1365d4b5cae4SRobert Watson nwp->nw_qdrops, nwp->nw_queued); 1366d4b5cae4SRobert Watson } 1367d4b5cae4SRobert Watson } 1368d4b5cae4SRobert Watson } 1369d4b5cae4SRobert Watson #endif 1370