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