1 /*- 2 * Copyright (c) 2007-2009 Robert N. M. Watson 3 * Copyright (c) 2010-2011 Juniper Networks, Inc. 4 * All rights reserved. 5 * 6 * This software was developed by Robert N. M. Watson under contract 7 * to Juniper Networks, Inc. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28 * SUCH DAMAGE. 29 */ 30 31 #include <sys/cdefs.h> 32 __FBSDID("$FreeBSD$"); 33 34 /* 35 * netisr is a packet dispatch service, allowing synchronous (directly 36 * dispatched) and asynchronous (deferred dispatch) processing of packets by 37 * registered protocol handlers. Callers pass a protocol identifier and 38 * packet to netisr, along with a direct dispatch hint, and work will either 39 * be immediately processed by the registered handler, or passed to a 40 * software interrupt (SWI) thread for deferred dispatch. Callers will 41 * generally select one or the other based on: 42 * 43 * - Whether directly dispatching a netisr handler lead to code reentrance or 44 * lock recursion, such as entering the socket code from the socket code. 45 * - Whether directly dispatching a netisr handler lead to recursive 46 * processing, such as when decapsulating several wrapped layers of tunnel 47 * information (IPSEC within IPSEC within ...). 48 * 49 * Maintaining ordering for protocol streams is a critical design concern. 50 * Enforcing ordering limits the opportunity for concurrency, but maintains 51 * the strong ordering requirements found in some protocols, such as TCP. Of 52 * related concern is CPU affinity--it is desirable to process all data 53 * associated with a particular stream on the same CPU over time in order to 54 * avoid acquiring locks associated with the connection on different CPUs, 55 * keep connection data in one cache, and to generally encourage associated 56 * user threads to live on the same CPU as the stream. It's also desirable 57 * to avoid lock migration and contention where locks are associated with 58 * more than one flow. 59 * 60 * netisr supports several policy variations, represented by the 61 * NETISR_POLICY_* constants, allowing protocols to play various roles in 62 * identifying flows, assigning work to CPUs, etc. These are described in 63 * netisr.h. 64 */ 65 66 #include "opt_ddb.h" 67 #include "opt_device_polling.h" 68 69 #include <sys/param.h> 70 #include <sys/bus.h> 71 #include <sys/kernel.h> 72 #include <sys/kthread.h> 73 #include <sys/malloc.h> 74 #include <sys/interrupt.h> 75 #include <sys/lock.h> 76 #include <sys/mbuf.h> 77 #include <sys/mutex.h> 78 #include <sys/pcpu.h> 79 #include <sys/proc.h> 80 #include <sys/rmlock.h> 81 #include <sys/sched.h> 82 #include <sys/smp.h> 83 #include <sys/socket.h> 84 #include <sys/sysctl.h> 85 #include <sys/systm.h> 86 87 #ifdef DDB 88 #include <ddb/ddb.h> 89 #endif 90 91 #define _WANT_NETISR_INTERNAL /* Enable definitions from netisr_internal.h */ 92 #include <net/if.h> 93 #include <net/if_var.h> 94 #include <net/netisr.h> 95 #include <net/netisr_internal.h> 96 #include <net/vnet.h> 97 98 /*- 99 * Synchronize use and modification of the registered netisr data structures; 100 * acquire a read lock while modifying the set of registered protocols to 101 * prevent partially registered or unregistered protocols from being run. 102 * 103 * The following data structures and fields are protected by this lock: 104 * 105 * - The netisr_proto array, including all fields of struct netisr_proto. 106 * - The nws array, including all fields of struct netisr_worker. 107 * - The nws_array array. 108 * 109 * Note: the NETISR_LOCKING define controls whether read locks are acquired 110 * in packet processing paths requiring netisr registration stability. This 111 * is disabled by default as it can lead to measurable performance 112 * degradation even with rmlocks (3%-6% for loopback ping-pong traffic), and 113 * because netisr registration and unregistration is extremely rare at 114 * runtime. If it becomes more common, this decision should be revisited. 115 * 116 * XXXRW: rmlocks don't support assertions. 117 */ 118 static struct rmlock netisr_rmlock; 119 #define NETISR_LOCK_INIT() rm_init_flags(&netisr_rmlock, "netisr", \ 120 RM_NOWITNESS) 121 #define NETISR_LOCK_ASSERT() 122 #define NETISR_RLOCK(tracker) rm_rlock(&netisr_rmlock, (tracker)) 123 #define NETISR_RUNLOCK(tracker) rm_runlock(&netisr_rmlock, (tracker)) 124 #define NETISR_WLOCK() rm_wlock(&netisr_rmlock) 125 #define NETISR_WUNLOCK() rm_wunlock(&netisr_rmlock) 126 /* #define NETISR_LOCKING */ 127 128 static SYSCTL_NODE(_net, OID_AUTO, isr, CTLFLAG_RW, 0, "netisr"); 129 130 /*- 131 * Three global direct dispatch policies are supported: 132 * 133 * NETISR_DISPATCH_DEFERRED: All work is deferred for a netisr, regardless of 134 * context (may be overriden by protocols). 135 * 136 * NETISR_DISPATCH_HYBRID: If the executing context allows direct dispatch, 137 * and we're running on the CPU the work would be performed on, then direct 138 * dispatch it if it wouldn't violate ordering constraints on the workstream. 139 * 140 * NETISR_DISPATCH_DIRECT: If the executing context allows direct dispatch, 141 * always direct dispatch. (The default.) 142 * 143 * Notice that changing the global policy could lead to short periods of 144 * misordered processing, but this is considered acceptable as compared to 145 * the complexity of enforcing ordering during policy changes. Protocols can 146 * override the global policy (when they're not doing that, they select 147 * NETISR_DISPATCH_DEFAULT). 148 */ 149 #define NETISR_DISPATCH_POLICY_DEFAULT NETISR_DISPATCH_DIRECT 150 #define NETISR_DISPATCH_POLICY_MAXSTR 20 /* Used for temporary buffers. */ 151 static u_int netisr_dispatch_policy = NETISR_DISPATCH_POLICY_DEFAULT; 152 static int sysctl_netisr_dispatch_policy(SYSCTL_HANDLER_ARGS); 153 SYSCTL_PROC(_net_isr, OID_AUTO, dispatch, CTLTYPE_STRING | CTLFLAG_RWTUN, 154 0, 0, sysctl_netisr_dispatch_policy, "A", 155 "netisr dispatch policy"); 156 157 /* 158 * Allow the administrator to limit the number of threads (CPUs) to use for 159 * netisr. We don't check netisr_maxthreads before creating the thread for 160 * CPU 0. This must be set at boot. We will create at most one thread per CPU. 161 * By default we initialize this to 1 which would assign just 1 cpu (cpu0) and 162 * therefore only 1 workstream. If set to -1, netisr would use all cpus 163 * (mp_ncpus) and therefore would have those many workstreams. One workstream 164 * per thread (CPU). 165 */ 166 static int netisr_maxthreads = 1; /* Max number of threads. */ 167 SYSCTL_INT(_net_isr, OID_AUTO, maxthreads, CTLFLAG_RDTUN, 168 &netisr_maxthreads, 0, 169 "Use at most this many CPUs for netisr processing"); 170 171 static int netisr_bindthreads = 0; /* Bind threads to CPUs. */ 172 SYSCTL_INT(_net_isr, OID_AUTO, bindthreads, CTLFLAG_RDTUN, 173 &netisr_bindthreads, 0, "Bind netisr threads to CPUs."); 174 175 /* 176 * Limit per-workstream mbuf queue limits s to at most net.isr.maxqlimit, 177 * both for initial configuration and later modification using 178 * netisr_setqlimit(). 179 */ 180 #define NETISR_DEFAULT_MAXQLIMIT 10240 181 static u_int netisr_maxqlimit = NETISR_DEFAULT_MAXQLIMIT; 182 SYSCTL_UINT(_net_isr, OID_AUTO, maxqlimit, CTLFLAG_RDTUN, 183 &netisr_maxqlimit, 0, 184 "Maximum netisr per-protocol, per-CPU queue depth."); 185 186 /* 187 * The default per-workstream mbuf queue limit for protocols that don't 188 * initialize the nh_qlimit field of their struct netisr_handler. If this is 189 * set above netisr_maxqlimit, we truncate it to the maximum during boot. 190 */ 191 #define NETISR_DEFAULT_DEFAULTQLIMIT 256 192 static u_int netisr_defaultqlimit = NETISR_DEFAULT_DEFAULTQLIMIT; 193 SYSCTL_UINT(_net_isr, OID_AUTO, defaultqlimit, CTLFLAG_RDTUN, 194 &netisr_defaultqlimit, 0, 195 "Default netisr per-protocol, per-CPU queue limit if not set by protocol"); 196 197 /* 198 * Store and export the compile-time constant NETISR_MAXPROT limit on the 199 * number of protocols that can register with netisr at a time. This is 200 * required for crashdump analysis, as it sizes netisr_proto[]. 201 */ 202 static u_int netisr_maxprot = NETISR_MAXPROT; 203 SYSCTL_UINT(_net_isr, OID_AUTO, maxprot, CTLFLAG_RD, 204 &netisr_maxprot, 0, 205 "Compile-time limit on the number of protocols supported by netisr."); 206 207 /* 208 * The netisr_proto array describes all registered protocols, indexed by 209 * protocol number. See netisr_internal.h for more details. 210 */ 211 static struct netisr_proto netisr_proto[NETISR_MAXPROT]; 212 213 #ifdef VIMAGE 214 /* 215 * The netisr_enable array describes a per-VNET flag for registered 216 * protocols on whether this netisr is active in this VNET or not. 217 * netisr_register() will automatically enable the netisr for the 218 * default VNET and all currently active instances. 219 * netisr_unregister() will disable all active VNETs, including vnet0. 220 * Individual network stack instances can be enabled/disabled by the 221 * netisr_(un)register _vnet() functions. 222 * With this we keep the one netisr_proto per protocol but add a 223 * mechanism to stop netisr processing for vnet teardown. 224 * Apart from that we expect a VNET to always be enabled. 225 */ 226 static VNET_DEFINE(u_int, netisr_enable[NETISR_MAXPROT]); 227 #define V_netisr_enable VNET(netisr_enable) 228 #endif 229 230 /* 231 * Per-CPU workstream data. See netisr_internal.h for more details. 232 */ 233 DPCPU_DEFINE(struct netisr_workstream, nws); 234 235 /* 236 * Map contiguous values between 0 and nws_count into CPU IDs appropriate for 237 * accessing workstreams. This allows constructions of the form 238 * DPCPU_ID_GET(nws_array[arbitraryvalue % nws_count], nws). 239 */ 240 static u_int nws_array[MAXCPU]; 241 242 /* 243 * Number of registered workstreams. Will be at most the number of running 244 * CPUs once fully started. 245 */ 246 static u_int nws_count; 247 SYSCTL_UINT(_net_isr, OID_AUTO, numthreads, CTLFLAG_RD, 248 &nws_count, 0, "Number of extant netisr threads."); 249 250 /* 251 * Synchronization for each workstream: a mutex protects all mutable fields 252 * in each stream, including per-protocol state (mbuf queues). The SWI is 253 * woken up if asynchronous dispatch is required. 254 */ 255 #define NWS_LOCK(s) mtx_lock(&(s)->nws_mtx) 256 #define NWS_LOCK_ASSERT(s) mtx_assert(&(s)->nws_mtx, MA_OWNED) 257 #define NWS_UNLOCK(s) mtx_unlock(&(s)->nws_mtx) 258 #define NWS_SIGNAL(s) swi_sched((s)->nws_swi_cookie, 0) 259 260 /* 261 * Utility routines for protocols that implement their own mapping of flows 262 * to CPUs. 263 */ 264 u_int 265 netisr_get_cpucount(void) 266 { 267 268 return (nws_count); 269 } 270 271 u_int 272 netisr_get_cpuid(u_int cpunumber) 273 { 274 275 return (nws_array[cpunumber % nws_count]); 276 } 277 278 /* 279 * The default implementation of flow -> CPU ID mapping. 280 * 281 * Non-static so that protocols can use it to map their own work to specific 282 * CPUs in a manner consistent to netisr for affinity purposes. 283 */ 284 u_int 285 netisr_default_flow2cpu(u_int flowid) 286 { 287 288 return (nws_array[flowid % nws_count]); 289 } 290 291 /* 292 * Dispatch tunable and sysctl configuration. 293 */ 294 struct netisr_dispatch_table_entry { 295 u_int ndte_policy; 296 const char *ndte_policy_str; 297 }; 298 static const struct netisr_dispatch_table_entry netisr_dispatch_table[] = { 299 { NETISR_DISPATCH_DEFAULT, "default" }, 300 { NETISR_DISPATCH_DEFERRED, "deferred" }, 301 { NETISR_DISPATCH_HYBRID, "hybrid" }, 302 { NETISR_DISPATCH_DIRECT, "direct" }, 303 }; 304 305 static void 306 netisr_dispatch_policy_to_str(u_int dispatch_policy, char *buffer, 307 u_int buflen) 308 { 309 const struct netisr_dispatch_table_entry *ndtep; 310 const char *str; 311 u_int i; 312 313 str = "unknown"; 314 for (i = 0; i < nitems(netisr_dispatch_table); i++) { 315 ndtep = &netisr_dispatch_table[i]; 316 if (ndtep->ndte_policy == dispatch_policy) { 317 str = ndtep->ndte_policy_str; 318 break; 319 } 320 } 321 snprintf(buffer, buflen, "%s", str); 322 } 323 324 static int 325 netisr_dispatch_policy_from_str(const char *str, u_int *dispatch_policyp) 326 { 327 const struct netisr_dispatch_table_entry *ndtep; 328 u_int i; 329 330 for (i = 0; i < nitems(netisr_dispatch_table); i++) { 331 ndtep = &netisr_dispatch_table[i]; 332 if (strcmp(ndtep->ndte_policy_str, str) == 0) { 333 *dispatch_policyp = ndtep->ndte_policy; 334 return (0); 335 } 336 } 337 return (EINVAL); 338 } 339 340 static int 341 sysctl_netisr_dispatch_policy(SYSCTL_HANDLER_ARGS) 342 { 343 char tmp[NETISR_DISPATCH_POLICY_MAXSTR]; 344 u_int dispatch_policy; 345 int error; 346 347 netisr_dispatch_policy_to_str(netisr_dispatch_policy, tmp, 348 sizeof(tmp)); 349 error = sysctl_handle_string(oidp, tmp, sizeof(tmp), req); 350 if (error == 0 && req->newptr != NULL) { 351 error = netisr_dispatch_policy_from_str(tmp, 352 &dispatch_policy); 353 if (error == 0 && dispatch_policy == NETISR_DISPATCH_DEFAULT) 354 error = EINVAL; 355 if (error == 0) 356 netisr_dispatch_policy = dispatch_policy; 357 } 358 return (error); 359 } 360 361 /* 362 * Register a new netisr handler, which requires initializing per-protocol 363 * fields for each workstream. All netisr work is briefly suspended while 364 * the protocol is installed. 365 */ 366 void 367 netisr_register(const struct netisr_handler *nhp) 368 { 369 VNET_ITERATOR_DECL(vnet_iter); 370 struct netisr_work *npwp; 371 const char *name; 372 u_int i, proto; 373 374 proto = nhp->nh_proto; 375 name = nhp->nh_name; 376 377 /* 378 * Test that the requested registration is valid. 379 */ 380 KASSERT(nhp->nh_name != NULL, 381 ("%s: nh_name NULL for %u", __func__, proto)); 382 KASSERT(nhp->nh_handler != NULL, 383 ("%s: nh_handler NULL for %s", __func__, name)); 384 KASSERT(nhp->nh_policy == NETISR_POLICY_SOURCE || 385 nhp->nh_policy == NETISR_POLICY_FLOW || 386 nhp->nh_policy == NETISR_POLICY_CPU, 387 ("%s: unsupported nh_policy %u for %s", __func__, 388 nhp->nh_policy, name)); 389 KASSERT(nhp->nh_policy == NETISR_POLICY_FLOW || 390 nhp->nh_m2flow == NULL, 391 ("%s: nh_policy != FLOW but m2flow defined for %s", __func__, 392 name)); 393 KASSERT(nhp->nh_policy == NETISR_POLICY_CPU || nhp->nh_m2cpuid == NULL, 394 ("%s: nh_policy != CPU but m2cpuid defined for %s", __func__, 395 name)); 396 KASSERT(nhp->nh_policy != NETISR_POLICY_CPU || nhp->nh_m2cpuid != NULL, 397 ("%s: nh_policy == CPU but m2cpuid not defined for %s", __func__, 398 name)); 399 KASSERT(nhp->nh_dispatch == NETISR_DISPATCH_DEFAULT || 400 nhp->nh_dispatch == NETISR_DISPATCH_DEFERRED || 401 nhp->nh_dispatch == NETISR_DISPATCH_HYBRID || 402 nhp->nh_dispatch == NETISR_DISPATCH_DIRECT, 403 ("%s: invalid nh_dispatch (%u)", __func__, nhp->nh_dispatch)); 404 405 KASSERT(proto < NETISR_MAXPROT, 406 ("%s(%u, %s): protocol too big", __func__, proto, name)); 407 408 /* 409 * Test that no existing registration exists for this protocol. 410 */ 411 NETISR_WLOCK(); 412 KASSERT(netisr_proto[proto].np_name == NULL, 413 ("%s(%u, %s): name present", __func__, proto, name)); 414 KASSERT(netisr_proto[proto].np_handler == NULL, 415 ("%s(%u, %s): handler present", __func__, proto, name)); 416 417 netisr_proto[proto].np_name = name; 418 netisr_proto[proto].np_handler = nhp->nh_handler; 419 netisr_proto[proto].np_m2flow = nhp->nh_m2flow; 420 netisr_proto[proto].np_m2cpuid = nhp->nh_m2cpuid; 421 netisr_proto[proto].np_drainedcpu = nhp->nh_drainedcpu; 422 if (nhp->nh_qlimit == 0) 423 netisr_proto[proto].np_qlimit = netisr_defaultqlimit; 424 else if (nhp->nh_qlimit > netisr_maxqlimit) { 425 printf("%s: %s requested queue limit %u capped to " 426 "net.isr.maxqlimit %u\n", __func__, name, nhp->nh_qlimit, 427 netisr_maxqlimit); 428 netisr_proto[proto].np_qlimit = netisr_maxqlimit; 429 } else 430 netisr_proto[proto].np_qlimit = nhp->nh_qlimit; 431 netisr_proto[proto].np_policy = nhp->nh_policy; 432 netisr_proto[proto].np_dispatch = nhp->nh_dispatch; 433 CPU_FOREACH(i) { 434 npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 435 bzero(npwp, sizeof(*npwp)); 436 npwp->nw_qlimit = netisr_proto[proto].np_qlimit; 437 } 438 439 #ifdef VIMAGE 440 /* 441 * Test that we are in vnet0 and have a curvnet set. 442 */ 443 KASSERT(curvnet != NULL, ("%s: curvnet is NULL", __func__)); 444 KASSERT(IS_DEFAULT_VNET(curvnet), ("%s: curvnet %p is not vnet0 %p", 445 __func__, curvnet, vnet0)); 446 VNET_LIST_RLOCK_NOSLEEP(); 447 VNET_FOREACH(vnet_iter) { 448 CURVNET_SET(vnet_iter); 449 V_netisr_enable[proto] = 1; 450 CURVNET_RESTORE(); 451 } 452 VNET_LIST_RUNLOCK_NOSLEEP(); 453 #endif 454 NETISR_WUNLOCK(); 455 } 456 457 /* 458 * Clear drop counters across all workstreams for a protocol. 459 */ 460 void 461 netisr_clearqdrops(const struct netisr_handler *nhp) 462 { 463 struct netisr_work *npwp; 464 #ifdef INVARIANTS 465 const char *name; 466 #endif 467 u_int i, proto; 468 469 proto = nhp->nh_proto; 470 #ifdef INVARIANTS 471 name = nhp->nh_name; 472 #endif 473 KASSERT(proto < NETISR_MAXPROT, 474 ("%s(%u): protocol too big for %s", __func__, proto, name)); 475 476 NETISR_WLOCK(); 477 KASSERT(netisr_proto[proto].np_handler != NULL, 478 ("%s(%u): protocol not registered for %s", __func__, proto, 479 name)); 480 481 CPU_FOREACH(i) { 482 npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 483 npwp->nw_qdrops = 0; 484 } 485 NETISR_WUNLOCK(); 486 } 487 488 /* 489 * Query current drop counters across all workstreams for a protocol. 490 */ 491 void 492 netisr_getqdrops(const struct netisr_handler *nhp, u_int64_t *qdropp) 493 { 494 struct netisr_work *npwp; 495 struct rm_priotracker tracker; 496 #ifdef INVARIANTS 497 const char *name; 498 #endif 499 u_int i, proto; 500 501 *qdropp = 0; 502 proto = nhp->nh_proto; 503 #ifdef INVARIANTS 504 name = nhp->nh_name; 505 #endif 506 KASSERT(proto < NETISR_MAXPROT, 507 ("%s(%u): protocol too big for %s", __func__, proto, name)); 508 509 NETISR_RLOCK(&tracker); 510 KASSERT(netisr_proto[proto].np_handler != NULL, 511 ("%s(%u): protocol not registered for %s", __func__, proto, 512 name)); 513 514 CPU_FOREACH(i) { 515 npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 516 *qdropp += npwp->nw_qdrops; 517 } 518 NETISR_RUNLOCK(&tracker); 519 } 520 521 /* 522 * Query current per-workstream queue limit for a protocol. 523 */ 524 void 525 netisr_getqlimit(const struct netisr_handler *nhp, u_int *qlimitp) 526 { 527 struct rm_priotracker tracker; 528 #ifdef INVARIANTS 529 const char *name; 530 #endif 531 u_int proto; 532 533 proto = nhp->nh_proto; 534 #ifdef INVARIANTS 535 name = nhp->nh_name; 536 #endif 537 KASSERT(proto < NETISR_MAXPROT, 538 ("%s(%u): protocol too big for %s", __func__, proto, name)); 539 540 NETISR_RLOCK(&tracker); 541 KASSERT(netisr_proto[proto].np_handler != NULL, 542 ("%s(%u): protocol not registered for %s", __func__, proto, 543 name)); 544 *qlimitp = netisr_proto[proto].np_qlimit; 545 NETISR_RUNLOCK(&tracker); 546 } 547 548 /* 549 * Update the queue limit across per-workstream queues for a protocol. We 550 * simply change the limits, and don't drain overflowed packets as they will 551 * (hopefully) take care of themselves shortly. 552 */ 553 int 554 netisr_setqlimit(const struct netisr_handler *nhp, u_int qlimit) 555 { 556 struct netisr_work *npwp; 557 #ifdef INVARIANTS 558 const char *name; 559 #endif 560 u_int i, proto; 561 562 if (qlimit > netisr_maxqlimit) 563 return (EINVAL); 564 565 proto = nhp->nh_proto; 566 #ifdef INVARIANTS 567 name = nhp->nh_name; 568 #endif 569 KASSERT(proto < NETISR_MAXPROT, 570 ("%s(%u): protocol too big for %s", __func__, proto, name)); 571 572 NETISR_WLOCK(); 573 KASSERT(netisr_proto[proto].np_handler != NULL, 574 ("%s(%u): protocol not registered for %s", __func__, proto, 575 name)); 576 577 netisr_proto[proto].np_qlimit = qlimit; 578 CPU_FOREACH(i) { 579 npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 580 npwp->nw_qlimit = qlimit; 581 } 582 NETISR_WUNLOCK(); 583 return (0); 584 } 585 586 /* 587 * Drain all packets currently held in a particular protocol work queue. 588 */ 589 static void 590 netisr_drain_proto(struct netisr_work *npwp) 591 { 592 struct mbuf *m; 593 594 /* 595 * We would assert the lock on the workstream but it's not passed in. 596 */ 597 while ((m = npwp->nw_head) != NULL) { 598 npwp->nw_head = m->m_nextpkt; 599 m->m_nextpkt = NULL; 600 if (npwp->nw_head == NULL) 601 npwp->nw_tail = NULL; 602 npwp->nw_len--; 603 m_freem(m); 604 } 605 KASSERT(npwp->nw_tail == NULL, ("%s: tail", __func__)); 606 KASSERT(npwp->nw_len == 0, ("%s: len", __func__)); 607 } 608 609 /* 610 * Remove the registration of a network protocol, which requires clearing 611 * per-protocol fields across all workstreams, including freeing all mbufs in 612 * the queues at time of unregister. All work in netisr is briefly suspended 613 * while this takes place. 614 */ 615 void 616 netisr_unregister(const struct netisr_handler *nhp) 617 { 618 VNET_ITERATOR_DECL(vnet_iter); 619 struct netisr_work *npwp; 620 #ifdef INVARIANTS 621 const char *name; 622 #endif 623 u_int i, proto; 624 625 proto = nhp->nh_proto; 626 #ifdef INVARIANTS 627 name = nhp->nh_name; 628 #endif 629 KASSERT(proto < NETISR_MAXPROT, 630 ("%s(%u): protocol too big for %s", __func__, proto, name)); 631 632 NETISR_WLOCK(); 633 KASSERT(netisr_proto[proto].np_handler != NULL, 634 ("%s(%u): protocol not registered for %s", __func__, proto, 635 name)); 636 637 #ifdef VIMAGE 638 VNET_LIST_RLOCK_NOSLEEP(); 639 VNET_FOREACH(vnet_iter) { 640 CURVNET_SET(vnet_iter); 641 V_netisr_enable[proto] = 0; 642 CURVNET_RESTORE(); 643 } 644 VNET_LIST_RUNLOCK_NOSLEEP(); 645 #endif 646 647 netisr_proto[proto].np_name = NULL; 648 netisr_proto[proto].np_handler = NULL; 649 netisr_proto[proto].np_m2flow = NULL; 650 netisr_proto[proto].np_m2cpuid = NULL; 651 netisr_proto[proto].np_qlimit = 0; 652 netisr_proto[proto].np_policy = 0; 653 CPU_FOREACH(i) { 654 npwp = &(DPCPU_ID_PTR(i, nws))->nws_work[proto]; 655 netisr_drain_proto(npwp); 656 bzero(npwp, sizeof(*npwp)); 657 } 658 NETISR_WUNLOCK(); 659 } 660 661 #ifdef VIMAGE 662 void 663 netisr_register_vnet(const struct netisr_handler *nhp) 664 { 665 u_int proto; 666 667 proto = nhp->nh_proto; 668 669 KASSERT(curvnet != NULL, ("%s: curvnet is NULL", __func__)); 670 KASSERT(proto < NETISR_MAXPROT, 671 ("%s(%u): protocol too big for %s", __func__, proto, nhp->nh_name)); 672 NETISR_WLOCK(); 673 KASSERT(netisr_proto[proto].np_handler != NULL, 674 ("%s(%u): protocol not registered for %s", __func__, proto, 675 nhp->nh_name)); 676 677 V_netisr_enable[proto] = 1; 678 NETISR_WUNLOCK(); 679 } 680 681 static void 682 netisr_drain_proto_vnet(struct vnet *vnet, u_int proto) 683 { 684 struct netisr_workstream *nwsp; 685 struct netisr_work *npwp; 686 struct mbuf *m, *mp, *n, *ne; 687 u_int i; 688 689 KASSERT(vnet != NULL, ("%s: vnet is NULL", __func__)); 690 NETISR_LOCK_ASSERT(); 691 692 CPU_FOREACH(i) { 693 nwsp = DPCPU_ID_PTR(i, nws); 694 if (nwsp->nws_intr_event == NULL) 695 continue; 696 npwp = &nwsp->nws_work[proto]; 697 NWS_LOCK(nwsp); 698 699 /* 700 * Rather than dissecting and removing mbufs from the middle 701 * of the chain, we build a new chain if the packet stays and 702 * update the head and tail pointers at the end. All packets 703 * matching the given vnet are freed. 704 */ 705 m = npwp->nw_head; 706 n = ne = NULL; 707 while (m != NULL) { 708 mp = m; 709 m = m->m_nextpkt; 710 mp->m_nextpkt = NULL; 711 if (mp->m_pkthdr.rcvif->if_vnet != vnet) { 712 if (n == NULL) { 713 n = ne = mp; 714 } else { 715 ne->m_nextpkt = mp; 716 ne = mp; 717 } 718 continue; 719 } 720 /* This is a packet in the selected vnet. Free it. */ 721 npwp->nw_len--; 722 m_freem(mp); 723 } 724 npwp->nw_head = n; 725 npwp->nw_tail = ne; 726 NWS_UNLOCK(nwsp); 727 } 728 } 729 730 void 731 netisr_unregister_vnet(const struct netisr_handler *nhp) 732 { 733 u_int proto; 734 735 proto = nhp->nh_proto; 736 737 KASSERT(curvnet != NULL, ("%s: curvnet is NULL", __func__)); 738 KASSERT(proto < NETISR_MAXPROT, 739 ("%s(%u): protocol too big for %s", __func__, proto, nhp->nh_name)); 740 NETISR_WLOCK(); 741 KASSERT(netisr_proto[proto].np_handler != NULL, 742 ("%s(%u): protocol not registered for %s", __func__, proto, 743 nhp->nh_name)); 744 745 V_netisr_enable[proto] = 0; 746 747 netisr_drain_proto_vnet(curvnet, proto); 748 NETISR_WUNLOCK(); 749 } 750 #endif 751 752 /* 753 * Compose the global and per-protocol policies on dispatch, and return the 754 * dispatch policy to use. 755 */ 756 static u_int 757 netisr_get_dispatch(struct netisr_proto *npp) 758 { 759 760 /* 761 * Protocol-specific configuration overrides the global default. 762 */ 763 if (npp->np_dispatch != NETISR_DISPATCH_DEFAULT) 764 return (npp->np_dispatch); 765 return (netisr_dispatch_policy); 766 } 767 768 /* 769 * Look up the workstream given a packet and source identifier. Do this by 770 * checking the protocol's policy, and optionally call out to the protocol 771 * for assistance if required. 772 */ 773 static struct mbuf * 774 netisr_select_cpuid(struct netisr_proto *npp, u_int dispatch_policy, 775 uintptr_t source, struct mbuf *m, u_int *cpuidp) 776 { 777 struct ifnet *ifp; 778 u_int policy; 779 780 NETISR_LOCK_ASSERT(); 781 782 /* 783 * In the event we have only one worker, shortcut and deliver to it 784 * without further ado. 785 */ 786 if (nws_count == 1) { 787 *cpuidp = nws_array[0]; 788 return (m); 789 } 790 791 /* 792 * What happens next depends on the policy selected by the protocol. 793 * If we want to support per-interface policies, we should do that 794 * here first. 795 */ 796 policy = npp->np_policy; 797 if (policy == NETISR_POLICY_CPU) { 798 m = npp->np_m2cpuid(m, source, cpuidp); 799 if (m == NULL) 800 return (NULL); 801 802 /* 803 * It's possible for a protocol not to have a good idea about 804 * where to process a packet, in which case we fall back on 805 * the netisr code to decide. In the hybrid case, return the 806 * current CPU ID, which will force an immediate direct 807 * dispatch. In the queued case, fall back on the SOURCE 808 * policy. 809 */ 810 if (*cpuidp != NETISR_CPUID_NONE) { 811 *cpuidp = netisr_get_cpuid(*cpuidp); 812 return (m); 813 } 814 if (dispatch_policy == NETISR_DISPATCH_HYBRID) { 815 *cpuidp = netisr_get_cpuid(curcpu); 816 return (m); 817 } 818 policy = NETISR_POLICY_SOURCE; 819 } 820 821 if (policy == NETISR_POLICY_FLOW) { 822 if (M_HASHTYPE_GET(m) == M_HASHTYPE_NONE && 823 npp->np_m2flow != NULL) { 824 m = npp->np_m2flow(m, source); 825 if (m == NULL) 826 return (NULL); 827 } 828 if (M_HASHTYPE_GET(m) != M_HASHTYPE_NONE) { 829 *cpuidp = 830 netisr_default_flow2cpu(m->m_pkthdr.flowid); 831 return (m); 832 } 833 policy = NETISR_POLICY_SOURCE; 834 } 835 836 KASSERT(policy == NETISR_POLICY_SOURCE, 837 ("%s: invalid policy %u for %s", __func__, npp->np_policy, 838 npp->np_name)); 839 840 ifp = m->m_pkthdr.rcvif; 841 if (ifp != NULL) 842 *cpuidp = nws_array[(ifp->if_index + source) % nws_count]; 843 else 844 *cpuidp = nws_array[source % nws_count]; 845 return (m); 846 } 847 848 /* 849 * Process packets associated with a workstream and protocol. For reasons of 850 * fairness, we process up to one complete netisr queue at a time, moving the 851 * queue to a stack-local queue for processing, but do not loop refreshing 852 * from the global queue. The caller is responsible for deciding whether to 853 * loop, and for setting the NWS_RUNNING flag. The passed workstream will be 854 * locked on entry and relocked before return, but will be released while 855 * processing. The number of packets processed is returned. 856 */ 857 static u_int 858 netisr_process_workstream_proto(struct netisr_workstream *nwsp, u_int proto) 859 { 860 struct netisr_work local_npw, *npwp; 861 u_int handled; 862 struct mbuf *m; 863 864 NETISR_LOCK_ASSERT(); 865 NWS_LOCK_ASSERT(nwsp); 866 867 KASSERT(nwsp->nws_flags & NWS_RUNNING, 868 ("%s(%u): not running", __func__, proto)); 869 KASSERT(proto >= 0 && proto < NETISR_MAXPROT, 870 ("%s(%u): invalid proto\n", __func__, proto)); 871 872 npwp = &nwsp->nws_work[proto]; 873 if (npwp->nw_len == 0) 874 return (0); 875 876 /* 877 * Move the global work queue to a thread-local work queue. 878 * 879 * Notice that this means the effective maximum length of the queue 880 * is actually twice that of the maximum queue length specified in 881 * the protocol registration call. 882 */ 883 handled = npwp->nw_len; 884 local_npw = *npwp; 885 npwp->nw_head = NULL; 886 npwp->nw_tail = NULL; 887 npwp->nw_len = 0; 888 nwsp->nws_pendingbits &= ~(1 << proto); 889 NWS_UNLOCK(nwsp); 890 while ((m = local_npw.nw_head) != NULL) { 891 local_npw.nw_head = m->m_nextpkt; 892 m->m_nextpkt = NULL; 893 if (local_npw.nw_head == NULL) 894 local_npw.nw_tail = NULL; 895 local_npw.nw_len--; 896 VNET_ASSERT(m->m_pkthdr.rcvif != NULL, 897 ("%s:%d rcvif == NULL: m=%p", __func__, __LINE__, m)); 898 CURVNET_SET(m->m_pkthdr.rcvif->if_vnet); 899 netisr_proto[proto].np_handler(m); 900 CURVNET_RESTORE(); 901 } 902 KASSERT(local_npw.nw_len == 0, 903 ("%s(%u): len %u", __func__, proto, local_npw.nw_len)); 904 if (netisr_proto[proto].np_drainedcpu) 905 netisr_proto[proto].np_drainedcpu(nwsp->nws_cpu); 906 NWS_LOCK(nwsp); 907 npwp->nw_handled += handled; 908 return (handled); 909 } 910 911 /* 912 * SWI handler for netisr -- processes packets in a set of workstreams that 913 * it owns, woken up by calls to NWS_SIGNAL(). If this workstream is already 914 * being direct dispatched, go back to sleep and wait for the dispatching 915 * thread to wake us up again. 916 */ 917 static void 918 swi_net(void *arg) 919 { 920 #ifdef NETISR_LOCKING 921 struct rm_priotracker tracker; 922 #endif 923 struct netisr_workstream *nwsp; 924 u_int bits, prot; 925 926 nwsp = arg; 927 928 #ifdef DEVICE_POLLING 929 KASSERT(nws_count == 1, 930 ("%s: device_polling but nws_count != 1", __func__)); 931 netisr_poll(); 932 #endif 933 #ifdef NETISR_LOCKING 934 NETISR_RLOCK(&tracker); 935 #endif 936 NWS_LOCK(nwsp); 937 KASSERT(!(nwsp->nws_flags & NWS_RUNNING), ("swi_net: running")); 938 if (nwsp->nws_flags & NWS_DISPATCHING) 939 goto out; 940 nwsp->nws_flags |= NWS_RUNNING; 941 nwsp->nws_flags &= ~NWS_SCHEDULED; 942 while ((bits = nwsp->nws_pendingbits) != 0) { 943 while ((prot = ffs(bits)) != 0) { 944 prot--; 945 bits &= ~(1 << prot); 946 (void)netisr_process_workstream_proto(nwsp, prot); 947 } 948 } 949 nwsp->nws_flags &= ~NWS_RUNNING; 950 out: 951 NWS_UNLOCK(nwsp); 952 #ifdef NETISR_LOCKING 953 NETISR_RUNLOCK(&tracker); 954 #endif 955 #ifdef DEVICE_POLLING 956 netisr_pollmore(); 957 #endif 958 } 959 960 static int 961 netisr_queue_workstream(struct netisr_workstream *nwsp, u_int proto, 962 struct netisr_work *npwp, struct mbuf *m, int *dosignalp) 963 { 964 965 NWS_LOCK_ASSERT(nwsp); 966 967 *dosignalp = 0; 968 if (npwp->nw_len < npwp->nw_qlimit) { 969 m->m_nextpkt = NULL; 970 if (npwp->nw_head == NULL) { 971 npwp->nw_head = m; 972 npwp->nw_tail = m; 973 } else { 974 npwp->nw_tail->m_nextpkt = m; 975 npwp->nw_tail = m; 976 } 977 npwp->nw_len++; 978 if (npwp->nw_len > npwp->nw_watermark) 979 npwp->nw_watermark = npwp->nw_len; 980 981 /* 982 * We must set the bit regardless of NWS_RUNNING, so that 983 * swi_net() keeps calling netisr_process_workstream_proto(). 984 */ 985 nwsp->nws_pendingbits |= (1 << proto); 986 if (!(nwsp->nws_flags & 987 (NWS_RUNNING | NWS_DISPATCHING | NWS_SCHEDULED))) { 988 nwsp->nws_flags |= NWS_SCHEDULED; 989 *dosignalp = 1; /* Defer until unlocked. */ 990 } 991 npwp->nw_queued++; 992 return (0); 993 } else { 994 m_freem(m); 995 npwp->nw_qdrops++; 996 return (ENOBUFS); 997 } 998 } 999 1000 static int 1001 netisr_queue_internal(u_int proto, struct mbuf *m, u_int cpuid) 1002 { 1003 struct netisr_workstream *nwsp; 1004 struct netisr_work *npwp; 1005 int dosignal, error; 1006 1007 #ifdef NETISR_LOCKING 1008 NETISR_LOCK_ASSERT(); 1009 #endif 1010 KASSERT(cpuid <= mp_maxid, ("%s: cpuid too big (%u, %u)", __func__, 1011 cpuid, mp_maxid)); 1012 KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 1013 1014 dosignal = 0; 1015 error = 0; 1016 nwsp = DPCPU_ID_PTR(cpuid, nws); 1017 npwp = &nwsp->nws_work[proto]; 1018 NWS_LOCK(nwsp); 1019 error = netisr_queue_workstream(nwsp, proto, npwp, m, &dosignal); 1020 NWS_UNLOCK(nwsp); 1021 if (dosignal) 1022 NWS_SIGNAL(nwsp); 1023 return (error); 1024 } 1025 1026 int 1027 netisr_queue_src(u_int proto, uintptr_t source, struct mbuf *m) 1028 { 1029 #ifdef NETISR_LOCKING 1030 struct rm_priotracker tracker; 1031 #endif 1032 u_int cpuid; 1033 int error; 1034 1035 KASSERT(proto < NETISR_MAXPROT, 1036 ("%s: invalid proto %u", __func__, proto)); 1037 1038 #ifdef NETISR_LOCKING 1039 NETISR_RLOCK(&tracker); 1040 #endif 1041 KASSERT(netisr_proto[proto].np_handler != NULL, 1042 ("%s: invalid proto %u", __func__, proto)); 1043 1044 #ifdef VIMAGE 1045 if (V_netisr_enable[proto] == 0) { 1046 m_freem(m); 1047 return (ENOPROTOOPT); 1048 } 1049 #endif 1050 1051 m = netisr_select_cpuid(&netisr_proto[proto], NETISR_DISPATCH_DEFERRED, 1052 source, m, &cpuid); 1053 if (m != NULL) { 1054 KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, 1055 cpuid)); 1056 error = netisr_queue_internal(proto, m, cpuid); 1057 } else 1058 error = ENOBUFS; 1059 #ifdef NETISR_LOCKING 1060 NETISR_RUNLOCK(&tracker); 1061 #endif 1062 return (error); 1063 } 1064 1065 int 1066 netisr_queue(u_int proto, struct mbuf *m) 1067 { 1068 1069 return (netisr_queue_src(proto, 0, m)); 1070 } 1071 1072 /* 1073 * Dispatch a packet for netisr processing; direct dispatch is permitted by 1074 * calling context. 1075 */ 1076 int 1077 netisr_dispatch_src(u_int proto, uintptr_t source, struct mbuf *m) 1078 { 1079 #ifdef NETISR_LOCKING 1080 struct rm_priotracker tracker; 1081 #endif 1082 struct netisr_workstream *nwsp; 1083 struct netisr_proto *npp; 1084 struct netisr_work *npwp; 1085 int dosignal, error; 1086 u_int cpuid, dispatch_policy; 1087 1088 KASSERT(proto < NETISR_MAXPROT, 1089 ("%s: invalid proto %u", __func__, proto)); 1090 #ifdef NETISR_LOCKING 1091 NETISR_RLOCK(&tracker); 1092 #endif 1093 npp = &netisr_proto[proto]; 1094 KASSERT(npp->np_handler != NULL, ("%s: invalid proto %u", __func__, 1095 proto)); 1096 1097 #ifdef VIMAGE 1098 if (V_netisr_enable[proto] == 0) { 1099 m_freem(m); 1100 return (ENOPROTOOPT); 1101 } 1102 #endif 1103 1104 dispatch_policy = netisr_get_dispatch(npp); 1105 if (dispatch_policy == NETISR_DISPATCH_DEFERRED) 1106 return (netisr_queue_src(proto, source, m)); 1107 1108 /* 1109 * If direct dispatch is forced, then unconditionally dispatch 1110 * without a formal CPU selection. Borrow the current CPU's stats, 1111 * even if there's no worker on it. In this case we don't update 1112 * nws_flags because all netisr processing will be source ordered due 1113 * to always being forced to directly dispatch. 1114 */ 1115 if (dispatch_policy == NETISR_DISPATCH_DIRECT) { 1116 nwsp = DPCPU_PTR(nws); 1117 npwp = &nwsp->nws_work[proto]; 1118 npwp->nw_dispatched++; 1119 npwp->nw_handled++; 1120 netisr_proto[proto].np_handler(m); 1121 error = 0; 1122 goto out_unlock; 1123 } 1124 1125 KASSERT(dispatch_policy == NETISR_DISPATCH_HYBRID, 1126 ("%s: unknown dispatch policy (%u)", __func__, dispatch_policy)); 1127 1128 /* 1129 * Otherwise, we execute in a hybrid mode where we will try to direct 1130 * dispatch if we're on the right CPU and the netisr worker isn't 1131 * already running. 1132 */ 1133 sched_pin(); 1134 m = netisr_select_cpuid(&netisr_proto[proto], NETISR_DISPATCH_HYBRID, 1135 source, m, &cpuid); 1136 if (m == NULL) { 1137 error = ENOBUFS; 1138 goto out_unpin; 1139 } 1140 KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 1141 if (cpuid != curcpu) 1142 goto queue_fallback; 1143 nwsp = DPCPU_PTR(nws); 1144 npwp = &nwsp->nws_work[proto]; 1145 1146 /*- 1147 * We are willing to direct dispatch only if three conditions hold: 1148 * 1149 * (1) The netisr worker isn't already running, 1150 * (2) Another thread isn't already directly dispatching, and 1151 * (3) The netisr hasn't already been woken up. 1152 */ 1153 NWS_LOCK(nwsp); 1154 if (nwsp->nws_flags & (NWS_RUNNING | NWS_DISPATCHING | NWS_SCHEDULED)) { 1155 error = netisr_queue_workstream(nwsp, proto, npwp, m, 1156 &dosignal); 1157 NWS_UNLOCK(nwsp); 1158 if (dosignal) 1159 NWS_SIGNAL(nwsp); 1160 goto out_unpin; 1161 } 1162 1163 /* 1164 * The current thread is now effectively the netisr worker, so set 1165 * the dispatching flag to prevent concurrent processing of the 1166 * stream from another thread (even the netisr worker), which could 1167 * otherwise lead to effective misordering of the stream. 1168 */ 1169 nwsp->nws_flags |= NWS_DISPATCHING; 1170 NWS_UNLOCK(nwsp); 1171 netisr_proto[proto].np_handler(m); 1172 NWS_LOCK(nwsp); 1173 nwsp->nws_flags &= ~NWS_DISPATCHING; 1174 npwp->nw_handled++; 1175 npwp->nw_hybrid_dispatched++; 1176 1177 /* 1178 * If other work was enqueued by another thread while we were direct 1179 * dispatching, we need to signal the netisr worker to do that work. 1180 * In the future, we might want to do some of that work in the 1181 * current thread, rather than trigger further context switches. If 1182 * so, we'll want to establish a reasonable bound on the work done in 1183 * the "borrowed" context. 1184 */ 1185 if (nwsp->nws_pendingbits != 0) { 1186 nwsp->nws_flags |= NWS_SCHEDULED; 1187 dosignal = 1; 1188 } else 1189 dosignal = 0; 1190 NWS_UNLOCK(nwsp); 1191 if (dosignal) 1192 NWS_SIGNAL(nwsp); 1193 error = 0; 1194 goto out_unpin; 1195 1196 queue_fallback: 1197 error = netisr_queue_internal(proto, m, cpuid); 1198 out_unpin: 1199 sched_unpin(); 1200 out_unlock: 1201 #ifdef NETISR_LOCKING 1202 NETISR_RUNLOCK(&tracker); 1203 #endif 1204 return (error); 1205 } 1206 1207 int 1208 netisr_dispatch(u_int proto, struct mbuf *m) 1209 { 1210 1211 return (netisr_dispatch_src(proto, 0, m)); 1212 } 1213 1214 #ifdef DEVICE_POLLING 1215 /* 1216 * Kernel polling borrows a netisr thread to run interface polling in; this 1217 * function allows kernel polling to request that the netisr thread be 1218 * scheduled even if no packets are pending for protocols. 1219 */ 1220 void 1221 netisr_sched_poll(void) 1222 { 1223 struct netisr_workstream *nwsp; 1224 1225 nwsp = DPCPU_ID_PTR(nws_array[0], nws); 1226 NWS_SIGNAL(nwsp); 1227 } 1228 #endif 1229 1230 static void 1231 netisr_start_swi(u_int cpuid, struct pcpu *pc) 1232 { 1233 char swiname[12]; 1234 struct netisr_workstream *nwsp; 1235 int error; 1236 1237 KASSERT(!CPU_ABSENT(cpuid), ("%s: CPU %u absent", __func__, cpuid)); 1238 1239 nwsp = DPCPU_ID_PTR(cpuid, nws); 1240 mtx_init(&nwsp->nws_mtx, "netisr_mtx", NULL, MTX_DEF); 1241 nwsp->nws_cpu = cpuid; 1242 snprintf(swiname, sizeof(swiname), "netisr %u", cpuid); 1243 error = swi_add(&nwsp->nws_intr_event, swiname, swi_net, nwsp, 1244 SWI_NET, INTR_MPSAFE, &nwsp->nws_swi_cookie); 1245 if (error) 1246 panic("%s: swi_add %d", __func__, error); 1247 pc->pc_netisr = nwsp->nws_intr_event; 1248 if (netisr_bindthreads) { 1249 error = intr_event_bind(nwsp->nws_intr_event, cpuid); 1250 if (error != 0) 1251 printf("%s: cpu %u: intr_event_bind: %d", __func__, 1252 cpuid, error); 1253 } 1254 NETISR_WLOCK(); 1255 nws_array[nws_count] = nwsp->nws_cpu; 1256 nws_count++; 1257 NETISR_WUNLOCK(); 1258 } 1259 1260 /* 1261 * Initialize the netisr subsystem. We rely on BSS and static initialization 1262 * of most fields in global data structures. 1263 * 1264 * Start a worker thread for the boot CPU so that we can support network 1265 * traffic immediately in case the network stack is used before additional 1266 * CPUs are started (for example, diskless boot). 1267 */ 1268 static void 1269 netisr_init(void *arg) 1270 { 1271 struct pcpu *pc; 1272 1273 NETISR_LOCK_INIT(); 1274 if (netisr_maxthreads == 0 || netisr_maxthreads < -1 ) 1275 netisr_maxthreads = 1; /* default behavior */ 1276 else if (netisr_maxthreads == -1) 1277 netisr_maxthreads = mp_ncpus; /* use max cpus */ 1278 if (netisr_maxthreads > mp_ncpus) { 1279 printf("netisr_init: forcing maxthreads from %d to %d\n", 1280 netisr_maxthreads, mp_ncpus); 1281 netisr_maxthreads = mp_ncpus; 1282 } 1283 if (netisr_defaultqlimit > netisr_maxqlimit) { 1284 printf("netisr_init: forcing defaultqlimit from %d to %d\n", 1285 netisr_defaultqlimit, netisr_maxqlimit); 1286 netisr_defaultqlimit = netisr_maxqlimit; 1287 } 1288 #ifdef DEVICE_POLLING 1289 /* 1290 * The device polling code is not yet aware of how to deal with 1291 * multiple netisr threads, so for the time being compiling in device 1292 * polling disables parallel netisr workers. 1293 */ 1294 if (netisr_maxthreads != 1 || netisr_bindthreads != 0) { 1295 printf("netisr_init: forcing maxthreads to 1 and " 1296 "bindthreads to 0 for device polling\n"); 1297 netisr_maxthreads = 1; 1298 netisr_bindthreads = 0; 1299 } 1300 #endif 1301 1302 #ifdef EARLY_AP_STARTUP 1303 STAILQ_FOREACH(pc, &cpuhead, pc_allcpu) { 1304 if (nws_count >= netisr_maxthreads) 1305 break; 1306 netisr_start_swi(pc->pc_cpuid, pc); 1307 } 1308 #else 1309 pc = get_pcpu(); 1310 netisr_start_swi(pc->pc_cpuid, pc); 1311 #endif 1312 } 1313 SYSINIT(netisr_init, SI_SUB_SOFTINTR, SI_ORDER_FIRST, netisr_init, NULL); 1314 1315 #ifndef EARLY_AP_STARTUP 1316 /* 1317 * Start worker threads for additional CPUs. No attempt to gracefully handle 1318 * work reassignment, we don't yet support dynamic reconfiguration. 1319 */ 1320 static void 1321 netisr_start(void *arg) 1322 { 1323 struct pcpu *pc; 1324 1325 STAILQ_FOREACH(pc, &cpuhead, pc_allcpu) { 1326 if (nws_count >= netisr_maxthreads) 1327 break; 1328 /* Worker will already be present for boot CPU. */ 1329 if (pc->pc_netisr != NULL) 1330 continue; 1331 netisr_start_swi(pc->pc_cpuid, pc); 1332 } 1333 } 1334 SYSINIT(netisr_start, SI_SUB_SMP, SI_ORDER_MIDDLE, netisr_start, NULL); 1335 #endif 1336 1337 /* 1338 * Sysctl monitoring for netisr: query a list of registered protocols. 1339 */ 1340 static int 1341 sysctl_netisr_proto(SYSCTL_HANDLER_ARGS) 1342 { 1343 struct rm_priotracker tracker; 1344 struct sysctl_netisr_proto *snpp, *snp_array; 1345 struct netisr_proto *npp; 1346 u_int counter, proto; 1347 int error; 1348 1349 if (req->newptr != NULL) 1350 return (EINVAL); 1351 snp_array = malloc(sizeof(*snp_array) * NETISR_MAXPROT, M_TEMP, 1352 M_ZERO | M_WAITOK); 1353 counter = 0; 1354 NETISR_RLOCK(&tracker); 1355 for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1356 npp = &netisr_proto[proto]; 1357 if (npp->np_name == NULL) 1358 continue; 1359 snpp = &snp_array[counter]; 1360 snpp->snp_version = sizeof(*snpp); 1361 strlcpy(snpp->snp_name, npp->np_name, NETISR_NAMEMAXLEN); 1362 snpp->snp_proto = proto; 1363 snpp->snp_qlimit = npp->np_qlimit; 1364 snpp->snp_policy = npp->np_policy; 1365 snpp->snp_dispatch = npp->np_dispatch; 1366 if (npp->np_m2flow != NULL) 1367 snpp->snp_flags |= NETISR_SNP_FLAGS_M2FLOW; 1368 if (npp->np_m2cpuid != NULL) 1369 snpp->snp_flags |= NETISR_SNP_FLAGS_M2CPUID; 1370 if (npp->np_drainedcpu != NULL) 1371 snpp->snp_flags |= NETISR_SNP_FLAGS_DRAINEDCPU; 1372 counter++; 1373 } 1374 NETISR_RUNLOCK(&tracker); 1375 KASSERT(counter <= NETISR_MAXPROT, 1376 ("sysctl_netisr_proto: counter too big (%d)", counter)); 1377 error = SYSCTL_OUT(req, snp_array, sizeof(*snp_array) * counter); 1378 free(snp_array, M_TEMP); 1379 return (error); 1380 } 1381 1382 SYSCTL_PROC(_net_isr, OID_AUTO, proto, 1383 CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_proto, 1384 "S,sysctl_netisr_proto", 1385 "Return list of protocols registered with netisr"); 1386 1387 /* 1388 * Sysctl monitoring for netisr: query a list of workstreams. 1389 */ 1390 static int 1391 sysctl_netisr_workstream(SYSCTL_HANDLER_ARGS) 1392 { 1393 struct rm_priotracker tracker; 1394 struct sysctl_netisr_workstream *snwsp, *snws_array; 1395 struct netisr_workstream *nwsp; 1396 u_int counter, cpuid; 1397 int error; 1398 1399 if (req->newptr != NULL) 1400 return (EINVAL); 1401 snws_array = malloc(sizeof(*snws_array) * MAXCPU, M_TEMP, 1402 M_ZERO | M_WAITOK); 1403 counter = 0; 1404 NETISR_RLOCK(&tracker); 1405 CPU_FOREACH(cpuid) { 1406 nwsp = DPCPU_ID_PTR(cpuid, nws); 1407 if (nwsp->nws_intr_event == NULL) 1408 continue; 1409 NWS_LOCK(nwsp); 1410 snwsp = &snws_array[counter]; 1411 snwsp->snws_version = sizeof(*snwsp); 1412 1413 /* 1414 * For now, we equate workstream IDs and CPU IDs in the 1415 * kernel, but expose them independently to userspace in case 1416 * that assumption changes in the future. 1417 */ 1418 snwsp->snws_wsid = cpuid; 1419 snwsp->snws_cpu = cpuid; 1420 if (nwsp->nws_intr_event != NULL) 1421 snwsp->snws_flags |= NETISR_SNWS_FLAGS_INTR; 1422 NWS_UNLOCK(nwsp); 1423 counter++; 1424 } 1425 NETISR_RUNLOCK(&tracker); 1426 KASSERT(counter <= MAXCPU, 1427 ("sysctl_netisr_workstream: counter too big (%d)", counter)); 1428 error = SYSCTL_OUT(req, snws_array, sizeof(*snws_array) * counter); 1429 free(snws_array, M_TEMP); 1430 return (error); 1431 } 1432 1433 SYSCTL_PROC(_net_isr, OID_AUTO, workstream, 1434 CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_workstream, 1435 "S,sysctl_netisr_workstream", 1436 "Return list of workstreams implemented by netisr"); 1437 1438 /* 1439 * Sysctl monitoring for netisr: query per-protocol data across all 1440 * workstreams. 1441 */ 1442 static int 1443 sysctl_netisr_work(SYSCTL_HANDLER_ARGS) 1444 { 1445 struct rm_priotracker tracker; 1446 struct sysctl_netisr_work *snwp, *snw_array; 1447 struct netisr_workstream *nwsp; 1448 struct netisr_proto *npp; 1449 struct netisr_work *nwp; 1450 u_int counter, cpuid, proto; 1451 int error; 1452 1453 if (req->newptr != NULL) 1454 return (EINVAL); 1455 snw_array = malloc(sizeof(*snw_array) * MAXCPU * NETISR_MAXPROT, 1456 M_TEMP, M_ZERO | M_WAITOK); 1457 counter = 0; 1458 NETISR_RLOCK(&tracker); 1459 CPU_FOREACH(cpuid) { 1460 nwsp = DPCPU_ID_PTR(cpuid, nws); 1461 if (nwsp->nws_intr_event == NULL) 1462 continue; 1463 NWS_LOCK(nwsp); 1464 for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1465 npp = &netisr_proto[proto]; 1466 if (npp->np_name == NULL) 1467 continue; 1468 nwp = &nwsp->nws_work[proto]; 1469 snwp = &snw_array[counter]; 1470 snwp->snw_version = sizeof(*snwp); 1471 snwp->snw_wsid = cpuid; /* See comment above. */ 1472 snwp->snw_proto = proto; 1473 snwp->snw_len = nwp->nw_len; 1474 snwp->snw_watermark = nwp->nw_watermark; 1475 snwp->snw_dispatched = nwp->nw_dispatched; 1476 snwp->snw_hybrid_dispatched = 1477 nwp->nw_hybrid_dispatched; 1478 snwp->snw_qdrops = nwp->nw_qdrops; 1479 snwp->snw_queued = nwp->nw_queued; 1480 snwp->snw_handled = nwp->nw_handled; 1481 counter++; 1482 } 1483 NWS_UNLOCK(nwsp); 1484 } 1485 KASSERT(counter <= MAXCPU * NETISR_MAXPROT, 1486 ("sysctl_netisr_work: counter too big (%d)", counter)); 1487 NETISR_RUNLOCK(&tracker); 1488 error = SYSCTL_OUT(req, snw_array, sizeof(*snw_array) * counter); 1489 free(snw_array, M_TEMP); 1490 return (error); 1491 } 1492 1493 SYSCTL_PROC(_net_isr, OID_AUTO, work, 1494 CTLFLAG_RD|CTLTYPE_STRUCT|CTLFLAG_MPSAFE, 0, 0, sysctl_netisr_work, 1495 "S,sysctl_netisr_work", 1496 "Return list of per-workstream, per-protocol work in netisr"); 1497 1498 #ifdef DDB 1499 DB_SHOW_COMMAND(netisr, db_show_netisr) 1500 { 1501 struct netisr_workstream *nwsp; 1502 struct netisr_work *nwp; 1503 int first, proto; 1504 u_int cpuid; 1505 1506 db_printf("%3s %6s %5s %5s %5s %8s %8s %8s %8s\n", "CPU", "Proto", 1507 "Len", "WMark", "Max", "Disp", "HDisp", "Drop", "Queue"); 1508 CPU_FOREACH(cpuid) { 1509 nwsp = DPCPU_ID_PTR(cpuid, nws); 1510 if (nwsp->nws_intr_event == NULL) 1511 continue; 1512 first = 1; 1513 for (proto = 0; proto < NETISR_MAXPROT; proto++) { 1514 if (netisr_proto[proto].np_handler == NULL) 1515 continue; 1516 nwp = &nwsp->nws_work[proto]; 1517 if (first) { 1518 db_printf("%3d ", cpuid); 1519 first = 0; 1520 } else 1521 db_printf("%3s ", ""); 1522 db_printf( 1523 "%6s %5d %5d %5d %8ju %8ju %8ju %8ju\n", 1524 netisr_proto[proto].np_name, nwp->nw_len, 1525 nwp->nw_watermark, nwp->nw_qlimit, 1526 nwp->nw_dispatched, nwp->nw_hybrid_dispatched, 1527 nwp->nw_qdrops, nwp->nw_queued); 1528 } 1529 } 1530 } 1531 #endif 1532