if_bridge.c revision 1.125
1 /* $NetBSD: if_bridge.c,v 1.125 2016/06/10 13:31:44 ozaki-r Exp $ */ 2 3 /* 4 * Copyright 2001 Wasabi Systems, Inc. 5 * All rights reserved. 6 * 7 * Written by Jason R. Thorpe for Wasabi Systems, 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 * 3. All advertising materials mentioning features or use of this software 18 * must display the following acknowledgement: 19 * This product includes software developed for the NetBSD Project by 20 * Wasabi Systems, Inc. 21 * 4. The name of Wasabi Systems, Inc. may not be used to endorse 22 * or promote products derived from this software without specific prior 23 * written permission. 24 * 25 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND 26 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 27 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 28 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC 29 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 30 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 31 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 32 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 33 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 34 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 35 * POSSIBILITY OF SUCH DAMAGE. 36 */ 37 38 /* 39 * Copyright (c) 1999, 2000 Jason L. Wright (jason (at) thought.net) 40 * All rights reserved. 41 * 42 * Redistribution and use in source and binary forms, with or without 43 * modification, are permitted provided that the following conditions 44 * are met: 45 * 1. Redistributions of source code must retain the above copyright 46 * notice, this list of conditions and the following disclaimer. 47 * 2. Redistributions in binary form must reproduce the above copyright 48 * notice, this list of conditions and the following disclaimer in the 49 * documentation and/or other materials provided with the distribution. 50 * 3. All advertising materials mentioning features or use of this software 51 * must display the following acknowledgement: 52 * This product includes software developed by Jason L. Wright 53 * 4. The name of the author may not be used to endorse or promote products 54 * derived from this software without specific prior written permission. 55 * 56 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 57 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 58 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 59 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 60 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 61 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 62 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 63 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 64 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 65 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 66 * POSSIBILITY OF SUCH DAMAGE. 67 * 68 * OpenBSD: if_bridge.c,v 1.60 2001/06/15 03:38:33 itojun Exp 69 */ 70 71 /* 72 * Network interface bridge support. 73 * 74 * TODO: 75 * 76 * - Currently only supports Ethernet-like interfaces (Ethernet, 77 * 802.11, VLANs on Ethernet, etc.) Figure out a nice way 78 * to bridge other types of interfaces (FDDI-FDDI, and maybe 79 * consider heterogenous bridges). 80 */ 81 82 #include <sys/cdefs.h> 83 __KERNEL_RCSID(0, "$NetBSD: if_bridge.c,v 1.125 2016/06/10 13:31:44 ozaki-r Exp $"); 84 85 #ifdef _KERNEL_OPT 86 #include "opt_bridge_ipf.h" 87 #include "opt_inet.h" 88 #include "opt_net_mpsafe.h" 89 #endif /* _KERNEL_OPT */ 90 91 #include <sys/param.h> 92 #include <sys/kernel.h> 93 #include <sys/mbuf.h> 94 #include <sys/queue.h> 95 #include <sys/socket.h> 96 #include <sys/socketvar.h> /* for softnet_lock */ 97 #include <sys/sockio.h> 98 #include <sys/systm.h> 99 #include <sys/proc.h> 100 #include <sys/pool.h> 101 #include <sys/kauth.h> 102 #include <sys/cpu.h> 103 #include <sys/cprng.h> 104 #include <sys/mutex.h> 105 #include <sys/kmem.h> 106 107 #include <net/bpf.h> 108 #include <net/if.h> 109 #include <net/if_dl.h> 110 #include <net/if_types.h> 111 #include <net/if_llc.h> 112 113 #include <net/if_ether.h> 114 #include <net/if_bridgevar.h> 115 116 #if defined(BRIDGE_IPF) 117 /* Used for bridge_ip[6]_checkbasic */ 118 #include <netinet/in.h> 119 #include <netinet/in_systm.h> 120 #include <netinet/ip.h> 121 #include <netinet/ip_var.h> 122 #include <netinet/ip_private.h> /* XXX */ 123 124 #include <netinet/ip6.h> 125 #include <netinet6/in6_var.h> 126 #include <netinet6/ip6_var.h> 127 #include <netinet6/ip6_private.h> /* XXX */ 128 #endif /* BRIDGE_IPF */ 129 130 /* 131 * Size of the route hash table. Must be a power of two. 132 */ 133 #ifndef BRIDGE_RTHASH_SIZE 134 #define BRIDGE_RTHASH_SIZE 1024 135 #endif 136 137 #define BRIDGE_RTHASH_MASK (BRIDGE_RTHASH_SIZE - 1) 138 139 #include "carp.h" 140 #if NCARP > 0 141 #include <netinet/in.h> 142 #include <netinet/in_var.h> 143 #include <netinet/ip_carp.h> 144 #endif 145 146 #include "ioconf.h" 147 148 __CTASSERT(sizeof(struct ifbifconf) == sizeof(struct ifbaconf)); 149 __CTASSERT(offsetof(struct ifbifconf, ifbic_len) == offsetof(struct ifbaconf, ifbac_len)); 150 __CTASSERT(offsetof(struct ifbifconf, ifbic_buf) == offsetof(struct ifbaconf, ifbac_buf)); 151 152 /* 153 * Maximum number of addresses to cache. 154 */ 155 #ifndef BRIDGE_RTABLE_MAX 156 #define BRIDGE_RTABLE_MAX 100 157 #endif 158 159 /* 160 * Spanning tree defaults. 161 */ 162 #define BSTP_DEFAULT_MAX_AGE (20 * 256) 163 #define BSTP_DEFAULT_HELLO_TIME (2 * 256) 164 #define BSTP_DEFAULT_FORWARD_DELAY (15 * 256) 165 #define BSTP_DEFAULT_HOLD_TIME (1 * 256) 166 #define BSTP_DEFAULT_BRIDGE_PRIORITY 0x8000 167 #define BSTP_DEFAULT_PORT_PRIORITY 0x80 168 #define BSTP_DEFAULT_PATH_COST 55 169 170 /* 171 * Timeout (in seconds) for entries learned dynamically. 172 */ 173 #ifndef BRIDGE_RTABLE_TIMEOUT 174 #define BRIDGE_RTABLE_TIMEOUT (20 * 60) /* same as ARP */ 175 #endif 176 177 /* 178 * Number of seconds between walks of the route list. 179 */ 180 #ifndef BRIDGE_RTABLE_PRUNE_PERIOD 181 #define BRIDGE_RTABLE_PRUNE_PERIOD (5 * 60) 182 #endif 183 184 #define BRIDGE_RT_LOCK(_sc) if ((_sc)->sc_rtlist_lock) \ 185 mutex_enter((_sc)->sc_rtlist_lock) 186 #define BRIDGE_RT_UNLOCK(_sc) if ((_sc)->sc_rtlist_lock) \ 187 mutex_exit((_sc)->sc_rtlist_lock) 188 #define BRIDGE_RT_LOCKED(_sc) (!(_sc)->sc_rtlist_lock || \ 189 mutex_owned((_sc)->sc_rtlist_lock)) 190 191 #define BRIDGE_RT_PSZ_PERFORM(_sc) \ 192 if ((_sc)->sc_rtlist_psz != NULL) \ 193 pserialize_perform((_sc)->sc_rtlist_psz); 194 195 #define BRIDGE_RT_RENTER(__s) do { __s = pserialize_read_enter(); } while (0) 196 #define BRIDGE_RT_REXIT(__s) do { pserialize_read_exit(__s); } while (0) 197 198 199 #ifdef NET_MPSAFE 200 #define DECLARE_LOCK_VARIABLE 201 #define ACQUIRE_GLOBAL_LOCKS() do { } while (0) 202 #define RELEASE_GLOBAL_LOCKS() do { } while (0) 203 #else 204 #define DECLARE_LOCK_VARIABLE int __s 205 #define ACQUIRE_GLOBAL_LOCKS() do { \ 206 KERNEL_LOCK(1, NULL); \ 207 mutex_enter(softnet_lock); \ 208 __s = splnet(); \ 209 } while (0) 210 #define RELEASE_GLOBAL_LOCKS() do { \ 211 splx(__s); \ 212 mutex_exit(softnet_lock); \ 213 KERNEL_UNLOCK_ONE(NULL); \ 214 } while (0) 215 #endif 216 217 struct psref_class *bridge_psref_class __read_mostly; 218 219 int bridge_rtable_prune_period = BRIDGE_RTABLE_PRUNE_PERIOD; 220 221 static struct pool bridge_rtnode_pool; 222 223 static int bridge_clone_create(struct if_clone *, int); 224 static int bridge_clone_destroy(struct ifnet *); 225 226 static int bridge_ioctl(struct ifnet *, u_long, void *); 227 static int bridge_init(struct ifnet *); 228 static void bridge_stop(struct ifnet *, int); 229 static void bridge_start(struct ifnet *); 230 231 static void bridge_input(struct ifnet *, struct mbuf *); 232 static void bridge_forward(struct bridge_softc *, struct mbuf *); 233 234 static void bridge_timer(void *); 235 236 static void bridge_broadcast(struct bridge_softc *, struct ifnet *, 237 struct mbuf *); 238 239 static int bridge_rtupdate(struct bridge_softc *, const uint8_t *, 240 struct ifnet *, int, uint8_t); 241 static struct ifnet *bridge_rtlookup(struct bridge_softc *, const uint8_t *); 242 static void bridge_rttrim(struct bridge_softc *); 243 static void bridge_rtage(struct bridge_softc *); 244 static void bridge_rtage_work(struct work *, void *); 245 static void bridge_rtflush(struct bridge_softc *, int); 246 static int bridge_rtdaddr(struct bridge_softc *, const uint8_t *); 247 static void bridge_rtdelete(struct bridge_softc *, struct ifnet *ifp); 248 249 static void bridge_rtable_init(struct bridge_softc *); 250 static void bridge_rtable_fini(struct bridge_softc *); 251 252 static struct bridge_rtnode *bridge_rtnode_lookup(struct bridge_softc *, 253 const uint8_t *); 254 static int bridge_rtnode_insert(struct bridge_softc *, 255 struct bridge_rtnode *); 256 static void bridge_rtnode_remove(struct bridge_softc *, 257 struct bridge_rtnode *); 258 static void bridge_rtnode_destroy(struct bridge_rtnode *); 259 260 static struct bridge_iflist *bridge_lookup_member(struct bridge_softc *, 261 const char *name, 262 struct psref *); 263 static struct bridge_iflist *bridge_lookup_member_if(struct bridge_softc *, 264 struct ifnet *ifp, 265 struct psref *); 266 static void bridge_release_member(struct bridge_softc *, struct bridge_iflist *, 267 struct psref *); 268 static void bridge_delete_member(struct bridge_softc *, 269 struct bridge_iflist *); 270 static void bridge_acquire_member(struct bridge_softc *sc, 271 struct bridge_iflist *, 272 struct psref *); 273 274 static int bridge_ioctl_add(struct bridge_softc *, void *); 275 static int bridge_ioctl_del(struct bridge_softc *, void *); 276 static int bridge_ioctl_gifflags(struct bridge_softc *, void *); 277 static int bridge_ioctl_sifflags(struct bridge_softc *, void *); 278 static int bridge_ioctl_scache(struct bridge_softc *, void *); 279 static int bridge_ioctl_gcache(struct bridge_softc *, void *); 280 static int bridge_ioctl_gifs(struct bridge_softc *, void *); 281 static int bridge_ioctl_rts(struct bridge_softc *, void *); 282 static int bridge_ioctl_saddr(struct bridge_softc *, void *); 283 static int bridge_ioctl_sto(struct bridge_softc *, void *); 284 static int bridge_ioctl_gto(struct bridge_softc *, void *); 285 static int bridge_ioctl_daddr(struct bridge_softc *, void *); 286 static int bridge_ioctl_flush(struct bridge_softc *, void *); 287 static int bridge_ioctl_gpri(struct bridge_softc *, void *); 288 static int bridge_ioctl_spri(struct bridge_softc *, void *); 289 static int bridge_ioctl_ght(struct bridge_softc *, void *); 290 static int bridge_ioctl_sht(struct bridge_softc *, void *); 291 static int bridge_ioctl_gfd(struct bridge_softc *, void *); 292 static int bridge_ioctl_sfd(struct bridge_softc *, void *); 293 static int bridge_ioctl_gma(struct bridge_softc *, void *); 294 static int bridge_ioctl_sma(struct bridge_softc *, void *); 295 static int bridge_ioctl_sifprio(struct bridge_softc *, void *); 296 static int bridge_ioctl_sifcost(struct bridge_softc *, void *); 297 #if defined(BRIDGE_IPF) 298 static int bridge_ioctl_gfilt(struct bridge_softc *, void *); 299 static int bridge_ioctl_sfilt(struct bridge_softc *, void *); 300 static int bridge_ipf(void *, struct mbuf **, struct ifnet *, int); 301 static int bridge_ip_checkbasic(struct mbuf **mp); 302 # ifdef INET6 303 static int bridge_ip6_checkbasic(struct mbuf **mp); 304 # endif /* INET6 */ 305 #endif /* BRIDGE_IPF */ 306 307 struct bridge_control { 308 int (*bc_func)(struct bridge_softc *, void *); 309 int bc_argsize; 310 int bc_flags; 311 }; 312 313 #define BC_F_COPYIN 0x01 /* copy arguments in */ 314 #define BC_F_COPYOUT 0x02 /* copy arguments out */ 315 #define BC_F_SUSER 0x04 /* do super-user check */ 316 #define BC_F_XLATEIN 0x08 /* xlate arguments in */ 317 #define BC_F_XLATEOUT 0x10 /* xlate arguments out */ 318 319 static const struct bridge_control bridge_control_table[] = { 320 [BRDGADD] = {bridge_ioctl_add, sizeof(struct ifbreq), BC_F_COPYIN|BC_F_SUSER}, 321 [BRDGDEL] = {bridge_ioctl_del, sizeof(struct ifbreq), BC_F_COPYIN|BC_F_SUSER}, 322 323 [BRDGGIFFLGS] = {bridge_ioctl_gifflags, sizeof(struct ifbreq), BC_F_COPYIN|BC_F_COPYOUT}, 324 [BRDGSIFFLGS] = {bridge_ioctl_sifflags, sizeof(struct ifbreq), BC_F_COPYIN|BC_F_SUSER}, 325 326 [BRDGSCACHE] = {bridge_ioctl_scache, sizeof(struct ifbrparam), BC_F_COPYIN|BC_F_SUSER}, 327 [BRDGGCACHE] = {bridge_ioctl_gcache, sizeof(struct ifbrparam), BC_F_COPYOUT}, 328 329 [OBRDGGIFS] = {bridge_ioctl_gifs, sizeof(struct ifbifconf), BC_F_COPYIN|BC_F_COPYOUT}, 330 [OBRDGRTS] = {bridge_ioctl_rts, sizeof(struct ifbaconf), BC_F_COPYIN|BC_F_COPYOUT}, 331 332 [BRDGSADDR] = {bridge_ioctl_saddr, sizeof(struct ifbareq), BC_F_COPYIN|BC_F_SUSER}, 333 334 [BRDGSTO] = {bridge_ioctl_sto, sizeof(struct ifbrparam), BC_F_COPYIN|BC_F_SUSER}, 335 [BRDGGTO] = {bridge_ioctl_gto, sizeof(struct ifbrparam), BC_F_COPYOUT}, 336 337 [BRDGDADDR] = {bridge_ioctl_daddr, sizeof(struct ifbareq), BC_F_COPYIN|BC_F_SUSER}, 338 339 [BRDGFLUSH] = {bridge_ioctl_flush, sizeof(struct ifbreq), BC_F_COPYIN|BC_F_SUSER}, 340 341 [BRDGGPRI] = {bridge_ioctl_gpri, sizeof(struct ifbrparam), BC_F_COPYOUT}, 342 [BRDGSPRI] = {bridge_ioctl_spri, sizeof(struct ifbrparam), BC_F_COPYIN|BC_F_SUSER}, 343 344 [BRDGGHT] = {bridge_ioctl_ght, sizeof(struct ifbrparam), BC_F_COPYOUT}, 345 [BRDGSHT] = {bridge_ioctl_sht, sizeof(struct ifbrparam), BC_F_COPYIN|BC_F_SUSER}, 346 347 [BRDGGFD] = {bridge_ioctl_gfd, sizeof(struct ifbrparam), BC_F_COPYOUT}, 348 [BRDGSFD] = {bridge_ioctl_sfd, sizeof(struct ifbrparam), BC_F_COPYIN|BC_F_SUSER}, 349 350 [BRDGGMA] = {bridge_ioctl_gma, sizeof(struct ifbrparam), BC_F_COPYOUT}, 351 [BRDGSMA] = {bridge_ioctl_sma, sizeof(struct ifbrparam), BC_F_COPYIN|BC_F_SUSER}, 352 353 [BRDGSIFPRIO] = {bridge_ioctl_sifprio, sizeof(struct ifbreq), BC_F_COPYIN|BC_F_SUSER}, 354 355 [BRDGSIFCOST] = {bridge_ioctl_sifcost, sizeof(struct ifbreq), BC_F_COPYIN|BC_F_SUSER}, 356 #if defined(BRIDGE_IPF) 357 [BRDGGFILT] = {bridge_ioctl_gfilt, sizeof(struct ifbrparam), BC_F_COPYOUT}, 358 [BRDGSFILT] = {bridge_ioctl_sfilt, sizeof(struct ifbrparam), BC_F_COPYIN|BC_F_SUSER}, 359 #endif /* BRIDGE_IPF */ 360 [BRDGGIFS] = {bridge_ioctl_gifs, sizeof(struct ifbifconf), BC_F_XLATEIN|BC_F_XLATEOUT}, 361 [BRDGRTS] = {bridge_ioctl_rts, sizeof(struct ifbaconf), BC_F_XLATEIN|BC_F_XLATEOUT}, 362 }; 363 364 static const int bridge_control_table_size = __arraycount(bridge_control_table); 365 366 static struct if_clone bridge_cloner = 367 IF_CLONE_INITIALIZER("bridge", bridge_clone_create, bridge_clone_destroy); 368 369 /* 370 * bridgeattach: 371 * 372 * Pseudo-device attach routine. 373 */ 374 void 375 bridgeattach(int n) 376 { 377 378 pool_init(&bridge_rtnode_pool, sizeof(struct bridge_rtnode), 379 0, 0, 0, "brtpl", NULL, IPL_NET); 380 381 bridge_psref_class = psref_class_create("bridge", IPL_SOFTNET); 382 383 if_clone_attach(&bridge_cloner); 384 } 385 386 /* 387 * bridge_clone_create: 388 * 389 * Create a new bridge instance. 390 */ 391 static int 392 bridge_clone_create(struct if_clone *ifc, int unit) 393 { 394 struct bridge_softc *sc; 395 struct ifnet *ifp; 396 int error; 397 398 sc = kmem_zalloc(sizeof(*sc), KM_SLEEP); 399 ifp = &sc->sc_if; 400 401 sc->sc_brtmax = BRIDGE_RTABLE_MAX; 402 sc->sc_brttimeout = BRIDGE_RTABLE_TIMEOUT; 403 sc->sc_bridge_max_age = BSTP_DEFAULT_MAX_AGE; 404 sc->sc_bridge_hello_time = BSTP_DEFAULT_HELLO_TIME; 405 sc->sc_bridge_forward_delay = BSTP_DEFAULT_FORWARD_DELAY; 406 sc->sc_bridge_priority = BSTP_DEFAULT_BRIDGE_PRIORITY; 407 sc->sc_hold_time = BSTP_DEFAULT_HOLD_TIME; 408 sc->sc_filter_flags = 0; 409 410 /* Initialize our routing table. */ 411 bridge_rtable_init(sc); 412 413 error = workqueue_create(&sc->sc_rtage_wq, "bridge_rtage", 414 bridge_rtage_work, sc, PRI_SOFTNET, IPL_SOFTNET, WQ_MPSAFE); 415 if (error) 416 panic("%s: workqueue_create %d\n", __func__, error); 417 418 callout_init(&sc->sc_brcallout, 0); 419 callout_init(&sc->sc_bstpcallout, 0); 420 421 mutex_init(&sc->sc_iflist_psref.bip_lock, MUTEX_DEFAULT, IPL_NONE); 422 PSLIST_INIT(&sc->sc_iflist_psref.bip_iflist); 423 sc->sc_iflist_psref.bip_psz = pserialize_create(); 424 425 if_initname(ifp, ifc->ifc_name, unit); 426 ifp->if_softc = sc; 427 ifp->if_mtu = ETHERMTU; 428 ifp->if_ioctl = bridge_ioctl; 429 ifp->if_output = bridge_output; 430 ifp->if_start = bridge_start; 431 ifp->if_stop = bridge_stop; 432 ifp->if_init = bridge_init; 433 ifp->if_type = IFT_BRIDGE; 434 ifp->if_addrlen = 0; 435 ifp->if_dlt = DLT_EN10MB; 436 ifp->if_hdrlen = ETHER_HDR_LEN; 437 438 if_initialize(ifp); 439 if_register(ifp); 440 441 if_alloc_sadl(ifp); 442 443 return (0); 444 } 445 446 /* 447 * bridge_clone_destroy: 448 * 449 * Destroy a bridge instance. 450 */ 451 static int 452 bridge_clone_destroy(struct ifnet *ifp) 453 { 454 struct bridge_softc *sc = ifp->if_softc; 455 struct bridge_iflist *bif; 456 int s; 457 458 s = splnet(); 459 460 bridge_stop(ifp, 1); 461 462 BRIDGE_LOCK(sc); 463 for (;;) { 464 bif = PSLIST_WRITER_FIRST(&sc->sc_iflist_psref.bip_iflist, struct bridge_iflist, 465 bif_next); 466 if (bif == NULL) 467 break; 468 bridge_delete_member(sc, bif); 469 } 470 PSLIST_DESTROY(&sc->sc_iflist_psref.bip_iflist); 471 BRIDGE_UNLOCK(sc); 472 473 splx(s); 474 475 if_detach(ifp); 476 477 /* Tear down the routing table. */ 478 bridge_rtable_fini(sc); 479 480 pserialize_destroy(sc->sc_iflist_psref.bip_psz); 481 mutex_destroy(&sc->sc_iflist_psref.bip_lock); 482 483 workqueue_destroy(sc->sc_rtage_wq); 484 485 kmem_free(sc, sizeof(*sc)); 486 487 return (0); 488 } 489 490 /* 491 * bridge_ioctl: 492 * 493 * Handle a control request from the operator. 494 */ 495 static int 496 bridge_ioctl(struct ifnet *ifp, u_long cmd, void *data) 497 { 498 struct bridge_softc *sc = ifp->if_softc; 499 struct lwp *l = curlwp; /* XXX */ 500 union { 501 struct ifbreq ifbreq; 502 struct ifbifconf ifbifconf; 503 struct ifbareq ifbareq; 504 struct ifbaconf ifbaconf; 505 struct ifbrparam ifbrparam; 506 } args; 507 struct ifdrv *ifd = (struct ifdrv *) data; 508 const struct bridge_control *bc = NULL; /* XXXGCC */ 509 int s, error = 0; 510 511 /* Authorize command before calling splnet(). */ 512 switch (cmd) { 513 case SIOCGDRVSPEC: 514 case SIOCSDRVSPEC: 515 if (ifd->ifd_cmd >= bridge_control_table_size 516 || (bc = &bridge_control_table[ifd->ifd_cmd]) == NULL) { 517 error = EINVAL; 518 return error; 519 } 520 521 /* We only care about BC_F_SUSER at this point. */ 522 if ((bc->bc_flags & BC_F_SUSER) == 0) 523 break; 524 525 error = kauth_authorize_network(l->l_cred, 526 KAUTH_NETWORK_INTERFACE_BRIDGE, 527 cmd == SIOCGDRVSPEC ? 528 KAUTH_REQ_NETWORK_INTERFACE_BRIDGE_GETPRIV : 529 KAUTH_REQ_NETWORK_INTERFACE_BRIDGE_SETPRIV, 530 ifd, NULL, NULL); 531 if (error) 532 return (error); 533 534 break; 535 } 536 537 s = splnet(); 538 539 switch (cmd) { 540 case SIOCGDRVSPEC: 541 case SIOCSDRVSPEC: 542 KASSERT(bc != NULL); 543 if (cmd == SIOCGDRVSPEC && 544 (bc->bc_flags & (BC_F_COPYOUT|BC_F_XLATEOUT)) == 0) { 545 error = EINVAL; 546 break; 547 } 548 else if (cmd == SIOCSDRVSPEC && 549 (bc->bc_flags & (BC_F_COPYOUT|BC_F_XLATEOUT)) != 0) { 550 error = EINVAL; 551 break; 552 } 553 554 /* BC_F_SUSER is checked above, before splnet(). */ 555 556 if ((bc->bc_flags & (BC_F_XLATEIN|BC_F_XLATEOUT)) == 0 557 && (ifd->ifd_len != bc->bc_argsize 558 || ifd->ifd_len > sizeof(args))) { 559 error = EINVAL; 560 break; 561 } 562 563 memset(&args, 0, sizeof(args)); 564 if (bc->bc_flags & BC_F_COPYIN) { 565 error = copyin(ifd->ifd_data, &args, ifd->ifd_len); 566 if (error) 567 break; 568 } else if (bc->bc_flags & BC_F_XLATEIN) { 569 args.ifbifconf.ifbic_len = ifd->ifd_len; 570 args.ifbifconf.ifbic_buf = ifd->ifd_data; 571 } 572 573 error = (*bc->bc_func)(sc, &args); 574 if (error) 575 break; 576 577 if (bc->bc_flags & BC_F_COPYOUT) { 578 error = copyout(&args, ifd->ifd_data, ifd->ifd_len); 579 } else if (bc->bc_flags & BC_F_XLATEOUT) { 580 ifd->ifd_len = args.ifbifconf.ifbic_len; 581 ifd->ifd_data = args.ifbifconf.ifbic_buf; 582 } 583 break; 584 585 case SIOCSIFFLAGS: 586 if ((error = ifioctl_common(ifp, cmd, data)) != 0) 587 break; 588 switch (ifp->if_flags & (IFF_UP|IFF_RUNNING)) { 589 case IFF_RUNNING: 590 /* 591 * If interface is marked down and it is running, 592 * then stop and disable it. 593 */ 594 (*ifp->if_stop)(ifp, 1); 595 break; 596 case IFF_UP: 597 /* 598 * If interface is marked up and it is stopped, then 599 * start it. 600 */ 601 error = (*ifp->if_init)(ifp); 602 break; 603 default: 604 break; 605 } 606 break; 607 608 case SIOCSIFMTU: 609 if ((error = ifioctl_common(ifp, cmd, data)) == ENETRESET) 610 error = 0; 611 break; 612 613 default: 614 error = ifioctl_common(ifp, cmd, data); 615 break; 616 } 617 618 splx(s); 619 620 return (error); 621 } 622 623 /* 624 * bridge_lookup_member: 625 * 626 * Lookup a bridge member interface. 627 */ 628 static struct bridge_iflist * 629 bridge_lookup_member(struct bridge_softc *sc, const char *name, struct psref *psref) 630 { 631 struct bridge_iflist *bif; 632 struct ifnet *ifp; 633 int s; 634 635 BRIDGE_PSZ_RENTER(s); 636 637 BRIDGE_IFLIST_READER_FOREACH(bif, sc) { 638 ifp = bif->bif_ifp; 639 if (strcmp(ifp->if_xname, name) == 0) 640 break; 641 } 642 if (bif != NULL) 643 bridge_acquire_member(sc, bif, psref); 644 645 BRIDGE_PSZ_REXIT(s); 646 647 return bif; 648 } 649 650 /* 651 * bridge_lookup_member_if: 652 * 653 * Lookup a bridge member interface by ifnet*. 654 */ 655 static struct bridge_iflist * 656 bridge_lookup_member_if(struct bridge_softc *sc, struct ifnet *member_ifp, 657 struct psref *psref) 658 { 659 struct bridge_iflist *bif; 660 int s; 661 662 BRIDGE_PSZ_RENTER(s); 663 664 bif = member_ifp->if_bridgeif; 665 if (bif != NULL) { 666 psref_acquire(psref, &bif->bif_psref, 667 bridge_psref_class); 668 } 669 670 BRIDGE_PSZ_REXIT(s); 671 672 return bif; 673 } 674 675 static void 676 bridge_acquire_member(struct bridge_softc *sc, struct bridge_iflist *bif, 677 struct psref *psref) 678 { 679 680 psref_acquire(psref, &bif->bif_psref, bridge_psref_class); 681 } 682 683 /* 684 * bridge_release_member: 685 * 686 * Release the specified member interface. 687 */ 688 static void 689 bridge_release_member(struct bridge_softc *sc, struct bridge_iflist *bif, 690 struct psref *psref) 691 { 692 693 psref_release(psref, &bif->bif_psref, bridge_psref_class); 694 } 695 696 /* 697 * bridge_delete_member: 698 * 699 * Delete the specified member interface. 700 */ 701 static void 702 bridge_delete_member(struct bridge_softc *sc, struct bridge_iflist *bif) 703 { 704 struct ifnet *ifs = bif->bif_ifp; 705 706 KASSERT(BRIDGE_LOCKED(sc)); 707 708 ifs->_if_input = ether_input; 709 ifs->if_bridge = NULL; 710 ifs->if_bridgeif = NULL; 711 712 PSLIST_WRITER_REMOVE(bif, bif_next); 713 BRIDGE_PSZ_PERFORM(sc); 714 BRIDGE_UNLOCK(sc); 715 716 psref_target_destroy(&bif->bif_psref, bridge_psref_class); 717 718 PSLIST_ENTRY_DESTROY(bif, bif_next); 719 kmem_free(bif, sizeof(*bif)); 720 721 BRIDGE_LOCK(sc); 722 } 723 724 static int 725 bridge_ioctl_add(struct bridge_softc *sc, void *arg) 726 { 727 struct ifbreq *req = arg; 728 struct bridge_iflist *bif = NULL; 729 struct ifnet *ifs; 730 int error = 0; 731 struct psref psref; 732 733 ifs = if_get(req->ifbr_ifsname, &psref); 734 if (ifs == NULL) 735 return (ENOENT); 736 737 if (sc->sc_if.if_mtu != ifs->if_mtu) { 738 error = EINVAL; 739 goto out; 740 } 741 742 if (ifs->if_bridge == sc) { 743 error = EEXIST; 744 goto out; 745 } 746 747 if (ifs->if_bridge != NULL) { 748 error = EBUSY; 749 goto out; 750 } 751 752 if (ifs->_if_input != ether_input) { 753 error = EINVAL; 754 goto out; 755 } 756 757 /* FIXME: doesn't work with non-IFF_SIMPLEX interfaces */ 758 if ((ifs->if_flags & IFF_SIMPLEX) == 0) { 759 error = EINVAL; 760 goto out; 761 } 762 763 bif = kmem_alloc(sizeof(*bif), KM_SLEEP); 764 765 switch (ifs->if_type) { 766 case IFT_ETHER: 767 if ((error = ether_enable_vlan_mtu(ifs)) > 0) 768 goto out; 769 /* 770 * Place the interface into promiscuous mode. 771 */ 772 error = ifpromisc(ifs, 1); 773 if (error) 774 goto out; 775 break; 776 default: 777 error = EINVAL; 778 goto out; 779 } 780 781 bif->bif_ifp = ifs; 782 bif->bif_flags = IFBIF_LEARNING | IFBIF_DISCOVER; 783 bif->bif_priority = BSTP_DEFAULT_PORT_PRIORITY; 784 bif->bif_path_cost = BSTP_DEFAULT_PATH_COST; 785 PSLIST_ENTRY_INIT(bif, bif_next); 786 psref_target_init(&bif->bif_psref, bridge_psref_class); 787 788 BRIDGE_LOCK(sc); 789 790 ifs->if_bridge = sc; 791 ifs->if_bridgeif = bif; 792 PSLIST_WRITER_INSERT_HEAD(&sc->sc_iflist_psref.bip_iflist, bif, bif_next); 793 ifs->_if_input = bridge_input; 794 795 BRIDGE_UNLOCK(sc); 796 797 if (sc->sc_if.if_flags & IFF_RUNNING) 798 bstp_initialization(sc); 799 else 800 bstp_stop(sc); 801 802 out: 803 if_put(ifs, &psref); 804 if (error) { 805 if (bif != NULL) 806 kmem_free(bif, sizeof(*bif)); 807 } 808 return (error); 809 } 810 811 static int 812 bridge_ioctl_del(struct bridge_softc *sc, void *arg) 813 { 814 struct ifbreq *req = arg; 815 const char *name = req->ifbr_ifsname; 816 struct bridge_iflist *bif; 817 struct ifnet *ifs; 818 819 BRIDGE_LOCK(sc); 820 821 /* 822 * Don't use bridge_lookup_member. We want to get a member 823 * with bif_refs == 0. 824 */ 825 BRIDGE_IFLIST_WRITER_FOREACH(bif, sc) { 826 ifs = bif->bif_ifp; 827 if (strcmp(ifs->if_xname, name) == 0) 828 break; 829 } 830 831 if (bif == NULL) { 832 BRIDGE_UNLOCK(sc); 833 return ENOENT; 834 } 835 836 bridge_delete_member(sc, bif); 837 838 BRIDGE_UNLOCK(sc); 839 840 switch (ifs->if_type) { 841 case IFT_ETHER: 842 /* 843 * Take the interface out of promiscuous mode. 844 * Don't call it with holding a spin lock. 845 */ 846 (void) ifpromisc(ifs, 0); 847 (void) ether_disable_vlan_mtu(ifs); 848 break; 849 default: 850 #ifdef DIAGNOSTIC 851 panic("bridge_delete_member: impossible"); 852 #endif 853 break; 854 } 855 856 bridge_rtdelete(sc, ifs); 857 858 if (sc->sc_if.if_flags & IFF_RUNNING) 859 bstp_initialization(sc); 860 861 return 0; 862 } 863 864 static int 865 bridge_ioctl_gifflags(struct bridge_softc *sc, void *arg) 866 { 867 struct ifbreq *req = arg; 868 struct bridge_iflist *bif; 869 struct psref psref; 870 871 bif = bridge_lookup_member(sc, req->ifbr_ifsname, &psref); 872 if (bif == NULL) 873 return (ENOENT); 874 875 req->ifbr_ifsflags = bif->bif_flags; 876 req->ifbr_state = bif->bif_state; 877 req->ifbr_priority = bif->bif_priority; 878 req->ifbr_path_cost = bif->bif_path_cost; 879 req->ifbr_portno = bif->bif_ifp->if_index & 0xff; 880 881 bridge_release_member(sc, bif, &psref); 882 883 return (0); 884 } 885 886 static int 887 bridge_ioctl_sifflags(struct bridge_softc *sc, void *arg) 888 { 889 struct ifbreq *req = arg; 890 struct bridge_iflist *bif; 891 struct psref psref; 892 893 bif = bridge_lookup_member(sc, req->ifbr_ifsname, &psref); 894 if (bif == NULL) 895 return (ENOENT); 896 897 if (req->ifbr_ifsflags & IFBIF_STP) { 898 switch (bif->bif_ifp->if_type) { 899 case IFT_ETHER: 900 /* These can do spanning tree. */ 901 break; 902 903 default: 904 /* Nothing else can. */ 905 bridge_release_member(sc, bif, &psref); 906 return (EINVAL); 907 } 908 } 909 910 bif->bif_flags = req->ifbr_ifsflags; 911 912 bridge_release_member(sc, bif, &psref); 913 914 if (sc->sc_if.if_flags & IFF_RUNNING) 915 bstp_initialization(sc); 916 917 return (0); 918 } 919 920 static int 921 bridge_ioctl_scache(struct bridge_softc *sc, void *arg) 922 { 923 struct ifbrparam *param = arg; 924 925 sc->sc_brtmax = param->ifbrp_csize; 926 bridge_rttrim(sc); 927 928 return (0); 929 } 930 931 static int 932 bridge_ioctl_gcache(struct bridge_softc *sc, void *arg) 933 { 934 struct ifbrparam *param = arg; 935 936 param->ifbrp_csize = sc->sc_brtmax; 937 938 return (0); 939 } 940 941 static int 942 bridge_ioctl_gifs(struct bridge_softc *sc, void *arg) 943 { 944 struct ifbifconf *bifc = arg; 945 struct bridge_iflist *bif; 946 struct ifbreq *breqs; 947 int i, count, error = 0; 948 949 retry: 950 BRIDGE_LOCK(sc); 951 count = 0; 952 BRIDGE_IFLIST_WRITER_FOREACH(bif, sc) 953 count++; 954 BRIDGE_UNLOCK(sc); 955 956 if (count == 0) { 957 bifc->ifbic_len = 0; 958 return 0; 959 } 960 961 if (bifc->ifbic_len == 0 || bifc->ifbic_len < (sizeof(*breqs) * count)) { 962 /* Tell that a larger buffer is needed */ 963 bifc->ifbic_len = sizeof(*breqs) * count; 964 return 0; 965 } 966 967 breqs = kmem_alloc(sizeof(*breqs) * count, KM_SLEEP); 968 969 BRIDGE_LOCK(sc); 970 971 i = 0; 972 BRIDGE_IFLIST_WRITER_FOREACH(bif, sc) 973 i++; 974 if (i > count) { 975 /* 976 * The number of members has been increased. 977 * We need more memory! 978 */ 979 BRIDGE_UNLOCK(sc); 980 kmem_free(breqs, sizeof(*breqs) * count); 981 goto retry; 982 } 983 984 i = 0; 985 BRIDGE_IFLIST_WRITER_FOREACH(bif, sc) { 986 struct ifbreq *breq = &breqs[i++]; 987 memset(breq, 0, sizeof(*breq)); 988 989 strlcpy(breq->ifbr_ifsname, bif->bif_ifp->if_xname, 990 sizeof(breq->ifbr_ifsname)); 991 breq->ifbr_ifsflags = bif->bif_flags; 992 breq->ifbr_state = bif->bif_state; 993 breq->ifbr_priority = bif->bif_priority; 994 breq->ifbr_path_cost = bif->bif_path_cost; 995 breq->ifbr_portno = bif->bif_ifp->if_index & 0xff; 996 } 997 998 /* Don't call copyout with holding the mutex */ 999 BRIDGE_UNLOCK(sc); 1000 1001 for (i = 0; i < count; i++) { 1002 error = copyout(&breqs[i], bifc->ifbic_req + i, sizeof(*breqs)); 1003 if (error) 1004 break; 1005 } 1006 bifc->ifbic_len = sizeof(*breqs) * i; 1007 1008 kmem_free(breqs, sizeof(*breqs) * count); 1009 1010 return error; 1011 } 1012 1013 static int 1014 bridge_ioctl_rts(struct bridge_softc *sc, void *arg) 1015 { 1016 struct ifbaconf *bac = arg; 1017 struct bridge_rtnode *brt; 1018 struct ifbareq bareq; 1019 int count = 0, error = 0, len; 1020 1021 if (bac->ifbac_len == 0) 1022 return (0); 1023 1024 BRIDGE_RT_LOCK(sc); 1025 1026 len = bac->ifbac_len; 1027 LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) { 1028 if (len < sizeof(bareq)) 1029 goto out; 1030 memset(&bareq, 0, sizeof(bareq)); 1031 strlcpy(bareq.ifba_ifsname, brt->brt_ifp->if_xname, 1032 sizeof(bareq.ifba_ifsname)); 1033 memcpy(bareq.ifba_dst, brt->brt_addr, sizeof(brt->brt_addr)); 1034 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) { 1035 bareq.ifba_expire = brt->brt_expire - time_uptime; 1036 } else 1037 bareq.ifba_expire = 0; 1038 bareq.ifba_flags = brt->brt_flags; 1039 1040 error = copyout(&bareq, bac->ifbac_req + count, sizeof(bareq)); 1041 if (error) 1042 goto out; 1043 count++; 1044 len -= sizeof(bareq); 1045 } 1046 out: 1047 BRIDGE_RT_UNLOCK(sc); 1048 1049 bac->ifbac_len = sizeof(bareq) * count; 1050 return (error); 1051 } 1052 1053 static int 1054 bridge_ioctl_saddr(struct bridge_softc *sc, void *arg) 1055 { 1056 struct ifbareq *req = arg; 1057 struct bridge_iflist *bif; 1058 int error; 1059 struct psref psref; 1060 1061 bif = bridge_lookup_member(sc, req->ifba_ifsname, &psref); 1062 if (bif == NULL) 1063 return (ENOENT); 1064 1065 error = bridge_rtupdate(sc, req->ifba_dst, bif->bif_ifp, 1, 1066 req->ifba_flags); 1067 1068 bridge_release_member(sc, bif, &psref); 1069 1070 return (error); 1071 } 1072 1073 static int 1074 bridge_ioctl_sto(struct bridge_softc *sc, void *arg) 1075 { 1076 struct ifbrparam *param = arg; 1077 1078 sc->sc_brttimeout = param->ifbrp_ctime; 1079 1080 return (0); 1081 } 1082 1083 static int 1084 bridge_ioctl_gto(struct bridge_softc *sc, void *arg) 1085 { 1086 struct ifbrparam *param = arg; 1087 1088 param->ifbrp_ctime = sc->sc_brttimeout; 1089 1090 return (0); 1091 } 1092 1093 static int 1094 bridge_ioctl_daddr(struct bridge_softc *sc, void *arg) 1095 { 1096 struct ifbareq *req = arg; 1097 1098 return (bridge_rtdaddr(sc, req->ifba_dst)); 1099 } 1100 1101 static int 1102 bridge_ioctl_flush(struct bridge_softc *sc, void *arg) 1103 { 1104 struct ifbreq *req = arg; 1105 1106 bridge_rtflush(sc, req->ifbr_ifsflags); 1107 1108 return (0); 1109 } 1110 1111 static int 1112 bridge_ioctl_gpri(struct bridge_softc *sc, void *arg) 1113 { 1114 struct ifbrparam *param = arg; 1115 1116 param->ifbrp_prio = sc->sc_bridge_priority; 1117 1118 return (0); 1119 } 1120 1121 static int 1122 bridge_ioctl_spri(struct bridge_softc *sc, void *arg) 1123 { 1124 struct ifbrparam *param = arg; 1125 1126 sc->sc_bridge_priority = param->ifbrp_prio; 1127 1128 if (sc->sc_if.if_flags & IFF_RUNNING) 1129 bstp_initialization(sc); 1130 1131 return (0); 1132 } 1133 1134 static int 1135 bridge_ioctl_ght(struct bridge_softc *sc, void *arg) 1136 { 1137 struct ifbrparam *param = arg; 1138 1139 param->ifbrp_hellotime = sc->sc_bridge_hello_time >> 8; 1140 1141 return (0); 1142 } 1143 1144 static int 1145 bridge_ioctl_sht(struct bridge_softc *sc, void *arg) 1146 { 1147 struct ifbrparam *param = arg; 1148 1149 if (param->ifbrp_hellotime == 0) 1150 return (EINVAL); 1151 sc->sc_bridge_hello_time = param->ifbrp_hellotime << 8; 1152 1153 if (sc->sc_if.if_flags & IFF_RUNNING) 1154 bstp_initialization(sc); 1155 1156 return (0); 1157 } 1158 1159 static int 1160 bridge_ioctl_gfd(struct bridge_softc *sc, void *arg) 1161 { 1162 struct ifbrparam *param = arg; 1163 1164 param->ifbrp_fwddelay = sc->sc_bridge_forward_delay >> 8; 1165 1166 return (0); 1167 } 1168 1169 static int 1170 bridge_ioctl_sfd(struct bridge_softc *sc, void *arg) 1171 { 1172 struct ifbrparam *param = arg; 1173 1174 if (param->ifbrp_fwddelay == 0) 1175 return (EINVAL); 1176 sc->sc_bridge_forward_delay = param->ifbrp_fwddelay << 8; 1177 1178 if (sc->sc_if.if_flags & IFF_RUNNING) 1179 bstp_initialization(sc); 1180 1181 return (0); 1182 } 1183 1184 static int 1185 bridge_ioctl_gma(struct bridge_softc *sc, void *arg) 1186 { 1187 struct ifbrparam *param = arg; 1188 1189 param->ifbrp_maxage = sc->sc_bridge_max_age >> 8; 1190 1191 return (0); 1192 } 1193 1194 static int 1195 bridge_ioctl_sma(struct bridge_softc *sc, void *arg) 1196 { 1197 struct ifbrparam *param = arg; 1198 1199 if (param->ifbrp_maxage == 0) 1200 return (EINVAL); 1201 sc->sc_bridge_max_age = param->ifbrp_maxage << 8; 1202 1203 if (sc->sc_if.if_flags & IFF_RUNNING) 1204 bstp_initialization(sc); 1205 1206 return (0); 1207 } 1208 1209 static int 1210 bridge_ioctl_sifprio(struct bridge_softc *sc, void *arg) 1211 { 1212 struct ifbreq *req = arg; 1213 struct bridge_iflist *bif; 1214 struct psref psref; 1215 1216 bif = bridge_lookup_member(sc, req->ifbr_ifsname, &psref); 1217 if (bif == NULL) 1218 return (ENOENT); 1219 1220 bif->bif_priority = req->ifbr_priority; 1221 1222 if (sc->sc_if.if_flags & IFF_RUNNING) 1223 bstp_initialization(sc); 1224 1225 bridge_release_member(sc, bif, &psref); 1226 1227 return (0); 1228 } 1229 1230 #if defined(BRIDGE_IPF) 1231 static int 1232 bridge_ioctl_gfilt(struct bridge_softc *sc, void *arg) 1233 { 1234 struct ifbrparam *param = arg; 1235 1236 param->ifbrp_filter = sc->sc_filter_flags; 1237 1238 return (0); 1239 } 1240 1241 static int 1242 bridge_ioctl_sfilt(struct bridge_softc *sc, void *arg) 1243 { 1244 struct ifbrparam *param = arg; 1245 uint32_t nflags, oflags; 1246 1247 if (param->ifbrp_filter & ~IFBF_FILT_MASK) 1248 return (EINVAL); 1249 1250 nflags = param->ifbrp_filter; 1251 oflags = sc->sc_filter_flags; 1252 1253 if ((nflags & IFBF_FILT_USEIPF) && !(oflags & IFBF_FILT_USEIPF)) { 1254 pfil_add_hook((void *)bridge_ipf, NULL, PFIL_IN|PFIL_OUT, 1255 sc->sc_if.if_pfil); 1256 } 1257 if (!(nflags & IFBF_FILT_USEIPF) && (oflags & IFBF_FILT_USEIPF)) { 1258 pfil_remove_hook((void *)bridge_ipf, NULL, PFIL_IN|PFIL_OUT, 1259 sc->sc_if.if_pfil); 1260 } 1261 1262 sc->sc_filter_flags = nflags; 1263 1264 return (0); 1265 } 1266 #endif /* BRIDGE_IPF */ 1267 1268 static int 1269 bridge_ioctl_sifcost(struct bridge_softc *sc, void *arg) 1270 { 1271 struct ifbreq *req = arg; 1272 struct bridge_iflist *bif; 1273 struct psref psref; 1274 1275 bif = bridge_lookup_member(sc, req->ifbr_ifsname, &psref); 1276 if (bif == NULL) 1277 return (ENOENT); 1278 1279 bif->bif_path_cost = req->ifbr_path_cost; 1280 1281 if (sc->sc_if.if_flags & IFF_RUNNING) 1282 bstp_initialization(sc); 1283 1284 bridge_release_member(sc, bif, &psref); 1285 1286 return (0); 1287 } 1288 1289 /* 1290 * bridge_ifdetach: 1291 * 1292 * Detach an interface from a bridge. Called when a member 1293 * interface is detaching. 1294 */ 1295 void 1296 bridge_ifdetach(struct ifnet *ifp) 1297 { 1298 struct bridge_softc *sc = ifp->if_bridge; 1299 struct ifbreq breq; 1300 1301 /* ioctl_lock should prevent this from happening */ 1302 KASSERT(sc != NULL); 1303 1304 memset(&breq, 0, sizeof(breq)); 1305 strlcpy(breq.ifbr_ifsname, ifp->if_xname, sizeof(breq.ifbr_ifsname)); 1306 1307 (void) bridge_ioctl_del(sc, &breq); 1308 } 1309 1310 /* 1311 * bridge_init: 1312 * 1313 * Initialize a bridge interface. 1314 */ 1315 static int 1316 bridge_init(struct ifnet *ifp) 1317 { 1318 struct bridge_softc *sc = ifp->if_softc; 1319 1320 if (ifp->if_flags & IFF_RUNNING) 1321 return (0); 1322 1323 callout_reset(&sc->sc_brcallout, bridge_rtable_prune_period * hz, 1324 bridge_timer, sc); 1325 1326 ifp->if_flags |= IFF_RUNNING; 1327 bstp_initialization(sc); 1328 return (0); 1329 } 1330 1331 /* 1332 * bridge_stop: 1333 * 1334 * Stop the bridge interface. 1335 */ 1336 static void 1337 bridge_stop(struct ifnet *ifp, int disable) 1338 { 1339 struct bridge_softc *sc = ifp->if_softc; 1340 1341 if ((ifp->if_flags & IFF_RUNNING) == 0) 1342 return; 1343 1344 callout_stop(&sc->sc_brcallout); 1345 bstp_stop(sc); 1346 1347 bridge_rtflush(sc, IFBF_FLUSHDYN); 1348 1349 ifp->if_flags &= ~IFF_RUNNING; 1350 } 1351 1352 /* 1353 * bridge_enqueue: 1354 * 1355 * Enqueue a packet on a bridge member interface. 1356 */ 1357 void 1358 bridge_enqueue(struct bridge_softc *sc, struct ifnet *dst_ifp, struct mbuf *m, 1359 int runfilt) 1360 { 1361 int len, error; 1362 short mflags; 1363 1364 /* 1365 * Clear any in-bound checksum flags for this packet. 1366 */ 1367 m->m_pkthdr.csum_flags = 0; 1368 1369 if (runfilt) { 1370 if (pfil_run_hooks(sc->sc_if.if_pfil, &m, 1371 dst_ifp, PFIL_OUT) != 0) { 1372 if (m != NULL) 1373 m_freem(m); 1374 return; 1375 } 1376 if (m == NULL) 1377 return; 1378 } 1379 1380 #ifdef ALTQ 1381 /* 1382 * If ALTQ is enabled on the member interface, do 1383 * classification; the queueing discipline might 1384 * not require classification, but might require 1385 * the address family/header pointer in the pktattr. 1386 */ 1387 if (ALTQ_IS_ENABLED(&dst_ifp->if_snd)) { 1388 /* XXX IFT_ETHER */ 1389 altq_etherclassify(&dst_ifp->if_snd, m); 1390 } 1391 #endif /* ALTQ */ 1392 1393 len = m->m_pkthdr.len; 1394 mflags = m->m_flags; 1395 1396 error = (*dst_ifp->if_transmit)(dst_ifp, m); 1397 if (error) { 1398 /* mbuf is already freed */ 1399 sc->sc_if.if_oerrors++; 1400 return; 1401 } 1402 1403 sc->sc_if.if_opackets++; 1404 sc->sc_if.if_obytes += len; 1405 if (mflags & M_MCAST) 1406 sc->sc_if.if_omcasts++; 1407 } 1408 1409 /* 1410 * bridge_output: 1411 * 1412 * Send output from a bridge member interface. This 1413 * performs the bridging function for locally originated 1414 * packets. 1415 * 1416 * The mbuf has the Ethernet header already attached. We must 1417 * enqueue or free the mbuf before returning. 1418 */ 1419 int 1420 bridge_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *sa, 1421 const struct rtentry *rt) 1422 { 1423 struct ether_header *eh; 1424 struct ifnet *dst_if; 1425 struct bridge_softc *sc; 1426 int s; 1427 1428 if (m->m_len < ETHER_HDR_LEN) { 1429 m = m_pullup(m, ETHER_HDR_LEN); 1430 if (m == NULL) 1431 return (0); 1432 } 1433 1434 eh = mtod(m, struct ether_header *); 1435 sc = ifp->if_bridge; 1436 1437 if (ETHER_IS_MULTICAST(eh->ether_dhost)) { 1438 if (memcmp(etherbroadcastaddr, 1439 eh->ether_dhost, ETHER_ADDR_LEN) == 0) 1440 m->m_flags |= M_BCAST; 1441 else 1442 m->m_flags |= M_MCAST; 1443 } 1444 1445 /* 1446 * If bridge is down, but the original output interface is up, 1447 * go ahead and send out that interface. Otherwise, the packet 1448 * is dropped below. 1449 */ 1450 if (__predict_false(sc == NULL) || 1451 (sc->sc_if.if_flags & IFF_RUNNING) == 0) { 1452 dst_if = ifp; 1453 goto sendunicast; 1454 } 1455 1456 /* 1457 * If the packet is a multicast, or we don't know a better way to 1458 * get there, send to all interfaces. 1459 */ 1460 if ((m->m_flags & (M_MCAST | M_BCAST)) != 0) 1461 dst_if = NULL; 1462 else 1463 dst_if = bridge_rtlookup(sc, eh->ether_dhost); 1464 if (dst_if == NULL) { 1465 /* XXX Should call bridge_broadcast, but there are locking 1466 * issues which need resolving first. */ 1467 struct bridge_iflist *bif; 1468 struct mbuf *mc; 1469 bool used = false; 1470 1471 BRIDGE_PSZ_RENTER(s); 1472 BRIDGE_IFLIST_READER_FOREACH(bif, sc) { 1473 struct psref psref; 1474 1475 bridge_acquire_member(sc, bif, &psref); 1476 BRIDGE_PSZ_REXIT(s); 1477 1478 dst_if = bif->bif_ifp; 1479 if ((dst_if->if_flags & IFF_RUNNING) == 0) 1480 goto next; 1481 1482 /* 1483 * If this is not the original output interface, 1484 * and the interface is participating in spanning 1485 * tree, make sure the port is in a state that 1486 * allows forwarding. 1487 */ 1488 if (dst_if != ifp && 1489 (bif->bif_flags & IFBIF_STP) != 0) { 1490 switch (bif->bif_state) { 1491 case BSTP_IFSTATE_BLOCKING: 1492 case BSTP_IFSTATE_LISTENING: 1493 case BSTP_IFSTATE_DISABLED: 1494 goto next; 1495 } 1496 } 1497 1498 if (PSLIST_READER_NEXT(bif, struct bridge_iflist, 1499 bif_next) == NULL && 1500 ((m->m_flags & (M_MCAST | M_BCAST)) == 0 || 1501 dst_if == ifp)) 1502 { 1503 used = true; 1504 mc = m; 1505 } else { 1506 mc = m_copym(m, 0, M_COPYALL, M_NOWAIT); 1507 if (mc == NULL) { 1508 sc->sc_if.if_oerrors++; 1509 goto next; 1510 } 1511 } 1512 1513 #ifndef NET_MPSAFE 1514 s = splnet(); 1515 #endif 1516 bridge_enqueue(sc, dst_if, mc, 0); 1517 #ifndef NET_MPSAFE 1518 splx(s); 1519 #endif 1520 1521 if ((m->m_flags & (M_MCAST | M_BCAST)) != 0 && 1522 dst_if != ifp) 1523 { 1524 if (PSLIST_READER_NEXT(bif, 1525 struct bridge_iflist, bif_next) == NULL) 1526 { 1527 used = true; 1528 mc = m; 1529 } else { 1530 mc = m_copym(m, 0, M_COPYALL, 1531 M_DONTWAIT); 1532 if (mc == NULL) { 1533 sc->sc_if.if_oerrors++; 1534 goto next; 1535 } 1536 } 1537 1538 m_set_rcvif(mc, dst_if); 1539 mc->m_flags &= ~M_PROMISC; 1540 1541 #ifndef NET_MPSAFE 1542 s = splnet(); 1543 #endif 1544 ether_input(dst_if, mc); 1545 #ifndef NET_MPSAFE 1546 splx(s); 1547 #endif 1548 } 1549 1550 next: 1551 BRIDGE_PSZ_RENTER(s); 1552 bridge_release_member(sc, bif, &psref); 1553 1554 /* Guarantee we don't re-enter the loop as we already 1555 * decided we're at the end. */ 1556 if (used) 1557 break; 1558 } 1559 BRIDGE_PSZ_REXIT(s); 1560 1561 if (!used) 1562 m_freem(m); 1563 return (0); 1564 } 1565 1566 sendunicast: 1567 /* 1568 * XXX Spanning tree consideration here? 1569 */ 1570 1571 if ((dst_if->if_flags & IFF_RUNNING) == 0) { 1572 m_freem(m); 1573 return (0); 1574 } 1575 1576 #ifndef NET_MPSAFE 1577 s = splnet(); 1578 #endif 1579 bridge_enqueue(sc, dst_if, m, 0); 1580 #ifndef NET_MPSAFE 1581 splx(s); 1582 #endif 1583 1584 return (0); 1585 } 1586 1587 /* 1588 * bridge_start: 1589 * 1590 * Start output on a bridge. 1591 * 1592 * NOTE: This routine should never be called in this implementation. 1593 */ 1594 static void 1595 bridge_start(struct ifnet *ifp) 1596 { 1597 1598 printf("%s: bridge_start() called\n", ifp->if_xname); 1599 } 1600 1601 /* 1602 * bridge_forward: 1603 * 1604 * The forwarding function of the bridge. 1605 */ 1606 static void 1607 bridge_forward(struct bridge_softc *sc, struct mbuf *m) 1608 { 1609 struct bridge_iflist *bif; 1610 struct ifnet *src_if, *dst_if; 1611 struct ether_header *eh; 1612 struct psref psref; 1613 struct psref psref_src; 1614 DECLARE_LOCK_VARIABLE; 1615 1616 if ((sc->sc_if.if_flags & IFF_RUNNING) == 0) 1617 return; 1618 1619 src_if = m_get_rcvif_psref(m, &psref_src); 1620 if (src_if == NULL) { 1621 /* Interface is being destroyed? */ 1622 m_freem(m); 1623 goto out; 1624 } 1625 1626 sc->sc_if.if_ipackets++; 1627 sc->sc_if.if_ibytes += m->m_pkthdr.len; 1628 1629 /* 1630 * Look up the bridge_iflist. 1631 */ 1632 bif = bridge_lookup_member_if(sc, src_if, &psref); 1633 if (bif == NULL) { 1634 /* Interface is not a bridge member (anymore?) */ 1635 m_freem(m); 1636 goto out; 1637 } 1638 1639 if (bif->bif_flags & IFBIF_STP) { 1640 switch (bif->bif_state) { 1641 case BSTP_IFSTATE_BLOCKING: 1642 case BSTP_IFSTATE_LISTENING: 1643 case BSTP_IFSTATE_DISABLED: 1644 m_freem(m); 1645 bridge_release_member(sc, bif, &psref); 1646 goto out; 1647 } 1648 } 1649 1650 eh = mtod(m, struct ether_header *); 1651 1652 /* 1653 * If the interface is learning, and the source 1654 * address is valid and not multicast, record 1655 * the address. 1656 */ 1657 if ((bif->bif_flags & IFBIF_LEARNING) != 0 && 1658 ETHER_IS_MULTICAST(eh->ether_shost) == 0 && 1659 (eh->ether_shost[0] == 0 && 1660 eh->ether_shost[1] == 0 && 1661 eh->ether_shost[2] == 0 && 1662 eh->ether_shost[3] == 0 && 1663 eh->ether_shost[4] == 0 && 1664 eh->ether_shost[5] == 0) == 0) { 1665 (void) bridge_rtupdate(sc, eh->ether_shost, 1666 src_if, 0, IFBAF_DYNAMIC); 1667 } 1668 1669 if ((bif->bif_flags & IFBIF_STP) != 0 && 1670 bif->bif_state == BSTP_IFSTATE_LEARNING) { 1671 m_freem(m); 1672 bridge_release_member(sc, bif, &psref); 1673 goto out; 1674 } 1675 1676 bridge_release_member(sc, bif, &psref); 1677 1678 /* 1679 * At this point, the port either doesn't participate 1680 * in spanning tree or it is in the forwarding state. 1681 */ 1682 1683 /* 1684 * If the packet is unicast, destined for someone on 1685 * "this" side of the bridge, drop it. 1686 */ 1687 if ((m->m_flags & (M_BCAST|M_MCAST)) == 0) { 1688 dst_if = bridge_rtlookup(sc, eh->ether_dhost); 1689 if (src_if == dst_if) { 1690 m_freem(m); 1691 goto out; 1692 } 1693 } else { 1694 /* ...forward it to all interfaces. */ 1695 sc->sc_if.if_imcasts++; 1696 dst_if = NULL; 1697 } 1698 1699 if (pfil_run_hooks(sc->sc_if.if_pfil, &m, src_if, PFIL_IN) != 0) { 1700 if (m != NULL) 1701 m_freem(m); 1702 goto out; 1703 } 1704 if (m == NULL) 1705 goto out; 1706 1707 if (dst_if == NULL) { 1708 bridge_broadcast(sc, src_if, m); 1709 goto out; 1710 } 1711 1712 m_put_rcvif_psref(src_if, &psref_src); 1713 src_if = NULL; 1714 1715 /* 1716 * At this point, we're dealing with a unicast frame 1717 * going to a different interface. 1718 */ 1719 if ((dst_if->if_flags & IFF_RUNNING) == 0) { 1720 m_freem(m); 1721 goto out; 1722 } 1723 1724 bif = bridge_lookup_member_if(sc, dst_if, &psref); 1725 if (bif == NULL) { 1726 /* Not a member of the bridge (anymore?) */ 1727 m_freem(m); 1728 goto out; 1729 } 1730 1731 if (bif->bif_flags & IFBIF_STP) { 1732 switch (bif->bif_state) { 1733 case BSTP_IFSTATE_DISABLED: 1734 case BSTP_IFSTATE_BLOCKING: 1735 m_freem(m); 1736 bridge_release_member(sc, bif, &psref); 1737 goto out; 1738 } 1739 } 1740 1741 bridge_release_member(sc, bif, &psref); 1742 1743 ACQUIRE_GLOBAL_LOCKS(); 1744 bridge_enqueue(sc, dst_if, m, 1); 1745 RELEASE_GLOBAL_LOCKS(); 1746 out: 1747 if (src_if != NULL) 1748 m_put_rcvif_psref(src_if, &psref_src); 1749 return; 1750 } 1751 1752 static bool 1753 bstp_state_before_learning(struct bridge_iflist *bif) 1754 { 1755 if (bif->bif_flags & IFBIF_STP) { 1756 switch (bif->bif_state) { 1757 case BSTP_IFSTATE_BLOCKING: 1758 case BSTP_IFSTATE_LISTENING: 1759 case BSTP_IFSTATE_DISABLED: 1760 return true; 1761 } 1762 } 1763 return false; 1764 } 1765 1766 static bool 1767 bridge_ourether(struct bridge_iflist *bif, struct ether_header *eh, int src) 1768 { 1769 uint8_t *ether = src ? eh->ether_shost : eh->ether_dhost; 1770 1771 if (memcmp(CLLADDR(bif->bif_ifp->if_sadl), ether, ETHER_ADDR_LEN) == 0 1772 #if NCARP > 0 1773 || (bif->bif_ifp->if_carp && 1774 carp_ourether(bif->bif_ifp->if_carp, eh, IFT_ETHER, src) != NULL) 1775 #endif /* NCARP > 0 */ 1776 ) 1777 return true; 1778 1779 return false; 1780 } 1781 1782 /* 1783 * bridge_input: 1784 * 1785 * Receive input from a member interface. Queue the packet for 1786 * bridging if it is not for us. 1787 */ 1788 static void 1789 bridge_input(struct ifnet *ifp, struct mbuf *m) 1790 { 1791 struct bridge_softc *sc = ifp->if_bridge; 1792 struct bridge_iflist *bif; 1793 struct ether_header *eh; 1794 struct psref psref; 1795 DECLARE_LOCK_VARIABLE; 1796 1797 KASSERT(!cpu_intr_p()); 1798 1799 if (__predict_false(sc == NULL) || 1800 (sc->sc_if.if_flags & IFF_RUNNING) == 0) { 1801 ACQUIRE_GLOBAL_LOCKS(); 1802 ether_input(ifp, m); 1803 RELEASE_GLOBAL_LOCKS(); 1804 return; 1805 } 1806 1807 bif = bridge_lookup_member_if(sc, ifp, &psref); 1808 if (bif == NULL) { 1809 ACQUIRE_GLOBAL_LOCKS(); 1810 ether_input(ifp, m); 1811 RELEASE_GLOBAL_LOCKS(); 1812 return; 1813 } 1814 1815 eh = mtod(m, struct ether_header *); 1816 1817 if (ETHER_IS_MULTICAST(eh->ether_dhost)) { 1818 if (memcmp(etherbroadcastaddr, 1819 eh->ether_dhost, ETHER_ADDR_LEN) == 0) 1820 m->m_flags |= M_BCAST; 1821 else 1822 m->m_flags |= M_MCAST; 1823 } 1824 1825 /* 1826 * A 'fast' path for packets addressed to interfaces that are 1827 * part of this bridge. 1828 */ 1829 if (!(m->m_flags & (M_BCAST|M_MCAST)) && 1830 !bstp_state_before_learning(bif)) { 1831 struct bridge_iflist *_bif; 1832 struct ifnet *_ifp = NULL; 1833 int s; 1834 struct psref _psref; 1835 1836 BRIDGE_PSZ_RENTER(s); 1837 BRIDGE_IFLIST_READER_FOREACH(_bif, sc) { 1838 /* It is destined for us. */ 1839 if (bridge_ourether(_bif, eh, 0)) { 1840 bridge_acquire_member(sc, _bif, &_psref); 1841 BRIDGE_PSZ_REXIT(s); 1842 if (_bif->bif_flags & IFBIF_LEARNING) 1843 (void) bridge_rtupdate(sc, 1844 eh->ether_shost, ifp, 0, IFBAF_DYNAMIC); 1845 m_set_rcvif(m, _bif->bif_ifp); 1846 _ifp = _bif->bif_ifp; 1847 bridge_release_member(sc, _bif, &_psref); 1848 goto out; 1849 } 1850 1851 /* We just received a packet that we sent out. */ 1852 if (bridge_ourether(_bif, eh, 1)) 1853 break; 1854 } 1855 BRIDGE_PSZ_REXIT(s); 1856 out: 1857 1858 if (_bif != NULL) { 1859 bridge_release_member(sc, bif, &psref); 1860 if (_ifp != NULL) { 1861 m->m_flags &= ~M_PROMISC; 1862 ACQUIRE_GLOBAL_LOCKS(); 1863 ether_input(_ifp, m); 1864 RELEASE_GLOBAL_LOCKS(); 1865 } else 1866 m_freem(m); 1867 return; 1868 } 1869 } 1870 1871 /* Tap off 802.1D packets; they do not get forwarded. */ 1872 if (bif->bif_flags & IFBIF_STP && 1873 memcmp(eh->ether_dhost, bstp_etheraddr, ETHER_ADDR_LEN) == 0) { 1874 bstp_input(sc, bif, m); 1875 bridge_release_member(sc, bif, &psref); 1876 return; 1877 } 1878 1879 /* 1880 * A normal switch would discard the packet here, but that's not what 1881 * we've done historically. This also prevents some obnoxious behaviour. 1882 */ 1883 if (bstp_state_before_learning(bif)) { 1884 bridge_release_member(sc, bif, &psref); 1885 ACQUIRE_GLOBAL_LOCKS(); 1886 ether_input(ifp, m); 1887 RELEASE_GLOBAL_LOCKS(); 1888 return; 1889 } 1890 1891 bridge_release_member(sc, bif, &psref); 1892 1893 bridge_forward(sc, m); 1894 } 1895 1896 /* 1897 * bridge_broadcast: 1898 * 1899 * Send a frame to all interfaces that are members of 1900 * the bridge, except for the one on which the packet 1901 * arrived. 1902 */ 1903 static void 1904 bridge_broadcast(struct bridge_softc *sc, struct ifnet *src_if, 1905 struct mbuf *m) 1906 { 1907 struct bridge_iflist *bif; 1908 struct mbuf *mc; 1909 struct ifnet *dst_if; 1910 bool bmcast; 1911 int s; 1912 DECLARE_LOCK_VARIABLE; 1913 1914 bmcast = m->m_flags & (M_BCAST|M_MCAST); 1915 1916 BRIDGE_PSZ_RENTER(s); 1917 BRIDGE_IFLIST_READER_FOREACH(bif, sc) { 1918 struct psref psref; 1919 1920 bridge_acquire_member(sc, bif, &psref); 1921 BRIDGE_PSZ_REXIT(s); 1922 1923 dst_if = bif->bif_ifp; 1924 1925 if (bif->bif_flags & IFBIF_STP) { 1926 switch (bif->bif_state) { 1927 case BSTP_IFSTATE_BLOCKING: 1928 case BSTP_IFSTATE_DISABLED: 1929 goto next; 1930 } 1931 } 1932 1933 if ((bif->bif_flags & IFBIF_DISCOVER) == 0 && !bmcast) 1934 goto next; 1935 1936 if ((dst_if->if_flags & IFF_RUNNING) == 0) 1937 goto next; 1938 1939 if (dst_if != src_if) { 1940 mc = m_copym(m, 0, M_COPYALL, M_DONTWAIT); 1941 if (mc == NULL) { 1942 sc->sc_if.if_oerrors++; 1943 goto next; 1944 } 1945 ACQUIRE_GLOBAL_LOCKS(); 1946 bridge_enqueue(sc, dst_if, mc, 1); 1947 RELEASE_GLOBAL_LOCKS(); 1948 } 1949 1950 if (bmcast) { 1951 mc = m_copym(m, 0, M_COPYALL, M_DONTWAIT); 1952 if (mc == NULL) { 1953 sc->sc_if.if_oerrors++; 1954 goto next; 1955 } 1956 1957 m_set_rcvif(mc, dst_if); 1958 mc->m_flags &= ~M_PROMISC; 1959 1960 ACQUIRE_GLOBAL_LOCKS(); 1961 ether_input(dst_if, mc); 1962 RELEASE_GLOBAL_LOCKS(); 1963 } 1964 next: 1965 BRIDGE_PSZ_RENTER(s); 1966 bridge_release_member(sc, bif, &psref); 1967 } 1968 BRIDGE_PSZ_REXIT(s); 1969 1970 m_freem(m); 1971 } 1972 1973 static int 1974 bridge_rtalloc(struct bridge_softc *sc, const uint8_t *dst, 1975 struct bridge_rtnode **brtp) 1976 { 1977 struct bridge_rtnode *brt; 1978 int error; 1979 1980 if (sc->sc_brtcnt >= sc->sc_brtmax) 1981 return ENOSPC; 1982 1983 /* 1984 * Allocate a new bridge forwarding node, and 1985 * initialize the expiration time and Ethernet 1986 * address. 1987 */ 1988 brt = pool_get(&bridge_rtnode_pool, PR_NOWAIT); 1989 if (brt == NULL) 1990 return ENOMEM; 1991 1992 memset(brt, 0, sizeof(*brt)); 1993 brt->brt_expire = time_uptime + sc->sc_brttimeout; 1994 brt->brt_flags = IFBAF_DYNAMIC; 1995 memcpy(brt->brt_addr, dst, ETHER_ADDR_LEN); 1996 1997 BRIDGE_RT_LOCK(sc); 1998 error = bridge_rtnode_insert(sc, brt); 1999 BRIDGE_RT_UNLOCK(sc); 2000 2001 if (error != 0) { 2002 pool_put(&bridge_rtnode_pool, brt); 2003 return error; 2004 } 2005 2006 *brtp = brt; 2007 return 0; 2008 } 2009 2010 /* 2011 * bridge_rtupdate: 2012 * 2013 * Add a bridge routing entry. 2014 */ 2015 static int 2016 bridge_rtupdate(struct bridge_softc *sc, const uint8_t *dst, 2017 struct ifnet *dst_if, int setflags, uint8_t flags) 2018 { 2019 struct bridge_rtnode *brt; 2020 int s; 2021 2022 again: 2023 /* 2024 * A route for this destination might already exist. If so, 2025 * update it, otherwise create a new one. 2026 */ 2027 BRIDGE_RT_RENTER(s); 2028 brt = bridge_rtnode_lookup(sc, dst); 2029 2030 if (brt != NULL) { 2031 brt->brt_ifp = dst_if; 2032 if (setflags) { 2033 brt->brt_flags = flags; 2034 if (flags & IFBAF_STATIC) 2035 brt->brt_expire = 0; 2036 else 2037 brt->brt_expire = time_uptime + sc->sc_brttimeout; 2038 } else { 2039 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) 2040 brt->brt_expire = time_uptime + sc->sc_brttimeout; 2041 } 2042 } 2043 BRIDGE_RT_REXIT(s); 2044 2045 if (brt == NULL) { 2046 int r; 2047 2048 r = bridge_rtalloc(sc, dst, &brt); 2049 if (r != 0) 2050 return r; 2051 goto again; 2052 } 2053 2054 return 0; 2055 } 2056 2057 /* 2058 * bridge_rtlookup: 2059 * 2060 * Lookup the destination interface for an address. 2061 */ 2062 static struct ifnet * 2063 bridge_rtlookup(struct bridge_softc *sc, const uint8_t *addr) 2064 { 2065 struct bridge_rtnode *brt; 2066 struct ifnet *ifs = NULL; 2067 int s; 2068 2069 BRIDGE_RT_RENTER(s); 2070 brt = bridge_rtnode_lookup(sc, addr); 2071 if (brt != NULL) 2072 ifs = brt->brt_ifp; 2073 BRIDGE_RT_REXIT(s); 2074 2075 return ifs; 2076 } 2077 2078 typedef bool (*bridge_iterate_cb_t) 2079 (struct bridge_softc *, struct bridge_rtnode *, bool *, void *); 2080 2081 /* 2082 * bridge_rtlist_iterate_remove: 2083 * 2084 * It iterates on sc->sc_rtlist and removes rtnodes of it which func 2085 * callback judges to remove. Removals of rtnodes are done in a manner 2086 * of pserialize. To this end, all kmem_* operations are placed out of 2087 * mutexes. 2088 */ 2089 static void 2090 bridge_rtlist_iterate_remove(struct bridge_softc *sc, bridge_iterate_cb_t func, void *arg) 2091 { 2092 struct bridge_rtnode *brt, *nbrt; 2093 struct bridge_rtnode **brt_list; 2094 int i, count; 2095 2096 retry: 2097 count = sc->sc_brtcnt; 2098 if (count == 0) 2099 return; 2100 brt_list = kmem_alloc(sizeof(*brt_list) * count, KM_SLEEP); 2101 2102 BRIDGE_RT_LOCK(sc); 2103 if (__predict_false(sc->sc_brtcnt > count)) { 2104 /* The rtnodes increased, we need more memory */ 2105 BRIDGE_RT_UNLOCK(sc); 2106 kmem_free(brt_list, sizeof(*brt_list) * count); 2107 goto retry; 2108 } 2109 2110 i = 0; 2111 LIST_FOREACH_SAFE(brt, &sc->sc_rtlist, brt_list, nbrt) { 2112 bool need_break = false; 2113 if (func(sc, brt, &need_break, arg)) { 2114 bridge_rtnode_remove(sc, brt); 2115 brt_list[i++] = brt; 2116 } 2117 if (need_break) 2118 break; 2119 } 2120 2121 if (i > 0) 2122 BRIDGE_RT_PSZ_PERFORM(sc); 2123 BRIDGE_RT_UNLOCK(sc); 2124 2125 while (--i >= 0) 2126 bridge_rtnode_destroy(brt_list[i]); 2127 2128 kmem_free(brt_list, sizeof(*brt_list) * count); 2129 } 2130 2131 static bool 2132 bridge_rttrim0_cb(struct bridge_softc *sc, struct bridge_rtnode *brt, 2133 bool *need_break, void *arg) 2134 { 2135 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) { 2136 /* Take into account of the subsequent removal */ 2137 if ((sc->sc_brtcnt - 1) <= sc->sc_brtmax) 2138 *need_break = true; 2139 return true; 2140 } else 2141 return false; 2142 } 2143 2144 static void 2145 bridge_rttrim0(struct bridge_softc *sc) 2146 { 2147 bridge_rtlist_iterate_remove(sc, bridge_rttrim0_cb, NULL); 2148 } 2149 2150 /* 2151 * bridge_rttrim: 2152 * 2153 * Trim the routine table so that we have a number 2154 * of routing entries less than or equal to the 2155 * maximum number. 2156 */ 2157 static void 2158 bridge_rttrim(struct bridge_softc *sc) 2159 { 2160 2161 /* Make sure we actually need to do this. */ 2162 if (sc->sc_brtcnt <= sc->sc_brtmax) 2163 return; 2164 2165 /* Force an aging cycle; this might trim enough addresses. */ 2166 bridge_rtage(sc); 2167 if (sc->sc_brtcnt <= sc->sc_brtmax) 2168 return; 2169 2170 bridge_rttrim0(sc); 2171 2172 return; 2173 } 2174 2175 /* 2176 * bridge_timer: 2177 * 2178 * Aging timer for the bridge. 2179 */ 2180 static void 2181 bridge_timer(void *arg) 2182 { 2183 struct bridge_softc *sc = arg; 2184 2185 workqueue_enqueue(sc->sc_rtage_wq, &sc->sc_rtage_wk, NULL); 2186 } 2187 2188 static void 2189 bridge_rtage_work(struct work *wk, void *arg) 2190 { 2191 struct bridge_softc *sc = arg; 2192 2193 KASSERT(wk == &sc->sc_rtage_wk); 2194 2195 bridge_rtage(sc); 2196 2197 if (sc->sc_if.if_flags & IFF_RUNNING) 2198 callout_reset(&sc->sc_brcallout, 2199 bridge_rtable_prune_period * hz, bridge_timer, sc); 2200 } 2201 2202 static bool 2203 bridge_rtage_cb(struct bridge_softc *sc, struct bridge_rtnode *brt, 2204 bool *need_break, void *arg) 2205 { 2206 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC && 2207 time_uptime >= brt->brt_expire) 2208 return true; 2209 else 2210 return false; 2211 } 2212 2213 /* 2214 * bridge_rtage: 2215 * 2216 * Perform an aging cycle. 2217 */ 2218 static void 2219 bridge_rtage(struct bridge_softc *sc) 2220 { 2221 bridge_rtlist_iterate_remove(sc, bridge_rtage_cb, NULL); 2222 } 2223 2224 2225 static bool 2226 bridge_rtflush_cb(struct bridge_softc *sc, struct bridge_rtnode *brt, 2227 bool *need_break, void *arg) 2228 { 2229 int full = *(int*)arg; 2230 2231 if (full || (brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) 2232 return true; 2233 else 2234 return false; 2235 } 2236 2237 /* 2238 * bridge_rtflush: 2239 * 2240 * Remove all dynamic addresses from the bridge. 2241 */ 2242 static void 2243 bridge_rtflush(struct bridge_softc *sc, int full) 2244 { 2245 bridge_rtlist_iterate_remove(sc, bridge_rtflush_cb, &full); 2246 } 2247 2248 /* 2249 * bridge_rtdaddr: 2250 * 2251 * Remove an address from the table. 2252 */ 2253 static int 2254 bridge_rtdaddr(struct bridge_softc *sc, const uint8_t *addr) 2255 { 2256 struct bridge_rtnode *brt; 2257 2258 BRIDGE_RT_LOCK(sc); 2259 if ((brt = bridge_rtnode_lookup(sc, addr)) == NULL) { 2260 BRIDGE_RT_UNLOCK(sc); 2261 return ENOENT; 2262 } 2263 bridge_rtnode_remove(sc, brt); 2264 BRIDGE_RT_PSZ_PERFORM(sc); 2265 BRIDGE_RT_UNLOCK(sc); 2266 2267 bridge_rtnode_destroy(brt); 2268 2269 return 0; 2270 } 2271 2272 /* 2273 * bridge_rtdelete: 2274 * 2275 * Delete routes to a speicifc member interface. 2276 */ 2277 static void 2278 bridge_rtdelete(struct bridge_softc *sc, struct ifnet *ifp) 2279 { 2280 struct bridge_rtnode *brt; 2281 2282 BRIDGE_RT_LOCK(sc); 2283 LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) { 2284 if (brt->brt_ifp == ifp) 2285 break; 2286 } 2287 if (brt == NULL) { 2288 BRIDGE_RT_UNLOCK(sc); 2289 return; 2290 } 2291 bridge_rtnode_remove(sc, brt); 2292 BRIDGE_RT_PSZ_PERFORM(sc); 2293 BRIDGE_RT_UNLOCK(sc); 2294 2295 bridge_rtnode_destroy(brt); 2296 } 2297 2298 /* 2299 * bridge_rtable_init: 2300 * 2301 * Initialize the route table for this bridge. 2302 */ 2303 static void 2304 bridge_rtable_init(struct bridge_softc *sc) 2305 { 2306 int i; 2307 2308 sc->sc_rthash = kmem_alloc(sizeof(*sc->sc_rthash) * BRIDGE_RTHASH_SIZE, 2309 KM_SLEEP); 2310 2311 for (i = 0; i < BRIDGE_RTHASH_SIZE; i++) 2312 LIST_INIT(&sc->sc_rthash[i]); 2313 2314 sc->sc_rthash_key = cprng_fast32(); 2315 2316 LIST_INIT(&sc->sc_rtlist); 2317 2318 sc->sc_rtlist_psz = pserialize_create(); 2319 sc->sc_rtlist_lock = mutex_obj_alloc(MUTEX_DEFAULT, IPL_SOFTNET); 2320 } 2321 2322 /* 2323 * bridge_rtable_fini: 2324 * 2325 * Deconstruct the route table for this bridge. 2326 */ 2327 static void 2328 bridge_rtable_fini(struct bridge_softc *sc) 2329 { 2330 2331 kmem_free(sc->sc_rthash, sizeof(*sc->sc_rthash) * BRIDGE_RTHASH_SIZE); 2332 if (sc->sc_rtlist_lock) 2333 mutex_obj_free(sc->sc_rtlist_lock); 2334 if (sc->sc_rtlist_psz) 2335 pserialize_destroy(sc->sc_rtlist_psz); 2336 } 2337 2338 /* 2339 * The following hash function is adapted from "Hash Functions" by Bob Jenkins 2340 * ("Algorithm Alley", Dr. Dobbs Journal, September 1997). 2341 */ 2342 #define mix(a, b, c) \ 2343 do { \ 2344 a -= b; a -= c; a ^= (c >> 13); \ 2345 b -= c; b -= a; b ^= (a << 8); \ 2346 c -= a; c -= b; c ^= (b >> 13); \ 2347 a -= b; a -= c; a ^= (c >> 12); \ 2348 b -= c; b -= a; b ^= (a << 16); \ 2349 c -= a; c -= b; c ^= (b >> 5); \ 2350 a -= b; a -= c; a ^= (c >> 3); \ 2351 b -= c; b -= a; b ^= (a << 10); \ 2352 c -= a; c -= b; c ^= (b >> 15); \ 2353 } while (/*CONSTCOND*/0) 2354 2355 static inline uint32_t 2356 bridge_rthash(struct bridge_softc *sc, const uint8_t *addr) 2357 { 2358 uint32_t a = 0x9e3779b9, b = 0x9e3779b9, c = sc->sc_rthash_key; 2359 2360 b += addr[5] << 8; 2361 b += addr[4]; 2362 a += addr[3] << 24; 2363 a += addr[2] << 16; 2364 a += addr[1] << 8; 2365 a += addr[0]; 2366 2367 mix(a, b, c); 2368 2369 return (c & BRIDGE_RTHASH_MASK); 2370 } 2371 2372 #undef mix 2373 2374 /* 2375 * bridge_rtnode_lookup: 2376 * 2377 * Look up a bridge route node for the specified destination. 2378 */ 2379 static struct bridge_rtnode * 2380 bridge_rtnode_lookup(struct bridge_softc *sc, const uint8_t *addr) 2381 { 2382 struct bridge_rtnode *brt; 2383 uint32_t hash; 2384 int dir; 2385 2386 hash = bridge_rthash(sc, addr); 2387 LIST_FOREACH(brt, &sc->sc_rthash[hash], brt_hash) { 2388 dir = memcmp(addr, brt->brt_addr, ETHER_ADDR_LEN); 2389 if (dir == 0) 2390 return (brt); 2391 if (dir > 0) 2392 return (NULL); 2393 } 2394 2395 return (NULL); 2396 } 2397 2398 /* 2399 * bridge_rtnode_insert: 2400 * 2401 * Insert the specified bridge node into the route table. We 2402 * assume the entry is not already in the table. 2403 */ 2404 static int 2405 bridge_rtnode_insert(struct bridge_softc *sc, struct bridge_rtnode *brt) 2406 { 2407 struct bridge_rtnode *lbrt; 2408 uint32_t hash; 2409 int dir; 2410 2411 KASSERT(BRIDGE_RT_LOCKED(sc)); 2412 2413 hash = bridge_rthash(sc, brt->brt_addr); 2414 2415 lbrt = LIST_FIRST(&sc->sc_rthash[hash]); 2416 if (lbrt == NULL) { 2417 LIST_INSERT_HEAD(&sc->sc_rthash[hash], brt, brt_hash); 2418 goto out; 2419 } 2420 2421 do { 2422 dir = memcmp(brt->brt_addr, lbrt->brt_addr, ETHER_ADDR_LEN); 2423 if (dir == 0) 2424 return (EEXIST); 2425 if (dir > 0) { 2426 LIST_INSERT_BEFORE(lbrt, brt, brt_hash); 2427 goto out; 2428 } 2429 if (LIST_NEXT(lbrt, brt_hash) == NULL) { 2430 LIST_INSERT_AFTER(lbrt, brt, brt_hash); 2431 goto out; 2432 } 2433 lbrt = LIST_NEXT(lbrt, brt_hash); 2434 } while (lbrt != NULL); 2435 2436 #ifdef DIAGNOSTIC 2437 panic("bridge_rtnode_insert: impossible"); 2438 #endif 2439 2440 out: 2441 LIST_INSERT_HEAD(&sc->sc_rtlist, brt, brt_list); 2442 sc->sc_brtcnt++; 2443 2444 return (0); 2445 } 2446 2447 /* 2448 * bridge_rtnode_remove: 2449 * 2450 * Remove a bridge rtnode from the rthash and the rtlist of a bridge. 2451 */ 2452 static void 2453 bridge_rtnode_remove(struct bridge_softc *sc, struct bridge_rtnode *brt) 2454 { 2455 2456 KASSERT(BRIDGE_RT_LOCKED(sc)); 2457 2458 LIST_REMOVE(brt, brt_hash); 2459 LIST_REMOVE(brt, brt_list); 2460 sc->sc_brtcnt--; 2461 } 2462 2463 /* 2464 * bridge_rtnode_destroy: 2465 * 2466 * Destroy a bridge rtnode. 2467 */ 2468 static void 2469 bridge_rtnode_destroy(struct bridge_rtnode *brt) 2470 { 2471 2472 pool_put(&bridge_rtnode_pool, brt); 2473 } 2474 2475 #if defined(BRIDGE_IPF) 2476 extern pfil_head_t *inet_pfil_hook; /* XXX */ 2477 extern pfil_head_t *inet6_pfil_hook; /* XXX */ 2478 2479 /* 2480 * Send bridge packets through IPF if they are one of the types IPF can deal 2481 * with, or if they are ARP or REVARP. (IPF will pass ARP and REVARP without 2482 * question.) 2483 */ 2484 static int 2485 bridge_ipf(void *arg, struct mbuf **mp, struct ifnet *ifp, int dir) 2486 { 2487 int snap, error; 2488 struct ether_header *eh1, eh2; 2489 struct llc llc1; 2490 uint16_t ether_type; 2491 2492 snap = 0; 2493 error = -1; /* Default error if not error == 0 */ 2494 eh1 = mtod(*mp, struct ether_header *); 2495 ether_type = ntohs(eh1->ether_type); 2496 2497 /* 2498 * Check for SNAP/LLC. 2499 */ 2500 if (ether_type < ETHERMTU) { 2501 struct llc *llc2 = (struct llc *)(eh1 + 1); 2502 2503 if ((*mp)->m_len >= ETHER_HDR_LEN + 8 && 2504 llc2->llc_dsap == LLC_SNAP_LSAP && 2505 llc2->llc_ssap == LLC_SNAP_LSAP && 2506 llc2->llc_control == LLC_UI) { 2507 ether_type = htons(llc2->llc_un.type_snap.ether_type); 2508 snap = 1; 2509 } 2510 } 2511 2512 /* 2513 * If we're trying to filter bridge traffic, don't look at anything 2514 * other than IP and ARP traffic. If the filter doesn't understand 2515 * IPv6, don't allow IPv6 through the bridge either. This is lame 2516 * since if we really wanted, say, an AppleTalk filter, we are hosed, 2517 * but of course we don't have an AppleTalk filter to begin with. 2518 * (Note that since IPF doesn't understand ARP it will pass *ALL* 2519 * ARP traffic.) 2520 */ 2521 switch (ether_type) { 2522 case ETHERTYPE_ARP: 2523 case ETHERTYPE_REVARP: 2524 return 0; /* Automatically pass */ 2525 case ETHERTYPE_IP: 2526 # ifdef INET6 2527 case ETHERTYPE_IPV6: 2528 # endif /* INET6 */ 2529 break; 2530 default: 2531 goto bad; 2532 } 2533 2534 /* Strip off the Ethernet header and keep a copy. */ 2535 m_copydata(*mp, 0, ETHER_HDR_LEN, (void *) &eh2); 2536 m_adj(*mp, ETHER_HDR_LEN); 2537 2538 /* Strip off snap header, if present */ 2539 if (snap) { 2540 m_copydata(*mp, 0, sizeof(struct llc), (void *) &llc1); 2541 m_adj(*mp, sizeof(struct llc)); 2542 } 2543 2544 /* 2545 * Check basic packet sanity and run IPF through pfil. 2546 */ 2547 KASSERT(!cpu_intr_p()); 2548 switch (ether_type) 2549 { 2550 case ETHERTYPE_IP : 2551 error = (dir == PFIL_IN) ? bridge_ip_checkbasic(mp) : 0; 2552 if (error == 0) 2553 error = pfil_run_hooks(inet_pfil_hook, mp, ifp, dir); 2554 break; 2555 # ifdef INET6 2556 case ETHERTYPE_IPV6 : 2557 error = (dir == PFIL_IN) ? bridge_ip6_checkbasic(mp) : 0; 2558 if (error == 0) 2559 error = pfil_run_hooks(inet6_pfil_hook, mp, ifp, dir); 2560 break; 2561 # endif 2562 default : 2563 error = 0; 2564 break; 2565 } 2566 2567 if (*mp == NULL) 2568 return error; 2569 if (error != 0) 2570 goto bad; 2571 2572 error = -1; 2573 2574 /* 2575 * Finally, put everything back the way it was and return 2576 */ 2577 if (snap) { 2578 M_PREPEND(*mp, sizeof(struct llc), M_DONTWAIT); 2579 if (*mp == NULL) 2580 return error; 2581 bcopy(&llc1, mtod(*mp, void *), sizeof(struct llc)); 2582 } 2583 2584 M_PREPEND(*mp, ETHER_HDR_LEN, M_DONTWAIT); 2585 if (*mp == NULL) 2586 return error; 2587 bcopy(&eh2, mtod(*mp, void *), ETHER_HDR_LEN); 2588 2589 return 0; 2590 2591 bad: 2592 m_freem(*mp); 2593 *mp = NULL; 2594 return error; 2595 } 2596 2597 /* 2598 * Perform basic checks on header size since 2599 * IPF assumes ip_input has already processed 2600 * it for it. Cut-and-pasted from ip_input.c. 2601 * Given how simple the IPv6 version is, 2602 * does the IPv4 version really need to be 2603 * this complicated? 2604 * 2605 * XXX Should we update ipstat here, or not? 2606 * XXX Right now we update ipstat but not 2607 * XXX csum_counter. 2608 */ 2609 static int 2610 bridge_ip_checkbasic(struct mbuf **mp) 2611 { 2612 struct mbuf *m = *mp; 2613 struct ip *ip; 2614 int len, hlen; 2615 2616 if (*mp == NULL) 2617 return -1; 2618 2619 if (IP_HDR_ALIGNED_P(mtod(m, void *)) == 0) { 2620 if ((m = m_copyup(m, sizeof(struct ip), 2621 (max_linkhdr + 3) & ~3)) == NULL) { 2622 /* XXXJRT new stat, please */ 2623 ip_statinc(IP_STAT_TOOSMALL); 2624 goto bad; 2625 } 2626 } else if (__predict_false(m->m_len < sizeof (struct ip))) { 2627 if ((m = m_pullup(m, sizeof (struct ip))) == NULL) { 2628 ip_statinc(IP_STAT_TOOSMALL); 2629 goto bad; 2630 } 2631 } 2632 ip = mtod(m, struct ip *); 2633 if (ip == NULL) goto bad; 2634 2635 if (ip->ip_v != IPVERSION) { 2636 ip_statinc(IP_STAT_BADVERS); 2637 goto bad; 2638 } 2639 hlen = ip->ip_hl << 2; 2640 if (hlen < sizeof(struct ip)) { /* minimum header length */ 2641 ip_statinc(IP_STAT_BADHLEN); 2642 goto bad; 2643 } 2644 if (hlen > m->m_len) { 2645 if ((m = m_pullup(m, hlen)) == 0) { 2646 ip_statinc(IP_STAT_BADHLEN); 2647 goto bad; 2648 } 2649 ip = mtod(m, struct ip *); 2650 if (ip == NULL) goto bad; 2651 } 2652 2653 switch (m->m_pkthdr.csum_flags & 2654 ((m_get_rcvif_NOMPSAFE(m)->if_csum_flags_rx & M_CSUM_IPv4) | 2655 M_CSUM_IPv4_BAD)) { 2656 case M_CSUM_IPv4|M_CSUM_IPv4_BAD: 2657 /* INET_CSUM_COUNTER_INCR(&ip_hwcsum_bad); */ 2658 goto bad; 2659 2660 case M_CSUM_IPv4: 2661 /* Checksum was okay. */ 2662 /* INET_CSUM_COUNTER_INCR(&ip_hwcsum_ok); */ 2663 break; 2664 2665 default: 2666 /* Must compute it ourselves. */ 2667 /* INET_CSUM_COUNTER_INCR(&ip_swcsum); */ 2668 if (in_cksum(m, hlen) != 0) 2669 goto bad; 2670 break; 2671 } 2672 2673 /* Retrieve the packet length. */ 2674 len = ntohs(ip->ip_len); 2675 2676 /* 2677 * Check for additional length bogosity 2678 */ 2679 if (len < hlen) { 2680 ip_statinc(IP_STAT_BADLEN); 2681 goto bad; 2682 } 2683 2684 /* 2685 * Check that the amount of data in the buffers 2686 * is as at least much as the IP header would have us expect. 2687 * Drop packet if shorter than we expect. 2688 */ 2689 if (m->m_pkthdr.len < len) { 2690 ip_statinc(IP_STAT_TOOSHORT); 2691 goto bad; 2692 } 2693 2694 /* Checks out, proceed */ 2695 *mp = m; 2696 return 0; 2697 2698 bad: 2699 *mp = m; 2700 return -1; 2701 } 2702 2703 # ifdef INET6 2704 /* 2705 * Same as above, but for IPv6. 2706 * Cut-and-pasted from ip6_input.c. 2707 * XXX Should we update ip6stat, or not? 2708 */ 2709 static int 2710 bridge_ip6_checkbasic(struct mbuf **mp) 2711 { 2712 struct mbuf *m = *mp; 2713 struct ip6_hdr *ip6; 2714 2715 /* 2716 * If the IPv6 header is not aligned, slurp it up into a new 2717 * mbuf with space for link headers, in the event we forward 2718 * it. Otherwise, if it is aligned, make sure the entire base 2719 * IPv6 header is in the first mbuf of the chain. 2720 */ 2721 if (IP6_HDR_ALIGNED_P(mtod(m, void *)) == 0) { 2722 struct ifnet *inifp = m_get_rcvif_NOMPSAFE(m); 2723 if ((m = m_copyup(m, sizeof(struct ip6_hdr), 2724 (max_linkhdr + 3) & ~3)) == NULL) { 2725 /* XXXJRT new stat, please */ 2726 ip6_statinc(IP6_STAT_TOOSMALL); 2727 in6_ifstat_inc(inifp, ifs6_in_hdrerr); 2728 goto bad; 2729 } 2730 } else if (__predict_false(m->m_len < sizeof(struct ip6_hdr))) { 2731 struct ifnet *inifp = m_get_rcvif_NOMPSAFE(m); 2732 if ((m = m_pullup(m, sizeof(struct ip6_hdr))) == NULL) { 2733 ip6_statinc(IP6_STAT_TOOSMALL); 2734 in6_ifstat_inc(inifp, ifs6_in_hdrerr); 2735 goto bad; 2736 } 2737 } 2738 2739 ip6 = mtod(m, struct ip6_hdr *); 2740 2741 if ((ip6->ip6_vfc & IPV6_VERSION_MASK) != IPV6_VERSION) { 2742 ip6_statinc(IP6_STAT_BADVERS); 2743 in6_ifstat_inc(m_get_rcvif_NOMPSAFE(m), ifs6_in_hdrerr); 2744 goto bad; 2745 } 2746 2747 /* Checks out, proceed */ 2748 *mp = m; 2749 return 0; 2750 2751 bad: 2752 *mp = m; 2753 return -1; 2754 } 2755 # endif /* INET6 */ 2756 #endif /* BRIDGE_IPF */ 2757
Indexes created Thu Oct 02 14:10:14 GMT 2025