if_bridge.c revision 1.122 1 /* $NetBSD: if_bridge.c,v 1.122 2016/05/04 18:59:55 roy 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.122 2016/05/04 18:59:55 roy 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
732 ifs = ifunit(req->ifbr_ifsname);
733 if (ifs == NULL)
734 return (ENOENT);
735
736 if (sc->sc_if.if_mtu != ifs->if_mtu)
737 return (EINVAL);
738
739 if (ifs->if_bridge == sc)
740 return (EEXIST);
741
742 if (ifs->if_bridge != NULL)
743 return (EBUSY);
744
745 if (ifs->_if_input != ether_input)
746 return EINVAL;
747
748 /* FIXME: doesn't work with non-IFF_SIMPLEX interfaces */
749 if ((ifs->if_flags & IFF_SIMPLEX) == 0)
750 return EINVAL;
751
752 bif = kmem_alloc(sizeof(*bif), KM_SLEEP);
753
754 switch (ifs->if_type) {
755 case IFT_ETHER:
756 if ((error = ether_enable_vlan_mtu(ifs)) > 0)
757 goto out;
758 /*
759 * Place the interface into promiscuous mode.
760 */
761 error = ifpromisc(ifs, 1);
762 if (error)
763 goto out;
764 break;
765 default:
766 error = EINVAL;
767 goto out;
768 }
769
770 bif->bif_ifp = ifs;
771 bif->bif_flags = IFBIF_LEARNING | IFBIF_DISCOVER;
772 bif->bif_priority = BSTP_DEFAULT_PORT_PRIORITY;
773 bif->bif_path_cost = BSTP_DEFAULT_PATH_COST;
774 PSLIST_ENTRY_INIT(bif, bif_next);
775 psref_target_init(&bif->bif_psref, bridge_psref_class);
776
777 BRIDGE_LOCK(sc);
778
779 ifs->if_bridge = sc;
780 ifs->if_bridgeif = bif;
781 PSLIST_WRITER_INSERT_HEAD(&sc->sc_iflist_psref.bip_iflist, bif, bif_next);
782 ifs->_if_input = bridge_input;
783
784 BRIDGE_UNLOCK(sc);
785
786 if (sc->sc_if.if_flags & IFF_RUNNING)
787 bstp_initialization(sc);
788 else
789 bstp_stop(sc);
790
791 out:
792 if (error) {
793 if (bif != NULL)
794 kmem_free(bif, sizeof(*bif));
795 }
796 return (error);
797 }
798
799 static int
800 bridge_ioctl_del(struct bridge_softc *sc, void *arg)
801 {
802 struct ifbreq *req = arg;
803 const char *name = req->ifbr_ifsname;
804 struct bridge_iflist *bif;
805 struct ifnet *ifs;
806
807 BRIDGE_LOCK(sc);
808
809 /*
810 * Don't use bridge_lookup_member. We want to get a member
811 * with bif_refs == 0.
812 */
813 BRIDGE_IFLIST_WRITER_FOREACH(bif, sc) {
814 ifs = bif->bif_ifp;
815 if (strcmp(ifs->if_xname, name) == 0)
816 break;
817 }
818
819 if (bif == NULL) {
820 BRIDGE_UNLOCK(sc);
821 return ENOENT;
822 }
823
824 bridge_delete_member(sc, bif);
825
826 BRIDGE_UNLOCK(sc);
827
828 switch (ifs->if_type) {
829 case IFT_ETHER:
830 /*
831 * Take the interface out of promiscuous mode.
832 * Don't call it with holding a spin lock.
833 */
834 (void) ifpromisc(ifs, 0);
835 (void) ether_disable_vlan_mtu(ifs);
836 break;
837 default:
838 #ifdef DIAGNOSTIC
839 panic("bridge_delete_member: impossible");
840 #endif
841 break;
842 }
843
844 bridge_rtdelete(sc, ifs);
845
846 if (sc->sc_if.if_flags & IFF_RUNNING)
847 bstp_initialization(sc);
848
849 return 0;
850 }
851
852 static int
853 bridge_ioctl_gifflags(struct bridge_softc *sc, void *arg)
854 {
855 struct ifbreq *req = arg;
856 struct bridge_iflist *bif;
857 struct psref psref;
858
859 bif = bridge_lookup_member(sc, req->ifbr_ifsname, &psref);
860 if (bif == NULL)
861 return (ENOENT);
862
863 req->ifbr_ifsflags = bif->bif_flags;
864 req->ifbr_state = bif->bif_state;
865 req->ifbr_priority = bif->bif_priority;
866 req->ifbr_path_cost = bif->bif_path_cost;
867 req->ifbr_portno = bif->bif_ifp->if_index & 0xff;
868
869 bridge_release_member(sc, bif, &psref);
870
871 return (0);
872 }
873
874 static int
875 bridge_ioctl_sifflags(struct bridge_softc *sc, void *arg)
876 {
877 struct ifbreq *req = arg;
878 struct bridge_iflist *bif;
879 struct psref psref;
880
881 bif = bridge_lookup_member(sc, req->ifbr_ifsname, &psref);
882 if (bif == NULL)
883 return (ENOENT);
884
885 if (req->ifbr_ifsflags & IFBIF_STP) {
886 switch (bif->bif_ifp->if_type) {
887 case IFT_ETHER:
888 /* These can do spanning tree. */
889 break;
890
891 default:
892 /* Nothing else can. */
893 bridge_release_member(sc, bif, &psref);
894 return (EINVAL);
895 }
896 }
897
898 bif->bif_flags = req->ifbr_ifsflags;
899
900 bridge_release_member(sc, bif, &psref);
901
902 if (sc->sc_if.if_flags & IFF_RUNNING)
903 bstp_initialization(sc);
904
905 return (0);
906 }
907
908 static int
909 bridge_ioctl_scache(struct bridge_softc *sc, void *arg)
910 {
911 struct ifbrparam *param = arg;
912
913 sc->sc_brtmax = param->ifbrp_csize;
914 bridge_rttrim(sc);
915
916 return (0);
917 }
918
919 static int
920 bridge_ioctl_gcache(struct bridge_softc *sc, void *arg)
921 {
922 struct ifbrparam *param = arg;
923
924 param->ifbrp_csize = sc->sc_brtmax;
925
926 return (0);
927 }
928
929 static int
930 bridge_ioctl_gifs(struct bridge_softc *sc, void *arg)
931 {
932 struct ifbifconf *bifc = arg;
933 struct bridge_iflist *bif;
934 struct ifbreq *breqs;
935 int i, count, error = 0;
936
937 retry:
938 BRIDGE_LOCK(sc);
939 count = 0;
940 BRIDGE_IFLIST_WRITER_FOREACH(bif, sc)
941 count++;
942 BRIDGE_UNLOCK(sc);
943
944 if (count == 0) {
945 bifc->ifbic_len = 0;
946 return 0;
947 }
948
949 if (bifc->ifbic_len == 0 || bifc->ifbic_len < (sizeof(*breqs) * count)) {
950 /* Tell that a larger buffer is needed */
951 bifc->ifbic_len = sizeof(*breqs) * count;
952 return 0;
953 }
954
955 breqs = kmem_alloc(sizeof(*breqs) * count, KM_SLEEP);
956
957 BRIDGE_LOCK(sc);
958
959 i = 0;
960 BRIDGE_IFLIST_WRITER_FOREACH(bif, sc)
961 i++;
962 if (i > count) {
963 /*
964 * The number of members has been increased.
965 * We need more memory!
966 */
967 BRIDGE_UNLOCK(sc);
968 kmem_free(breqs, sizeof(*breqs) * count);
969 goto retry;
970 }
971
972 i = 0;
973 BRIDGE_IFLIST_WRITER_FOREACH(bif, sc) {
974 struct ifbreq *breq = &breqs[i++];
975 memset(breq, 0, sizeof(*breq));
976
977 strlcpy(breq->ifbr_ifsname, bif->bif_ifp->if_xname,
978 sizeof(breq->ifbr_ifsname));
979 breq->ifbr_ifsflags = bif->bif_flags;
980 breq->ifbr_state = bif->bif_state;
981 breq->ifbr_priority = bif->bif_priority;
982 breq->ifbr_path_cost = bif->bif_path_cost;
983 breq->ifbr_portno = bif->bif_ifp->if_index & 0xff;
984 }
985
986 /* Don't call copyout with holding the mutex */
987 BRIDGE_UNLOCK(sc);
988
989 for (i = 0; i < count; i++) {
990 error = copyout(&breqs[i], bifc->ifbic_req + i, sizeof(*breqs));
991 if (error)
992 break;
993 }
994 bifc->ifbic_len = sizeof(*breqs) * i;
995
996 kmem_free(breqs, sizeof(*breqs) * count);
997
998 return error;
999 }
1000
1001 static int
1002 bridge_ioctl_rts(struct bridge_softc *sc, void *arg)
1003 {
1004 struct ifbaconf *bac = arg;
1005 struct bridge_rtnode *brt;
1006 struct ifbareq bareq;
1007 int count = 0, error = 0, len;
1008
1009 if (bac->ifbac_len == 0)
1010 return (0);
1011
1012 BRIDGE_RT_LOCK(sc);
1013
1014 len = bac->ifbac_len;
1015 LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) {
1016 if (len < sizeof(bareq))
1017 goto out;
1018 memset(&bareq, 0, sizeof(bareq));
1019 strlcpy(bareq.ifba_ifsname, brt->brt_ifp->if_xname,
1020 sizeof(bareq.ifba_ifsname));
1021 memcpy(bareq.ifba_dst, brt->brt_addr, sizeof(brt->brt_addr));
1022 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) {
1023 bareq.ifba_expire = brt->brt_expire - time_uptime;
1024 } else
1025 bareq.ifba_expire = 0;
1026 bareq.ifba_flags = brt->brt_flags;
1027
1028 error = copyout(&bareq, bac->ifbac_req + count, sizeof(bareq));
1029 if (error)
1030 goto out;
1031 count++;
1032 len -= sizeof(bareq);
1033 }
1034 out:
1035 BRIDGE_RT_UNLOCK(sc);
1036
1037 bac->ifbac_len = sizeof(bareq) * count;
1038 return (error);
1039 }
1040
1041 static int
1042 bridge_ioctl_saddr(struct bridge_softc *sc, void *arg)
1043 {
1044 struct ifbareq *req = arg;
1045 struct bridge_iflist *bif;
1046 int error;
1047 struct psref psref;
1048
1049 bif = bridge_lookup_member(sc, req->ifba_ifsname, &psref);
1050 if (bif == NULL)
1051 return (ENOENT);
1052
1053 error = bridge_rtupdate(sc, req->ifba_dst, bif->bif_ifp, 1,
1054 req->ifba_flags);
1055
1056 bridge_release_member(sc, bif, &psref);
1057
1058 return (error);
1059 }
1060
1061 static int
1062 bridge_ioctl_sto(struct bridge_softc *sc, void *arg)
1063 {
1064 struct ifbrparam *param = arg;
1065
1066 sc->sc_brttimeout = param->ifbrp_ctime;
1067
1068 return (0);
1069 }
1070
1071 static int
1072 bridge_ioctl_gto(struct bridge_softc *sc, void *arg)
1073 {
1074 struct ifbrparam *param = arg;
1075
1076 param->ifbrp_ctime = sc->sc_brttimeout;
1077
1078 return (0);
1079 }
1080
1081 static int
1082 bridge_ioctl_daddr(struct bridge_softc *sc, void *arg)
1083 {
1084 struct ifbareq *req = arg;
1085
1086 return (bridge_rtdaddr(sc, req->ifba_dst));
1087 }
1088
1089 static int
1090 bridge_ioctl_flush(struct bridge_softc *sc, void *arg)
1091 {
1092 struct ifbreq *req = arg;
1093
1094 bridge_rtflush(sc, req->ifbr_ifsflags);
1095
1096 return (0);
1097 }
1098
1099 static int
1100 bridge_ioctl_gpri(struct bridge_softc *sc, void *arg)
1101 {
1102 struct ifbrparam *param = arg;
1103
1104 param->ifbrp_prio = sc->sc_bridge_priority;
1105
1106 return (0);
1107 }
1108
1109 static int
1110 bridge_ioctl_spri(struct bridge_softc *sc, void *arg)
1111 {
1112 struct ifbrparam *param = arg;
1113
1114 sc->sc_bridge_priority = param->ifbrp_prio;
1115
1116 if (sc->sc_if.if_flags & IFF_RUNNING)
1117 bstp_initialization(sc);
1118
1119 return (0);
1120 }
1121
1122 static int
1123 bridge_ioctl_ght(struct bridge_softc *sc, void *arg)
1124 {
1125 struct ifbrparam *param = arg;
1126
1127 param->ifbrp_hellotime = sc->sc_bridge_hello_time >> 8;
1128
1129 return (0);
1130 }
1131
1132 static int
1133 bridge_ioctl_sht(struct bridge_softc *sc, void *arg)
1134 {
1135 struct ifbrparam *param = arg;
1136
1137 if (param->ifbrp_hellotime == 0)
1138 return (EINVAL);
1139 sc->sc_bridge_hello_time = param->ifbrp_hellotime << 8;
1140
1141 if (sc->sc_if.if_flags & IFF_RUNNING)
1142 bstp_initialization(sc);
1143
1144 return (0);
1145 }
1146
1147 static int
1148 bridge_ioctl_gfd(struct bridge_softc *sc, void *arg)
1149 {
1150 struct ifbrparam *param = arg;
1151
1152 param->ifbrp_fwddelay = sc->sc_bridge_forward_delay >> 8;
1153
1154 return (0);
1155 }
1156
1157 static int
1158 bridge_ioctl_sfd(struct bridge_softc *sc, void *arg)
1159 {
1160 struct ifbrparam *param = arg;
1161
1162 if (param->ifbrp_fwddelay == 0)
1163 return (EINVAL);
1164 sc->sc_bridge_forward_delay = param->ifbrp_fwddelay << 8;
1165
1166 if (sc->sc_if.if_flags & IFF_RUNNING)
1167 bstp_initialization(sc);
1168
1169 return (0);
1170 }
1171
1172 static int
1173 bridge_ioctl_gma(struct bridge_softc *sc, void *arg)
1174 {
1175 struct ifbrparam *param = arg;
1176
1177 param->ifbrp_maxage = sc->sc_bridge_max_age >> 8;
1178
1179 return (0);
1180 }
1181
1182 static int
1183 bridge_ioctl_sma(struct bridge_softc *sc, void *arg)
1184 {
1185 struct ifbrparam *param = arg;
1186
1187 if (param->ifbrp_maxage == 0)
1188 return (EINVAL);
1189 sc->sc_bridge_max_age = param->ifbrp_maxage << 8;
1190
1191 if (sc->sc_if.if_flags & IFF_RUNNING)
1192 bstp_initialization(sc);
1193
1194 return (0);
1195 }
1196
1197 static int
1198 bridge_ioctl_sifprio(struct bridge_softc *sc, void *arg)
1199 {
1200 struct ifbreq *req = arg;
1201 struct bridge_iflist *bif;
1202 struct psref psref;
1203
1204 bif = bridge_lookup_member(sc, req->ifbr_ifsname, &psref);
1205 if (bif == NULL)
1206 return (ENOENT);
1207
1208 bif->bif_priority = req->ifbr_priority;
1209
1210 if (sc->sc_if.if_flags & IFF_RUNNING)
1211 bstp_initialization(sc);
1212
1213 bridge_release_member(sc, bif, &psref);
1214
1215 return (0);
1216 }
1217
1218 #if defined(BRIDGE_IPF)
1219 static int
1220 bridge_ioctl_gfilt(struct bridge_softc *sc, void *arg)
1221 {
1222 struct ifbrparam *param = arg;
1223
1224 param->ifbrp_filter = sc->sc_filter_flags;
1225
1226 return (0);
1227 }
1228
1229 static int
1230 bridge_ioctl_sfilt(struct bridge_softc *sc, void *arg)
1231 {
1232 struct ifbrparam *param = arg;
1233 uint32_t nflags, oflags;
1234
1235 if (param->ifbrp_filter & ~IFBF_FILT_MASK)
1236 return (EINVAL);
1237
1238 nflags = param->ifbrp_filter;
1239 oflags = sc->sc_filter_flags;
1240
1241 if ((nflags & IFBF_FILT_USEIPF) && !(oflags & IFBF_FILT_USEIPF)) {
1242 pfil_add_hook((void *)bridge_ipf, NULL, PFIL_IN|PFIL_OUT,
1243 sc->sc_if.if_pfil);
1244 }
1245 if (!(nflags & IFBF_FILT_USEIPF) && (oflags & IFBF_FILT_USEIPF)) {
1246 pfil_remove_hook((void *)bridge_ipf, NULL, PFIL_IN|PFIL_OUT,
1247 sc->sc_if.if_pfil);
1248 }
1249
1250 sc->sc_filter_flags = nflags;
1251
1252 return (0);
1253 }
1254 #endif /* BRIDGE_IPF */
1255
1256 static int
1257 bridge_ioctl_sifcost(struct bridge_softc *sc, void *arg)
1258 {
1259 struct ifbreq *req = arg;
1260 struct bridge_iflist *bif;
1261 struct psref psref;
1262
1263 bif = bridge_lookup_member(sc, req->ifbr_ifsname, &psref);
1264 if (bif == NULL)
1265 return (ENOENT);
1266
1267 bif->bif_path_cost = req->ifbr_path_cost;
1268
1269 if (sc->sc_if.if_flags & IFF_RUNNING)
1270 bstp_initialization(sc);
1271
1272 bridge_release_member(sc, bif, &psref);
1273
1274 return (0);
1275 }
1276
1277 /*
1278 * bridge_ifdetach:
1279 *
1280 * Detach an interface from a bridge. Called when a member
1281 * interface is detaching.
1282 */
1283 void
1284 bridge_ifdetach(struct ifnet *ifp)
1285 {
1286 struct bridge_softc *sc = ifp->if_bridge;
1287 struct ifbreq breq;
1288
1289 /* ioctl_lock should prevent this from happening */
1290 KASSERT(sc != NULL);
1291
1292 memset(&breq, 0, sizeof(breq));
1293 strlcpy(breq.ifbr_ifsname, ifp->if_xname, sizeof(breq.ifbr_ifsname));
1294
1295 (void) bridge_ioctl_del(sc, &breq);
1296 }
1297
1298 /*
1299 * bridge_init:
1300 *
1301 * Initialize a bridge interface.
1302 */
1303 static int
1304 bridge_init(struct ifnet *ifp)
1305 {
1306 struct bridge_softc *sc = ifp->if_softc;
1307
1308 if (ifp->if_flags & IFF_RUNNING)
1309 return (0);
1310
1311 callout_reset(&sc->sc_brcallout, bridge_rtable_prune_period * hz,
1312 bridge_timer, sc);
1313
1314 ifp->if_flags |= IFF_RUNNING;
1315 bstp_initialization(sc);
1316 return (0);
1317 }
1318
1319 /*
1320 * bridge_stop:
1321 *
1322 * Stop the bridge interface.
1323 */
1324 static void
1325 bridge_stop(struct ifnet *ifp, int disable)
1326 {
1327 struct bridge_softc *sc = ifp->if_softc;
1328
1329 if ((ifp->if_flags & IFF_RUNNING) == 0)
1330 return;
1331
1332 callout_stop(&sc->sc_brcallout);
1333 bstp_stop(sc);
1334
1335 bridge_rtflush(sc, IFBF_FLUSHDYN);
1336
1337 ifp->if_flags &= ~IFF_RUNNING;
1338 }
1339
1340 /*
1341 * bridge_enqueue:
1342 *
1343 * Enqueue a packet on a bridge member interface.
1344 */
1345 void
1346 bridge_enqueue(struct bridge_softc *sc, struct ifnet *dst_ifp, struct mbuf *m,
1347 int runfilt)
1348 {
1349 int len, error;
1350 short mflags;
1351
1352 /*
1353 * Clear any in-bound checksum flags for this packet.
1354 */
1355 m->m_pkthdr.csum_flags = 0;
1356
1357 if (runfilt) {
1358 if (pfil_run_hooks(sc->sc_if.if_pfil, &m,
1359 dst_ifp, PFIL_OUT) != 0) {
1360 if (m != NULL)
1361 m_freem(m);
1362 return;
1363 }
1364 if (m == NULL)
1365 return;
1366 }
1367
1368 #ifdef ALTQ
1369 /*
1370 * If ALTQ is enabled on the member interface, do
1371 * classification; the queueing discipline might
1372 * not require classification, but might require
1373 * the address family/header pointer in the pktattr.
1374 */
1375 if (ALTQ_IS_ENABLED(&dst_ifp->if_snd)) {
1376 /* XXX IFT_ETHER */
1377 altq_etherclassify(&dst_ifp->if_snd, m);
1378 }
1379 #endif /* ALTQ */
1380
1381 len = m->m_pkthdr.len;
1382 mflags = m->m_flags;
1383
1384 error = (*dst_ifp->if_transmit)(dst_ifp, m);
1385 if (error) {
1386 /* mbuf is already freed */
1387 sc->sc_if.if_oerrors++;
1388 return;
1389 }
1390
1391 sc->sc_if.if_opackets++;
1392 sc->sc_if.if_obytes += len;
1393 if (mflags & M_MCAST)
1394 sc->sc_if.if_omcasts++;
1395 }
1396
1397 /*
1398 * bridge_output:
1399 *
1400 * Send output from a bridge member interface. This
1401 * performs the bridging function for locally originated
1402 * packets.
1403 *
1404 * The mbuf has the Ethernet header already attached. We must
1405 * enqueue or free the mbuf before returning.
1406 */
1407 int
1408 bridge_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *sa,
1409 const struct rtentry *rt)
1410 {
1411 struct ether_header *eh;
1412 struct ifnet *dst_if;
1413 struct bridge_softc *sc;
1414 int s;
1415
1416 if (m->m_len < ETHER_HDR_LEN) {
1417 m = m_pullup(m, ETHER_HDR_LEN);
1418 if (m == NULL)
1419 return (0);
1420 }
1421
1422 eh = mtod(m, struct ether_header *);
1423 sc = ifp->if_bridge;
1424
1425 if (ETHER_IS_MULTICAST(eh->ether_dhost)) {
1426 if (memcmp(etherbroadcastaddr,
1427 eh->ether_dhost, ETHER_ADDR_LEN) == 0)
1428 m->m_flags |= M_BCAST;
1429 else
1430 m->m_flags |= M_MCAST;
1431 }
1432
1433 /*
1434 * If bridge is down, but the original output interface is up,
1435 * go ahead and send out that interface. Otherwise, the packet
1436 * is dropped below.
1437 */
1438 if (__predict_false(sc == NULL) ||
1439 (sc->sc_if.if_flags & IFF_RUNNING) == 0) {
1440 dst_if = ifp;
1441 goto sendunicast;
1442 }
1443
1444 /*
1445 * If the packet is a multicast, or we don't know a better way to
1446 * get there, send to all interfaces.
1447 */
1448 if ((m->m_flags & (M_MCAST | M_BCAST)) != 0)
1449 dst_if = NULL;
1450 else
1451 dst_if = bridge_rtlookup(sc, eh->ether_dhost);
1452 if (dst_if == NULL) {
1453 /* XXX Should call bridge_broadcast, but there are locking
1454 * issues which need resolving first. */
1455 struct bridge_iflist *bif;
1456 struct mbuf *mc;
1457 bool used = false;
1458
1459 BRIDGE_PSZ_RENTER(s);
1460 BRIDGE_IFLIST_READER_FOREACH(bif, sc) {
1461 struct psref psref;
1462
1463 bridge_acquire_member(sc, bif, &psref);
1464 BRIDGE_PSZ_REXIT(s);
1465
1466 dst_if = bif->bif_ifp;
1467 if ((dst_if->if_flags & IFF_RUNNING) == 0)
1468 goto next;
1469
1470 /*
1471 * If this is not the original output interface,
1472 * and the interface is participating in spanning
1473 * tree, make sure the port is in a state that
1474 * allows forwarding.
1475 */
1476 if (dst_if != ifp &&
1477 (bif->bif_flags & IFBIF_STP) != 0) {
1478 switch (bif->bif_state) {
1479 case BSTP_IFSTATE_BLOCKING:
1480 case BSTP_IFSTATE_LISTENING:
1481 case BSTP_IFSTATE_DISABLED:
1482 goto next;
1483 }
1484 }
1485
1486 if (PSLIST_READER_NEXT(bif, struct bridge_iflist,
1487 bif_next) == NULL &&
1488 ((m->m_flags & (M_MCAST | M_BCAST)) == 0 ||
1489 dst_if == ifp))
1490 {
1491 used = true;
1492 mc = m;
1493 } else {
1494 mc = m_copym(m, 0, M_COPYALL, M_NOWAIT);
1495 if (mc == NULL) {
1496 sc->sc_if.if_oerrors++;
1497 goto next;
1498 }
1499 }
1500
1501 #ifndef NET_MPSAFE
1502 s = splnet();
1503 #endif
1504 bridge_enqueue(sc, dst_if, mc, 0);
1505 #ifndef NET_MPSAFE
1506 splx(s);
1507 #endif
1508
1509 if ((m->m_flags & (M_MCAST | M_BCAST)) != 0 &&
1510 dst_if != ifp)
1511 {
1512 if (PSLIST_READER_NEXT(bif,
1513 struct bridge_iflist, bif_next) == NULL)
1514 {
1515 used = true;
1516 mc = m;
1517 } else {
1518 mc = m_copym(m, 0, M_COPYALL,
1519 M_DONTWAIT);
1520 if (mc == NULL) {
1521 sc->sc_if.if_oerrors++;
1522 goto next;
1523 }
1524 }
1525
1526 mc->m_pkthdr.rcvif = dst_if;
1527 mc->m_flags &= ~M_PROMISC;
1528
1529 #ifndef NET_MPSAFE
1530 s = splnet();
1531 #endif
1532 ether_input(dst_if, mc);
1533 #ifndef NET_MPSAFE
1534 splx(s);
1535 #endif
1536 }
1537
1538 next:
1539 BRIDGE_PSZ_RENTER(s);
1540 bridge_release_member(sc, bif, &psref);
1541
1542 /* Guarantee we don't re-enter the loop as we already
1543 * decided we're at the end. */
1544 if (used)
1545 break;
1546 }
1547 BRIDGE_PSZ_REXIT(s);
1548
1549 if (!used)
1550 m_freem(m);
1551 return (0);
1552 }
1553
1554 sendunicast:
1555 /*
1556 * XXX Spanning tree consideration here?
1557 */
1558
1559 if ((dst_if->if_flags & IFF_RUNNING) == 0) {
1560 m_freem(m);
1561 return (0);
1562 }
1563
1564 #ifndef NET_MPSAFE
1565 s = splnet();
1566 #endif
1567 bridge_enqueue(sc, dst_if, m, 0);
1568 #ifndef NET_MPSAFE
1569 splx(s);
1570 #endif
1571
1572 return (0);
1573 }
1574
1575 /*
1576 * bridge_start:
1577 *
1578 * Start output on a bridge.
1579 *
1580 * NOTE: This routine should never be called in this implementation.
1581 */
1582 static void
1583 bridge_start(struct ifnet *ifp)
1584 {
1585
1586 printf("%s: bridge_start() called\n", ifp->if_xname);
1587 }
1588
1589 /*
1590 * bridge_forward:
1591 *
1592 * The forwarding function of the bridge.
1593 */
1594 static void
1595 bridge_forward(struct bridge_softc *sc, struct mbuf *m)
1596 {
1597 struct bridge_iflist *bif;
1598 struct ifnet *src_if, *dst_if;
1599 struct ether_header *eh;
1600 struct psref psref;
1601 DECLARE_LOCK_VARIABLE;
1602
1603 if ((sc->sc_if.if_flags & IFF_RUNNING) == 0)
1604 return;
1605
1606 src_if = m->m_pkthdr.rcvif;
1607
1608 sc->sc_if.if_ipackets++;
1609 sc->sc_if.if_ibytes += m->m_pkthdr.len;
1610
1611 /*
1612 * Look up the bridge_iflist.
1613 */
1614 bif = bridge_lookup_member_if(sc, src_if, &psref);
1615 if (bif == NULL) {
1616 /* Interface is not a bridge member (anymore?) */
1617 m_freem(m);
1618 goto out;
1619 }
1620
1621 if (bif->bif_flags & IFBIF_STP) {
1622 switch (bif->bif_state) {
1623 case BSTP_IFSTATE_BLOCKING:
1624 case BSTP_IFSTATE_LISTENING:
1625 case BSTP_IFSTATE_DISABLED:
1626 m_freem(m);
1627 bridge_release_member(sc, bif, &psref);
1628 goto out;
1629 }
1630 }
1631
1632 eh = mtod(m, struct ether_header *);
1633
1634 /*
1635 * If the interface is learning, and the source
1636 * address is valid and not multicast, record
1637 * the address.
1638 */
1639 if ((bif->bif_flags & IFBIF_LEARNING) != 0 &&
1640 ETHER_IS_MULTICAST(eh->ether_shost) == 0 &&
1641 (eh->ether_shost[0] == 0 &&
1642 eh->ether_shost[1] == 0 &&
1643 eh->ether_shost[2] == 0 &&
1644 eh->ether_shost[3] == 0 &&
1645 eh->ether_shost[4] == 0 &&
1646 eh->ether_shost[5] == 0) == 0) {
1647 (void) bridge_rtupdate(sc, eh->ether_shost,
1648 src_if, 0, IFBAF_DYNAMIC);
1649 }
1650
1651 if ((bif->bif_flags & IFBIF_STP) != 0 &&
1652 bif->bif_state == BSTP_IFSTATE_LEARNING) {
1653 m_freem(m);
1654 bridge_release_member(sc, bif, &psref);
1655 goto out;
1656 }
1657
1658 bridge_release_member(sc, bif, &psref);
1659
1660 /*
1661 * At this point, the port either doesn't participate
1662 * in spanning tree or it is in the forwarding state.
1663 */
1664
1665 /*
1666 * If the packet is unicast, destined for someone on
1667 * "this" side of the bridge, drop it.
1668 */
1669 if ((m->m_flags & (M_BCAST|M_MCAST)) == 0) {
1670 dst_if = bridge_rtlookup(sc, eh->ether_dhost);
1671 if (src_if == dst_if) {
1672 m_freem(m);
1673 goto out;
1674 }
1675 } else {
1676 /* ...forward it to all interfaces. */
1677 sc->sc_if.if_imcasts++;
1678 dst_if = NULL;
1679 }
1680
1681 if (pfil_run_hooks(sc->sc_if.if_pfil, &m,
1682 m->m_pkthdr.rcvif, PFIL_IN) != 0) {
1683 if (m != NULL)
1684 m_freem(m);
1685 goto out;
1686 }
1687 if (m == NULL)
1688 goto out;
1689
1690 if (dst_if == NULL) {
1691 bridge_broadcast(sc, src_if, m);
1692 goto out;
1693 }
1694
1695 /*
1696 * At this point, we're dealing with a unicast frame
1697 * going to a different interface.
1698 */
1699 if ((dst_if->if_flags & IFF_RUNNING) == 0) {
1700 m_freem(m);
1701 goto out;
1702 }
1703
1704 bif = bridge_lookup_member_if(sc, dst_if, &psref);
1705 if (bif == NULL) {
1706 /* Not a member of the bridge (anymore?) */
1707 m_freem(m);
1708 goto out;
1709 }
1710
1711 if (bif->bif_flags & IFBIF_STP) {
1712 switch (bif->bif_state) {
1713 case BSTP_IFSTATE_DISABLED:
1714 case BSTP_IFSTATE_BLOCKING:
1715 m_freem(m);
1716 bridge_release_member(sc, bif, &psref);
1717 goto out;
1718 }
1719 }
1720
1721 bridge_release_member(sc, bif, &psref);
1722
1723 ACQUIRE_GLOBAL_LOCKS();
1724 bridge_enqueue(sc, dst_if, m, 1);
1725 RELEASE_GLOBAL_LOCKS();
1726 out:
1727 /* XXX gcc */
1728 return;
1729 }
1730
1731 static bool
1732 bstp_state_before_learning(struct bridge_iflist *bif)
1733 {
1734 if (bif->bif_flags & IFBIF_STP) {
1735 switch (bif->bif_state) {
1736 case BSTP_IFSTATE_BLOCKING:
1737 case BSTP_IFSTATE_LISTENING:
1738 case BSTP_IFSTATE_DISABLED:
1739 return true;
1740 }
1741 }
1742 return false;
1743 }
1744
1745 static bool
1746 bridge_ourether(struct bridge_iflist *bif, struct ether_header *eh, int src)
1747 {
1748 uint8_t *ether = src ? eh->ether_shost : eh->ether_dhost;
1749
1750 if (memcmp(CLLADDR(bif->bif_ifp->if_sadl), ether, ETHER_ADDR_LEN) == 0
1751 #if NCARP > 0
1752 || (bif->bif_ifp->if_carp &&
1753 carp_ourether(bif->bif_ifp->if_carp, eh, IFT_ETHER, src) != NULL)
1754 #endif /* NCARP > 0 */
1755 )
1756 return true;
1757
1758 return false;
1759 }
1760
1761 /*
1762 * bridge_input:
1763 *
1764 * Receive input from a member interface. Queue the packet for
1765 * bridging if it is not for us.
1766 */
1767 static void
1768 bridge_input(struct ifnet *ifp, struct mbuf *m)
1769 {
1770 struct bridge_softc *sc = ifp->if_bridge;
1771 struct bridge_iflist *bif;
1772 struct ether_header *eh;
1773 struct psref psref;
1774 DECLARE_LOCK_VARIABLE;
1775
1776 KASSERT(!cpu_intr_p());
1777
1778 if (__predict_false(sc == NULL) ||
1779 (sc->sc_if.if_flags & IFF_RUNNING) == 0) {
1780 ACQUIRE_GLOBAL_LOCKS();
1781 ether_input(ifp, m);
1782 RELEASE_GLOBAL_LOCKS();
1783 return;
1784 }
1785
1786 bif = bridge_lookup_member_if(sc, ifp, &psref);
1787 if (bif == NULL) {
1788 ACQUIRE_GLOBAL_LOCKS();
1789 ether_input(ifp, m);
1790 RELEASE_GLOBAL_LOCKS();
1791 return;
1792 }
1793
1794 eh = mtod(m, struct ether_header *);
1795
1796 if (ETHER_IS_MULTICAST(eh->ether_dhost)) {
1797 if (memcmp(etherbroadcastaddr,
1798 eh->ether_dhost, ETHER_ADDR_LEN) == 0)
1799 m->m_flags |= M_BCAST;
1800 else
1801 m->m_flags |= M_MCAST;
1802 }
1803
1804 /*
1805 * A 'fast' path for packets addressed to interfaces that are
1806 * part of this bridge.
1807 */
1808 if (!(m->m_flags & (M_BCAST|M_MCAST)) &&
1809 !bstp_state_before_learning(bif)) {
1810 struct bridge_iflist *_bif;
1811 struct ifnet *_ifp = NULL;
1812 int s;
1813 struct psref _psref;
1814
1815 BRIDGE_PSZ_RENTER(s);
1816 BRIDGE_IFLIST_READER_FOREACH(_bif, sc) {
1817 /* It is destined for us. */
1818 if (bridge_ourether(_bif, eh, 0)) {
1819 bridge_acquire_member(sc, _bif, &_psref);
1820 BRIDGE_PSZ_REXIT(s);
1821 if (_bif->bif_flags & IFBIF_LEARNING)
1822 (void) bridge_rtupdate(sc,
1823 eh->ether_shost, ifp, 0, IFBAF_DYNAMIC);
1824 _ifp = m->m_pkthdr.rcvif = _bif->bif_ifp;
1825 bridge_release_member(sc, _bif, &_psref);
1826 goto out;
1827 }
1828
1829 /* We just received a packet that we sent out. */
1830 if (bridge_ourether(_bif, eh, 1))
1831 break;
1832 }
1833 BRIDGE_PSZ_REXIT(s);
1834 out:
1835
1836 if (_bif != NULL) {
1837 bridge_release_member(sc, bif, &psref);
1838 if (_ifp != NULL) {
1839 m->m_flags &= ~M_PROMISC;
1840 ACQUIRE_GLOBAL_LOCKS();
1841 ether_input(_ifp, m);
1842 RELEASE_GLOBAL_LOCKS();
1843 } else
1844 m_freem(m);
1845 return;
1846 }
1847 }
1848
1849 /* Tap off 802.1D packets; they do not get forwarded. */
1850 if (bif->bif_flags & IFBIF_STP &&
1851 memcmp(eh->ether_dhost, bstp_etheraddr, ETHER_ADDR_LEN) == 0) {
1852 bstp_input(sc, bif, m);
1853 bridge_release_member(sc, bif, &psref);
1854 return;
1855 }
1856
1857 /*
1858 * A normal switch would discard the packet here, but that's not what
1859 * we've done historically. This also prevents some obnoxious behaviour.
1860 */
1861 if (bstp_state_before_learning(bif)) {
1862 bridge_release_member(sc, bif, &psref);
1863 ACQUIRE_GLOBAL_LOCKS();
1864 ether_input(ifp, m);
1865 RELEASE_GLOBAL_LOCKS();
1866 return;
1867 }
1868
1869 bridge_release_member(sc, bif, &psref);
1870
1871 bridge_forward(sc, m);
1872 }
1873
1874 /*
1875 * bridge_broadcast:
1876 *
1877 * Send a frame to all interfaces that are members of
1878 * the bridge, except for the one on which the packet
1879 * arrived.
1880 */
1881 static void
1882 bridge_broadcast(struct bridge_softc *sc, struct ifnet *src_if,
1883 struct mbuf *m)
1884 {
1885 struct bridge_iflist *bif;
1886 struct mbuf *mc;
1887 struct ifnet *dst_if;
1888 bool bmcast;
1889 int s;
1890 DECLARE_LOCK_VARIABLE;
1891
1892 bmcast = m->m_flags & (M_BCAST|M_MCAST);
1893
1894 BRIDGE_PSZ_RENTER(s);
1895 BRIDGE_IFLIST_READER_FOREACH(bif, sc) {
1896 struct psref psref;
1897
1898 bridge_acquire_member(sc, bif, &psref);
1899 BRIDGE_PSZ_REXIT(s);
1900
1901 dst_if = bif->bif_ifp;
1902
1903 if (bif->bif_flags & IFBIF_STP) {
1904 switch (bif->bif_state) {
1905 case BSTP_IFSTATE_BLOCKING:
1906 case BSTP_IFSTATE_DISABLED:
1907 goto next;
1908 }
1909 }
1910
1911 if ((bif->bif_flags & IFBIF_DISCOVER) == 0 && !bmcast)
1912 goto next;
1913
1914 if ((dst_if->if_flags & IFF_RUNNING) == 0)
1915 goto next;
1916
1917 if (dst_if != src_if) {
1918 mc = m_copym(m, 0, M_COPYALL, M_DONTWAIT);
1919 if (mc == NULL) {
1920 sc->sc_if.if_oerrors++;
1921 goto next;
1922 }
1923 ACQUIRE_GLOBAL_LOCKS();
1924 bridge_enqueue(sc, dst_if, mc, 1);
1925 RELEASE_GLOBAL_LOCKS();
1926 }
1927
1928 if (bmcast) {
1929 mc = m_copym(m, 0, M_COPYALL, M_DONTWAIT);
1930 if (mc == NULL) {
1931 sc->sc_if.if_oerrors++;
1932 goto next;
1933 }
1934
1935 mc->m_pkthdr.rcvif = dst_if;
1936 mc->m_flags &= ~M_PROMISC;
1937
1938 ACQUIRE_GLOBAL_LOCKS();
1939 ether_input(dst_if, mc);
1940 RELEASE_GLOBAL_LOCKS();
1941 }
1942 next:
1943 BRIDGE_PSZ_RENTER(s);
1944 bridge_release_member(sc, bif, &psref);
1945 }
1946 BRIDGE_PSZ_REXIT(s);
1947
1948 m_freem(m);
1949 }
1950
1951 static int
1952 bridge_rtalloc(struct bridge_softc *sc, const uint8_t *dst,
1953 struct bridge_rtnode **brtp)
1954 {
1955 struct bridge_rtnode *brt;
1956 int error;
1957
1958 if (sc->sc_brtcnt >= sc->sc_brtmax)
1959 return ENOSPC;
1960
1961 /*
1962 * Allocate a new bridge forwarding node, and
1963 * initialize the expiration time and Ethernet
1964 * address.
1965 */
1966 brt = pool_get(&bridge_rtnode_pool, PR_NOWAIT);
1967 if (brt == NULL)
1968 return ENOMEM;
1969
1970 memset(brt, 0, sizeof(*brt));
1971 brt->brt_expire = time_uptime + sc->sc_brttimeout;
1972 brt->brt_flags = IFBAF_DYNAMIC;
1973 memcpy(brt->brt_addr, dst, ETHER_ADDR_LEN);
1974
1975 BRIDGE_RT_LOCK(sc);
1976 error = bridge_rtnode_insert(sc, brt);
1977 BRIDGE_RT_UNLOCK(sc);
1978
1979 if (error != 0) {
1980 pool_put(&bridge_rtnode_pool, brt);
1981 return error;
1982 }
1983
1984 *brtp = brt;
1985 return 0;
1986 }
1987
1988 /*
1989 * bridge_rtupdate:
1990 *
1991 * Add a bridge routing entry.
1992 */
1993 static int
1994 bridge_rtupdate(struct bridge_softc *sc, const uint8_t *dst,
1995 struct ifnet *dst_if, int setflags, uint8_t flags)
1996 {
1997 struct bridge_rtnode *brt;
1998 int s;
1999
2000 again:
2001 /*
2002 * A route for this destination might already exist. If so,
2003 * update it, otherwise create a new one.
2004 */
2005 BRIDGE_RT_RENTER(s);
2006 brt = bridge_rtnode_lookup(sc, dst);
2007
2008 if (brt != NULL) {
2009 brt->brt_ifp = dst_if;
2010 if (setflags) {
2011 brt->brt_flags = flags;
2012 if (flags & IFBAF_STATIC)
2013 brt->brt_expire = 0;
2014 else
2015 brt->brt_expire = time_uptime + sc->sc_brttimeout;
2016 } else {
2017 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC)
2018 brt->brt_expire = time_uptime + sc->sc_brttimeout;
2019 }
2020 }
2021 BRIDGE_RT_REXIT(s);
2022
2023 if (brt == NULL) {
2024 int r;
2025
2026 r = bridge_rtalloc(sc, dst, &brt);
2027 if (r != 0)
2028 return r;
2029 goto again;
2030 }
2031
2032 return 0;
2033 }
2034
2035 /*
2036 * bridge_rtlookup:
2037 *
2038 * Lookup the destination interface for an address.
2039 */
2040 static struct ifnet *
2041 bridge_rtlookup(struct bridge_softc *sc, const uint8_t *addr)
2042 {
2043 struct bridge_rtnode *brt;
2044 struct ifnet *ifs = NULL;
2045 int s;
2046
2047 BRIDGE_RT_RENTER(s);
2048 brt = bridge_rtnode_lookup(sc, addr);
2049 if (brt != NULL)
2050 ifs = brt->brt_ifp;
2051 BRIDGE_RT_REXIT(s);
2052
2053 return ifs;
2054 }
2055
2056 typedef bool (*bridge_iterate_cb_t)
2057 (struct bridge_softc *, struct bridge_rtnode *, bool *, void *);
2058
2059 /*
2060 * bridge_rtlist_iterate_remove:
2061 *
2062 * It iterates on sc->sc_rtlist and removes rtnodes of it which func
2063 * callback judges to remove. Removals of rtnodes are done in a manner
2064 * of pserialize. To this end, all kmem_* operations are placed out of
2065 * mutexes.
2066 */
2067 static void
2068 bridge_rtlist_iterate_remove(struct bridge_softc *sc, bridge_iterate_cb_t func, void *arg)
2069 {
2070 struct bridge_rtnode *brt, *nbrt;
2071 struct bridge_rtnode **brt_list;
2072 int i, count;
2073
2074 retry:
2075 count = sc->sc_brtcnt;
2076 if (count == 0)
2077 return;
2078 brt_list = kmem_alloc(sizeof(*brt_list) * count, KM_SLEEP);
2079
2080 BRIDGE_RT_LOCK(sc);
2081 if (__predict_false(sc->sc_brtcnt > count)) {
2082 /* The rtnodes increased, we need more memory */
2083 BRIDGE_RT_UNLOCK(sc);
2084 kmem_free(brt_list, sizeof(*brt_list) * count);
2085 goto retry;
2086 }
2087
2088 i = 0;
2089 LIST_FOREACH_SAFE(brt, &sc->sc_rtlist, brt_list, nbrt) {
2090 bool need_break = false;
2091 if (func(sc, brt, &need_break, arg)) {
2092 bridge_rtnode_remove(sc, brt);
2093 brt_list[i++] = brt;
2094 }
2095 if (need_break)
2096 break;
2097 }
2098
2099 if (i > 0)
2100 BRIDGE_RT_PSZ_PERFORM(sc);
2101 BRIDGE_RT_UNLOCK(sc);
2102
2103 while (--i >= 0)
2104 bridge_rtnode_destroy(brt_list[i]);
2105
2106 kmem_free(brt_list, sizeof(*brt_list) * count);
2107 }
2108
2109 static bool
2110 bridge_rttrim0_cb(struct bridge_softc *sc, struct bridge_rtnode *brt,
2111 bool *need_break, void *arg)
2112 {
2113 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) {
2114 /* Take into account of the subsequent removal */
2115 if ((sc->sc_brtcnt - 1) <= sc->sc_brtmax)
2116 *need_break = true;
2117 return true;
2118 } else
2119 return false;
2120 }
2121
2122 static void
2123 bridge_rttrim0(struct bridge_softc *sc)
2124 {
2125 bridge_rtlist_iterate_remove(sc, bridge_rttrim0_cb, NULL);
2126 }
2127
2128 /*
2129 * bridge_rttrim:
2130 *
2131 * Trim the routine table so that we have a number
2132 * of routing entries less than or equal to the
2133 * maximum number.
2134 */
2135 static void
2136 bridge_rttrim(struct bridge_softc *sc)
2137 {
2138
2139 /* Make sure we actually need to do this. */
2140 if (sc->sc_brtcnt <= sc->sc_brtmax)
2141 return;
2142
2143 /* Force an aging cycle; this might trim enough addresses. */
2144 bridge_rtage(sc);
2145 if (sc->sc_brtcnt <= sc->sc_brtmax)
2146 return;
2147
2148 bridge_rttrim0(sc);
2149
2150 return;
2151 }
2152
2153 /*
2154 * bridge_timer:
2155 *
2156 * Aging timer for the bridge.
2157 */
2158 static void
2159 bridge_timer(void *arg)
2160 {
2161 struct bridge_softc *sc = arg;
2162
2163 workqueue_enqueue(sc->sc_rtage_wq, &sc->sc_rtage_wk, NULL);
2164 }
2165
2166 static void
2167 bridge_rtage_work(struct work *wk, void *arg)
2168 {
2169 struct bridge_softc *sc = arg;
2170
2171 KASSERT(wk == &sc->sc_rtage_wk);
2172
2173 bridge_rtage(sc);
2174
2175 if (sc->sc_if.if_flags & IFF_RUNNING)
2176 callout_reset(&sc->sc_brcallout,
2177 bridge_rtable_prune_period * hz, bridge_timer, sc);
2178 }
2179
2180 static bool
2181 bridge_rtage_cb(struct bridge_softc *sc, struct bridge_rtnode *brt,
2182 bool *need_break, void *arg)
2183 {
2184 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
2185 time_uptime >= brt->brt_expire)
2186 return true;
2187 else
2188 return false;
2189 }
2190
2191 /*
2192 * bridge_rtage:
2193 *
2194 * Perform an aging cycle.
2195 */
2196 static void
2197 bridge_rtage(struct bridge_softc *sc)
2198 {
2199 bridge_rtlist_iterate_remove(sc, bridge_rtage_cb, NULL);
2200 }
2201
2202
2203 static bool
2204 bridge_rtflush_cb(struct bridge_softc *sc, struct bridge_rtnode *brt,
2205 bool *need_break, void *arg)
2206 {
2207 int full = *(int*)arg;
2208
2209 if (full || (brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC)
2210 return true;
2211 else
2212 return false;
2213 }
2214
2215 /*
2216 * bridge_rtflush:
2217 *
2218 * Remove all dynamic addresses from the bridge.
2219 */
2220 static void
2221 bridge_rtflush(struct bridge_softc *sc, int full)
2222 {
2223 bridge_rtlist_iterate_remove(sc, bridge_rtflush_cb, &full);
2224 }
2225
2226 /*
2227 * bridge_rtdaddr:
2228 *
2229 * Remove an address from the table.
2230 */
2231 static int
2232 bridge_rtdaddr(struct bridge_softc *sc, const uint8_t *addr)
2233 {
2234 struct bridge_rtnode *brt;
2235
2236 BRIDGE_RT_LOCK(sc);
2237 if ((brt = bridge_rtnode_lookup(sc, addr)) == NULL) {
2238 BRIDGE_RT_UNLOCK(sc);
2239 return ENOENT;
2240 }
2241 bridge_rtnode_remove(sc, brt);
2242 BRIDGE_RT_PSZ_PERFORM(sc);
2243 BRIDGE_RT_UNLOCK(sc);
2244
2245 bridge_rtnode_destroy(brt);
2246
2247 return 0;
2248 }
2249
2250 /*
2251 * bridge_rtdelete:
2252 *
2253 * Delete routes to a speicifc member interface.
2254 */
2255 static void
2256 bridge_rtdelete(struct bridge_softc *sc, struct ifnet *ifp)
2257 {
2258 struct bridge_rtnode *brt;
2259
2260 BRIDGE_RT_LOCK(sc);
2261 LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) {
2262 if (brt->brt_ifp == ifp)
2263 break;
2264 }
2265 if (brt == NULL) {
2266 BRIDGE_RT_UNLOCK(sc);
2267 return;
2268 }
2269 bridge_rtnode_remove(sc, brt);
2270 BRIDGE_RT_PSZ_PERFORM(sc);
2271 BRIDGE_RT_UNLOCK(sc);
2272
2273 bridge_rtnode_destroy(brt);
2274 }
2275
2276 /*
2277 * bridge_rtable_init:
2278 *
2279 * Initialize the route table for this bridge.
2280 */
2281 static void
2282 bridge_rtable_init(struct bridge_softc *sc)
2283 {
2284 int i;
2285
2286 sc->sc_rthash = kmem_alloc(sizeof(*sc->sc_rthash) * BRIDGE_RTHASH_SIZE,
2287 KM_SLEEP);
2288
2289 for (i = 0; i < BRIDGE_RTHASH_SIZE; i++)
2290 LIST_INIT(&sc->sc_rthash[i]);
2291
2292 sc->sc_rthash_key = cprng_fast32();
2293
2294 LIST_INIT(&sc->sc_rtlist);
2295
2296 sc->sc_rtlist_psz = pserialize_create();
2297 sc->sc_rtlist_lock = mutex_obj_alloc(MUTEX_DEFAULT, IPL_SOFTNET);
2298 }
2299
2300 /*
2301 * bridge_rtable_fini:
2302 *
2303 * Deconstruct the route table for this bridge.
2304 */
2305 static void
2306 bridge_rtable_fini(struct bridge_softc *sc)
2307 {
2308
2309 kmem_free(sc->sc_rthash, sizeof(*sc->sc_rthash) * BRIDGE_RTHASH_SIZE);
2310 if (sc->sc_rtlist_lock)
2311 mutex_obj_free(sc->sc_rtlist_lock);
2312 if (sc->sc_rtlist_psz)
2313 pserialize_destroy(sc->sc_rtlist_psz);
2314 }
2315
2316 /*
2317 * The following hash function is adapted from "Hash Functions" by Bob Jenkins
2318 * ("Algorithm Alley", Dr. Dobbs Journal, September 1997).
2319 */
2320 #define mix(a, b, c) \
2321 do { \
2322 a -= b; a -= c; a ^= (c >> 13); \
2323 b -= c; b -= a; b ^= (a << 8); \
2324 c -= a; c -= b; c ^= (b >> 13); \
2325 a -= b; a -= c; a ^= (c >> 12); \
2326 b -= c; b -= a; b ^= (a << 16); \
2327 c -= a; c -= b; c ^= (b >> 5); \
2328 a -= b; a -= c; a ^= (c >> 3); \
2329 b -= c; b -= a; b ^= (a << 10); \
2330 c -= a; c -= b; c ^= (b >> 15); \
2331 } while (/*CONSTCOND*/0)
2332
2333 static inline uint32_t
2334 bridge_rthash(struct bridge_softc *sc, const uint8_t *addr)
2335 {
2336 uint32_t a = 0x9e3779b9, b = 0x9e3779b9, c = sc->sc_rthash_key;
2337
2338 b += addr[5] << 8;
2339 b += addr[4];
2340 a += addr[3] << 24;
2341 a += addr[2] << 16;
2342 a += addr[1] << 8;
2343 a += addr[0];
2344
2345 mix(a, b, c);
2346
2347 return (c & BRIDGE_RTHASH_MASK);
2348 }
2349
2350 #undef mix
2351
2352 /*
2353 * bridge_rtnode_lookup:
2354 *
2355 * Look up a bridge route node for the specified destination.
2356 */
2357 static struct bridge_rtnode *
2358 bridge_rtnode_lookup(struct bridge_softc *sc, const uint8_t *addr)
2359 {
2360 struct bridge_rtnode *brt;
2361 uint32_t hash;
2362 int dir;
2363
2364 hash = bridge_rthash(sc, addr);
2365 LIST_FOREACH(brt, &sc->sc_rthash[hash], brt_hash) {
2366 dir = memcmp(addr, brt->brt_addr, ETHER_ADDR_LEN);
2367 if (dir == 0)
2368 return (brt);
2369 if (dir > 0)
2370 return (NULL);
2371 }
2372
2373 return (NULL);
2374 }
2375
2376 /*
2377 * bridge_rtnode_insert:
2378 *
2379 * Insert the specified bridge node into the route table. We
2380 * assume the entry is not already in the table.
2381 */
2382 static int
2383 bridge_rtnode_insert(struct bridge_softc *sc, struct bridge_rtnode *brt)
2384 {
2385 struct bridge_rtnode *lbrt;
2386 uint32_t hash;
2387 int dir;
2388
2389 KASSERT(BRIDGE_RT_LOCKED(sc));
2390
2391 hash = bridge_rthash(sc, brt->brt_addr);
2392
2393 lbrt = LIST_FIRST(&sc->sc_rthash[hash]);
2394 if (lbrt == NULL) {
2395 LIST_INSERT_HEAD(&sc->sc_rthash[hash], brt, brt_hash);
2396 goto out;
2397 }
2398
2399 do {
2400 dir = memcmp(brt->brt_addr, lbrt->brt_addr, ETHER_ADDR_LEN);
2401 if (dir == 0)
2402 return (EEXIST);
2403 if (dir > 0) {
2404 LIST_INSERT_BEFORE(lbrt, brt, brt_hash);
2405 goto out;
2406 }
2407 if (LIST_NEXT(lbrt, brt_hash) == NULL) {
2408 LIST_INSERT_AFTER(lbrt, brt, brt_hash);
2409 goto out;
2410 }
2411 lbrt = LIST_NEXT(lbrt, brt_hash);
2412 } while (lbrt != NULL);
2413
2414 #ifdef DIAGNOSTIC
2415 panic("bridge_rtnode_insert: impossible");
2416 #endif
2417
2418 out:
2419 LIST_INSERT_HEAD(&sc->sc_rtlist, brt, brt_list);
2420 sc->sc_brtcnt++;
2421
2422 return (0);
2423 }
2424
2425 /*
2426 * bridge_rtnode_remove:
2427 *
2428 * Remove a bridge rtnode from the rthash and the rtlist of a bridge.
2429 */
2430 static void
2431 bridge_rtnode_remove(struct bridge_softc *sc, struct bridge_rtnode *brt)
2432 {
2433
2434 KASSERT(BRIDGE_RT_LOCKED(sc));
2435
2436 LIST_REMOVE(brt, brt_hash);
2437 LIST_REMOVE(brt, brt_list);
2438 sc->sc_brtcnt--;
2439 }
2440
2441 /*
2442 * bridge_rtnode_destroy:
2443 *
2444 * Destroy a bridge rtnode.
2445 */
2446 static void
2447 bridge_rtnode_destroy(struct bridge_rtnode *brt)
2448 {
2449
2450 pool_put(&bridge_rtnode_pool, brt);
2451 }
2452
2453 #if defined(BRIDGE_IPF)
2454 extern pfil_head_t *inet_pfil_hook; /* XXX */
2455 extern pfil_head_t *inet6_pfil_hook; /* XXX */
2456
2457 /*
2458 * Send bridge packets through IPF if they are one of the types IPF can deal
2459 * with, or if they are ARP or REVARP. (IPF will pass ARP and REVARP without
2460 * question.)
2461 */
2462 static int
2463 bridge_ipf(void *arg, struct mbuf **mp, struct ifnet *ifp, int dir)
2464 {
2465 int snap, error;
2466 struct ether_header *eh1, eh2;
2467 struct llc llc1;
2468 uint16_t ether_type;
2469
2470 snap = 0;
2471 error = -1; /* Default error if not error == 0 */
2472 eh1 = mtod(*mp, struct ether_header *);
2473 ether_type = ntohs(eh1->ether_type);
2474
2475 /*
2476 * Check for SNAP/LLC.
2477 */
2478 if (ether_type < ETHERMTU) {
2479 struct llc *llc2 = (struct llc *)(eh1 + 1);
2480
2481 if ((*mp)->m_len >= ETHER_HDR_LEN + 8 &&
2482 llc2->llc_dsap == LLC_SNAP_LSAP &&
2483 llc2->llc_ssap == LLC_SNAP_LSAP &&
2484 llc2->llc_control == LLC_UI) {
2485 ether_type = htons(llc2->llc_un.type_snap.ether_type);
2486 snap = 1;
2487 }
2488 }
2489
2490 /*
2491 * If we're trying to filter bridge traffic, don't look at anything
2492 * other than IP and ARP traffic. If the filter doesn't understand
2493 * IPv6, don't allow IPv6 through the bridge either. This is lame
2494 * since if we really wanted, say, an AppleTalk filter, we are hosed,
2495 * but of course we don't have an AppleTalk filter to begin with.
2496 * (Note that since IPF doesn't understand ARP it will pass *ALL*
2497 * ARP traffic.)
2498 */
2499 switch (ether_type) {
2500 case ETHERTYPE_ARP:
2501 case ETHERTYPE_REVARP:
2502 return 0; /* Automatically pass */
2503 case ETHERTYPE_IP:
2504 # ifdef INET6
2505 case ETHERTYPE_IPV6:
2506 # endif /* INET6 */
2507 break;
2508 default:
2509 goto bad;
2510 }
2511
2512 /* Strip off the Ethernet header and keep a copy. */
2513 m_copydata(*mp, 0, ETHER_HDR_LEN, (void *) &eh2);
2514 m_adj(*mp, ETHER_HDR_LEN);
2515
2516 /* Strip off snap header, if present */
2517 if (snap) {
2518 m_copydata(*mp, 0, sizeof(struct llc), (void *) &llc1);
2519 m_adj(*mp, sizeof(struct llc));
2520 }
2521
2522 /*
2523 * Check basic packet sanity and run IPF through pfil.
2524 */
2525 KASSERT(!cpu_intr_p());
2526 switch (ether_type)
2527 {
2528 case ETHERTYPE_IP :
2529 error = (dir == PFIL_IN) ? bridge_ip_checkbasic(mp) : 0;
2530 if (error == 0)
2531 error = pfil_run_hooks(inet_pfil_hook, mp, ifp, dir);
2532 break;
2533 # ifdef INET6
2534 case ETHERTYPE_IPV6 :
2535 error = (dir == PFIL_IN) ? bridge_ip6_checkbasic(mp) : 0;
2536 if (error == 0)
2537 error = pfil_run_hooks(inet6_pfil_hook, mp, ifp, dir);
2538 break;
2539 # endif
2540 default :
2541 error = 0;
2542 break;
2543 }
2544
2545 if (*mp == NULL)
2546 return error;
2547 if (error != 0)
2548 goto bad;
2549
2550 error = -1;
2551
2552 /*
2553 * Finally, put everything back the way it was and return
2554 */
2555 if (snap) {
2556 M_PREPEND(*mp, sizeof(struct llc), M_DONTWAIT);
2557 if (*mp == NULL)
2558 return error;
2559 bcopy(&llc1, mtod(*mp, void *), sizeof(struct llc));
2560 }
2561
2562 M_PREPEND(*mp, ETHER_HDR_LEN, M_DONTWAIT);
2563 if (*mp == NULL)
2564 return error;
2565 bcopy(&eh2, mtod(*mp, void *), ETHER_HDR_LEN);
2566
2567 return 0;
2568
2569 bad:
2570 m_freem(*mp);
2571 *mp = NULL;
2572 return error;
2573 }
2574
2575 /*
2576 * Perform basic checks on header size since
2577 * IPF assumes ip_input has already processed
2578 * it for it. Cut-and-pasted from ip_input.c.
2579 * Given how simple the IPv6 version is,
2580 * does the IPv4 version really need to be
2581 * this complicated?
2582 *
2583 * XXX Should we update ipstat here, or not?
2584 * XXX Right now we update ipstat but not
2585 * XXX csum_counter.
2586 */
2587 static int
2588 bridge_ip_checkbasic(struct mbuf **mp)
2589 {
2590 struct mbuf *m = *mp;
2591 struct ip *ip;
2592 int len, hlen;
2593
2594 if (*mp == NULL)
2595 return -1;
2596
2597 if (IP_HDR_ALIGNED_P(mtod(m, void *)) == 0) {
2598 if ((m = m_copyup(m, sizeof(struct ip),
2599 (max_linkhdr + 3) & ~3)) == NULL) {
2600 /* XXXJRT new stat, please */
2601 ip_statinc(IP_STAT_TOOSMALL);
2602 goto bad;
2603 }
2604 } else if (__predict_false(m->m_len < sizeof (struct ip))) {
2605 if ((m = m_pullup(m, sizeof (struct ip))) == NULL) {
2606 ip_statinc(IP_STAT_TOOSMALL);
2607 goto bad;
2608 }
2609 }
2610 ip = mtod(m, struct ip *);
2611 if (ip == NULL) goto bad;
2612
2613 if (ip->ip_v != IPVERSION) {
2614 ip_statinc(IP_STAT_BADVERS);
2615 goto bad;
2616 }
2617 hlen = ip->ip_hl << 2;
2618 if (hlen < sizeof(struct ip)) { /* minimum header length */
2619 ip_statinc(IP_STAT_BADHLEN);
2620 goto bad;
2621 }
2622 if (hlen > m->m_len) {
2623 if ((m = m_pullup(m, hlen)) == 0) {
2624 ip_statinc(IP_STAT_BADHLEN);
2625 goto bad;
2626 }
2627 ip = mtod(m, struct ip *);
2628 if (ip == NULL) goto bad;
2629 }
2630
2631 switch (m->m_pkthdr.csum_flags &
2632 ((m->m_pkthdr.rcvif->if_csum_flags_rx & M_CSUM_IPv4) |
2633 M_CSUM_IPv4_BAD)) {
2634 case M_CSUM_IPv4|M_CSUM_IPv4_BAD:
2635 /* INET_CSUM_COUNTER_INCR(&ip_hwcsum_bad); */
2636 goto bad;
2637
2638 case M_CSUM_IPv4:
2639 /* Checksum was okay. */
2640 /* INET_CSUM_COUNTER_INCR(&ip_hwcsum_ok); */
2641 break;
2642
2643 default:
2644 /* Must compute it ourselves. */
2645 /* INET_CSUM_COUNTER_INCR(&ip_swcsum); */
2646 if (in_cksum(m, hlen) != 0)
2647 goto bad;
2648 break;
2649 }
2650
2651 /* Retrieve the packet length. */
2652 len = ntohs(ip->ip_len);
2653
2654 /*
2655 * Check for additional length bogosity
2656 */
2657 if (len < hlen) {
2658 ip_statinc(IP_STAT_BADLEN);
2659 goto bad;
2660 }
2661
2662 /*
2663 * Check that the amount of data in the buffers
2664 * is as at least much as the IP header would have us expect.
2665 * Drop packet if shorter than we expect.
2666 */
2667 if (m->m_pkthdr.len < len) {
2668 ip_statinc(IP_STAT_TOOSHORT);
2669 goto bad;
2670 }
2671
2672 /* Checks out, proceed */
2673 *mp = m;
2674 return 0;
2675
2676 bad:
2677 *mp = m;
2678 return -1;
2679 }
2680
2681 # ifdef INET6
2682 /*
2683 * Same as above, but for IPv6.
2684 * Cut-and-pasted from ip6_input.c.
2685 * XXX Should we update ip6stat, or not?
2686 */
2687 static int
2688 bridge_ip6_checkbasic(struct mbuf **mp)
2689 {
2690 struct mbuf *m = *mp;
2691 struct ip6_hdr *ip6;
2692
2693 /*
2694 * If the IPv6 header is not aligned, slurp it up into a new
2695 * mbuf with space for link headers, in the event we forward
2696 * it. Otherwise, if it is aligned, make sure the entire base
2697 * IPv6 header is in the first mbuf of the chain.
2698 */
2699 if (IP6_HDR_ALIGNED_P(mtod(m, void *)) == 0) {
2700 struct ifnet *inifp = m->m_pkthdr.rcvif;
2701 if ((m = m_copyup(m, sizeof(struct ip6_hdr),
2702 (max_linkhdr + 3) & ~3)) == NULL) {
2703 /* XXXJRT new stat, please */
2704 ip6_statinc(IP6_STAT_TOOSMALL);
2705 in6_ifstat_inc(inifp, ifs6_in_hdrerr);
2706 goto bad;
2707 }
2708 } else if (__predict_false(m->m_len < sizeof(struct ip6_hdr))) {
2709 struct ifnet *inifp = m->m_pkthdr.rcvif;
2710 if ((m = m_pullup(m, sizeof(struct ip6_hdr))) == NULL) {
2711 ip6_statinc(IP6_STAT_TOOSMALL);
2712 in6_ifstat_inc(inifp, ifs6_in_hdrerr);
2713 goto bad;
2714 }
2715 }
2716
2717 ip6 = mtod(m, struct ip6_hdr *);
2718
2719 if ((ip6->ip6_vfc & IPV6_VERSION_MASK) != IPV6_VERSION) {
2720 ip6_statinc(IP6_STAT_BADVERS);
2721 in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_hdrerr);
2722 goto bad;
2723 }
2724
2725 /* Checks out, proceed */
2726 *mp = m;
2727 return 0;
2728
2729 bad:
2730 *mp = m;
2731 return -1;
2732 }
2733 # endif /* INET6 */
2734 #endif /* BRIDGE_IPF */
2735