?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Save 'ipfw forward' information in mtag, use m_pkthdr.fw_flags to indicate
[dragonfly/netmp.git] / sys / net / bridge / if_bridge.c
blobe5ae711d71455e7a693906ea5baa3096d15ee35c
1 /*
2 * Copyright 2001 Wasabi Systems, Inc.
3 * All rights reserved.
4 *
5 * Written by Jason R. Thorpe for Wasabi Systems, Inc.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed for the NetBSD Project by
18 * Wasabi Systems, Inc.
19 * 4. The name of Wasabi Systems, Inc. may not be used to endorse
20 * or promote products derived from this software without specific prior
21 * written permission.
22 *
23 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
24 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
25 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
26 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
27 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
30 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
31 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33 * POSSIBILITY OF SUCH DAMAGE.
34 */
35
36 /*
37 * Copyright (c) 1999, 2000 Jason L. Wright (jason@thought.net)
38 * All rights reserved.
39 *
40 * Redistribution and use in source and binary forms, with or without
41 * modification, are permitted provided that the following conditions
42 * are met:
43 * 1. Redistributions of source code must retain the above copyright
44 * notice, this list of conditions and the following disclaimer.
45 * 2. Redistributions in binary form must reproduce the above copyright
46 * notice, this list of conditions and the following disclaimer in the
47 * documentation and/or other materials provided with the distribution.
48 * 3. All advertising materials mentioning features or use of this software
49 * must display the following acknowledgement:
50 * This product includes software developed by Jason L. Wright
51 * 4. The name of the author may not be used to endorse or promote products
52 * derived from this software without specific prior written permission.
53 *
54 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
55 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
56 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
57 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
58 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
59 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
60 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
61 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
62 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
63 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
64 * POSSIBILITY OF SUCH DAMAGE.
65 *
66 * $OpenBSD: if_bridge.c,v 1.60 2001/06/15 03:38:33 itojun Exp $
67 * $NetBSD: if_bridge.c,v 1.31 2005/06/01 19:45:34 jdc Exp $
68 * $FreeBSD: src/sys/net/if_bridge.c,v 1.26 2005/10/13 23:05:55 thompsa Exp $
69 * $DragonFly: src/sys/net/bridge/if_bridge.c,v 1.43 2008/08/22 09:14:17 sephe Exp $
70 */
71
72 /*
73 * Network interface bridge support.
74 *
75 * TODO:
76 *
77 * - Currently only supports Ethernet-like interfaces (Ethernet,
78 * 802.11, VLANs on Ethernet, etc.) Figure out a nice way
79 * to bridge other types of interfaces (FDDI-FDDI, and maybe
80 * consider heterogenous bridges).
81 */
82
83 #include <sys/cdefs.h>
84
85 #include "opt_inet.h"
86 #include "opt_inet6.h"
87
88 #include <sys/param.h>
89 #include <sys/mbuf.h>
90 #include <sys/malloc.h>
91 #include <sys/protosw.h>
92 #include <sys/systm.h>
93 #include <sys/time.h>
94 #include <sys/socket.h> /* for net/if.h */
95 #include <sys/sockio.h>
96 #include <sys/ctype.h> /* string functions */
97 #include <sys/kernel.h>
98 #include <sys/random.h>
99 #include <sys/sysctl.h>
100 #include <sys/module.h>
101 #include <sys/proc.h>
102 #include <sys/lock.h>
103 #include <sys/thread.h>
104 #include <sys/thread2.h>
105 #include <sys/mpipe.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_var.h>
112 #include <net/pfil.h>
113 #include <net/ifq_var.h>
114 #include <net/if_clone.h>
115
116 #include <netinet/in.h> /* for struct arpcom */
117 #include <netinet/in_systm.h>
118 #include <netinet/in_var.h>
119 #include <netinet/ip.h>
120 #include <netinet/ip_var.h>
121 #ifdef INET6
122 #include <netinet/ip6.h>
123 #include <netinet6/ip6_var.h>
124 #endif
125 #include <netinet/if_ether.h> /* for struct arpcom */
126 #include <net/bridge/if_bridgevar.h>
127 #include <net/if_llc.h>
128 #include <net/netmsg2.h>
129
130 #include <net/route.h>
131 #include <sys/in_cksum.h>
132
133 /*
134 * Size of the route hash table. Must be a power of two.
135 */
136 #ifndef BRIDGE_RTHASH_SIZE
137 #define BRIDGE_RTHASH_SIZE 1024
138 #endif
139
140 #define BRIDGE_RTHASH_MASK (BRIDGE_RTHASH_SIZE - 1)
141
142 /*
143 * Maximum number of addresses to cache.
144 */
145 #ifndef BRIDGE_RTABLE_MAX
146 #define BRIDGE_RTABLE_MAX 100
147 #endif
148
149 /*
150 * Spanning tree defaults.
151 */
152 #define BSTP_DEFAULT_MAX_AGE (20 * 256)
153 #define BSTP_DEFAULT_HELLO_TIME (2 * 256)
154 #define BSTP_DEFAULT_FORWARD_DELAY (15 * 256)
155 #define BSTP_DEFAULT_HOLD_TIME (1 * 256)
156 #define BSTP_DEFAULT_BRIDGE_PRIORITY 0x8000
157 #define BSTP_DEFAULT_PORT_PRIORITY 0x80
158 #define BSTP_DEFAULT_PATH_COST 55
159
160 /*
161 * Timeout (in seconds) for entries learned dynamically.
162 */
163 #ifndef BRIDGE_RTABLE_TIMEOUT
164 #define BRIDGE_RTABLE_TIMEOUT (20 * 60) /* same as ARP */
165 #endif
166
167 /*
168 * Number of seconds between walks of the route list.
169 */
170 #ifndef BRIDGE_RTABLE_PRUNE_PERIOD
171 #define BRIDGE_RTABLE_PRUNE_PERIOD (5 * 60)
172 #endif
173
174 /*
175 * List of capabilities to mask on the member interface.
176 */
177 #define BRIDGE_IFCAPS_MASK IFCAP_TXCSUM
178
179 eventhandler_tag bridge_detach_cookie = NULL;
180
181 extern struct mbuf *(*bridge_input_p)(struct ifnet *, struct mbuf *);
182 extern int (*bridge_output_p)(struct ifnet *, struct mbuf *);
183 extern void (*bridge_dn_p)(struct mbuf *, struct ifnet *);
184
185 typedef int (*bridge_ctl_t)(struct bridge_softc *, void *);
186
187 static int bridge_rtable_prune_period = BRIDGE_RTABLE_PRUNE_PERIOD;
188
189 static int bridge_clone_create(struct if_clone *, int);
190 static void bridge_clone_destroy(struct ifnet *);
191
192 static int bridge_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
193 static void bridge_mutecaps(struct bridge_iflist *, int);
194 static void bridge_ifdetach(void *arg __unused, struct ifnet *);
195 static void bridge_init(void *);
196 static void bridge_stop(struct ifnet *);
197 static void bridge_start(struct ifnet *);
198 static struct mbuf *bridge_input(struct ifnet *, struct mbuf *);
199 static int bridge_output(struct ifnet *, struct mbuf *);
200
201 static void bridge_forward(struct bridge_softc *, struct mbuf *m);
202
203 static void bridge_timer(void *);
204
205 static void bridge_broadcast(struct bridge_softc *, struct ifnet *,
206 struct mbuf *, int);
207 static void bridge_span(struct bridge_softc *, struct mbuf *);
208
209 static int bridge_rtupdate(struct bridge_softc *, const uint8_t *,
210 struct ifnet *, int, uint8_t);
211 static struct ifnet *bridge_rtlookup(struct bridge_softc *, const uint8_t *);
212 static void bridge_rttrim(struct bridge_softc *);
213 static void bridge_rtage(struct bridge_softc *);
214 static void bridge_rtflush(struct bridge_softc *, int);
215 static int bridge_rtdaddr(struct bridge_softc *, const uint8_t *);
216
217 static int bridge_rtable_init(struct bridge_softc *);
218 static void bridge_rtable_fini(struct bridge_softc *);
219
220 static int bridge_rtnode_addr_cmp(const uint8_t *, const uint8_t *);
221 static struct bridge_rtnode *bridge_rtnode_lookup(struct bridge_softc *,
222 const uint8_t *);
223 static int bridge_rtnode_insert(struct bridge_softc *,
224 struct bridge_rtnode *);
225 static void bridge_rtnode_destroy(struct bridge_softc *,
226 struct bridge_rtnode *);
227
228 static struct bridge_iflist *bridge_lookup_member(struct bridge_softc *,
229 const char *name);
230 static struct bridge_iflist *bridge_lookup_member_if(struct bridge_softc *,
231 struct ifnet *ifp);
232 static void bridge_delete_member(struct bridge_softc *,
233 struct bridge_iflist *, int);
234 static void bridge_delete_span(struct bridge_softc *,
235 struct bridge_iflist *);
236
237 static int bridge_control(struct bridge_softc *, u_long,
238 bridge_ctl_t, void *);
239 static int bridge_ioctl_add(struct bridge_softc *, void *);
240 static int bridge_ioctl_del(struct bridge_softc *, void *);
241 static int bridge_ioctl_gifflags(struct bridge_softc *, void *);
242 static int bridge_ioctl_sifflags(struct bridge_softc *, void *);
243 static int bridge_ioctl_scache(struct bridge_softc *, void *);
244 static int bridge_ioctl_gcache(struct bridge_softc *, void *);
245 static int bridge_ioctl_gifs(struct bridge_softc *, void *);
246 static int bridge_ioctl_rts(struct bridge_softc *, void *);
247 static int bridge_ioctl_saddr(struct bridge_softc *, void *);
248 static int bridge_ioctl_sto(struct bridge_softc *, void *);
249 static int bridge_ioctl_gto(struct bridge_softc *, void *);
250 static int bridge_ioctl_daddr(struct bridge_softc *, void *);
251 static int bridge_ioctl_flush(struct bridge_softc *, void *);
252 static int bridge_ioctl_gpri(struct bridge_softc *, void *);
253 static int bridge_ioctl_spri(struct bridge_softc *, void *);
254 static int bridge_ioctl_ght(struct bridge_softc *, void *);
255 static int bridge_ioctl_sht(struct bridge_softc *, void *);
256 static int bridge_ioctl_gfd(struct bridge_softc *, void *);
257 static int bridge_ioctl_sfd(struct bridge_softc *, void *);
258 static int bridge_ioctl_gma(struct bridge_softc *, void *);
259 static int bridge_ioctl_sma(struct bridge_softc *, void *);
260 static int bridge_ioctl_sifprio(struct bridge_softc *, void *);
261 static int bridge_ioctl_sifcost(struct bridge_softc *, void *);
262 static int bridge_ioctl_addspan(struct bridge_softc *, void *);
263 static int bridge_ioctl_delspan(struct bridge_softc *, void *);
264 static int bridge_pfil(struct mbuf **, struct ifnet *, struct ifnet *,
265 int);
266 static int bridge_ip_checkbasic(struct mbuf **mp);
267 #ifdef INET6
268 static int bridge_ip6_checkbasic(struct mbuf **mp);
269 #endif /* INET6 */
270 static int bridge_fragment(struct ifnet *, struct mbuf *,
271 struct ether_header *, int, struct llc *);
272 static void bridge_enqueue_internal(struct ifnet *, struct mbuf *m,
273 netisr_fn_t);
274 static void bridge_enqueue_handler(struct netmsg *);
275 static void bridge_pfil_enqueue_handler(struct netmsg *);
276 static void bridge_pfil_enqueue(struct ifnet *, struct mbuf *, int);
277 static void bridge_handoff_notags(struct ifnet *, struct mbuf *);
278 static void bridge_handoff(struct ifnet *, struct mbuf *);
279
280 SYSCTL_DECL(_net_link);
281 SYSCTL_NODE(_net_link, IFT_BRIDGE, bridge, CTLFLAG_RW, 0, "Bridge");
282
283 static int pfil_onlyip = 1; /* only pass IP[46] packets when pfil is enabled */
284 static int pfil_bridge = 1; /* run pfil hooks on the bridge interface */
285 static int pfil_member = 1; /* run pfil hooks on the member interface */
286 SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_onlyip, CTLFLAG_RW,
287 &pfil_onlyip, 0, "Only pass IP packets when pfil is enabled");
288 SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_bridge, CTLFLAG_RW,
289 &pfil_bridge, 0, "Packet filter on the bridge interface");
290 SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_member, CTLFLAG_RW,
291 &pfil_member, 0, "Packet filter on the member interface");
292
293 struct bridge_control {
294 bridge_ctl_t bc_func;
295 int bc_argsize;
296 int bc_flags;
297 };
298
299 #define BC_F_COPYIN 0x01 /* copy arguments in */
300 #define BC_F_COPYOUT 0x02 /* copy arguments out */
301 #define BC_F_SUSER 0x04 /* do super-user check */
302
303 const struct bridge_control bridge_control_table[] = {
304 { bridge_ioctl_add, sizeof(struct ifbreq),
305 BC_F_COPYIN|BC_F_SUSER },
306 { bridge_ioctl_del, sizeof(struct ifbreq),
307 BC_F_COPYIN|BC_F_SUSER },
308
309 { bridge_ioctl_gifflags, sizeof(struct ifbreq),
310 BC_F_COPYIN|BC_F_COPYOUT },
311 { bridge_ioctl_sifflags, sizeof(struct ifbreq),
312 BC_F_COPYIN|BC_F_SUSER },
313
314 { bridge_ioctl_scache, sizeof(struct ifbrparam),
315 BC_F_COPYIN|BC_F_SUSER },
316 { bridge_ioctl_gcache, sizeof(struct ifbrparam),
317 BC_F_COPYOUT },
318
319 { bridge_ioctl_gifs, sizeof(struct ifbifconf),
320 BC_F_COPYIN|BC_F_COPYOUT },
321 { bridge_ioctl_rts, sizeof(struct ifbaconf),
322 BC_F_COPYIN|BC_F_COPYOUT },
323
324 { bridge_ioctl_saddr, sizeof(struct ifbareq),
325 BC_F_COPYIN|BC_F_SUSER },
326
327 { bridge_ioctl_sto, sizeof(struct ifbrparam),
328 BC_F_COPYIN|BC_F_SUSER },
329 { bridge_ioctl_gto, sizeof(struct ifbrparam),
330 BC_F_COPYOUT },
331
332 { bridge_ioctl_daddr, sizeof(struct ifbareq),
333 BC_F_COPYIN|BC_F_SUSER },
334
335 { bridge_ioctl_flush, sizeof(struct ifbreq),
336 BC_F_COPYIN|BC_F_SUSER },
337
338 { bridge_ioctl_gpri, sizeof(struct ifbrparam),
339 BC_F_COPYOUT },
340 { bridge_ioctl_spri, sizeof(struct ifbrparam),
341 BC_F_COPYIN|BC_F_SUSER },
342
343 { bridge_ioctl_ght, sizeof(struct ifbrparam),
344 BC_F_COPYOUT },
345 { bridge_ioctl_sht, sizeof(struct ifbrparam),
346 BC_F_COPYIN|BC_F_SUSER },
347
348 { bridge_ioctl_gfd, sizeof(struct ifbrparam),
349 BC_F_COPYOUT },
350 { bridge_ioctl_sfd, sizeof(struct ifbrparam),
351 BC_F_COPYIN|BC_F_SUSER },
352
353 { bridge_ioctl_gma, sizeof(struct ifbrparam),
354 BC_F_COPYOUT },
355 { bridge_ioctl_sma, sizeof(struct ifbrparam),
356 BC_F_COPYIN|BC_F_SUSER },
357
358 { bridge_ioctl_sifprio, sizeof(struct ifbreq),
359 BC_F_COPYIN|BC_F_SUSER },
360
361 { bridge_ioctl_sifcost, sizeof(struct ifbreq),
362 BC_F_COPYIN|BC_F_SUSER },
363
364 { bridge_ioctl_addspan, sizeof(struct ifbreq),
365 BC_F_COPYIN|BC_F_SUSER },
366 { bridge_ioctl_delspan, sizeof(struct ifbreq),
367 BC_F_COPYIN|BC_F_SUSER },
368 };
369 const int bridge_control_table_size =
370 sizeof(bridge_control_table) / sizeof(bridge_control_table[0]);
371
372 LIST_HEAD(, bridge_softc) bridge_list;
373
374 struct if_clone bridge_cloner = IF_CLONE_INITIALIZER("bridge",
375 bridge_clone_create,
376 bridge_clone_destroy, 0, IF_MAXUNIT);
377
378 static int
379 bridge_modevent(module_t mod, int type, void *data)
380 {
381 switch (type) {
382 case MOD_LOAD:
383 LIST_INIT(&bridge_list);
384 if_clone_attach(&bridge_cloner);
385 bridge_input_p = bridge_input;
386 bridge_output_p = bridge_output;
387 bridge_detach_cookie = EVENTHANDLER_REGISTER(
388 ifnet_detach_event, bridge_ifdetach, NULL,
389 EVENTHANDLER_PRI_ANY);
390 #if notyet
391 bstp_linkstate_p = bstp_linkstate;
392 #endif
393 break;
394 case MOD_UNLOAD:
395 if (!LIST_EMPTY(&bridge_list))
396 return (EBUSY);
397 EVENTHANDLER_DEREGISTER(ifnet_detach_event,
398 bridge_detach_cookie);
399 if_clone_detach(&bridge_cloner);
400 bridge_input_p = NULL;
401 bridge_output_p = NULL;
402 #if notyet
403 bstp_linkstate_p = NULL;
404 #endif
405 break;
406 default:
407 return (EOPNOTSUPP);
408 }
409 return (0);
410 }
411
412 static moduledata_t bridge_mod = {
413 "if_bridge",
414 bridge_modevent,
415 0
416 };
417
418 DECLARE_MODULE(if_bridge, bridge_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
419
420
421 /*
422 * bridge_clone_create:
423 *
424 * Create a new bridge instance.
425 */
426 static int
427 bridge_clone_create(struct if_clone *ifc, int unit)
428 {
429 struct bridge_softc *sc;
430 struct ifnet *ifp;
431 u_char eaddr[6];
432
433 sc = kmalloc(sizeof(*sc), M_DEVBUF, M_WAITOK|M_ZERO);
434 ifp = sc->sc_ifp = &sc->sc_if;
435
436 sc->sc_brtmax = BRIDGE_RTABLE_MAX;
437 sc->sc_brttimeout = BRIDGE_RTABLE_TIMEOUT;
438 sc->sc_bridge_max_age = BSTP_DEFAULT_MAX_AGE;
439 sc->sc_bridge_hello_time = BSTP_DEFAULT_HELLO_TIME;
440 sc->sc_bridge_forward_delay = BSTP_DEFAULT_FORWARD_DELAY;
441 sc->sc_bridge_priority = BSTP_DEFAULT_BRIDGE_PRIORITY;
442 sc->sc_hold_time = BSTP_DEFAULT_HOLD_TIME;
443
444 /* Initialize our routing table. */
445 bridge_rtable_init(sc);
446
447 callout_init(&sc->sc_brcallout);
448 callout_init(&sc->sc_bstpcallout);
449
450 LIST_INIT(&sc->sc_iflist);
451 LIST_INIT(&sc->sc_spanlist);
452
453 ifp->if_softc = sc;
454 if_initname(ifp, ifc->ifc_name, unit);
455 ifp->if_mtu = ETHERMTU;
456 ifp->if_flags = IFF_BROADCAST | IFF_MULTICAST;
457 ifp->if_ioctl = bridge_ioctl;
458 ifp->if_start = bridge_start;
459 ifp->if_init = bridge_init;
460 ifp->if_type = IFT_BRIDGE;
461 ifq_set_maxlen(&ifp->if_snd, ifqmaxlen);
462 ifp->if_snd.ifq_maxlen = ifqmaxlen;
463 ifq_set_ready(&ifp->if_snd);
464 ifp->if_hdrlen = ETHER_HDR_LEN;
465
466 /*
467 * Generate a random ethernet address and use the private AC:DE:48
468 * OUI code.
469 */
470 {
471 int rnd = karc4random();
472 bcopy(&rnd, &eaddr[0], 4); /* ETHER_ADDR_LEN == 6 */
473 rnd = karc4random();
474 bcopy(&rnd, &eaddr[2], 4); /* ETHER_ADDR_LEN == 6 */
475 }
476 eaddr[0] &= ~1; /* clear multicast bit */
477 eaddr[0] |= 2; /* set the LAA bit */
478
479 ether_ifattach(ifp, eaddr, NULL);
480 /* Now undo some of the damage... */
481 ifp->if_baudrate = 0;
482 ifp->if_type = IFT_BRIDGE;
483
484 crit_enter(); /* XXX MP */
485 LIST_INSERT_HEAD(&bridge_list, sc, sc_list);
486 crit_exit();
487
488 return (0);
489 }
490
491 static void
492 bridge_delete_dispatch(struct netmsg *nmsg)
493 {
494 struct lwkt_msg *lmsg = &nmsg->nm_lmsg;
495 struct bridge_softc *sc = lmsg->u.ms_resultp;
496 struct ifnet *bifp = sc->sc_ifp;
497 struct bridge_iflist *bif;
498
499 lwkt_serialize_enter(bifp->if_serializer);
500
501 while ((bif = LIST_FIRST(&sc->sc_iflist)) != NULL)
502 bridge_delete_member(sc, bif, 0);
503
504 while ((bif = LIST_FIRST(&sc->sc_spanlist)) != NULL)
505 bridge_delete_span(sc, bif);
506
507 lwkt_serialize_exit(bifp->if_serializer);
508
509 lwkt_replymsg(lmsg, 0);
510 }
511
512 /*
513 * bridge_clone_destroy:
514 *
515 * Destroy a bridge instance.
516 */
517 static void
518 bridge_clone_destroy(struct ifnet *ifp)
519 {
520 struct bridge_softc *sc = ifp->if_softc;
521 struct lwkt_msg *lmsg;
522 struct netmsg nmsg;
523
524 lwkt_serialize_enter(ifp->if_serializer);
525
526 bridge_stop(ifp);
527 ifp->if_flags &= ~IFF_UP;
528
529 callout_stop(&sc->sc_brcallout);
530 callout_stop(&sc->sc_bstpcallout);
531
532 lwkt_serialize_exit(ifp->if_serializer);
533
534 netmsg_init(&nmsg, &curthread->td_msgport, 0, bridge_delete_dispatch);
535 lmsg = &nmsg.nm_lmsg;
536 lmsg->u.ms_resultp = sc;
537 lwkt_domsg(cpu_portfn(0), lmsg, 0);
538
539 crit_enter(); /* XXX MP */
540 LIST_REMOVE(sc, sc_list);
541 crit_exit();
542
543 ether_ifdetach(ifp);
544
545 /* Tear down the routing table. */
546 bridge_rtable_fini(sc);
547
548 kfree(sc, M_DEVBUF);
549 }
550
551 /*
552 * bridge_ioctl:
553 *
554 * Handle a control request from the operator.
555 */
556 static int
557 bridge_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *cr)
558 {
559 struct bridge_softc *sc = ifp->if_softc;
560 union {
561 struct ifbreq ifbreq;
562 struct ifbifconf ifbifconf;
563 struct ifbareq ifbareq;
564 struct ifbaconf ifbaconf;
565 struct ifbrparam ifbrparam;
566 } args;
567 struct ifdrv *ifd = (struct ifdrv *) data;
568 const struct bridge_control *bc;
569 int error = 0;
570
571 ASSERT_SERIALIZED(ifp->if_serializer);
572
573 switch (cmd) {
574 case SIOCADDMULTI:
575 case SIOCDELMULTI:
576 break;
577
578 case SIOCGDRVSPEC:
579 case SIOCSDRVSPEC:
580 if (ifd->ifd_cmd >= bridge_control_table_size) {
581 error = EINVAL;
582 break;
583 }
584 bc = &bridge_control_table[ifd->ifd_cmd];
585
586 if (cmd == SIOCGDRVSPEC &&
587 (bc->bc_flags & BC_F_COPYOUT) == 0) {
588 error = EINVAL;
589 break;
590 } else if (cmd == SIOCSDRVSPEC &&
591 (bc->bc_flags & BC_F_COPYOUT) != 0) {
592 error = EINVAL;
593 break;
594 }
595
596 if (bc->bc_flags & BC_F_SUSER) {
597 error = suser_cred(cr, NULL_CRED_OKAY);
598 if (error)
599 break;
600 }
601
602 if (ifd->ifd_len != bc->bc_argsize ||
603 ifd->ifd_len > sizeof(args)) {
604 error = EINVAL;
605 break;
606 }
607
608 memset(&args, 0, sizeof(args));
609 if (bc->bc_flags & BC_F_COPYIN) {
610 error = copyin(ifd->ifd_data, &args, ifd->ifd_len);
611 if (error)
612 break;
613 }
614
615 error = bridge_control(sc, cmd, bc->bc_func, &args);
616 if (error)
617 break;
618
619 if (bc->bc_flags & BC_F_COPYOUT)
620 error = copyout(&args, ifd->ifd_data, ifd->ifd_len);
621 break;
622
623 case SIOCSIFFLAGS:
624 if (!(ifp->if_flags & IFF_UP) &&
625 (ifp->if_flags & IFF_RUNNING)) {
626 /*
627 * If interface is marked down and it is running,
628 * then stop it.
629 */
630 bridge_stop(ifp);
631 } else if ((ifp->if_flags & IFF_UP) &&
632 !(ifp->if_flags & IFF_RUNNING)) {
633 /*
634 * If interface is marked up and it is stopped, then
635 * start it.
636 */
637 ifp->if_init(sc);
638 }
639 break;
640
641 case SIOCSIFMTU:
642 /* Do not allow the MTU to be changed on the bridge */
643 error = EINVAL;
644 break;
645
646 default:
647 error = ether_ioctl(ifp, cmd, data);
648 break;
649 }
650 return (error);
651 }
652
653 /*
654 * bridge_mutecaps:
655 *
656 * Clear or restore unwanted capabilities on the member interface
657 */
658 static void
659 bridge_mutecaps(struct bridge_iflist *bif, int mute)
660 {
661 struct ifnet *ifp = bif->bif_ifp;
662 struct ifreq ifr;
663 int error;
664
665 if (ifp->if_ioctl == NULL)
666 return;
667
668 bzero(&ifr, sizeof(ifr));
669 ifr.ifr_reqcap = ifp->if_capenable;
670
671 if (mute) {
672 /* mask off and save capabilities */
673 bif->bif_mutecap = ifr.ifr_reqcap & BRIDGE_IFCAPS_MASK;
674 if (bif->bif_mutecap != 0)
675 ifr.ifr_reqcap &= ~BRIDGE_IFCAPS_MASK;
676 } else {
677 /* restore muted capabilities */
678 ifr.ifr_reqcap |= bif->bif_mutecap;
679 }
680
681 if (bif->bif_mutecap != 0) {
682 lwkt_serialize_enter(ifp->if_serializer);
683 error = ifp->if_ioctl(ifp, SIOCSIFCAP, (caddr_t)&ifr, NULL);
684 lwkt_serialize_exit(ifp->if_serializer);
685 }
686 }
687
688 /*
689 * bridge_lookup_member:
690 *
691 * Lookup a bridge member interface.
692 */
693 static struct bridge_iflist *
694 bridge_lookup_member(struct bridge_softc *sc, const char *name)
695 {
696 struct bridge_iflist *bif;
697 struct ifnet *ifp;
698
699 LIST_FOREACH(bif, &sc->sc_iflist, bif_next) {
700 ifp = bif->bif_ifp;
701 if (strcmp(ifp->if_xname, name) == 0)
702 return (bif);
703 }
704
705 return (NULL);
706 }
707
708 /*
709 * bridge_lookup_member_if:
710 *
711 * Lookup a bridge member interface by ifnet*.
712 */
713 static struct bridge_iflist *
714 bridge_lookup_member_if(struct bridge_softc *sc, struct ifnet *member_ifp)
715 {
716 struct bridge_iflist *bif;
717
718 LIST_FOREACH(bif, &sc->sc_iflist, bif_next) {
719 if (bif->bif_ifp == member_ifp)
720 return (bif);
721 }
722
723 return (NULL);
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 int gone)
734 {
735 struct ifnet *ifs = bif->bif_ifp;
736 struct ifnet *bifp = sc->sc_ifp;
737
738 ASSERT_SERIALIZED(bifp->if_serializer);
739
740 ifs->if_bridge = NULL;
741
742 /*
743 * Release bridge interface's serializer:
744 * - To avoid possible dead lock.
745 * - netmsg_service_sync will block current thread.
746 */
747 lwkt_serialize_exit(bifp->if_serializer);
748
749 /*
750 * Make sure that all protocol threads see 'ifs' if_bridge change.
751 */
752 netmsg_service_sync();
753
754 if (!gone) {
755 switch (ifs->if_type) {
756 case IFT_ETHER:
757 case IFT_L2VLAN:
758 /*
759 * Take the interface out of promiscuous mode.
760 */
761 ifpromisc(ifs, 0);
762 bridge_mutecaps(bif, 0);
763 break;
764
765 case IFT_GIF:
766 break;
767
768 default:
769 panic("bridge_delete_member: impossible");
770 break;
771 }
772 }
773
774 lwkt_serialize_enter(bifp->if_serializer);
775
776 LIST_REMOVE(bif, bif_next);
777
778 bridge_rtdelete(sc, ifs, IFBF_FLUSHALL);
779
780 kfree(bif, M_DEVBUF);
781
782 if (sc->sc_ifp->if_flags & IFF_RUNNING)
783 bstp_initialization(sc);
784 }
785
786 /*
787 * bridge_delete_span:
788 *
789 * Delete the specified span interface.
790 */
791 static void
792 bridge_delete_span(struct bridge_softc *sc, struct bridge_iflist *bif)
793 {
794 KASSERT(bif->bif_ifp->if_bridge == NULL,
795 ("%s: not a span interface", __func__));
796
797 LIST_REMOVE(bif, bif_next);
798 kfree(bif, M_DEVBUF);
799 }
800
801 static int
802 bridge_ioctl_add(struct bridge_softc *sc, void *arg)
803 {
804 struct ifbreq *req = arg;
805 struct bridge_iflist *bif = NULL;
806 struct ifnet *ifs, *bifp;
807 int error = 0;
808
809 bifp = sc->sc_ifp;
810 ASSERT_SERIALIZED(bifp->if_serializer);
811
812 ifs = ifunit(req->ifbr_ifsname);
813 if (ifs == NULL)
814 return (ENOENT);
815
816 /* If it's in the span list, it can't be a member. */
817 LIST_FOREACH(bif, &sc->sc_spanlist, bif_next)
818 if (ifs == bif->bif_ifp)
819 return (EBUSY);
820
821 /* Allow the first Ethernet member to define the MTU */
822 if (ifs->if_type != IFT_GIF) {
823 if (LIST_EMPTY(&sc->sc_iflist)) {
824 bifp->if_mtu = ifs->if_mtu;
825 } else if (bifp->if_mtu != ifs->if_mtu) {
826 if_printf(bifp, "invalid MTU for %s\n", ifs->if_xname);
827 return (EINVAL);
828 }
829 }
830
831 if (ifs->if_bridge == sc)
832 return (EEXIST);
833
834 if (ifs->if_bridge != NULL)
835 return (EBUSY);
836
837 bif = kmalloc(sizeof(*bif), M_DEVBUF, M_WAITOK|M_ZERO);
838 bif->bif_ifp = ifs;
839 bif->bif_flags = IFBIF_LEARNING | IFBIF_DISCOVER;
840 bif->bif_priority = BSTP_DEFAULT_PORT_PRIORITY;
841 bif->bif_path_cost = BSTP_DEFAULT_PATH_COST;
842
843 switch (ifs->if_type) {
844 case IFT_ETHER:
845 case IFT_L2VLAN:
846 /*
847 * Release bridge interface's serializer to
848 * avoid possible dead lock.
849 */
850 lwkt_serialize_exit(bifp->if_serializer);
851
852 /*
853 * Place the interface into promiscuous mode.
854 */
855 error = ifpromisc(ifs, 1);
856 if (error) {
857 lwkt_serialize_enter(bifp->if_serializer);
858 goto out;
859 }
860
861 bridge_mutecaps(bif, 1);
862
863 lwkt_serialize_enter(bifp->if_serializer);
864 break;
865
866 case IFT_GIF: /* :^) */
867 break;
868
869 default:
870 error = EINVAL;
871 goto out;
872 }
873
874 LIST_INSERT_HEAD(&sc->sc_iflist, bif, bif_next);
875
876 if (bifp->if_flags & IFF_RUNNING)
877 bstp_initialization(sc);
878 else
879 bstp_stop(sc);
880
881 /*
882 * Everything has been setup, so let the member interface
883 * deliver packets to this bridge on its input/output path.
884 */
885 ifs->if_bridge = sc;
886 out:
887 if (error) {
888 if (bif != NULL)
889 kfree(bif, M_DEVBUF);
890 }
891 return (error);
892 }
893
894 static int
895 bridge_ioctl_del(struct bridge_softc *sc, void *arg)
896 {
897 struct ifbreq *req = arg;
898 struct bridge_iflist *bif;
899
900 bif = bridge_lookup_member(sc, req->ifbr_ifsname);
901 if (bif == NULL)
902 return (ENOENT);
903
904 bridge_delete_member(sc, bif, 0);
905
906 return (0);
907 }
908
909 static int
910 bridge_ioctl_gifflags(struct bridge_softc *sc, void *arg)
911 {
912 struct ifbreq *req = arg;
913 struct bridge_iflist *bif;
914
915 bif = bridge_lookup_member(sc, req->ifbr_ifsname);
916 if (bif == NULL)
917 return (ENOENT);
918
919 req->ifbr_ifsflags = bif->bif_flags;
920 req->ifbr_state = bif->bif_state;
921 req->ifbr_priority = bif->bif_priority;
922 req->ifbr_path_cost = bif->bif_path_cost;
923 req->ifbr_portno = bif->bif_ifp->if_index & 0xff;
924
925 return (0);
926 }
927
928 static int
929 bridge_ioctl_sifflags(struct bridge_softc *sc, void *arg)
930 {
931 struct ifbreq *req = arg;
932 struct bridge_iflist *bif;
933
934 bif = bridge_lookup_member(sc, req->ifbr_ifsname);
935 if (bif == NULL)
936 return (ENOENT);
937
938 if (req->ifbr_ifsflags & IFBIF_SPAN)
939 /* SPAN is readonly */
940 return (EINVAL);
941
942 if (req->ifbr_ifsflags & IFBIF_STP) {
943 switch (bif->bif_ifp->if_type) {
944 case IFT_ETHER:
945 /* These can do spanning tree. */
946 break;
947
948 default:
949 /* Nothing else can. */
950 return (EINVAL);
951 }
952 }
953
954 bif->bif_flags = req->ifbr_ifsflags;
955
956 if (sc->sc_ifp->if_flags & IFF_RUNNING)
957 bstp_initialization(sc);
958
959 return (0);
960 }
961
962 static int
963 bridge_ioctl_scache(struct bridge_softc *sc, void *arg)
964 {
965 struct ifbrparam *param = arg;
966
967 sc->sc_brtmax = param->ifbrp_csize;
968 bridge_rttrim(sc);
969
970 return (0);
971 }
972
973 static int
974 bridge_ioctl_gcache(struct bridge_softc *sc, void *arg)
975 {
976 struct ifbrparam *param = arg;
977
978 param->ifbrp_csize = sc->sc_brtmax;
979
980 return (0);
981 }
982
983 static int
984 bridge_ioctl_gifs(struct bridge_softc *sc, void *arg)
985 {
986 struct ifbifconf *bifc = arg;
987 struct bridge_iflist *bif;
988 struct ifbreq breq;
989 int count, len, error = 0;
990
991 count = 0;
992 LIST_FOREACH(bif, &sc->sc_iflist, bif_next)
993 count++;
994 LIST_FOREACH(bif, &sc->sc_spanlist, bif_next)
995 count++;
996
997 if (bifc->ifbic_len == 0) {
998 bifc->ifbic_len = sizeof(breq) * count;
999 return (0);
1000 }
1001
1002 count = 0;
1003 len = bifc->ifbic_len;
1004 memset(&breq, 0, sizeof breq);
1005 LIST_FOREACH(bif, &sc->sc_iflist, bif_next) {
1006 if (len < sizeof(breq))
1007 break;
1008
1009 strlcpy(breq.ifbr_ifsname, bif->bif_ifp->if_xname,
1010 sizeof(breq.ifbr_ifsname));
1011 breq.ifbr_ifsflags = bif->bif_flags;
1012 breq.ifbr_state = bif->bif_state;
1013 breq.ifbr_priority = bif->bif_priority;
1014 breq.ifbr_path_cost = bif->bif_path_cost;
1015 breq.ifbr_portno = bif->bif_ifp->if_index & 0xff;
1016 error = copyout(&breq, bifc->ifbic_req + count, sizeof(breq));
1017 if (error)
1018 break;
1019 count++;
1020 len -= sizeof(breq);
1021 }
1022 LIST_FOREACH(bif, &sc->sc_spanlist, bif_next) {
1023 if (len < sizeof(breq))
1024 break;
1025
1026 strlcpy(breq.ifbr_ifsname, bif->bif_ifp->if_xname,
1027 sizeof(breq.ifbr_ifsname));
1028 breq.ifbr_ifsflags = bif->bif_flags;
1029 breq.ifbr_state = bif->bif_state;
1030 breq.ifbr_priority = bif->bif_priority;
1031 breq.ifbr_path_cost = bif->bif_path_cost;
1032 breq.ifbr_portno = bif->bif_ifp->if_index & 0xff;
1033 error = copyout(&breq, bifc->ifbic_req + count, sizeof(breq));
1034 if (error)
1035 break;
1036 count++;
1037 len -= sizeof(breq);
1038 }
1039
1040 bifc->ifbic_len = sizeof(breq) * count;
1041 return (error);
1042 }
1043
1044 static int
1045 bridge_ioctl_rts(struct bridge_softc *sc, void *arg)
1046 {
1047 struct ifbaconf *bac = arg;
1048 struct bridge_rtnode *brt;
1049 struct ifbareq bareq;
1050 int count = 0, error = 0, len;
1051
1052 if (bac->ifbac_len == 0)
1053 return (0);
1054
1055 len = bac->ifbac_len;
1056 memset(&bareq, 0, sizeof(bareq));
1057 LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) {
1058 if (len < sizeof(bareq))
1059 goto out;
1060 strlcpy(bareq.ifba_ifsname, brt->brt_ifp->if_xname,
1061 sizeof(bareq.ifba_ifsname));
1062 memcpy(bareq.ifba_dst, brt->brt_addr, sizeof(brt->brt_addr));
1063 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
1064 time_second < brt->brt_expire)
1065 bareq.ifba_expire = brt->brt_expire - time_second;
1066 else
1067 bareq.ifba_expire = 0;
1068 bareq.ifba_flags = brt->brt_flags;
1069
1070 error = copyout(&bareq, bac->ifbac_req + count, sizeof(bareq));
1071 if (error)
1072 goto out;
1073 count++;
1074 len -= sizeof(bareq);
1075 }
1076 out:
1077 bac->ifbac_len = sizeof(bareq) * count;
1078 return (error);
1079 }
1080
1081 static int
1082 bridge_ioctl_saddr(struct bridge_softc *sc, void *arg)
1083 {
1084 struct ifbareq *req = arg;
1085 struct bridge_iflist *bif;
1086 int error;
1087
1088 bif = bridge_lookup_member(sc, req->ifba_ifsname);
1089 if (bif == NULL)
1090 return (ENOENT);
1091
1092 error = bridge_rtupdate(sc, req->ifba_dst, bif->bif_ifp, 1,
1093 req->ifba_flags);
1094
1095 return (error);
1096 }
1097
1098 static int
1099 bridge_ioctl_sto(struct bridge_softc *sc, void *arg)
1100 {
1101 struct ifbrparam *param = arg;
1102
1103 sc->sc_brttimeout = param->ifbrp_ctime;
1104
1105 return (0);
1106 }
1107
1108 static int
1109 bridge_ioctl_gto(struct bridge_softc *sc, void *arg)
1110 {
1111 struct ifbrparam *param = arg;
1112
1113 param->ifbrp_ctime = sc->sc_brttimeout;
1114
1115 return (0);
1116 }
1117
1118 static int
1119 bridge_ioctl_daddr(struct bridge_softc *sc, void *arg)
1120 {
1121 struct ifbareq *req = arg;
1122
1123 return (bridge_rtdaddr(sc, req->ifba_dst));
1124 }
1125
1126 static int
1127 bridge_ioctl_flush(struct bridge_softc *sc, void *arg)
1128 {
1129 struct ifbreq *req = arg;
1130
1131 bridge_rtflush(sc, req->ifbr_ifsflags);
1132
1133 return (0);
1134 }
1135
1136 static int
1137 bridge_ioctl_gpri(struct bridge_softc *sc, void *arg)
1138 {
1139 struct ifbrparam *param = arg;
1140
1141 param->ifbrp_prio = sc->sc_bridge_priority;
1142
1143 return (0);
1144 }
1145
1146 static int
1147 bridge_ioctl_spri(struct bridge_softc *sc, void *arg)
1148 {
1149 struct ifbrparam *param = arg;
1150
1151 sc->sc_bridge_priority = param->ifbrp_prio;
1152
1153 if (sc->sc_ifp->if_flags & IFF_RUNNING)
1154 bstp_initialization(sc);
1155
1156 return (0);
1157 }
1158
1159 static int
1160 bridge_ioctl_ght(struct bridge_softc *sc, void *arg)
1161 {
1162 struct ifbrparam *param = arg;
1163
1164 param->ifbrp_hellotime = sc->sc_bridge_hello_time >> 8;
1165
1166 return (0);
1167 }
1168
1169 static int
1170 bridge_ioctl_sht(struct bridge_softc *sc, void *arg)
1171 {
1172 struct ifbrparam *param = arg;
1173
1174 if (param->ifbrp_hellotime == 0)
1175 return (EINVAL);
1176 sc->sc_bridge_hello_time = param->ifbrp_hellotime << 8;
1177
1178 if (sc->sc_ifp->if_flags & IFF_RUNNING)
1179 bstp_initialization(sc);
1180
1181 return (0);
1182 }
1183
1184 static int
1185 bridge_ioctl_gfd(struct bridge_softc *sc, void *arg)
1186 {
1187 struct ifbrparam *param = arg;
1188
1189 param->ifbrp_fwddelay = sc->sc_bridge_forward_delay >> 8;
1190
1191 return (0);
1192 }
1193
1194 static int
1195 bridge_ioctl_sfd(struct bridge_softc *sc, void *arg)
1196 {
1197 struct ifbrparam *param = arg;
1198
1199 if (param->ifbrp_fwddelay == 0)
1200 return (EINVAL);
1201 sc->sc_bridge_forward_delay = param->ifbrp_fwddelay << 8;
1202
1203 if (sc->sc_ifp->if_flags & IFF_RUNNING)
1204 bstp_initialization(sc);
1205
1206 return (0);
1207 }
1208
1209 static int
1210 bridge_ioctl_gma(struct bridge_softc *sc, void *arg)
1211 {
1212 struct ifbrparam *param = arg;
1213
1214 param->ifbrp_maxage = sc->sc_bridge_max_age >> 8;
1215
1216 return (0);
1217 }
1218
1219 static int
1220 bridge_ioctl_sma(struct bridge_softc *sc, void *arg)
1221 {
1222 struct ifbrparam *param = arg;
1223
1224 if (param->ifbrp_maxage == 0)
1225 return (EINVAL);
1226 sc->sc_bridge_max_age = param->ifbrp_maxage << 8;
1227
1228 if (sc->sc_ifp->if_flags & IFF_RUNNING)
1229 bstp_initialization(sc);
1230
1231 return (0);
1232 }
1233
1234 static int
1235 bridge_ioctl_sifprio(struct bridge_softc *sc, void *arg)
1236 {
1237 struct ifbreq *req = arg;
1238 struct bridge_iflist *bif;
1239
1240 bif = bridge_lookup_member(sc, req->ifbr_ifsname);
1241 if (bif == NULL)
1242 return (ENOENT);
1243
1244 bif->bif_priority = req->ifbr_priority;
1245
1246 if (sc->sc_ifp->if_flags & IFF_RUNNING)
1247 bstp_initialization(sc);
1248
1249 return (0);
1250 }
1251
1252 static int
1253 bridge_ioctl_sifcost(struct bridge_softc *sc, void *arg)
1254 {
1255 struct ifbreq *req = arg;
1256 struct bridge_iflist *bif;
1257
1258 bif = bridge_lookup_member(sc, req->ifbr_ifsname);
1259 if (bif == NULL)
1260 return (ENOENT);
1261
1262 bif->bif_path_cost = req->ifbr_path_cost;
1263
1264 if (sc->sc_ifp->if_flags & IFF_RUNNING)
1265 bstp_initialization(sc);
1266
1267 return (0);
1268 }
1269
1270 static int
1271 bridge_ioctl_addspan(struct bridge_softc *sc, void *arg)
1272 {
1273 struct ifbreq *req = arg;
1274 struct bridge_iflist *bif = NULL;
1275 struct ifnet *ifs;
1276
1277 ifs = ifunit(req->ifbr_ifsname);
1278 if (ifs == NULL)
1279 return (ENOENT);
1280
1281 LIST_FOREACH(bif, &sc->sc_spanlist, bif_next)
1282 if (ifs == bif->bif_ifp)
1283 return (EBUSY);
1284
1285 if (ifs->if_bridge != NULL)
1286 return (EBUSY);
1287
1288 switch (ifs->if_type) {
1289 case IFT_ETHER:
1290 case IFT_GIF:
1291 case IFT_L2VLAN:
1292 break;
1293 default:
1294 return (EINVAL);
1295 }
1296
1297 bif = kmalloc(sizeof(*bif), M_DEVBUF, M_WAITOK|M_ZERO);
1298
1299 bif->bif_ifp = ifs;
1300 bif->bif_flags = IFBIF_SPAN;
1301
1302 LIST_INSERT_HEAD(&sc->sc_spanlist, bif, bif_next);
1303
1304 return (0);
1305 }
1306
1307 static int
1308 bridge_ioctl_delspan(struct bridge_softc *sc, void *arg)
1309 {
1310 struct ifbreq *req = arg;
1311 struct bridge_iflist *bif;
1312 struct ifnet *ifs;
1313
1314 ifs = ifunit(req->ifbr_ifsname);
1315 if (ifs == NULL)
1316 return (ENOENT);
1317
1318 LIST_FOREACH(bif, &sc->sc_spanlist, bif_next)
1319 if (ifs == bif->bif_ifp)
1320 break;
1321
1322 if (bif == NULL)
1323 return (ENOENT);
1324
1325 bridge_delete_span(sc, bif);
1326
1327 return (0);
1328 }
1329
1330 static void
1331 bridge_ifdetach_dispatch(struct netmsg *nmsg)
1332 {
1333 struct lwkt_msg *lmsg = &nmsg->nm_lmsg;
1334 struct ifnet *ifp, *bifp;
1335 struct bridge_softc *sc;
1336 struct bridge_iflist *bif;
1337
1338 ifp = lmsg->u.ms_resultp;
1339 sc = ifp->if_bridge;
1340
1341 /* Check if the interface is a bridge member */
1342 if (sc != NULL) {
1343 bifp = sc->sc_ifp;
1344
1345 lwkt_serialize_enter(bifp->if_serializer);
1346
1347 bif = bridge_lookup_member_if(sc, ifp);
1348 if (bif != NULL) {
1349 bridge_delete_member(sc, bif, 1);
1350 } else {
1351 /* XXX Why bif will be NULL? */
1352 }
1353
1354 lwkt_serialize_exit(bifp->if_serializer);
1355 goto reply;
1356 }
1357
1358 crit_enter(); /* XXX MP */
1359
1360 /* Check if the interface is a span port */
1361 LIST_FOREACH(sc, &bridge_list, sc_list) {
1362 bifp = sc->sc_ifp;
1363
1364 lwkt_serialize_enter(bifp->if_serializer);
1365
1366 LIST_FOREACH(bif, &sc->sc_spanlist, bif_next)
1367 if (ifp == bif->bif_ifp) {
1368 bridge_delete_span(sc, bif);
1369 break;
1370 }
1371
1372 lwkt_serialize_exit(bifp->if_serializer);
1373 }
1374
1375 crit_exit();
1376
1377 reply:
1378 lwkt_replymsg(lmsg, 0);
1379 }
1380
1381 /*
1382 * bridge_ifdetach:
1383 *
1384 * Detach an interface from a bridge. Called when a member
1385 * interface is detaching.
1386 */
1387 static void
1388 bridge_ifdetach(void *arg __unused, struct ifnet *ifp)
1389 {
1390 struct lwkt_msg *lmsg;
1391 struct netmsg nmsg;
1392
1393 netmsg_init(&nmsg, &curthread->td_msgport, 0, bridge_ifdetach_dispatch);
1394 lmsg = &nmsg.nm_lmsg;
1395 lmsg->u.ms_resultp = ifp;
1396
1397 lwkt_domsg(cpu_portfn(0), lmsg, 0);
1398 }
1399
1400 /*
1401 * bridge_init:
1402 *
1403 * Initialize a bridge interface.
1404 */
1405 static void
1406 bridge_init(void *xsc)
1407 {
1408 struct bridge_softc *sc = (struct bridge_softc *)xsc;
1409 struct ifnet *ifp = sc->sc_ifp;
1410
1411 ASSERT_SERIALIZED(ifp->if_serializer);
1412
1413 if (ifp->if_flags & IFF_RUNNING)
1414 return;
1415
1416 callout_reset(&sc->sc_brcallout, bridge_rtable_prune_period * hz,
1417 bridge_timer, sc);
1418
1419 ifp->if_flags |= IFF_RUNNING;
1420 bstp_initialization(sc);
1421 return;
1422 }
1423
1424 /*
1425 * bridge_stop:
1426 *
1427 * Stop the bridge interface.
1428 */
1429 static void
1430 bridge_stop(struct ifnet *ifp)
1431 {
1432 struct bridge_softc *sc = ifp->if_softc;
1433
1434 ASSERT_SERIALIZED(ifp->if_serializer);
1435
1436 if ((ifp->if_flags & IFF_RUNNING) == 0)
1437 return;
1438
1439 callout_stop(&sc->sc_brcallout);
1440 bstp_stop(sc);
1441
1442 bridge_rtflush(sc, IFBF_FLUSHDYN);
1443
1444 ifp->if_flags &= ~IFF_RUNNING;
1445 }
1446
1447 static void
1448 bridge_enqueue_internal(struct ifnet *dst_ifp, struct mbuf *m,
1449 netisr_fn_t handler)
1450 {
1451 struct netmsg_packet *nmp;
1452 lwkt_port_t port;
1453 int cpu = mycpu->gd_cpuid;
1454
1455 nmp = &m->m_hdr.mh_netmsg;
1456 netmsg_init(&nmp->nm_netmsg, &netisr_apanic_rport, 0, handler);
1457 nmp->nm_packet = m;
1458 nmp->nm_netmsg.nm_lmsg.u.ms_resultp = dst_ifp;
1459
1460 port = cpu_portfn(cpu);
1461 lwkt_sendmsg(port, &nmp->nm_netmsg.nm_lmsg);
1462 }
1463
1464 static void
1465 bridge_pfil_enqueue(struct ifnet *dst_ifp, struct mbuf *m,
1466 int runfilt)
1467 {
1468 netisr_fn_t handler;
1469
1470 if (runfilt && (inet_pfil_hook.ph_hashooks > 0
1471 #ifdef INET6
1472 || inet6_pfil_hook.ph_hashooks > 0
1473 #endif
1474 )) {
1475 handler = bridge_pfil_enqueue_handler;
1476 } else {
1477 handler = bridge_enqueue_handler;
1478 }
1479 bridge_enqueue_internal(dst_ifp, m, handler);
1480 }
1481
1482 /*
1483 * bridge_enqueue:
1484 *
1485 * Enqueue a packet on a bridge member interface.
1486 *
1487 */
1488 void
1489 bridge_enqueue(struct ifnet *dst_ifp, struct mbuf *m)
1490 {
1491 bridge_enqueue_internal(dst_ifp, m, bridge_enqueue_handler);
1492 }
1493
1494 /*
1495 * bridge_output:
1496 *
1497 * Send output from a bridge member interface. This
1498 * performs the bridging function for locally originated
1499 * packets.
1500 *
1501 * The mbuf has the Ethernet header already attached. We must
1502 * enqueue or free the mbuf before returning.
1503 */
1504 static int
1505 bridge_output(struct ifnet *ifp, struct mbuf *m)
1506 {
1507 struct bridge_softc *sc = ifp->if_bridge;
1508 struct ether_header *eh;
1509 struct ifnet *dst_if;
1510
1511 ASSERT_NOT_SERIALIZED(ifp->if_serializer);
1512
1513 /*
1514 * Make sure that we are still a member of a bridge interface.
1515 */
1516 if (sc == NULL) {
1517 m_freem(m);
1518 return (0);
1519 }
1520
1521 if (m->m_len < ETHER_HDR_LEN) {
1522 m = m_pullup(m, ETHER_HDR_LEN);
1523 if (m == NULL)
1524 return (0);
1525 }
1526
1527 /* Serialize our bridge interface. */
1528 lwkt_serialize_enter(sc->sc_ifp->if_serializer);
1529
1530 eh = mtod(m, struct ether_header *);
1531
1532 /*
1533 * If bridge is down, but the original output interface is up,
1534 * go ahead and send out that interface. Otherwise, the packet
1535 * is dropped below.
1536 */
1537 if ((sc->sc_ifp->if_flags & IFF_RUNNING) == 0) {
1538 dst_if = ifp;
1539 goto sendunicast;
1540 }
1541
1542 /*
1543 * If the packet is a multicast, or we don't know a better way to
1544 * get there, send to all interfaces.
1545 */
1546 if (ETHER_IS_MULTICAST(eh->ether_dhost))
1547 dst_if = NULL;
1548 else
1549 dst_if = bridge_rtlookup(sc, eh->ether_dhost);
1550 if (dst_if == NULL) {
1551 struct bridge_iflist *bif;
1552 struct mbuf *mc;
1553 int used = 0;
1554
1555 bridge_span(sc, m);
1556
1557 LIST_FOREACH(bif, &sc->sc_iflist, bif_next) {
1558 dst_if = bif->bif_ifp;
1559 if ((dst_if->if_flags & IFF_RUNNING) == 0)
1560 continue;
1561
1562 /*
1563 * If this is not the original output interface,
1564 * and the interface is participating in spanning
1565 * tree, make sure the port is in a state that
1566 * allows forwarding.
1567 */
1568 if (dst_if != ifp &&
1569 (bif->bif_flags & IFBIF_STP) != 0) {
1570 switch (bif->bif_state) {
1571 case BSTP_IFSTATE_BLOCKING:
1572 case BSTP_IFSTATE_LISTENING:
1573 case BSTP_IFSTATE_DISABLED:
1574 continue;
1575 }
1576 }
1577
1578 if (LIST_NEXT(bif, bif_next) == NULL) {
1579 used = 1;
1580 mc = m;
1581 } else {
1582 mc = m_copypacket(m, MB_DONTWAIT);
1583 if (mc == NULL) {
1584 sc->sc_ifp->if_oerrors++;
1585 continue;
1586 }
1587 }
1588 bridge_enqueue(dst_if, mc);
1589 }
1590 if (used == 0)
1591 m_freem(m);
1592 lwkt_serialize_exit(sc->sc_ifp->if_serializer);
1593 return (0);
1594 }
1595
1596 sendunicast:
1597 /*
1598 * XXX Spanning tree consideration here?
1599 */
1600
1601 bridge_span(sc, m);
1602 lwkt_serialize_exit(sc->sc_ifp->if_serializer);
1603 if ((dst_if->if_flags & IFF_RUNNING) == 0)
1604 m_freem(m);
1605 else
1606 bridge_enqueue(dst_if, m);
1607 return (0);
1608 }
1609
1610 /*
1611 * bridge_start:
1612 *
1613 * Start output on a bridge.
1614 *
1615 */
1616 static void
1617 bridge_start(struct ifnet *ifp)
1618 {
1619 struct bridge_softc *sc = ifp->if_softc;
1620
1621 ASSERT_SERIALIZED(ifp->if_serializer);
1622
1623 ifp->if_flags |= IFF_OACTIVE;
1624 for (;;) {
1625 struct ifnet *dst_if = NULL;
1626 struct ether_header *eh;
1627 struct mbuf *m;
1628
1629 m = ifq_dequeue(&ifp->if_snd, NULL);
1630 if (m == NULL)
1631 break;
1632
1633 if (m->m_len < sizeof(*eh)) {
1634 m = m_pullup(m, sizeof(*eh));
1635 if (m == NULL) {
1636 ifp->if_oerrors++;
1637 continue;
1638 }
1639 }
1640 eh = mtod(m, struct ether_header *);
1641
1642 BPF_MTAP(ifp, m);
1643 ifp->if_opackets++;
1644
1645 if ((m->m_flags & (M_BCAST|M_MCAST)) == 0)
1646 dst_if = bridge_rtlookup(sc, eh->ether_dhost);
1647
1648 if (dst_if == NULL)
1649 bridge_broadcast(sc, ifp, m, 0);
1650 else
1651 bridge_enqueue(dst_if, m);
1652 }
1653 ifp->if_flags &= ~IFF_OACTIVE;
1654 }
1655
1656 /*
1657 * bridge_forward:
1658 *
1659 * The forwarding function of the bridge.
1660 */
1661 static void
1662 bridge_forward(struct bridge_softc *sc, struct mbuf *m)
1663 {
1664 struct bridge_iflist *bif;
1665 struct ifnet *src_if, *dst_if, *ifp;
1666 struct ether_header *eh;
1667
1668 src_if = m->m_pkthdr.rcvif;
1669 ifp = sc->sc_ifp;
1670
1671 ASSERT_SERIALIZED(ifp->if_serializer);
1672
1673 ifp->if_ipackets++;
1674 ifp->if_ibytes += m->m_pkthdr.len;
1675
1676 /*
1677 * Look up the bridge_iflist.
1678 */
1679 bif = bridge_lookup_member_if(sc, src_if);
1680 if (bif == NULL) {
1681 /* Interface is not a bridge member (anymore?) */
1682 m_freem(m);
1683 return;
1684 }
1685
1686 if (bif->bif_flags & IFBIF_STP) {
1687 switch (bif->bif_state) {
1688 case BSTP_IFSTATE_BLOCKING:
1689 case BSTP_IFSTATE_LISTENING:
1690 case BSTP_IFSTATE_DISABLED:
1691 m_freem(m);
1692 return;
1693 }
1694 }
1695
1696 eh = mtod(m, struct ether_header *);
1697
1698 /*
1699 * If the interface is learning, and the source
1700 * address is valid and not multicast, record
1701 * the address.
1702 */
1703 if ((bif->bif_flags & IFBIF_LEARNING) != 0 &&
1704 ETHER_IS_MULTICAST(eh->ether_shost) == 0 &&
1705 (eh->ether_shost[0] == 0 &&
1706 eh->ether_shost[1] == 0 &&
1707 eh->ether_shost[2] == 0 &&
1708 eh->ether_shost[3] == 0 &&
1709 eh->ether_shost[4] == 0 &&
1710 eh->ether_shost[5] == 0) == 0) {
1711 bridge_rtupdate(sc, eh->ether_shost, src_if, 0, IFBAF_DYNAMIC);
1712 }
1713
1714 if ((bif->bif_flags & IFBIF_STP) != 0 &&
1715 bif->bif_state == BSTP_IFSTATE_LEARNING) {
1716 m_freem(m);
1717 return;
1718 }
1719
1720 /*
1721 * At this point, the port either doesn't participate
1722 * in spanning tree or it is in the forwarding state.
1723 */
1724
1725 /*
1726 * If the packet is unicast, destined for someone on
1727 * "this" side of the bridge, drop it.
1728 */
1729 if ((m->m_flags & (M_BCAST|M_MCAST)) == 0) {
1730 dst_if = bridge_rtlookup(sc, eh->ether_dhost);
1731 if (src_if == dst_if) {
1732 m_freem(m);
1733 return;
1734 }
1735 } else {
1736 /* ...forward it to all interfaces. */
1737 sc->sc_ifp->if_imcasts++;
1738 dst_if = NULL;
1739 }
1740
1741 if (dst_if == NULL) {
1742 bridge_broadcast(sc, src_if, m, 1);
1743 return;
1744 }
1745
1746 /*
1747 * At this point, we're dealing with a unicast frame
1748 * going to a different interface.
1749 */
1750 if ((dst_if->if_flags & IFF_RUNNING) == 0) {
1751 m_freem(m);
1752 return;
1753 }
1754 bif = bridge_lookup_member_if(sc, dst_if);
1755 if (bif == NULL) {
1756 /* Not a member of the bridge (anymore?) */
1757 m_freem(m);
1758 return;
1759 }
1760
1761 if (bif->bif_flags & IFBIF_STP) {
1762 switch (bif->bif_state) {
1763 case BSTP_IFSTATE_DISABLED:
1764 case BSTP_IFSTATE_BLOCKING:
1765 m_freem(m);
1766 return;
1767 }
1768 }
1769
1770 lwkt_serialize_exit(ifp->if_serializer);
1771
1772 /* run the packet filter */
1773 if (inet_pfil_hook.ph_hashooks > 0
1774 #ifdef INET6
1775 || inet6_pfil_hook.ph_hashooks > 0
1776 #endif
1777 ) {
1778 if (bridge_pfil(&m, ifp, src_if, PFIL_IN) != 0)
1779 goto done;
1780 if (m == NULL)
1781 goto done;
1782
1783 if (bridge_pfil(&m, ifp, dst_if, PFIL_OUT) != 0)
1784 goto done;
1785 if (m == NULL)
1786 goto done;
1787 }
1788 bridge_handoff(dst_if, m);
1789
1790 /*
1791 * ifp's serializer was held on entry and is expected to be held
1792 * on return.
1793 */
1794 done:
1795 lwkt_serialize_enter(ifp->if_serializer);
1796 }
1797
1798 /*
1799 * bridge_input:
1800 *
1801 * Receive input from a member interface. Queue the packet for
1802 * bridging if it is not for us.
1803 */
1804 static struct mbuf *
1805 bridge_input(struct ifnet *ifp, struct mbuf *m)
1806 {
1807 struct bridge_softc *sc = ifp->if_bridge;
1808 struct bridge_iflist *bif;
1809 struct ifnet *bifp, *new_ifp;
1810 struct ether_header *eh;
1811 struct mbuf *mc, *mc2;
1812
1813 /*
1814 * Make sure that we are still a member of a bridge interface.
1815 */
1816 if (sc == NULL)
1817 return m;
1818
1819 new_ifp = NULL;
1820 bifp = sc->sc_ifp;
1821
1822 lwkt_serialize_enter(bifp->if_serializer);
1823
1824 if ((bifp->if_flags & IFF_RUNNING) == 0)
1825 goto out;
1826
1827 /*
1828 * Implement support for bridge monitoring. If this flag has been
1829 * set on this interface, discard the packet once we push it through
1830 * the bpf(4) machinery, but before we do, increment the byte and
1831 * packet counters associated with this interface.
1832 */
1833 if ((bifp->if_flags & IFF_MONITOR) != 0) {
1834 m->m_pkthdr.rcvif = bifp;
1835 BPF_MTAP(bifp, m);
1836 bifp->if_ipackets++;
1837 bifp->if_ibytes += m->m_pkthdr.len;
1838 m_freem(m);
1839 m = NULL;
1840 goto out;
1841 }
1842
1843 eh = mtod(m, struct ether_header *);
1844
1845 m->m_flags &= ~M_PROTO1; /* XXX Hack - loop prevention */
1846
1847 if (memcmp(eh->ether_dhost, IF_LLADDR(bifp), ETHER_ADDR_LEN) == 0) {
1848 /*
1849 * If the packet is for us, set the packets source as the
1850 * bridge, and return the packet back to ifnet.if_input for
1851 * local processing.
1852 */
1853 KASSERT(bifp->if_bridge == NULL,
1854 ("loop created in bridge_input"));
1855 new_ifp = bifp;
1856 goto out;
1857 }
1858
1859 /*
1860 * Tap all packets arriving on the bridge, no matter if
1861 * they are local destinations or not. In is in.
1862 */
1863 BPF_MTAP(bifp, m);
1864
1865 bif = bridge_lookup_member_if(sc, ifp);
1866 if (bif == NULL)
1867 goto out;
1868
1869 bridge_span(sc, m);
1870
1871 if (m->m_flags & (M_BCAST | M_MCAST)) {
1872 /* Tap off 802.1D packets; they do not get forwarded. */
1873 if (memcmp(eh->ether_dhost, bstp_etheraddr,
1874 ETHER_ADDR_LEN) == 0) {
1875 m = bstp_input(sc, bif, m);
1876 KASSERT(m == NULL,
1877 ("attempt to deliver 802.1D packet\n"));
1878 goto out;
1879 }
1880
1881 if (bif->bif_flags & IFBIF_STP) {
1882 switch (bif->bif_state) {
1883 case BSTP_IFSTATE_BLOCKING:
1884 case BSTP_IFSTATE_LISTENING:
1885 case BSTP_IFSTATE_DISABLED:
1886 goto out;
1887 }
1888 }
1889
1890 /*
1891 * Make a deep copy of the packet and enqueue the copy
1892 * for bridge processing; return the original packet for
1893 * local processing.
1894 */
1895 mc = m_dup(m, MB_DONTWAIT);
1896 if (mc == NULL)
1897 goto out;
1898
1899 bridge_forward(sc, mc);
1900
1901 /*
1902 * Reinject the mbuf as arriving on the bridge so we have a
1903 * chance at claiming multicast packets. We can not loop back
1904 * here from ether_input as a bridge is never a member of a
1905 * bridge.
1906 */
1907 KASSERT(bifp->if_bridge == NULL,
1908 ("loop created in bridge_input"));
1909 mc2 = m_dup(m, MB_DONTWAIT);
1910 #ifdef notyet
1911 if (mc2 != NULL) {
1912 /* Keep the layer3 header aligned */
1913 int i = min(mc2->m_pkthdr.len, max_protohdr);
1914 mc2 = m_copyup(mc2, i, ETHER_ALIGN);
1915 }
1916 #endif
1917 if (mc2 != NULL) {
1918 mc2->m_pkthdr.rcvif = bifp;
1919 bifp->if_ipackets++;
1920 bifp->if_input(bifp, mc2);
1921 }
1922
1923 /* Return the original packet for local processing. */
1924 goto out;
1925 }
1926
1927 if (bif->bif_flags & IFBIF_STP) {
1928 switch (bif->bif_state) {
1929 case BSTP_IFSTATE_BLOCKING:
1930 case BSTP_IFSTATE_LISTENING:
1931 case BSTP_IFSTATE_DISABLED:
1932 goto out;
1933 }
1934 }
1935
1936 /*
1937 * Unicast. Make sure it's not for us.
1938 */
1939 LIST_FOREACH(bif, &sc->sc_iflist, bif_next) {
1940 if (bif->bif_ifp->if_type != IFT_ETHER)
1941 continue;
1942
1943 /* It is destined for us. */
1944 if (memcmp(IF_LLADDR(bif->bif_ifp), eh->ether_dhost,
1945 ETHER_ADDR_LEN) == 0) {
1946 if (bif->bif_flags & IFBIF_LEARNING) {
1947 bridge_rtupdate(sc,
1948 eh->ether_shost, ifp, 0, IFBAF_DYNAMIC);
1949 }
1950
1951 if (bif->bif_ifp != ifp) {
1952 /* XXX loop prevention */
1953 m->m_flags |= M_PROTO1;
1954 new_ifp = bif->bif_ifp;
1955 }
1956 goto out;
1957 }
1958
1959 /* We just received a packet that we sent out. */
1960 if (memcmp(IF_LLADDR(bif->bif_ifp), eh->ether_shost,
1961 ETHER_ADDR_LEN) == 0) {
1962 m_freem(m);
1963 m = NULL;
1964 goto out;
1965 }
1966 }
1967
1968 /* Perform the bridge forwarding function. */
1969 bridge_forward(sc, m);
1970 m = NULL;
1971 out:
1972 lwkt_serialize_exit(bifp->if_serializer);
1973
1974 if (new_ifp != NULL) {
1975 lwkt_serialize_enter(new_ifp->if_serializer);
1976
1977 m->m_pkthdr.rcvif = new_ifp;
1978 new_ifp->if_ipackets++;
1979 new_ifp->if_input(new_ifp, m);
1980 m = NULL;
1981
1982 lwkt_serialize_exit(new_ifp->if_serializer);
1983 }
1984 return (m);
1985 }
1986
1987 /*
1988 * bridge_broadcast:
1989 *
1990 * Send a frame to all interfaces that are members of
1991 * the bridge, except for the one on which the packet
1992 * arrived.
1993 */
1994 static void
1995 bridge_broadcast(struct bridge_softc *sc, struct ifnet *src_if,
1996 struct mbuf *m, int runfilt)
1997 {
1998 struct bridge_iflist *bif;
1999 struct mbuf *mc;
2000 struct ifnet *dst_if, *bifp;
2001 int used = 0;
2002
2003 bifp = sc->sc_ifp;
2004
2005 ASSERT_SERIALIZED(bifp->if_serializer);
2006
2007 /* run the packet filter */
2008 if (runfilt && (inet_pfil_hook.ph_hashooks > 0
2009 #ifdef INET6
2010 || inet6_pfil_hook.ph_hashooks > 0
2011 #endif
2012 )) {
2013 lwkt_serialize_exit(bifp->if_serializer);
2014
2015 /* Filter on the bridge interface before broadcasting */
2016
2017 if (bridge_pfil(&m, bifp, src_if, PFIL_IN) != 0)
2018 goto filt;
2019 if (m == NULL)
2020 goto filt;
2021
2022 if (bridge_pfil(&m, bifp, NULL, PFIL_OUT) != 0)
2023 m = NULL;
2024 filt:
2025 lwkt_serialize_enter(bifp->if_serializer);
2026 if (m == NULL)
2027 return;
2028 }
2029
2030 LIST_FOREACH(bif, &sc->sc_iflist, bif_next) {
2031 dst_if = bif->bif_ifp;
2032 if (dst_if == src_if)
2033 continue;
2034
2035 if (bif->bif_flags & IFBIF_STP) {
2036 switch (bif->bif_state) {
2037 case BSTP_IFSTATE_BLOCKING:
2038 case BSTP_IFSTATE_DISABLED:
2039 continue;
2040 }
2041 }
2042
2043 if ((bif->bif_flags & IFBIF_DISCOVER) == 0 &&
2044 (m->m_flags & (M_BCAST|M_MCAST)) == 0)
2045 continue;
2046
2047 if ((dst_if->if_flags & IFF_RUNNING) == 0)
2048 continue;
2049
2050 if (LIST_NEXT(bif, bif_next) == NULL) {
2051 mc = m;
2052 used = 1;
2053 } else {
2054 mc = m_copypacket(m, MB_DONTWAIT);
2055 if (mc == NULL) {
2056 sc->sc_ifp->if_oerrors++;
2057 continue;
2058 }
2059 }
2060 bridge_pfil_enqueue(dst_if, mc, runfilt);
2061 }
2062 if (used == 0)
2063 m_freem(m);
2064 }
2065
2066 /*
2067 * bridge_span:
2068 *
2069 * Duplicate a packet out one or more interfaces that are in span mode,
2070 * the original mbuf is unmodified.
2071 */
2072 static void
2073 bridge_span(struct bridge_softc *sc, struct mbuf *m)
2074 {
2075 struct bridge_iflist *bif;
2076 struct ifnet *dst_if;
2077 struct mbuf *mc;
2078
2079 if (LIST_EMPTY(&sc->sc_spanlist))
2080 return;
2081
2082 LIST_FOREACH(bif, &sc->sc_spanlist, bif_next) {
2083 dst_if = bif->bif_ifp;
2084
2085 if ((dst_if->if_flags & IFF_RUNNING) == 0)
2086 continue;
2087
2088 mc = m_copypacket(m, MB_DONTWAIT);
2089 if (mc == NULL) {
2090 sc->sc_ifp->if_oerrors++;
2091 continue;
2092 }
2093
2094 bridge_enqueue(dst_if, mc);
2095 }
2096 }
2097
2098 /*
2099 * bridge_rtupdate:
2100 *
2101 * Add a bridge routing entry.
2102 * Can be called from interrupt context.
2103 */
2104 static int
2105 bridge_rtupdate(struct bridge_softc *sc, const uint8_t *dst,
2106 struct ifnet *dst_if, int setflags, uint8_t flags)
2107 {
2108 struct bridge_rtnode *brt;
2109 int error;
2110
2111 /*
2112 * A route for this destination might already exist. If so,
2113 * update it, otherwise create a new one.
2114 */
2115 if ((brt = bridge_rtnode_lookup(sc, dst)) == NULL) {
2116 if (sc->sc_brtcnt >= sc->sc_brtmax)
2117 return (ENOSPC);
2118
2119 /*
2120 * Allocate a new bridge forwarding node, and
2121 * initialize the expiration time and Ethernet
2122 * address.
2123 */
2124 brt = kmalloc(sizeof(struct bridge_rtnode), M_DEVBUF,
2125 M_INTNOWAIT|M_ZERO);
2126 if (brt == NULL)
2127 return (ENOMEM);
2128
2129 brt->brt_flags = IFBAF_DYNAMIC;
2130 memcpy(brt->brt_addr, dst, ETHER_ADDR_LEN);
2131
2132 if ((error = bridge_rtnode_insert(sc, brt)) != 0) {
2133 kfree(brt, M_DEVBUF);
2134 return (error);
2135 }
2136 }
2137
2138 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC)
2139 brt->brt_ifp = dst_if;
2140 if ((flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC)
2141 brt->brt_expire = time_second + sc->sc_brttimeout;
2142 if (setflags)
2143 brt->brt_flags = flags;
2144
2145 return (0);
2146 }
2147
2148 /*
2149 * bridge_rtlookup:
2150 *
2151 * Lookup the destination interface for an address.
2152 */
2153 static struct ifnet *
2154 bridge_rtlookup(struct bridge_softc *sc, const uint8_t *addr)
2155 {
2156 struct bridge_rtnode *brt;
2157
2158 if ((brt = bridge_rtnode_lookup(sc, addr)) == NULL)
2159 return (NULL);
2160
2161 return (brt->brt_ifp);
2162 }
2163
2164 /*
2165 * bridge_rttrim:
2166 *
2167 * Trim the routine table so that we have a number
2168 * of routing entries less than or equal to the
2169 * maximum number.
2170 */
2171 static void
2172 bridge_rttrim(struct bridge_softc *sc)
2173 {
2174 struct bridge_rtnode *brt, *nbrt;
2175
2176 /* Make sure we actually need to do this. */
2177 if (sc->sc_brtcnt <= sc->sc_brtmax)
2178 return;
2179
2180 /* Force an aging cycle; this might trim enough addresses. */
2181 bridge_rtage(sc);
2182 if (sc->sc_brtcnt <= sc->sc_brtmax)
2183 return;
2184
2185 for (brt = LIST_FIRST(&sc->sc_rtlist); brt != NULL; brt = nbrt) {
2186 nbrt = LIST_NEXT(brt, brt_list);
2187 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) {
2188 bridge_rtnode_destroy(sc, brt);
2189 if (sc->sc_brtcnt <= sc->sc_brtmax)
2190 return;
2191 }
2192 }
2193 }
2194
2195 /*
2196 * bridge_timer:
2197 *
2198 * Aging timer for the bridge.
2199 */
2200 static void
2201 bridge_timer(void *arg)
2202 {
2203 struct bridge_softc *sc = arg;
2204
2205 lwkt_serialize_enter(sc->sc_ifp->if_serializer);
2206
2207 bridge_rtage(sc);
2208
2209 if (sc->sc_ifp->if_flags & IFF_RUNNING)
2210 callout_reset(&sc->sc_brcallout,
2211 bridge_rtable_prune_period * hz, bridge_timer, sc);
2212
2213 lwkt_serialize_exit(sc->sc_ifp->if_serializer);
2214 }
2215
2216 /*
2217 * bridge_rtage:
2218 *
2219 * Perform an aging cycle.
2220 */
2221 static void
2222 bridge_rtage(struct bridge_softc *sc)
2223 {
2224 struct bridge_rtnode *brt, *nbrt;
2225
2226 for (brt = LIST_FIRST(&sc->sc_rtlist); brt != NULL; brt = nbrt) {
2227 nbrt = LIST_NEXT(brt, brt_list);
2228 if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) {
2229 if (time_second >= brt->brt_expire)
2230 bridge_rtnode_destroy(sc, brt);
2231 }
2232 }
2233 }
2234
2235 /*
2236 * bridge_rtflush:
2237 *
2238 * Remove all dynamic addresses from the bridge.
2239 */
2240 static void
2241 bridge_rtflush(struct bridge_softc *sc, int full)
2242 {
2243 struct bridge_rtnode *brt, *nbrt;
2244
2245 for (brt = LIST_FIRST(&sc->sc_rtlist); brt != NULL; brt = nbrt) {
2246 nbrt = LIST_NEXT(brt, brt_list);
2247 if (full || (brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC)
2248 bridge_rtnode_destroy(sc, brt);
2249 }
2250 }
2251
2252 /*
2253 * bridge_rtdaddr:
2254 *
2255 * Remove an address from the table.
2256 */
2257 static int
2258 bridge_rtdaddr(struct bridge_softc *sc, const uint8_t *addr)
2259 {
2260 struct bridge_rtnode *brt;
2261
2262 if ((brt = bridge_rtnode_lookup(sc, addr)) == NULL)
2263 return (ENOENT);
2264
2265 bridge_rtnode_destroy(sc, brt);
2266 return (0);
2267 }
2268
2269 /*
2270 * bridge_rtdelete:
2271 *
2272 * Delete routes to a speicifc member interface.
2273 */
2274 void
2275 bridge_rtdelete(struct bridge_softc *sc, struct ifnet *ifp, int full)
2276 {
2277 struct bridge_rtnode *brt, *nbrt;
2278
2279 for (brt = LIST_FIRST(&sc->sc_rtlist); brt != NULL; brt = nbrt) {
2280 nbrt = LIST_NEXT(brt, brt_list);
2281 if (brt->brt_ifp == ifp && (full ||
2282 (brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC))
2283 bridge_rtnode_destroy(sc, brt);
2284 }
2285 }
2286
2287 /*
2288 * bridge_rtable_init:
2289 *
2290 * Initialize the route table for this bridge.
2291 */
2292 static int
2293 bridge_rtable_init(struct bridge_softc *sc)
2294 {
2295 int i;
2296
2297 sc->sc_rthash = kmalloc(sizeof(*sc->sc_rthash) * BRIDGE_RTHASH_SIZE,
2298 M_DEVBUF, M_WAITOK);
2299
2300 for (i = 0; i < BRIDGE_RTHASH_SIZE; i++)
2301 LIST_INIT(&sc->sc_rthash[i]);
2302
2303 sc->sc_rthash_key = karc4random();
2304
2305 LIST_INIT(&sc->sc_rtlist);
2306
2307 return (0);
2308 }
2309
2310 /*
2311 * bridge_rtable_fini:
2312 *
2313 * Deconstruct the route table for this bridge.
2314 */
2315 static void
2316 bridge_rtable_fini(struct bridge_softc *sc)
2317 {
2318
2319 kfree(sc->sc_rthash, M_DEVBUF);
2320 }
2321
2322 /*
2323 * The following hash function is adapted from "Hash Functions" by Bob Jenkins
2324 * ("Algorithm Alley", Dr. Dobbs Journal, September 1997).
2325 */
2326 #define mix(a, b, c) \
2327 do { \
2328 a -= b; a -= c; a ^= (c >> 13); \
2329 b -= c; b -= a; b ^= (a << 8); \
2330 c -= a; c -= b; c ^= (b >> 13); \
2331 a -= b; a -= c; a ^= (c >> 12); \
2332 b -= c; b -= a; b ^= (a << 16); \
2333 c -= a; c -= b; c ^= (b >> 5); \
2334 a -= b; a -= c; a ^= (c >> 3); \
2335 b -= c; b -= a; b ^= (a << 10); \
2336 c -= a; c -= b; c ^= (b >> 15); \
2337 } while (/*CONSTCOND*/0)
2338
2339 static __inline uint32_t
2340 bridge_rthash(struct bridge_softc *sc, const uint8_t *addr)
2341 {
2342 uint32_t a = 0x9e3779b9, b = 0x9e3779b9, c = sc->sc_rthash_key;
2343
2344 b += addr[5] << 8;
2345 b += addr[4];
2346 a += addr[3] << 24;
2347 a += addr[2] << 16;
2348 a += addr[1] << 8;
2349 a += addr[0];
2350
2351 mix(a, b, c);
2352
2353 return (c & BRIDGE_RTHASH_MASK);
2354 }
2355
2356 #undef mix
2357
2358 static int
2359 bridge_rtnode_addr_cmp(const uint8_t *a, const uint8_t *b)
2360 {
2361 int i, d;
2362
2363 for (i = 0, d = 0; i < ETHER_ADDR_LEN && d == 0; i++) {
2364 d = ((int)a[i]) - ((int)b[i]);
2365 }
2366
2367 return (d);
2368 }
2369
2370 /*
2371 * bridge_rtnode_lookup:
2372 *
2373 * Look up a bridge route node for the specified destination.
2374 */
2375 static struct bridge_rtnode *
2376 bridge_rtnode_lookup(struct bridge_softc *sc, const uint8_t *addr)
2377 {
2378 struct bridge_rtnode *brt;
2379 uint32_t hash;
2380 int dir;
2381
2382 hash = bridge_rthash(sc, addr);
2383 LIST_FOREACH(brt, &sc->sc_rthash[hash], brt_hash) {
2384 dir = bridge_rtnode_addr_cmp(addr, brt->brt_addr);
2385 if (dir == 0)
2386 return (brt);
2387 if (dir > 0)
2388 return (NULL);
2389 }
2390
2391 return (NULL);
2392 }
2393
2394 /*
2395 * bridge_rtnode_insert:
2396 *
2397 * Insert the specified bridge node into the route table. We
2398 * assume the entry is not already in the table.
2399 */
2400 static int
2401 bridge_rtnode_insert(struct bridge_softc *sc, struct bridge_rtnode *brt)
2402 {
2403 struct bridge_rtnode *lbrt;
2404 uint32_t hash;
2405 int dir;
2406
2407 hash = bridge_rthash(sc, brt->brt_addr);
2408
2409 lbrt = LIST_FIRST(&sc->sc_rthash[hash]);
2410 if (lbrt == NULL) {
2411 LIST_INSERT_HEAD(&sc->sc_rthash[hash], brt, brt_hash);
2412 goto out;
2413 }
2414
2415 do {
2416 dir = bridge_rtnode_addr_cmp(brt->brt_addr, lbrt->brt_addr);
2417 if (dir == 0)
2418 return (EEXIST);
2419 if (dir > 0) {
2420 LIST_INSERT_BEFORE(lbrt, brt, brt_hash);
2421 goto out;
2422 }
2423 if (LIST_NEXT(lbrt, brt_hash) == NULL) {
2424 LIST_INSERT_AFTER(lbrt, brt, brt_hash);
2425 goto out;
2426 }
2427 lbrt = LIST_NEXT(lbrt, brt_hash);
2428 } while (lbrt != NULL);
2429
2430 #ifdef DIAGNOSTIC
2431 panic("bridge_rtnode_insert: impossible");
2432 #endif
2433
2434 out:
2435 LIST_INSERT_HEAD(&sc->sc_rtlist, brt, brt_list);
2436 sc->sc_brtcnt++;
2437
2438 return (0);
2439 }
2440
2441 /*
2442 * bridge_rtnode_destroy:
2443 *
2444 * Destroy a bridge rtnode.
2445 */
2446 static void
2447 bridge_rtnode_destroy(struct bridge_softc *sc, struct bridge_rtnode *brt)
2448 {
2449
2450 LIST_REMOVE(brt, brt_hash);
2451
2452 LIST_REMOVE(brt, brt_list);
2453 sc->sc_brtcnt--;
2454 kfree(brt, M_DEVBUF);
2455 }
2456
2457 /*
2458 * Send bridge packets through pfil if they are one of the types pfil can deal
2459 * with, or if they are ARP or REVARP. (pfil will pass ARP and REVARP without
2460 * question.) If *bifp or *ifp are NULL then packet filtering is skipped for
2461 * that interface.
2462 */
2463 static int
2464 bridge_pfil(struct mbuf **mp, struct ifnet *bifp, struct ifnet *ifp, int dir)
2465 {
2466 int snap, error, i, hlen;
2467 struct ether_header *eh1, eh2;
2468 struct ip *ip;
2469 struct llc llc1;
2470 u_int16_t ether_type;
2471
2472 snap = 0;
2473 error = -1; /* Default error if not error == 0 */
2474
2475 if (pfil_bridge == 0 && pfil_member == 0)
2476 return (0); /* filtering is disabled */
2477
2478 i = min((*mp)->m_pkthdr.len, max_protohdr);
2479 if ((*mp)->m_len < i) {
2480 *mp = m_pullup(*mp, i);
2481 if (*mp == NULL) {
2482 kprintf("%s: m_pullup failed\n", __func__);
2483 return (-1);
2484 }
2485 }
2486
2487 eh1 = mtod(*mp, struct ether_header *);
2488 ether_type = ntohs(eh1->ether_type);
2489
2490 /*
2491 * Check for SNAP/LLC.
2492 */
2493 if (ether_type < ETHERMTU) {
2494 struct llc *llc2 = (struct llc *)(eh1 + 1);
2495
2496 if ((*mp)->m_len >= ETHER_HDR_LEN + 8 &&
2497 llc2->llc_dsap == LLC_SNAP_LSAP &&
2498 llc2->llc_ssap == LLC_SNAP_LSAP &&
2499 llc2->llc_control == LLC_UI) {
2500 ether_type = htons(llc2->llc_un.type_snap.ether_type);
2501 snap = 1;
2502 }
2503 }
2504
2505 /*
2506 * If we're trying to filter bridge traffic, don't look at anything
2507 * other than IP and ARP traffic. If the filter doesn't understand
2508 * IPv6, don't allow IPv6 through the bridge either. This is lame
2509 * since if we really wanted, say, an AppleTalk filter, we are hosed,
2510 * but of course we don't have an AppleTalk filter to begin with.
2511 * (Note that since pfil doesn't understand ARP it will pass *ALL*
2512 * ARP traffic.)
2513 */
2514 switch (ether_type) {
2515 case ETHERTYPE_ARP:
2516 case ETHERTYPE_REVARP:
2517 return (0); /* Automatically pass */
2518 case ETHERTYPE_IP:
2519 #ifdef INET6
2520 case ETHERTYPE_IPV6:
2521 #endif /* INET6 */
2522 break;
2523 default:
2524 /*
2525 * Check to see if the user wants to pass non-ip
2526 * packets, these will not be checked by pfil(9) and
2527 * passed unconditionally so the default is to drop.
2528 */
2529 if (pfil_onlyip)
2530 goto bad;
2531 }
2532
2533 /* Strip off the Ethernet header and keep a copy. */
2534 m_copydata(*mp, 0, ETHER_HDR_LEN, (caddr_t) &eh2);
2535 m_adj(*mp, ETHER_HDR_LEN);
2536
2537 /* Strip off snap header, if present */
2538 if (snap) {
2539 m_copydata(*mp, 0, sizeof(struct llc), (caddr_t) &llc1);
2540 m_adj(*mp, sizeof(struct llc));
2541 }
2542
2543 /*
2544 * Check the IP header for alignment and errors
2545 */
2546 if (dir == PFIL_IN) {
2547 switch (ether_type) {
2548 case ETHERTYPE_IP:
2549 error = bridge_ip_checkbasic(mp);
2550 break;
2551 #ifdef INET6
2552 case ETHERTYPE_IPV6:
2553 error = bridge_ip6_checkbasic(mp);
2554 break;
2555 #endif /* INET6 */
2556 default:
2557 error = 0;
2558 }
2559 if (error)
2560 goto bad;
2561 }
2562
2563 error = 0;
2564
2565 /*
2566 * Run the packet through pfil
2567 */
2568 switch (ether_type)
2569 {
2570 case ETHERTYPE_IP :
2571 /*
2572 * before calling the firewall, swap fields the same as
2573 * IP does. here we assume the header is contiguous
2574 */
2575 ip = mtod(*mp, struct ip *);
2576
2577 ip->ip_len = ntohs(ip->ip_len);
2578 ip->ip_off = ntohs(ip->ip_off);
2579
2580 /*
2581 * Run pfil on the member interface and the bridge, both can
2582 * be skipped by clearing pfil_member or pfil_bridge.
2583 *
2584 * Keep the order:
2585 * in_if -> bridge_if -> out_if
2586 */
2587 if (pfil_bridge && dir == PFIL_OUT && bifp != NULL)
2588 error = pfil_run_hooks(&inet_pfil_hook, mp, bifp,
2589 dir);
2590
2591 if (*mp == NULL || error != 0) /* filter may consume */
2592 break;
2593
2594 if (pfil_member && ifp != NULL)
2595 error = pfil_run_hooks(&inet_pfil_hook, mp, ifp,
2596 dir);
2597
2598 if (*mp == NULL || error != 0) /* filter may consume */
2599 break;
2600
2601 if (pfil_bridge && dir == PFIL_IN && bifp != NULL)
2602 error = pfil_run_hooks(&inet_pfil_hook, mp, bifp,
2603 dir);
2604
2605 if (*mp == NULL || error != 0) /* filter may consume */
2606 break;
2607
2608 /* check if we need to fragment the packet */
2609 if (pfil_member && ifp != NULL && dir == PFIL_OUT) {
2610 i = (*mp)->m_pkthdr.len;
2611 if (i > ifp->if_mtu) {
2612 error = bridge_fragment(ifp, *mp, &eh2, snap,
2613 &llc1);
2614 return (error);
2615 }
2616 }
2617
2618 /* Recalculate the ip checksum and restore byte ordering */
2619 ip = mtod(*mp, struct ip *);
2620 hlen = ip->ip_hl << 2;
2621 if (hlen < sizeof(struct ip))
2622 goto bad;
2623 if (hlen > (*mp)->m_len) {
2624 if ((*mp = m_pullup(*mp, hlen)) == 0)
2625 goto bad;
2626 ip = mtod(*mp, struct ip *);
2627 if (ip == NULL)
2628 goto bad;
2629 }
2630 ip->ip_len = htons(ip->ip_len);
2631 ip->ip_off = htons(ip->ip_off);
2632 ip->ip_sum = 0;
2633 if (hlen == sizeof(struct ip))
2634 ip->ip_sum = in_cksum_hdr(ip);
2635 else
2636 ip->ip_sum = in_cksum(*mp, hlen);
2637
2638 break;
2639 #ifdef INET6
2640 case ETHERTYPE_IPV6 :
2641 if (pfil_bridge && dir == PFIL_OUT && bifp != NULL)
2642 error = pfil_run_hooks(&inet6_pfil_hook, mp, bifp,
2643 dir);
2644
2645 if (*mp == NULL || error != 0) /* filter may consume */
2646 break;
2647
2648 if (pfil_member && ifp != NULL)
2649 error = pfil_run_hooks(&inet6_pfil_hook, mp, ifp,
2650 dir);
2651
2652 if (*mp == NULL || error != 0) /* filter may consume */
2653 break;
2654
2655 if (pfil_bridge && dir == PFIL_IN && bifp != NULL)
2656 error = pfil_run_hooks(&inet6_pfil_hook, mp, bifp,
2657 dir);
2658 break;
2659 #endif
2660 default :
2661 error = 0;
2662 break;
2663 }
2664
2665 if (*mp == NULL)
2666 return (error);
2667 if (error != 0)
2668 goto bad;
2669
2670 error = -1;
2671
2672 /*
2673 * Finally, put everything back the way it was and return
2674 */
2675 if (snap) {
2676 M_PREPEND(*mp, sizeof(struct llc), MB_DONTWAIT);
2677 if (*mp == NULL)
2678 return (error);
2679 bcopy(&llc1, mtod(*mp, caddr_t), sizeof(struct llc));
2680 }
2681
2682 M_PREPEND(*mp, ETHER_HDR_LEN, MB_DONTWAIT);
2683 if (*mp == NULL)
2684 return (error);
2685 bcopy(&eh2, mtod(*mp, caddr_t), ETHER_HDR_LEN);
2686
2687 return (0);
2688
2689 bad:
2690 m_freem(*mp);
2691 *mp = NULL;
2692 return (error);
2693 }
2694
2695 /*
2696 * Perform basic checks on header size since
2697 * pfil assumes ip_input has already processed
2698 * it for it. Cut-and-pasted from ip_input.c.
2699 * Given how simple the IPv6 version is,
2700 * does the IPv4 version really need to be
2701 * this complicated?
2702 *
2703 * XXX Should we update ipstat here, or not?
2704 * XXX Right now we update ipstat but not
2705 * XXX csum_counter.
2706 */
2707 static int
2708 bridge_ip_checkbasic(struct mbuf **mp)
2709 {
2710 struct mbuf *m = *mp;
2711 struct ip *ip;
2712 int len, hlen;
2713 u_short sum;
2714
2715 if (*mp == NULL)
2716 return (-1);
2717 #if notyet
2718 if (IP_HDR_ALIGNED_P(mtod(m, caddr_t)) == 0) {
2719 if ((m = m_copyup(m, sizeof(struct ip),
2720 (max_linkhdr + 3) & ~3)) == NULL) {
2721 /* XXXJRT new stat, please */
2722 ipstat.ips_toosmall++;
2723 goto bad;
2724 }
2725 } else
2726 #endif
2727 #ifndef __predict_false
2728 #define __predict_false(x) x
2729 #endif
2730 if (__predict_false(m->m_len < sizeof (struct ip))) {
2731 if ((m = m_pullup(m, sizeof (struct ip))) == NULL) {
2732 ipstat.ips_toosmall++;
2733 goto bad;
2734 }
2735 }
2736 ip = mtod(m, struct ip *);
2737 if (ip == NULL) goto bad;
2738
2739 if (ip->ip_v != IPVERSION) {
2740 ipstat.ips_badvers++;
2741 goto bad;
2742 }
2743 hlen = ip->ip_hl << 2;
2744 if (hlen < sizeof(struct ip)) { /* minimum header length */
2745 ipstat.ips_badhlen++;
2746 goto bad;
2747 }
2748 if (hlen > m->m_len) {
2749 if ((m = m_pullup(m, hlen)) == 0) {
2750 ipstat.ips_badhlen++;
2751 goto bad;
2752 }
2753 ip = mtod(m, struct ip *);
2754 if (ip == NULL) goto bad;
2755 }
2756
2757 if (m->m_pkthdr.csum_flags & CSUM_IP_CHECKED) {
2758 sum = !(m->m_pkthdr.csum_flags & CSUM_IP_VALID);
2759 } else {
2760 if (hlen == sizeof(struct ip)) {
2761 sum = in_cksum_hdr(ip);
2762 } else {
2763 sum = in_cksum(m, hlen);
2764 }
2765 }
2766 if (sum) {
2767 ipstat.ips_badsum++;
2768 goto bad;
2769 }
2770
2771 /* Retrieve the packet length. */
2772 len = ntohs(ip->ip_len);
2773
2774 /*
2775 * Check for additional length bogosity
2776 */
2777 if (len < hlen) {
2778 ipstat.ips_badlen++;
2779 goto bad;
2780 }
2781
2782 /*
2783 * Check that the amount of data in the buffers
2784 * is as at least much as the IP header would have us expect.
2785 * Drop packet if shorter than we expect.
2786 */
2787 if (m->m_pkthdr.len < len) {
2788 ipstat.ips_tooshort++;
2789 goto bad;
2790 }
2791
2792 /* Checks out, proceed */
2793 *mp = m;
2794 return (0);
2795
2796 bad:
2797 *mp = m;
2798 return (-1);
2799 }
2800
2801 #ifdef INET6
2802 /*
2803 * Same as above, but for IPv6.
2804 * Cut-and-pasted from ip6_input.c.
2805 * XXX Should we update ip6stat, or not?
2806 */
2807 static int
2808 bridge_ip6_checkbasic(struct mbuf **mp)
2809 {
2810 struct mbuf *m = *mp;
2811 struct ip6_hdr *ip6;
2812
2813 /*
2814 * If the IPv6 header is not aligned, slurp it up into a new
2815 * mbuf with space for link headers, in the event we forward
2816 * it. Otherwise, if it is aligned, make sure the entire base
2817 * IPv6 header is in the first mbuf of the chain.
2818 */
2819 #if notyet
2820 if (IP6_HDR_ALIGNED_P(mtod(m, caddr_t)) == 0) {
2821 struct ifnet *inifp = m->m_pkthdr.rcvif;
2822 if ((m = m_copyup(m, sizeof(struct ip6_hdr),
2823 (max_linkhdr + 3) & ~3)) == NULL) {
2824 /* XXXJRT new stat, please */
2825 ip6stat.ip6s_toosmall++;
2826 in6_ifstat_inc(inifp, ifs6_in_hdrerr);
2827 goto bad;
2828 }
2829 } else
2830 #endif
2831 if (__predict_false(m->m_len < sizeof(struct ip6_hdr))) {
2832 struct ifnet *inifp = m->m_pkthdr.rcvif;
2833 if ((m = m_pullup(m, sizeof(struct ip6_hdr))) == NULL) {
2834 ip6stat.ip6s_toosmall++;
2835 in6_ifstat_inc(inifp, ifs6_in_hdrerr);
2836 goto bad;
2837 }
2838 }
2839
2840 ip6 = mtod(m, struct ip6_hdr *);
2841
2842 if ((ip6->ip6_vfc & IPV6_VERSION_MASK) != IPV6_VERSION) {
2843 ip6stat.ip6s_badvers++;
2844 in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_hdrerr);
2845 goto bad;
2846 }
2847
2848 /* Checks out, proceed */
2849 *mp = m;
2850 return (0);
2851
2852 bad:
2853 *mp = m;
2854 return (-1);
2855 }
2856 #endif /* INET6 */
2857
2858 /*
2859 * bridge_fragment:
2860 *
2861 * Return a fragmented mbuf chain.
2862 */
2863 static int
2864 bridge_fragment(struct ifnet *ifp, struct mbuf *m, struct ether_header *eh,
2865 int snap, struct llc *llc)
2866 {
2867 struct mbuf *m0;
2868 struct ip *ip;
2869 int error = -1;
2870
2871 if (m->m_len < sizeof(struct ip) &&
2872 (m = m_pullup(m, sizeof(struct ip))) == NULL)
2873 goto out;
2874 ip = mtod(m, struct ip *);
2875
2876 error = ip_fragment(ip, &m, ifp->if_mtu, ifp->if_hwassist,
2877 CSUM_DELAY_IP);
2878 if (error)
2879 goto out;
2880
2881 /* walk the chain and re-add the Ethernet header */
2882 for (m0 = m; m0; m0 = m0->m_nextpkt) {
2883 if (error == 0) {
2884 if (snap) {
2885 M_PREPEND(m0, sizeof(struct llc), MB_DONTWAIT);
2886 if (m0 == NULL) {
2887 error = ENOBUFS;
2888 continue;
2889 }
2890 bcopy(llc, mtod(m0, caddr_t),
2891 sizeof(struct llc));
2892 }
2893 M_PREPEND(m0, ETHER_HDR_LEN, MB_DONTWAIT);
2894 if (m0 == NULL) {
2895 error = ENOBUFS;
2896 continue;
2897 }
2898 bcopy(eh, mtod(m0, caddr_t), ETHER_HDR_LEN);
2899 } else
2900 m_freem(m);
2901 }
2902
2903 if (error == 0)
2904 ipstat.ips_fragmented++;
2905
2906 return (error);
2907
2908 out:
2909 if (m != NULL)
2910 m_freem(m);
2911 return (error);
2912 }
2913
2914 static void
2915 bridge_enqueue_handler(struct netmsg *nmsg)
2916 {
2917 struct netmsg_packet *nmp;
2918 struct ifnet *dst_ifp;
2919 struct mbuf *m;
2920
2921 nmp = (struct netmsg_packet *)nmsg;
2922 m = nmp->nm_packet;
2923 dst_ifp = nmp->nm_netmsg.nm_lmsg.u.ms_resultp;
2924
2925 bridge_handoff_notags(dst_ifp, m);
2926 }
2927
2928 static void
2929 bridge_pfil_enqueue_handler(struct netmsg *nmsg)
2930 {
2931 struct netmsg_packet *nmp;
2932 struct ifnet *dst_ifp;
2933 struct mbuf *m;
2934
2935 nmp = (struct netmsg_packet *)nmsg;
2936 m = nmp->nm_packet;
2937 dst_ifp = nmp->nm_netmsg.nm_lmsg.u.ms_resultp;
2938
2939 /*
2940 * Filter on the output interface. Pass a NULL bridge interface
2941 * pointer so we do not redundantly filter on the bridge for
2942 * each interface we broadcast on.
2943 */
2944 if (inet_pfil_hook.ph_hashooks > 0
2945 #ifdef INET6
2946 || inet6_pfil_hook.ph_hashooks > 0
2947 #endif
2948 ) {
2949 if (bridge_pfil(&m, NULL, dst_ifp, PFIL_OUT) != 0)
2950 return;
2951 if (m == NULL)
2952 return;
2953 }
2954 bridge_handoff_notags(dst_ifp, m);
2955 }
2956
2957 static void
2958 bridge_handoff(struct ifnet *dst_ifp, struct mbuf *m)
2959 {
2960 bridge_handoff_notags(dst_ifp, m);
2961 }
2962
2963 static void
2964 bridge_handoff_notags(struct ifnet *dst_ifp, struct mbuf *m)
2965 {
2966 struct mbuf *m0;
2967
2968 lwkt_serialize_enter(dst_ifp->if_serializer);
2969
2970 /* We may be sending a fragment so traverse the mbuf */
2971 for (; m; m = m0) {
2972 struct altq_pktattr pktattr;
2973
2974 m0 = m->m_nextpkt;
2975 m->m_nextpkt = NULL;
2976
2977 if (ifq_is_enabled(&dst_ifp->if_snd))
2978 altq_etherclassify(&dst_ifp->if_snd, m, &pktattr);
2979
2980 ifq_handoff(dst_ifp, m, &pktattr);
2981 }
2982
2983 lwkt_serialize_exit(dst_ifp->if_serializer);
2984 }
2985
2986 struct netmsg_brgctl {
2987 struct netmsg bc_nmsg;
2988 bridge_ctl_t bc_func;
2989 struct bridge_softc *bc_sc;
2990 void *bc_arg;
2991 };
2992
2993 static void
2994 bridge_control_dispatch(struct netmsg *nmsg)
2995 {
2996 struct netmsg_brgctl *bc_msg = (struct netmsg_brgctl *)nmsg;
2997 struct ifnet *bifp = bc_msg->bc_sc->sc_ifp;
2998 int error;
2999
3000 lwkt_serialize_enter(bifp->if_serializer);
3001 error = bc_msg->bc_func(bc_msg->bc_sc, bc_msg->bc_arg);
3002 lwkt_serialize_exit(bifp->if_serializer);
3003
3004 lwkt_replymsg(&nmsg->nm_lmsg, error);
3005 }
3006
3007 static int
3008 bridge_control(struct bridge_softc *sc, u_long cmd,
3009 bridge_ctl_t bc_func, void *bc_arg)
3010 {
3011 struct ifnet *bifp = sc->sc_ifp;
3012 struct netmsg_brgctl bc_msg;
3013 struct netmsg *nmsg;
3014 int error;
3015
3016 ASSERT_SERIALIZED(bifp->if_serializer);
3017
3018 if (cmd == SIOCGDRVSPEC) {
3019 /*
3020 * Don't dispatch 'get' ioctl to netisr0;
3021 * there are copyouts down deep inside
3022 * specific bridge ioctl functions.
3023 */
3024 return bc_func(sc, bc_arg);
3025 }
3026
3027 bzero(&bc_msg, sizeof(bc_msg));
3028 nmsg = &bc_msg.bc_nmsg;
3029
3030 netmsg_init(nmsg, &curthread->td_msgport, 0, bridge_control_dispatch);
3031 bc_msg.bc_func = bc_func;
3032 bc_msg.bc_sc = sc;
3033 bc_msg.bc_arg = bc_arg;
3034
3035 lwkt_serialize_exit(bifp->if_serializer);
3036 error = lwkt_domsg(cpu_portfn(0), &nmsg->nm_lmsg, 0);
3037 lwkt_serialize_enter(bifp->if_serializer);
3038 return error;
3039 }
MP support for (parts of) the network stack