if: Move IFF_OACTIVE bit into ifaltq; prepare multiple TX queues support
[dragonfly.git] / sys / net / bridge / if_bridge.c
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  */
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  * Bridge's route information is duplicated to each CPUs:
83  *
84  *      CPU0          CPU1          CPU2          CPU3
85  * +-----------+ +-----------+ +-----------+ +-----------+
86  * |  rtnode   | |  rtnode   | |  rtnode   | |  rtnode   |
87  * |           | |           | |           | |           |
88  * | dst eaddr | | dst eaddr | | dst eaddr | | dst eaddr |
89  * +-----------+ +-----------+ +-----------+ +-----------+
90  *       |         |                     |         |
91  *       |         |                     |         |
92  *       |         |     +----------+    |         |
93  *       |         |     |  rtinfo  |    |         |
94  *       |         +---->|          |<---+         |
95  *       |               |  flags   |              |
96  *       +-------------->|  timeout |<-------------+
97  *                       |  dst_ifp |
98  *                       +----------+
99  *
100  * We choose to put timeout and dst_ifp into shared part, so updating
101  * them will be cheaper than using message forwarding.  Also there is
102  * not need to use spinlock to protect the updating: timeout and dst_ifp
103  * is not related and specific field's updating order has no importance.
104  * The cache pollution by the share part should not be heavy: in a stable
105  * setup, dst_ifp probably will be not changed in rtnode's life time,
106  * while timeout is refreshed once per second; most of the time, timeout
107  * and dst_ifp are read-only accessed.
108  *
109  *
110  * Bridge route information installation on bridge_input path:
111  *
112  *      CPU0           CPU1         CPU2          CPU3
113  *
114  *                               tcp_thread2
115  *                                    |
116  *                                alloc nmsg
117  *                    snd nmsg        |
118  *                    w/o rtinfo      |
119  *      ifnet0<-----------------------+
120  *        |                           :
121  *    lookup dst                      :
122  *   rtnode exists?(Y)free nmsg       :
123  *        |(N)                        :
124  *        |
125  *  alloc rtinfo
126  *  alloc rtnode
127  * install rtnode
128  *        |
129  *        +---------->ifnet1
130  *        : fwd nmsg    |
131  *        : w/ rtinfo   |
132  *        :             |
133  *        :             |
134  *                 alloc rtnode
135  *               (w/ nmsg's rtinfo)
136  *                install rtnode
137  *                      |
138  *                      +---------->ifnet2
139  *                      : fwd nmsg    |
140  *                      : w/ rtinfo   |
141  *                      :             |
142  *                      :         same as ifnet1
143  *                                    |
144  *                                    +---------->ifnet3
145  *                                    : fwd nmsg    |
146  *                                    : w/ rtinfo   |
147  *                                    :             |
148  *                                    :         same as ifnet1
149  *                                               free nmsg
150  *                                                  :
151  *                                                  :
152  *
153  * The netmsgs forwarded between protocol threads and ifnet threads are
154  * allocated with (M_WAITOK|M_NULLOK), so it will not fail under most
155  * cases (route information is too precious to be not installed :).
156  * Since multiple threads may try to install route information for the
157  * same dst eaddr, we look up route information in ifnet0.  However, this
158  * looking up only need to be performed on ifnet0, which is the start
159  * point of the route information installation process.
160  *
161  *
162  * Bridge route information deleting/flushing:
163  *
164  *  CPU0            CPU1             CPU2             CPU3
165  *
166  * netisr0
167  *   |
168  * find suitable rtnodes,
169  * mark their rtinfo dead
170  *   |
171  *   | domsg <------------------------------------------+
172  *   |                                                  | replymsg
173  *   |                                                  |
174  *   V     fwdmsg           fwdmsg           fwdmsg     |
175  * ifnet0 --------> ifnet1 --------> ifnet2 --------> ifnet3
176  * delete rtnodes   delete rtnodes   delete rtnodes   delete rtnodes
177  * w/ dead rtinfo   w/ dead rtinfo   w/ dead rtinfo   w/ dead rtinfo
178  *                                                    free dead rtinfos
179  *
180  * All deleting/flushing operations are serialized by netisr0, so each
181  * operation only reaps the route information marked dead by itself.
182  *
183  *
184  * Bridge route information adding/deleting/flushing:
185  * Since all operation is serialized by the fixed message flow between
186  * ifnet threads, it is not possible to create corrupted per-cpu route
187  * information.
188  *
189  *
190  *
191  * Percpu member interface list iteration with blocking operation:
192  * Since one bridge could only delete one member interface at a time and
193  * the deleted member interface is not freed after netmsg_service_sync(),
194  * following way is used to make sure that even if the certain member
195  * interface is ripped from the percpu list during the blocking operation,
196  * the iteration still could keep going:
197  *
198  * TAILQ_FOREACH_MUTABLE(bif, sc->sc_iflists[mycpuid], bif_next, nbif) {
199  *     blocking operation;
200  *     blocking operation;
201  *     ...
202  *     ...
203  *     if (nbif != NULL && !nbif->bif_onlist) {
204  *         KKASSERT(bif->bif_onlist);
205  *         nbif = TAILQ_NEXT(bif, bif_next);
206  *     }
207  * }
208  *
209  * As mentioned above only one member interface could be unlinked from the
210  * percpu member interface list, so either bif or nbif may be not on the list,
211  * but _not_ both.  To keep the list iteration, we don't care about bif, but
212  * only nbif.  Since removed member interface will only be freed after we
213  * finish our work, it is safe to access any field in an unlinked bif (here
214  * bif_onlist).  If nbif is no longer on the list, then bif must be on the
215  * list, so we change nbif to the next element of bif and keep going.
216  */
217
218 #include "opt_inet.h"
219 #include "opt_inet6.h"
220
221 #include <sys/param.h>
222 #include <sys/mbuf.h>
223 #include <sys/malloc.h>
224 #include <sys/protosw.h>
225 #include <sys/systm.h>
226 #include <sys/time.h>
227 #include <sys/socket.h> /* for net/if.h */
228 #include <sys/sockio.h>
229 #include <sys/ctype.h>  /* string functions */
230 #include <sys/kernel.h>
231 #include <sys/random.h>
232 #include <sys/sysctl.h>
233 #include <sys/module.h>
234 #include <sys/proc.h>
235 #include <sys/priv.h>
236 #include <sys/lock.h>
237 #include <sys/thread.h>
238 #include <sys/thread2.h>
239 #include <sys/mpipe.h>
240
241 #include <net/bpf.h>
242 #include <net/if.h>
243 #include <net/if_dl.h>
244 #include <net/if_types.h>
245 #include <net/if_var.h>
246 #include <net/pfil.h>
247 #include <net/ifq_var.h>
248 #include <net/if_clone.h>
249
250 #include <netinet/in.h> /* for struct arpcom */
251 #include <netinet/in_systm.h>
252 #include <netinet/in_var.h>
253 #include <netinet/ip.h>
254 #include <netinet/ip_var.h>
255 #ifdef INET6
256 #include <netinet/ip6.h>
257 #include <netinet6/ip6_var.h>
258 #endif
259 #include <netinet/if_ether.h> /* for struct arpcom */
260 #include <net/bridge/if_bridgevar.h>
261 #include <net/if_llc.h>
262 #include <net/netmsg2.h>
263
264 #include <net/route.h>
265 #include <sys/in_cksum.h>
266
267 /*
268  * Size of the route hash table.  Must be a power of two.
269  */
270 #ifndef BRIDGE_RTHASH_SIZE
271 #define BRIDGE_RTHASH_SIZE              1024
272 #endif
273
274 #define BRIDGE_RTHASH_MASK              (BRIDGE_RTHASH_SIZE - 1)
275
276 /*
277  * Maximum number of addresses to cache.
278  */
279 #ifndef BRIDGE_RTABLE_MAX
280 #define BRIDGE_RTABLE_MAX               100
281 #endif
282
283 /*
284  * Spanning tree defaults.
285  */
286 #define BSTP_DEFAULT_MAX_AGE            (20 * 256)
287 #define BSTP_DEFAULT_HELLO_TIME         (2 * 256)
288 #define BSTP_DEFAULT_FORWARD_DELAY      (15 * 256)
289 #define BSTP_DEFAULT_HOLD_TIME          (1 * 256)
290 #define BSTP_DEFAULT_BRIDGE_PRIORITY    0x8000
291 #define BSTP_DEFAULT_PORT_PRIORITY      0x80
292 #define BSTP_DEFAULT_PATH_COST          55
293
294 /*
295  * Timeout (in seconds) for entries learned dynamically.
296  */
297 #ifndef BRIDGE_RTABLE_TIMEOUT
298 #define BRIDGE_RTABLE_TIMEOUT           (20 * 60)       /* same as ARP */
299 #endif
300
301 /*
302  * Number of seconds between walks of the route list.
303  */
304 #ifndef BRIDGE_RTABLE_PRUNE_PERIOD
305 #define BRIDGE_RTABLE_PRUNE_PERIOD      (5 * 60)
306 #endif
307
308 /*
309  * List of capabilities to mask on the member interface.
310  */
311 #define BRIDGE_IFCAPS_MASK              IFCAP_TXCSUM
312
313 typedef int     (*bridge_ctl_t)(struct bridge_softc *, void *);
314
315 struct netmsg_brctl {
316         struct netmsg_base      base;
317         bridge_ctl_t            bc_func;
318         struct bridge_softc     *bc_sc;
319         void                    *bc_arg;
320 };
321
322 struct netmsg_brsaddr {
323         struct netmsg_base      base;
324         struct bridge_softc     *br_softc;
325         struct ifnet            *br_dst_if;
326         struct bridge_rtinfo    *br_rtinfo;
327         int                     br_setflags;
328         uint8_t                 br_dst[ETHER_ADDR_LEN];
329         uint8_t                 br_flags;
330 };
331
332 struct netmsg_braddbif {
333         struct netmsg_base      base;
334         struct bridge_softc     *br_softc;
335         struct bridge_ifinfo    *br_bif_info;
336         struct ifnet            *br_bif_ifp;
337 };
338
339 struct netmsg_brdelbif {
340         struct netmsg_base      base;
341         struct bridge_softc     *br_softc;
342         struct bridge_ifinfo    *br_bif_info;
343         struct bridge_iflist_head *br_bif_list;
344 };
345
346 struct netmsg_brsflags {
347         struct netmsg_base      base;
348         struct bridge_softc     *br_softc;
349         struct bridge_ifinfo    *br_bif_info;
350         uint32_t                br_bif_flags;
351 };
352
353 eventhandler_tag        bridge_detach_cookie = NULL;
354
355 extern  struct mbuf *(*bridge_input_p)(struct ifnet *, struct mbuf *);
356 extern  int (*bridge_output_p)(struct ifnet *, struct mbuf *);
357 extern  void (*bridge_dn_p)(struct mbuf *, struct ifnet *);
358 extern  struct ifnet *(*bridge_interface_p)(void *if_bridge);
359
360 static int      bridge_rtable_prune_period = BRIDGE_RTABLE_PRUNE_PERIOD;
361
362 static int      bridge_clone_create(struct if_clone *, int, caddr_t);
363 static int      bridge_clone_destroy(struct ifnet *);
364
365 static int      bridge_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
366 static void     bridge_mutecaps(struct bridge_ifinfo *, struct ifnet *, int);
367 static void     bridge_ifdetach(void *, struct ifnet *);
368 static void     bridge_init(void *);
369 static int      bridge_from_us(struct bridge_softc *, struct ether_header *);
370 static void     bridge_stop(struct ifnet *);
371 static void     bridge_start(struct ifnet *);
372 static struct mbuf *bridge_input(struct ifnet *, struct mbuf *);
373 static int      bridge_output(struct ifnet *, struct mbuf *);
374 static struct ifnet *bridge_interface(void *if_bridge);
375
376 static void     bridge_forward(struct bridge_softc *, struct mbuf *m);
377
378 static void     bridge_timer_handler(netmsg_t);
379 static void     bridge_timer(void *);
380
381 static void     bridge_start_bcast(struct bridge_softc *, struct mbuf *);
382 static void     bridge_broadcast(struct bridge_softc *, struct ifnet *,
383                     struct mbuf *);
384 static void     bridge_span(struct bridge_softc *, struct mbuf *);
385
386 static int      bridge_rtupdate(struct bridge_softc *, const uint8_t *,
387                     struct ifnet *, uint8_t);
388 static struct ifnet *bridge_rtlookup(struct bridge_softc *, const uint8_t *);
389 static void     bridge_rtreap(struct bridge_softc *);
390 static void     bridge_rtreap_async(struct bridge_softc *);
391 static void     bridge_rttrim(struct bridge_softc *);
392 static int      bridge_rtage_finddead(struct bridge_softc *);
393 static void     bridge_rtage(struct bridge_softc *);
394 static void     bridge_rtflush(struct bridge_softc *, int);
395 static int      bridge_rtdaddr(struct bridge_softc *, const uint8_t *);
396 static int      bridge_rtsaddr(struct bridge_softc *, const uint8_t *,
397                     struct ifnet *, uint8_t);
398 static void     bridge_rtmsg_sync(struct bridge_softc *sc);
399 static void     bridge_rtreap_handler(netmsg_t);
400 static void     bridge_rtinstall_handler(netmsg_t);
401 static int      bridge_rtinstall_oncpu(struct bridge_softc *, const uint8_t *,
402                     struct ifnet *, int, uint8_t, struct bridge_rtinfo **);
403
404 static void     bridge_rtable_init(struct bridge_softc *);
405 static void     bridge_rtable_fini(struct bridge_softc *);
406
407 static int      bridge_rtnode_addr_cmp(const uint8_t *, const uint8_t *);
408 static struct bridge_rtnode *bridge_rtnode_lookup(struct bridge_softc *,
409                     const uint8_t *);
410 static void     bridge_rtnode_insert(struct bridge_softc *,
411                     struct bridge_rtnode *);
412 static void     bridge_rtnode_destroy(struct bridge_softc *,
413                     struct bridge_rtnode *);
414
415 static struct bridge_iflist *bridge_lookup_member(struct bridge_softc *,
416                     const char *name);
417 static struct bridge_iflist *bridge_lookup_member_if(struct bridge_softc *,
418                     struct ifnet *ifp);
419 static struct bridge_iflist *bridge_lookup_member_ifinfo(struct bridge_softc *,
420                     struct bridge_ifinfo *);
421 static void     bridge_delete_member(struct bridge_softc *,
422                     struct bridge_iflist *, int);
423 static void     bridge_delete_span(struct bridge_softc *,
424                     struct bridge_iflist *);
425
426 static int      bridge_control(struct bridge_softc *, u_long,
427                                bridge_ctl_t, void *);
428 static int      bridge_ioctl_init(struct bridge_softc *, void *);
429 static int      bridge_ioctl_stop(struct bridge_softc *, void *);
430 static int      bridge_ioctl_add(struct bridge_softc *, void *);
431 static int      bridge_ioctl_del(struct bridge_softc *, void *);
432 static void     bridge_ioctl_fillflags(struct bridge_softc *sc,
433                                 struct bridge_iflist *bif, struct ifbreq *req);
434 static int      bridge_ioctl_gifflags(struct bridge_softc *, void *);
435 static int      bridge_ioctl_sifflags(struct bridge_softc *, void *);
436 static int      bridge_ioctl_scache(struct bridge_softc *, void *);
437 static int      bridge_ioctl_gcache(struct bridge_softc *, void *);
438 static int      bridge_ioctl_gifs(struct bridge_softc *, void *);
439 static int      bridge_ioctl_rts(struct bridge_softc *, void *);
440 static int      bridge_ioctl_saddr(struct bridge_softc *, void *);
441 static int      bridge_ioctl_sto(struct bridge_softc *, void *);
442 static int      bridge_ioctl_gto(struct bridge_softc *, void *);
443 static int      bridge_ioctl_daddr(struct bridge_softc *, void *);
444 static int      bridge_ioctl_flush(struct bridge_softc *, void *);
445 static int      bridge_ioctl_gpri(struct bridge_softc *, void *);
446 static int      bridge_ioctl_spri(struct bridge_softc *, void *);
447 static int      bridge_ioctl_reinit(struct bridge_softc *, void *);
448 static int      bridge_ioctl_ght(struct bridge_softc *, void *);
449 static int      bridge_ioctl_sht(struct bridge_softc *, void *);
450 static int      bridge_ioctl_gfd(struct bridge_softc *, void *);
451 static int      bridge_ioctl_sfd(struct bridge_softc *, void *);
452 static int      bridge_ioctl_gma(struct bridge_softc *, void *);
453 static int      bridge_ioctl_sma(struct bridge_softc *, void *);
454 static int      bridge_ioctl_sifprio(struct bridge_softc *, void *);
455 static int      bridge_ioctl_sifcost(struct bridge_softc *, void *);
456 static int      bridge_ioctl_addspan(struct bridge_softc *, void *);
457 static int      bridge_ioctl_delspan(struct bridge_softc *, void *);
458 static int      bridge_ioctl_sifbondwght(struct bridge_softc *, void *);
459 static int      bridge_pfil(struct mbuf **, struct ifnet *, struct ifnet *,
460                     int);
461 static int      bridge_ip_checkbasic(struct mbuf **mp);
462 #ifdef INET6
463 static int      bridge_ip6_checkbasic(struct mbuf **mp);
464 #endif /* INET6 */
465 static int      bridge_fragment(struct ifnet *, struct mbuf *,
466                     struct ether_header *, int, struct llc *);
467 static void     bridge_enqueue_handler(netmsg_t);
468 static void     bridge_handoff(struct bridge_softc *, struct ifnet *,
469                     struct mbuf *, int);
470
471 static void     bridge_del_bif_handler(netmsg_t);
472 static void     bridge_add_bif_handler(netmsg_t);
473 static void     bridge_del_bif(struct bridge_softc *, struct bridge_ifinfo *,
474                     struct bridge_iflist_head *);
475 static void     bridge_add_bif(struct bridge_softc *, struct bridge_ifinfo *,
476                     struct ifnet *);
477
478 SYSCTL_DECL(_net_link);
479 SYSCTL_NODE(_net_link, IFT_BRIDGE, bridge, CTLFLAG_RW, 0, "Bridge");
480
481 static int pfil_onlyip = 1; /* only pass IP[46] packets when pfil is enabled */
482 static int pfil_bridge = 1; /* run pfil hooks on the bridge interface */
483 static int pfil_member = 1; /* run pfil hooks on the member interface */
484 static int bridge_debug;
485 SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_onlyip, CTLFLAG_RW,
486     &pfil_onlyip, 0, "Only pass IP packets when pfil is enabled");
487 SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_bridge, CTLFLAG_RW,
488     &pfil_bridge, 0, "Packet filter on the bridge interface");
489 SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_member, CTLFLAG_RW,
490     &pfil_member, 0, "Packet filter on the member interface");
491 SYSCTL_INT(_net_link_bridge, OID_AUTO, debug, CTLFLAG_RW,
492     &bridge_debug, 0, "Bridge debug mode");
493
494 struct bridge_control_arg {
495         union {
496                 struct ifbreq ifbreq;
497                 struct ifbifconf ifbifconf;
498                 struct ifbareq ifbareq;
499                 struct ifbaconf ifbaconf;
500                 struct ifbrparam ifbrparam;
501         } bca_u;
502         int     bca_len;
503         void    *bca_uptr;
504         void    *bca_kptr;
505 };
506
507 struct bridge_control {
508         bridge_ctl_t    bc_func;
509         int             bc_argsize;
510         int             bc_flags;
511 };
512
513 #define BC_F_COPYIN             0x01    /* copy arguments in */
514 #define BC_F_COPYOUT            0x02    /* copy arguments out */
515 #define BC_F_SUSER              0x04    /* do super-user check */
516
517 const struct bridge_control bridge_control_table[] = {
518         { bridge_ioctl_add,             sizeof(struct ifbreq),
519           BC_F_COPYIN|BC_F_SUSER },
520         { bridge_ioctl_del,             sizeof(struct ifbreq),
521           BC_F_COPYIN|BC_F_SUSER },
522
523         { bridge_ioctl_gifflags,        sizeof(struct ifbreq),
524           BC_F_COPYIN|BC_F_COPYOUT },
525         { bridge_ioctl_sifflags,        sizeof(struct ifbreq),
526           BC_F_COPYIN|BC_F_SUSER },
527
528         { bridge_ioctl_scache,          sizeof(struct ifbrparam),
529           BC_F_COPYIN|BC_F_SUSER },
530         { bridge_ioctl_gcache,          sizeof(struct ifbrparam),
531           BC_F_COPYOUT },
532
533         { bridge_ioctl_gifs,            sizeof(struct ifbifconf),
534           BC_F_COPYIN|BC_F_COPYOUT },
535         { bridge_ioctl_rts,             sizeof(struct ifbaconf),
536           BC_F_COPYIN|BC_F_COPYOUT },
537
538         { bridge_ioctl_saddr,           sizeof(struct ifbareq),
539           BC_F_COPYIN|BC_F_SUSER },
540
541         { bridge_ioctl_sto,             sizeof(struct ifbrparam),
542           BC_F_COPYIN|BC_F_SUSER },
543         { bridge_ioctl_gto,             sizeof(struct ifbrparam),
544           BC_F_COPYOUT },
545
546         { bridge_ioctl_daddr,           sizeof(struct ifbareq),
547           BC_F_COPYIN|BC_F_SUSER },
548
549         { bridge_ioctl_flush,           sizeof(struct ifbreq),
550           BC_F_COPYIN|BC_F_SUSER },
551
552         { bridge_ioctl_gpri,            sizeof(struct ifbrparam),
553           BC_F_COPYOUT },
554         { bridge_ioctl_spri,            sizeof(struct ifbrparam),
555           BC_F_COPYIN|BC_F_SUSER },
556
557         { bridge_ioctl_ght,             sizeof(struct ifbrparam),
558           BC_F_COPYOUT },
559         { bridge_ioctl_sht,             sizeof(struct ifbrparam),
560           BC_F_COPYIN|BC_F_SUSER },
561
562         { bridge_ioctl_gfd,             sizeof(struct ifbrparam),
563           BC_F_COPYOUT },
564         { bridge_ioctl_sfd,             sizeof(struct ifbrparam),
565           BC_F_COPYIN|BC_F_SUSER },
566
567         { bridge_ioctl_gma,             sizeof(struct ifbrparam),
568           BC_F_COPYOUT },
569         { bridge_ioctl_sma,             sizeof(struct ifbrparam),
570           BC_F_COPYIN|BC_F_SUSER },
571
572         { bridge_ioctl_sifprio,         sizeof(struct ifbreq),
573           BC_F_COPYIN|BC_F_SUSER },
574
575         { bridge_ioctl_sifcost,         sizeof(struct ifbreq),
576           BC_F_COPYIN|BC_F_SUSER },
577
578         { bridge_ioctl_addspan,         sizeof(struct ifbreq),
579           BC_F_COPYIN|BC_F_SUSER },
580         { bridge_ioctl_delspan,         sizeof(struct ifbreq),
581           BC_F_COPYIN|BC_F_SUSER },
582
583         { bridge_ioctl_sifbondwght,     sizeof(struct ifbreq),
584           BC_F_COPYIN|BC_F_SUSER },
585
586 };
587 static const int bridge_control_table_size = NELEM(bridge_control_table);
588
589 LIST_HEAD(, bridge_softc) bridge_list;
590
591 struct if_clone bridge_cloner = IF_CLONE_INITIALIZER("bridge",
592                                 bridge_clone_create,
593                                 bridge_clone_destroy, 0, IF_MAXUNIT);
594
595 static int
596 bridge_modevent(module_t mod, int type, void *data)
597 {
598         switch (type) {
599         case MOD_LOAD:
600                 LIST_INIT(&bridge_list);
601                 if_clone_attach(&bridge_cloner);
602                 bridge_input_p = bridge_input;
603                 bridge_output_p = bridge_output;
604                 bridge_interface_p = bridge_interface;
605                 bridge_detach_cookie = EVENTHANDLER_REGISTER(
606                     ifnet_detach_event, bridge_ifdetach, NULL,
607                     EVENTHANDLER_PRI_ANY);
608 #if 0 /* notyet */
609                 bstp_linkstate_p = bstp_linkstate;
610 #endif
611                 break;
612         case MOD_UNLOAD:
613                 if (!LIST_EMPTY(&bridge_list))
614                         return (EBUSY);
615                 EVENTHANDLER_DEREGISTER(ifnet_detach_event,
616                     bridge_detach_cookie);
617                 if_clone_detach(&bridge_cloner);
618                 bridge_input_p = NULL;
619                 bridge_output_p = NULL;
620                 bridge_interface_p = NULL;
621 #if 0 /* notyet */
622                 bstp_linkstate_p = NULL;
623 #endif
624                 break;
625         default:
626                 return (EOPNOTSUPP);
627         }
628         return (0);
629 }
630
631 static moduledata_t bridge_mod = {
632         "if_bridge",
633         bridge_modevent,
634         0
635 };
636
637 DECLARE_MODULE(if_bridge, bridge_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
638
639
640 /*
641  * bridge_clone_create:
642  *
643  *      Create a new bridge instance.
644  */
645 static int
646 bridge_clone_create(struct if_clone *ifc, int unit, caddr_t param __unused)
647 {
648         struct bridge_softc *sc;
649         struct ifnet *ifp;
650         u_char eaddr[6];
651         int cpu, rnd;
652
653         sc = kmalloc(sizeof(*sc), M_DEVBUF, M_WAITOK | M_ZERO);
654         ifp = sc->sc_ifp = &sc->sc_if;
655
656         sc->sc_brtmax = BRIDGE_RTABLE_MAX;
657         sc->sc_brttimeout = BRIDGE_RTABLE_TIMEOUT;
658         sc->sc_bridge_max_age = BSTP_DEFAULT_MAX_AGE;
659         sc->sc_bridge_hello_time = BSTP_DEFAULT_HELLO_TIME;
660         sc->sc_bridge_forward_delay = BSTP_DEFAULT_FORWARD_DELAY;
661         sc->sc_bridge_priority = BSTP_DEFAULT_BRIDGE_PRIORITY;
662         sc->sc_hold_time = BSTP_DEFAULT_HOLD_TIME;
663
664         /* Initialize our routing table. */
665         bridge_rtable_init(sc);
666
667         callout_init(&sc->sc_brcallout);
668         netmsg_init(&sc->sc_brtimemsg, NULL, &netisr_adone_rport,
669                     MSGF_DROPABLE, bridge_timer_handler);
670         sc->sc_brtimemsg.lmsg.u.ms_resultp = sc;
671
672         callout_init(&sc->sc_bstpcallout);
673         netmsg_init(&sc->sc_bstptimemsg, NULL, &netisr_adone_rport,
674                     MSGF_DROPABLE, bstp_tick_handler);
675         sc->sc_bstptimemsg.lmsg.u.ms_resultp = sc;
676
677         /* Initialize per-cpu member iface lists */
678         sc->sc_iflists = kmalloc(sizeof(*sc->sc_iflists) * ncpus,
679                                  M_DEVBUF, M_WAITOK);
680         for (cpu = 0; cpu < ncpus; ++cpu)
681                 TAILQ_INIT(&sc->sc_iflists[cpu]);
682
683         TAILQ_INIT(&sc->sc_spanlist);
684
685         ifp->if_softc = sc;
686         if_initname(ifp, ifc->ifc_name, unit);
687         ifp->if_mtu = ETHERMTU;
688         ifp->if_flags = IFF_BROADCAST | IFF_MULTICAST;
689         ifp->if_ioctl = bridge_ioctl;
690         ifp->if_start = bridge_start;
691         ifp->if_init = bridge_init;
692         ifp->if_type = IFT_ETHER;
693         ifq_set_maxlen(&ifp->if_snd, ifqmaxlen);
694         ifq_set_ready(&ifp->if_snd);
695         ifp->if_hdrlen = ETHER_HDR_LEN;
696
697         /*
698          * Generate a random ethernet address and use the private AC:DE:48
699          * OUI code.
700          */
701         rnd = karc4random();
702         bcopy(&rnd, &eaddr[0], 4); /* ETHER_ADDR_LEN == 6 */
703         rnd = karc4random();
704         bcopy(&rnd, &eaddr[2], 4); /* ETHER_ADDR_LEN == 6 */
705
706         eaddr[0] &= ~1; /* clear multicast bit */
707         eaddr[0] |= 2;  /* set the LAA bit */
708
709         ether_ifattach(ifp, eaddr, NULL);
710         /* Now undo some of the damage... */
711         ifp->if_baudrate = 0;
712         /*ifp->if_type = IFT_BRIDGE;*/
713
714         crit_enter();   /* XXX MP */
715         LIST_INSERT_HEAD(&bridge_list, sc, sc_list);
716         crit_exit();
717
718         return (0);
719 }
720
721 static void
722 bridge_delete_dispatch(netmsg_t msg)
723 {
724         struct bridge_softc *sc = msg->lmsg.u.ms_resultp;
725         struct ifnet *bifp = sc->sc_ifp;
726         struct bridge_iflist *bif;
727
728         ifnet_serialize_all(bifp);
729
730         while ((bif = TAILQ_FIRST(&sc->sc_iflists[mycpuid])) != NULL)
731                 bridge_delete_member(sc, bif, 0);
732
733         while ((bif = TAILQ_FIRST(&sc->sc_spanlist)) != NULL)
734                 bridge_delete_span(sc, bif);
735
736         ifnet_deserialize_all(bifp);
737
738         lwkt_replymsg(&msg->lmsg, 0);
739 }
740
741 /*
742  * bridge_clone_destroy:
743  *
744  *      Destroy a bridge instance.
745  */
746 static int
747 bridge_clone_destroy(struct ifnet *ifp)
748 {
749         struct bridge_softc *sc = ifp->if_softc;
750         struct netmsg_base msg;
751
752         ifnet_serialize_all(ifp);
753
754         bridge_stop(ifp);
755         ifp->if_flags &= ~IFF_UP;
756
757         ifnet_deserialize_all(ifp);
758
759         netmsg_init(&msg, NULL, &curthread->td_msgport,
760                     0, bridge_delete_dispatch);
761         msg.lmsg.u.ms_resultp = sc;
762         lwkt_domsg(BRIDGE_CFGPORT, &msg.lmsg, 0);
763
764         crit_enter();   /* XXX MP */
765         LIST_REMOVE(sc, sc_list);
766         crit_exit();
767
768         ether_ifdetach(ifp);
769
770         /* Tear down the routing table. */
771         bridge_rtable_fini(sc);
772
773         /* Free per-cpu member iface lists */
774         kfree(sc->sc_iflists, M_DEVBUF);
775
776         kfree(sc, M_DEVBUF);
777
778         return 0;
779 }
780
781 /*
782  * bridge_ioctl:
783  *
784  *      Handle a control request from the operator.
785  */
786 static int
787 bridge_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *cr)
788 {
789         struct bridge_softc *sc = ifp->if_softc;
790         struct bridge_control_arg args;
791         struct ifdrv *ifd = (struct ifdrv *) data;
792         const struct bridge_control *bc;
793         int error = 0;
794
795         ASSERT_IFNET_SERIALIZED_ALL(ifp);
796
797         switch (cmd) {
798         case SIOCADDMULTI:
799         case SIOCDELMULTI:
800                 break;
801
802         case SIOCGDRVSPEC:
803         case SIOCSDRVSPEC:
804                 if (ifd->ifd_cmd >= bridge_control_table_size) {
805                         error = EINVAL;
806                         break;
807                 }
808                 bc = &bridge_control_table[ifd->ifd_cmd];
809
810                 if (cmd == SIOCGDRVSPEC &&
811                     (bc->bc_flags & BC_F_COPYOUT) == 0) {
812                         error = EINVAL;
813                         break;
814                 } else if (cmd == SIOCSDRVSPEC &&
815                            (bc->bc_flags & BC_F_COPYOUT)) {
816                         error = EINVAL;
817                         break;
818                 }
819
820                 if (bc->bc_flags & BC_F_SUSER) {
821                         error = priv_check_cred(cr, PRIV_ROOT, NULL_CRED_OKAY);
822                         if (error)
823                                 break;
824                 }
825
826                 if (ifd->ifd_len != bc->bc_argsize ||
827                     ifd->ifd_len > sizeof(args.bca_u)) {
828                         error = EINVAL;
829                         break;
830                 }
831
832                 memset(&args, 0, sizeof(args));
833                 if (bc->bc_flags & BC_F_COPYIN) {
834                         error = copyin(ifd->ifd_data, &args.bca_u,
835                                        ifd->ifd_len);
836                         if (error)
837                                 break;
838                 }
839
840                 error = bridge_control(sc, cmd, bc->bc_func, &args);
841                 if (error) {
842                         KKASSERT(args.bca_len == 0 && args.bca_kptr == NULL);
843                         break;
844                 }
845
846                 if (bc->bc_flags & BC_F_COPYOUT) {
847                         error = copyout(&args, ifd->ifd_data, ifd->ifd_len);
848                         if (args.bca_len != 0) {
849                                 KKASSERT(args.bca_kptr != NULL);
850                                 if (!error) {
851                                         error = copyout(args.bca_kptr,
852                                                 args.bca_uptr, args.bca_len);
853                                 }
854                                 kfree(args.bca_kptr, M_TEMP);
855                         } else {
856                                 KKASSERT(args.bca_kptr == NULL);
857                         }
858                 } else {
859                         KKASSERT(args.bca_len == 0 && args.bca_kptr == NULL);
860                 }
861                 break;
862
863         case SIOCSIFFLAGS:
864                 if (!(ifp->if_flags & IFF_UP) &&
865                     (ifp->if_flags & IFF_RUNNING)) {
866                         /*
867                          * If interface is marked down and it is running,
868                          * then stop it.
869                          */
870                         bridge_stop(ifp);
871                 } else if ((ifp->if_flags & IFF_UP) &&
872                     !(ifp->if_flags & IFF_RUNNING)) {
873                         /*
874                          * If interface is marked up and it is stopped, then
875                          * start it.
876                          */
877                         ifp->if_init(sc);
878                 }
879
880                 /*
881                  * If running and link flag state change we have to
882                  * reinitialize as well.
883                  */
884                 if ((ifp->if_flags & IFF_RUNNING) &&
885                     (ifp->if_flags & (IFF_LINK0|IFF_LINK1|IFF_LINK2)) !=
886                     sc->sc_copy_flags) {
887                         sc->sc_copy_flags = ifp->if_flags &
888                                         (IFF_LINK0|IFF_LINK1|IFF_LINK2);
889                         bridge_control(sc, 0, bridge_ioctl_reinit, NULL);
890                 }
891
892                 break;
893
894         case SIOCSIFMTU:
895                 /* Do not allow the MTU to be changed on the bridge */
896                 error = EINVAL;
897                 break;
898
899         default:
900                 error = ether_ioctl(ifp, cmd, data);
901                 break;
902         }
903         return (error);
904 }
905
906 /*
907  * bridge_mutecaps:
908  *
909  *      Clear or restore unwanted capabilities on the member interface
910  */
911 static void
912 bridge_mutecaps(struct bridge_ifinfo *bif_info, struct ifnet *ifp, int mute)
913 {
914         struct ifreq ifr;
915         int error;
916
917         if (ifp->if_ioctl == NULL)
918                 return;
919
920         bzero(&ifr, sizeof(ifr));
921         ifr.ifr_reqcap = ifp->if_capenable;
922
923         if (mute) {
924                 /* mask off and save capabilities */
925                 bif_info->bifi_mutecap = ifr.ifr_reqcap & BRIDGE_IFCAPS_MASK;
926                 if (bif_info->bifi_mutecap != 0)
927                         ifr.ifr_reqcap &= ~BRIDGE_IFCAPS_MASK;
928         } else {
929                 /* restore muted capabilities */
930                 ifr.ifr_reqcap |= bif_info->bifi_mutecap;
931         }
932
933         if (bif_info->bifi_mutecap != 0) {
934                 ifnet_serialize_all(ifp);
935                 error = ifp->if_ioctl(ifp, SIOCSIFCAP, (caddr_t)&ifr, NULL);
936                 ifnet_deserialize_all(ifp);
937         }
938 }
939
940 /*
941  * bridge_lookup_member:
942  *
943  *      Lookup a bridge member interface.
944  */
945 static struct bridge_iflist *
946 bridge_lookup_member(struct bridge_softc *sc, const char *name)
947 {
948         struct bridge_iflist *bif;
949
950         TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
951                 if (strcmp(bif->bif_ifp->if_xname, name) == 0)
952                         return (bif);
953         }
954         return (NULL);
955 }
956
957 /*
958  * bridge_lookup_member_if:
959  *
960  *      Lookup a bridge member interface by ifnet*.
961  */
962 static struct bridge_iflist *
963 bridge_lookup_member_if(struct bridge_softc *sc, struct ifnet *member_ifp)
964 {
965         struct bridge_iflist *bif;
966
967         TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
968                 if (bif->bif_ifp == member_ifp)
969                         return (bif);
970         }
971         return (NULL);
972 }
973
974 /*
975  * bridge_lookup_member_ifinfo:
976  *
977  *      Lookup a bridge member interface by bridge_ifinfo.
978  */
979 static struct bridge_iflist *
980 bridge_lookup_member_ifinfo(struct bridge_softc *sc,
981                             struct bridge_ifinfo *bif_info)
982 {
983         struct bridge_iflist *bif;
984
985         TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
986                 if (bif->bif_info == bif_info)
987                         return (bif);
988         }
989         return (NULL);
990 }
991
992 /*
993  * bridge_delete_member:
994  *
995  *      Delete the specified member interface.
996  */
997 static void
998 bridge_delete_member(struct bridge_softc *sc, struct bridge_iflist *bif,
999     int gone)
1000 {
1001         struct ifnet *ifs = bif->bif_ifp;
1002         struct ifnet *bifp = sc->sc_ifp;
1003         struct bridge_ifinfo *bif_info = bif->bif_info;
1004         struct bridge_iflist_head saved_bifs;
1005
1006         ASSERT_IFNET_SERIALIZED_ALL(bifp);
1007         KKASSERT(bif_info != NULL);
1008
1009         ifs->if_bridge = NULL;
1010
1011         /*
1012          * Release bridge interface's serializer:
1013          * - To avoid possible dead lock.
1014          * - Various sync operation will block the current thread.
1015          */
1016         ifnet_deserialize_all(bifp);
1017
1018         if (!gone) {
1019                 switch (ifs->if_type) {
1020                 case IFT_ETHER:
1021                 case IFT_L2VLAN:
1022                         /*
1023                          * Take the interface out of promiscuous mode.
1024                          */
1025                         ifpromisc(ifs, 0);
1026                         bridge_mutecaps(bif_info, ifs, 0);
1027                         break;
1028
1029                 case IFT_GIF:
1030                         break;
1031
1032                 default:
1033                         panic("bridge_delete_member: impossible");
1034                         break;
1035                 }
1036         }
1037
1038         /*
1039          * Remove bifs from percpu linked list.
1040          *
1041          * Removed bifs are not freed immediately, instead,
1042          * they are saved in saved_bifs.  They will be freed
1043          * after we make sure that no one is accessing them,
1044          * i.e. after following netmsg_service_sync()
1045          */
1046         TAILQ_INIT(&saved_bifs);
1047         bridge_del_bif(sc, bif_info, &saved_bifs);
1048
1049         /*
1050          * Make sure that all protocol threads:
1051          * o  see 'ifs' if_bridge is changed
1052          * o  know that bif is removed from the percpu linked list
1053          */
1054         netmsg_service_sync();
1055
1056         /*
1057          * Free the removed bifs
1058          */
1059         KKASSERT(!TAILQ_EMPTY(&saved_bifs));
1060         while ((bif = TAILQ_FIRST(&saved_bifs)) != NULL) {
1061                 TAILQ_REMOVE(&saved_bifs, bif, bif_next);
1062                 kfree(bif, M_DEVBUF);
1063         }
1064
1065         /* See the comment in bridge_ioctl_stop() */
1066         bridge_rtmsg_sync(sc);
1067         bridge_rtdelete(sc, ifs, IFBF_FLUSHALL | IFBF_FLUSHSYNC);
1068
1069         ifnet_serialize_all(bifp);
1070
1071         if (bifp->if_flags & IFF_RUNNING)
1072                 bstp_initialization(sc);
1073
1074         /*
1075          * Free the bif_info after bstp_initialization(), so that
1076          * bridge_softc.sc_root_port will not reference a dangling
1077          * pointer.
1078          */
1079         kfree(bif_info, M_DEVBUF);
1080 }
1081
1082 /*
1083  * bridge_delete_span:
1084  *
1085  *      Delete the specified span interface.
1086  */
1087 static void
1088 bridge_delete_span(struct bridge_softc *sc, struct bridge_iflist *bif)
1089 {
1090         KASSERT(bif->bif_ifp->if_bridge == NULL,
1091             ("%s: not a span interface", __func__));
1092
1093         TAILQ_REMOVE(&sc->sc_iflists[mycpuid], bif, bif_next);
1094         kfree(bif, M_DEVBUF);
1095 }
1096
1097 static int
1098 bridge_ioctl_init(struct bridge_softc *sc, void *arg __unused)
1099 {
1100         struct ifnet *ifp = sc->sc_ifp;
1101
1102         if (ifp->if_flags & IFF_RUNNING)
1103                 return 0;
1104
1105         callout_reset(&sc->sc_brcallout, bridge_rtable_prune_period * hz,
1106             bridge_timer, sc);
1107
1108         ifp->if_flags |= IFF_RUNNING;
1109         bstp_initialization(sc);
1110         return 0;
1111 }
1112
1113 static int
1114 bridge_ioctl_stop(struct bridge_softc *sc, void *arg __unused)
1115 {
1116         struct ifnet *ifp = sc->sc_ifp;
1117         struct lwkt_msg *lmsg;
1118
1119         if ((ifp->if_flags & IFF_RUNNING) == 0)
1120                 return 0;
1121
1122         callout_stop(&sc->sc_brcallout);
1123
1124         crit_enter();
1125         lmsg = &sc->sc_brtimemsg.lmsg;
1126         if ((lmsg->ms_flags & MSGF_DONE) == 0) {
1127                 /* Pending to be processed; drop it */
1128                 lwkt_dropmsg(lmsg);
1129         }
1130         crit_exit();
1131
1132         bstp_stop(sc);
1133
1134         ifp->if_flags &= ~IFF_RUNNING;
1135
1136         ifnet_deserialize_all(ifp);
1137
1138         /* Let everyone know that we are stopped */
1139         netmsg_service_sync();
1140
1141         /*
1142          * Sync ifnetX msgports in the order we forward rtnode
1143          * installation message.  This is used to make sure that
1144          * all rtnode installation messages sent by bridge_rtupdate()
1145          * during above netmsg_service_sync() are flushed.
1146          */
1147         bridge_rtmsg_sync(sc);
1148         bridge_rtflush(sc, IFBF_FLUSHDYN | IFBF_FLUSHSYNC);
1149
1150         ifnet_serialize_all(ifp);
1151         return 0;
1152 }
1153
1154 static int
1155 bridge_ioctl_add(struct bridge_softc *sc, void *arg)
1156 {
1157         struct ifbreq *req = arg;
1158         struct bridge_iflist *bif;
1159         struct bridge_ifinfo *bif_info;
1160         struct ifnet *ifs, *bifp;
1161         int error = 0;
1162
1163         bifp = sc->sc_ifp;
1164         ASSERT_IFNET_SERIALIZED_ALL(bifp);
1165
1166         ifs = ifunit(req->ifbr_ifsname);
1167         if (ifs == NULL)
1168                 return (ENOENT);
1169
1170         /* If it's in the span list, it can't be a member. */
1171         TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
1172                 if (ifs == bif->bif_ifp)
1173                         return (EBUSY);
1174
1175         /* Allow the first Ethernet member to define the MTU */
1176         if (ifs->if_type != IFT_GIF) {
1177                 if (TAILQ_EMPTY(&sc->sc_iflists[mycpuid])) {
1178                         bifp->if_mtu = ifs->if_mtu;
1179                 } else if (bifp->if_mtu != ifs->if_mtu) {
1180                         if_printf(bifp, "invalid MTU for %s\n", ifs->if_xname);
1181                         return (EINVAL);
1182                 }
1183         }
1184
1185         if (ifs->if_bridge == sc)
1186                 return (EEXIST);
1187
1188         if (ifs->if_bridge != NULL)
1189                 return (EBUSY);
1190
1191         bif_info = kmalloc(sizeof(*bif_info), M_DEVBUF, M_WAITOK | M_ZERO);
1192         bif_info->bifi_priority = BSTP_DEFAULT_PORT_PRIORITY;
1193         bif_info->bifi_path_cost = BSTP_DEFAULT_PATH_COST;
1194         bif_info->bifi_ifp = ifs;
1195         bif_info->bifi_bond_weight = 1;
1196
1197         /*
1198          * Release bridge interface's serializer:
1199          * - To avoid possible dead lock.
1200          * - Various sync operation will block the current thread.
1201          */
1202         ifnet_deserialize_all(bifp);
1203
1204         switch (ifs->if_type) {
1205         case IFT_ETHER:
1206         case IFT_L2VLAN:
1207                 /*
1208                  * Place the interface into promiscuous mode.
1209                  */
1210                 error = ifpromisc(ifs, 1);
1211                 if (error) {
1212                         ifnet_serialize_all(bifp);
1213                         goto out;
1214                 }
1215                 bridge_mutecaps(bif_info, ifs, 1);
1216                 break;
1217
1218         case IFT_GIF: /* :^) */
1219                 break;
1220
1221         default:
1222                 error = EINVAL;
1223                 ifnet_serialize_all(bifp);
1224                 goto out;
1225         }
1226
1227         /*
1228          * Add bifs to percpu linked lists
1229          */
1230         bridge_add_bif(sc, bif_info, ifs);
1231
1232         ifnet_serialize_all(bifp);
1233
1234         if (bifp->if_flags & IFF_RUNNING)
1235                 bstp_initialization(sc);
1236         else
1237                 bstp_stop(sc);
1238
1239         /*
1240          * Everything has been setup, so let the member interface
1241          * deliver packets to this bridge on its input/output path.
1242          */
1243         ifs->if_bridge = sc;
1244 out:
1245         if (error) {
1246                 if (bif_info != NULL)
1247                         kfree(bif_info, M_DEVBUF);
1248         }
1249         return (error);
1250 }
1251
1252 static int
1253 bridge_ioctl_del(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         bridge_delete_member(sc, bif, 0);
1263
1264         return (0);
1265 }
1266
1267 static int
1268 bridge_ioctl_gifflags(struct bridge_softc *sc, void *arg)
1269 {
1270         struct ifbreq *req = arg;
1271         struct bridge_iflist *bif;
1272
1273         bif = bridge_lookup_member(sc, req->ifbr_ifsname);
1274         if (bif == NULL)
1275                 return (ENOENT);
1276         bridge_ioctl_fillflags(sc, bif, req);
1277         return (0);
1278 }
1279
1280 static void
1281 bridge_ioctl_fillflags(struct bridge_softc *sc, struct bridge_iflist *bif,
1282                        struct ifbreq *req)
1283 {
1284         req->ifbr_ifsflags = bif->bif_flags;
1285         req->ifbr_state = bif->bif_state;
1286         req->ifbr_priority = bif->bif_priority;
1287         req->ifbr_path_cost = bif->bif_path_cost;
1288         req->ifbr_bond_weight = bif->bif_bond_weight;
1289         req->ifbr_portno = bif->bif_ifp->if_index & 0xff;
1290         if (bif->bif_flags & IFBIF_STP) {
1291                 req->ifbr_peer_root = bif->bif_peer_root;
1292                 req->ifbr_peer_bridge = bif->bif_peer_bridge;
1293                 req->ifbr_peer_cost = bif->bif_peer_cost;
1294                 req->ifbr_peer_port = bif->bif_peer_port;
1295                 if (bstp_supersedes_port_info(sc, bif)) {
1296                         req->ifbr_designated_root = bif->bif_peer_root;
1297                         req->ifbr_designated_bridge = bif->bif_peer_bridge;
1298                         req->ifbr_designated_cost = bif->bif_peer_cost;
1299                         req->ifbr_designated_port = bif->bif_peer_port;
1300                 } else {
1301                         req->ifbr_designated_root = sc->sc_bridge_id;
1302                         req->ifbr_designated_bridge = sc->sc_bridge_id;
1303                         req->ifbr_designated_cost = bif->bif_path_cost +
1304                                                     bif->bif_peer_cost;
1305                         req->ifbr_designated_port = bif->bif_port_id;
1306                 }
1307         } else {
1308                 req->ifbr_peer_root = 0;
1309                 req->ifbr_peer_bridge = 0;
1310                 req->ifbr_peer_cost = 0;
1311                 req->ifbr_peer_port = 0;
1312                 req->ifbr_designated_root = 0;
1313                 req->ifbr_designated_bridge = 0;
1314                 req->ifbr_designated_cost = 0;
1315                 req->ifbr_designated_port = 0;
1316         }
1317 }
1318
1319 static int
1320 bridge_ioctl_sifflags(struct bridge_softc *sc, void *arg)
1321 {
1322         struct ifbreq *req = arg;
1323         struct bridge_iflist *bif;
1324         struct ifnet *bifp = sc->sc_ifp;
1325
1326         bif = bridge_lookup_member(sc, req->ifbr_ifsname);
1327         if (bif == NULL)
1328                 return (ENOENT);
1329
1330         if (req->ifbr_ifsflags & IFBIF_SPAN) {
1331                 /* SPAN is readonly */
1332                 return (EINVAL);
1333         }
1334
1335         if (req->ifbr_ifsflags & IFBIF_STP) {
1336                 switch (bif->bif_ifp->if_type) {
1337                 case IFT_ETHER:
1338                         /* These can do spanning tree. */
1339                         break;
1340
1341                 default:
1342                         /* Nothing else can. */
1343                         return (EINVAL);
1344                 }
1345         }
1346
1347         bif->bif_flags = (bif->bif_flags & IFBIF_KEEPMASK) |
1348                          (req->ifbr_ifsflags & ~IFBIF_KEEPMASK);
1349         if (bifp->if_flags & IFF_RUNNING)
1350                 bstp_initialization(sc);
1351
1352         return (0);
1353 }
1354
1355 static int
1356 bridge_ioctl_scache(struct bridge_softc *sc, void *arg)
1357 {
1358         struct ifbrparam *param = arg;
1359         struct ifnet *ifp = sc->sc_ifp;
1360
1361         sc->sc_brtmax = param->ifbrp_csize;
1362
1363         ifnet_deserialize_all(ifp);
1364         bridge_rttrim(sc);
1365         ifnet_serialize_all(ifp);
1366
1367         return (0);
1368 }
1369
1370 static int
1371 bridge_ioctl_gcache(struct bridge_softc *sc, void *arg)
1372 {
1373         struct ifbrparam *param = arg;
1374
1375         param->ifbrp_csize = sc->sc_brtmax;
1376
1377         return (0);
1378 }
1379
1380 static int
1381 bridge_ioctl_gifs(struct bridge_softc *sc, void *arg)
1382 {
1383         struct bridge_control_arg *bc_arg = arg;
1384         struct ifbifconf *bifc = arg;
1385         struct bridge_iflist *bif;
1386         struct ifbreq *breq;
1387         int count, len;
1388
1389         count = 0;
1390         TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next)
1391                 count++;
1392         TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
1393                 count++;
1394
1395         if (bifc->ifbic_len == 0) {
1396                 bifc->ifbic_len = sizeof(*breq) * count;
1397                 return 0;
1398         } else if (count == 0 || bifc->ifbic_len < sizeof(*breq)) {
1399                 bifc->ifbic_len = 0;
1400                 return 0;
1401         }
1402
1403         len = min(bifc->ifbic_len, sizeof(*breq) * count);
1404         KKASSERT(len >= sizeof(*breq));
1405
1406         breq = kmalloc(len, M_TEMP, M_WAITOK | M_NULLOK | M_ZERO);
1407         if (breq == NULL) {
1408                 bifc->ifbic_len = 0;
1409                 return ENOMEM;
1410         }
1411         bc_arg->bca_kptr = breq;
1412
1413         count = 0;
1414         TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
1415                 if (len < sizeof(*breq))
1416                         break;
1417
1418                 strlcpy(breq->ifbr_ifsname, bif->bif_ifp->if_xname,
1419                         sizeof(breq->ifbr_ifsname));
1420                 bridge_ioctl_fillflags(sc, bif, breq);
1421                 breq++;
1422                 count++;
1423                 len -= sizeof(*breq);
1424         }
1425         TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) {
1426                 if (len < sizeof(*breq))
1427                         break;
1428
1429                 strlcpy(breq->ifbr_ifsname, bif->bif_ifp->if_xname,
1430                         sizeof(breq->ifbr_ifsname));
1431                 breq->ifbr_ifsflags = bif->bif_flags;
1432                 breq->ifbr_portno = bif->bif_ifp->if_index & 0xff;
1433                 breq++;
1434                 count++;
1435                 len -= sizeof(*breq);
1436         }
1437
1438         bifc->ifbic_len = sizeof(*breq) * count;
1439         KKASSERT(bifc->ifbic_len > 0);
1440
1441         bc_arg->bca_len = bifc->ifbic_len;
1442         bc_arg->bca_uptr = bifc->ifbic_req;
1443         return 0;
1444 }
1445
1446 static int
1447 bridge_ioctl_rts(struct bridge_softc *sc, void *arg)
1448 {
1449         struct bridge_control_arg *bc_arg = arg;
1450         struct ifbaconf *bac = arg;
1451         struct bridge_rtnode *brt;
1452         struct ifbareq *bareq;
1453         int count, len;
1454
1455         count = 0;
1456         LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list)
1457                 count++;
1458
1459         if (bac->ifbac_len == 0) {
1460                 bac->ifbac_len = sizeof(*bareq) * count;
1461                 return 0;
1462         } else if (count == 0 || bac->ifbac_len < sizeof(*bareq)) {
1463                 bac->ifbac_len = 0;
1464                 return 0;
1465         }
1466
1467         len = min(bac->ifbac_len, sizeof(*bareq) * count);
1468         KKASSERT(len >= sizeof(*bareq));
1469
1470         bareq = kmalloc(len, M_TEMP, M_WAITOK | M_NULLOK | M_ZERO);
1471         if (bareq == NULL) {
1472                 bac->ifbac_len = 0;
1473                 return ENOMEM;
1474         }
1475         bc_arg->bca_kptr = bareq;
1476
1477         count = 0;
1478         LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
1479                 struct bridge_rtinfo *bri = brt->brt_info;
1480                 unsigned long expire;
1481
1482                 if (len < sizeof(*bareq))
1483                         break;
1484
1485                 strlcpy(bareq->ifba_ifsname, bri->bri_ifp->if_xname,
1486                         sizeof(bareq->ifba_ifsname));
1487                 memcpy(bareq->ifba_dst, brt->brt_addr, sizeof(brt->brt_addr));
1488                 expire = bri->bri_expire;
1489                 if ((bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
1490                     time_second < expire)
1491                         bareq->ifba_expire = expire - time_second;
1492                 else
1493                         bareq->ifba_expire = 0;
1494                 bareq->ifba_flags = bri->bri_flags;
1495                 bareq++;
1496                 count++;
1497                 len -= sizeof(*bareq);
1498         }
1499
1500         bac->ifbac_len = sizeof(*bareq) * count;
1501         KKASSERT(bac->ifbac_len > 0);
1502
1503         bc_arg->bca_len = bac->ifbac_len;
1504         bc_arg->bca_uptr = bac->ifbac_req;
1505         return 0;
1506 }
1507
1508 static int
1509 bridge_ioctl_saddr(struct bridge_softc *sc, void *arg)
1510 {
1511         struct ifbareq *req = arg;
1512         struct bridge_iflist *bif;
1513         struct ifnet *ifp = sc->sc_ifp;
1514         int error;
1515
1516         ASSERT_IFNET_SERIALIZED_ALL(ifp);
1517
1518         bif = bridge_lookup_member(sc, req->ifba_ifsname);
1519         if (bif == NULL)
1520                 return (ENOENT);
1521
1522         ifnet_deserialize_all(ifp);
1523         error = bridge_rtsaddr(sc, req->ifba_dst, bif->bif_ifp,
1524                                req->ifba_flags);
1525         ifnet_serialize_all(ifp);
1526         return (error);
1527 }
1528
1529 static int
1530 bridge_ioctl_sto(struct bridge_softc *sc, void *arg)
1531 {
1532         struct ifbrparam *param = arg;
1533
1534         sc->sc_brttimeout = param->ifbrp_ctime;
1535
1536         return (0);
1537 }
1538
1539 static int
1540 bridge_ioctl_gto(struct bridge_softc *sc, void *arg)
1541 {
1542         struct ifbrparam *param = arg;
1543
1544         param->ifbrp_ctime = sc->sc_brttimeout;
1545
1546         return (0);
1547 }
1548
1549 static int
1550 bridge_ioctl_daddr(struct bridge_softc *sc, void *arg)
1551 {
1552         struct ifbareq *req = arg;
1553         struct ifnet *ifp = sc->sc_ifp;
1554         int error;
1555
1556         ifnet_deserialize_all(ifp);
1557         error = bridge_rtdaddr(sc, req->ifba_dst);
1558         ifnet_serialize_all(ifp);
1559         return error;
1560 }
1561
1562 static int
1563 bridge_ioctl_flush(struct bridge_softc *sc, void *arg)
1564 {
1565         struct ifbreq *req = arg;
1566         struct ifnet *ifp = sc->sc_ifp;
1567
1568         ifnet_deserialize_all(ifp);
1569         bridge_rtflush(sc, req->ifbr_ifsflags | IFBF_FLUSHSYNC);
1570         ifnet_serialize_all(ifp);
1571
1572         return (0);
1573 }
1574
1575 static int
1576 bridge_ioctl_gpri(struct bridge_softc *sc, void *arg)
1577 {
1578         struct ifbrparam *param = arg;
1579
1580         param->ifbrp_prio = sc->sc_bridge_priority;
1581
1582         return (0);
1583 }
1584
1585 static int
1586 bridge_ioctl_spri(struct bridge_softc *sc, void *arg)
1587 {
1588         struct ifbrparam *param = arg;
1589
1590         sc->sc_bridge_priority = param->ifbrp_prio;
1591
1592         if (sc->sc_ifp->if_flags & IFF_RUNNING)
1593                 bstp_initialization(sc);
1594
1595         return (0);
1596 }
1597
1598 static int
1599 bridge_ioctl_reinit(struct bridge_softc *sc, void *arg __unused)
1600 {
1601         if (sc->sc_ifp->if_flags & IFF_RUNNING)
1602                 bstp_initialization(sc);
1603         return (0);
1604 }
1605
1606 static int
1607 bridge_ioctl_ght(struct bridge_softc *sc, void *arg)
1608 {
1609         struct ifbrparam *param = arg;
1610
1611         param->ifbrp_hellotime = sc->sc_bridge_hello_time >> 8;
1612
1613         return (0);
1614 }
1615
1616 static int
1617 bridge_ioctl_sht(struct bridge_softc *sc, void *arg)
1618 {
1619         struct ifbrparam *param = arg;
1620
1621         if (param->ifbrp_hellotime == 0)
1622                 return (EINVAL);
1623         sc->sc_bridge_hello_time = param->ifbrp_hellotime << 8;
1624
1625         if (sc->sc_ifp->if_flags & IFF_RUNNING)
1626                 bstp_initialization(sc);
1627
1628         return (0);
1629 }
1630
1631 static int
1632 bridge_ioctl_gfd(struct bridge_softc *sc, void *arg)
1633 {
1634         struct ifbrparam *param = arg;
1635
1636         param->ifbrp_fwddelay = sc->sc_bridge_forward_delay >> 8;
1637
1638         return (0);
1639 }
1640
1641 static int
1642 bridge_ioctl_sfd(struct bridge_softc *sc, void *arg)
1643 {
1644         struct ifbrparam *param = arg;
1645
1646         if (param->ifbrp_fwddelay == 0)
1647                 return (EINVAL);
1648         sc->sc_bridge_forward_delay = param->ifbrp_fwddelay << 8;
1649
1650         if (sc->sc_ifp->if_flags & IFF_RUNNING)
1651                 bstp_initialization(sc);
1652
1653         return (0);
1654 }
1655
1656 static int
1657 bridge_ioctl_gma(struct bridge_softc *sc, void *arg)
1658 {
1659         struct ifbrparam *param = arg;
1660
1661         param->ifbrp_maxage = sc->sc_bridge_max_age >> 8;
1662
1663         return (0);
1664 }
1665
1666 static int
1667 bridge_ioctl_sma(struct bridge_softc *sc, void *arg)
1668 {
1669         struct ifbrparam *param = arg;
1670
1671         if (param->ifbrp_maxage == 0)
1672                 return (EINVAL);
1673         sc->sc_bridge_max_age = param->ifbrp_maxage << 8;
1674
1675         if (sc->sc_ifp->if_flags & IFF_RUNNING)
1676                 bstp_initialization(sc);
1677
1678         return (0);
1679 }
1680
1681 static int
1682 bridge_ioctl_sifprio(struct bridge_softc *sc, void *arg)
1683 {
1684         struct ifbreq *req = arg;
1685         struct bridge_iflist *bif;
1686
1687         bif = bridge_lookup_member(sc, req->ifbr_ifsname);
1688         if (bif == NULL)
1689                 return (ENOENT);
1690
1691         bif->bif_priority = req->ifbr_priority;
1692
1693         if (sc->sc_ifp->if_flags & IFF_RUNNING)
1694                 bstp_initialization(sc);
1695
1696         return (0);
1697 }
1698
1699 static int
1700 bridge_ioctl_sifcost(struct bridge_softc *sc, void *arg)
1701 {
1702         struct ifbreq *req = arg;
1703         struct bridge_iflist *bif;
1704
1705         bif = bridge_lookup_member(sc, req->ifbr_ifsname);
1706         if (bif == NULL)
1707                 return (ENOENT);
1708
1709         bif->bif_path_cost = req->ifbr_path_cost;
1710
1711         if (sc->sc_ifp->if_flags & IFF_RUNNING)
1712                 bstp_initialization(sc);
1713
1714         return (0);
1715 }
1716
1717 static int
1718 bridge_ioctl_sifbondwght(struct bridge_softc *sc, void *arg)
1719 {
1720         struct ifbreq *req = arg;
1721         struct bridge_iflist *bif;
1722
1723         bif = bridge_lookup_member(sc, req->ifbr_ifsname);
1724         if (bif == NULL)
1725                 return (ENOENT);
1726
1727         bif->bif_bond_weight = req->ifbr_bond_weight;
1728
1729         /* no reinit needed */
1730
1731         return (0);
1732 }
1733
1734 static int
1735 bridge_ioctl_addspan(struct bridge_softc *sc, void *arg)
1736 {
1737         struct ifbreq *req = arg;
1738         struct bridge_iflist *bif;
1739         struct ifnet *ifs;
1740         struct bridge_ifinfo *bif_info;
1741
1742         ifs = ifunit(req->ifbr_ifsname);
1743         if (ifs == NULL)
1744                 return (ENOENT);
1745
1746         TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
1747                 if (ifs == bif->bif_ifp)
1748                         return (EBUSY);
1749
1750         if (ifs->if_bridge != NULL)
1751                 return (EBUSY);
1752
1753         switch (ifs->if_type) {
1754         case IFT_ETHER:
1755         case IFT_GIF:
1756         case IFT_L2VLAN:
1757                 break;
1758
1759         default:
1760                 return (EINVAL);
1761         }
1762
1763         /*
1764          * bif_info is needed for bif_flags
1765          */
1766         bif_info = kmalloc(sizeof(*bif_info), M_DEVBUF, M_WAITOK | M_ZERO);
1767         bif_info->bifi_ifp = ifs;
1768
1769         bif = kmalloc(sizeof(*bif), M_DEVBUF, M_WAITOK | M_ZERO);
1770         bif->bif_ifp = ifs;
1771         bif->bif_info = bif_info;
1772         bif->bif_flags = IFBIF_SPAN;
1773         /* NOTE: span bif does not need bridge_ifinfo */
1774
1775         TAILQ_INSERT_HEAD(&sc->sc_spanlist, bif, bif_next);
1776
1777         sc->sc_span = 1;
1778
1779         return (0);
1780 }
1781
1782 static int
1783 bridge_ioctl_delspan(struct bridge_softc *sc, void *arg)
1784 {
1785         struct ifbreq *req = arg;
1786         struct bridge_iflist *bif;
1787         struct ifnet *ifs;
1788
1789         ifs = ifunit(req->ifbr_ifsname);
1790         if (ifs == NULL)
1791                 return (ENOENT);
1792
1793         TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
1794                 if (ifs == bif->bif_ifp)
1795                         break;
1796
1797         if (bif == NULL)
1798                 return (ENOENT);
1799
1800         bridge_delete_span(sc, bif);
1801
1802         if (TAILQ_EMPTY(&sc->sc_spanlist))
1803                 sc->sc_span = 0;
1804
1805         return (0);
1806 }
1807
1808 static void
1809 bridge_ifdetach_dispatch(netmsg_t msg)
1810 {
1811         struct ifnet *ifp, *bifp;
1812         struct bridge_softc *sc;
1813         struct bridge_iflist *bif;
1814
1815         ifp = msg->lmsg.u.ms_resultp;
1816         sc = ifp->if_bridge;
1817
1818         /* Check if the interface is a bridge member */
1819         if (sc != NULL) {
1820                 bifp = sc->sc_ifp;
1821
1822                 ifnet_serialize_all(bifp);
1823
1824                 bif = bridge_lookup_member_if(sc, ifp);
1825                 if (bif != NULL) {
1826                         bridge_delete_member(sc, bif, 1);
1827                 } else {
1828                         /* XXX Why bif will be NULL? */
1829                 }
1830
1831                 ifnet_deserialize_all(bifp);
1832                 goto reply;
1833         }
1834
1835         crit_enter();   /* XXX MP */
1836
1837         /* Check if the interface is a span port */
1838         LIST_FOREACH(sc, &bridge_list, sc_list) {
1839                 bifp = sc->sc_ifp;
1840
1841                 ifnet_serialize_all(bifp);
1842
1843                 TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
1844                         if (ifp == bif->bif_ifp) {
1845                                 bridge_delete_span(sc, bif);
1846                                 break;
1847                         }
1848
1849                 ifnet_deserialize_all(bifp);
1850         }
1851
1852         crit_exit();
1853
1854 reply:
1855         lwkt_replymsg(&msg->lmsg, 0);
1856 }
1857
1858 /*
1859  * bridge_ifdetach:
1860  *
1861  *      Detach an interface from a bridge.  Called when a member
1862  *      interface is detaching.
1863  */
1864 static void
1865 bridge_ifdetach(void *arg __unused, struct ifnet *ifp)
1866 {
1867         struct netmsg_base msg;
1868
1869         netmsg_init(&msg, NULL, &curthread->td_msgport,
1870                     0, bridge_ifdetach_dispatch);
1871         msg.lmsg.u.ms_resultp = ifp;
1872
1873         lwkt_domsg(BRIDGE_CFGPORT, &msg.lmsg, 0);
1874 }
1875
1876 /*
1877  * bridge_init:
1878  *
1879  *      Initialize a bridge interface.
1880  */
1881 static void
1882 bridge_init(void *xsc)
1883 {
1884         bridge_control(xsc, SIOCSIFFLAGS, bridge_ioctl_init, NULL);
1885 }
1886
1887 /*
1888  * bridge_stop:
1889  *
1890  *      Stop the bridge interface.
1891  */
1892 static void
1893 bridge_stop(struct ifnet *ifp)
1894 {
1895         bridge_control(ifp->if_softc, SIOCSIFFLAGS, bridge_ioctl_stop, NULL);
1896 }
1897
1898 /*
1899  * Returns TRUE if the packet is being sent 'from us'... from our bridge
1900  * interface or from any member of our bridge interface.  This is used
1901  * later on to force the MAC to be the MAC of our bridge interface.
1902  */
1903 static int
1904 bridge_from_us(struct bridge_softc *sc, struct ether_header *eh)
1905 {
1906         struct bridge_iflist *bif;
1907
1908         if (memcmp(eh->ether_shost, IF_LLADDR(sc->sc_ifp), ETHER_ADDR_LEN) == 0)
1909                 return (1);
1910
1911         TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
1912                 if (memcmp(eh->ether_shost, IF_LLADDR(bif->bif_ifp),
1913                            ETHER_ADDR_LEN) == 0) {
1914                         return (1);
1915                 }
1916         }
1917         return (0);
1918 }
1919
1920 /*
1921  * bridge_enqueue:
1922  *
1923  *      Enqueue a packet on a bridge member interface.
1924  *
1925  */
1926 void
1927 bridge_enqueue(struct ifnet *dst_ifp, struct mbuf *m)
1928 {
1929         struct netmsg_packet *nmp;
1930
1931         mbuftrackid(m, 64);
1932
1933         nmp = &m->m_hdr.mh_netmsg;
1934         netmsg_init(&nmp->base, NULL, &netisr_apanic_rport,
1935                     0, bridge_enqueue_handler);
1936         nmp->nm_packet = m;
1937         nmp->base.lmsg.u.ms_resultp = dst_ifp;
1938
1939         lwkt_sendmsg(netisr_portfn(mycpu->gd_cpuid), &nmp->base.lmsg);
1940 }
1941
1942 /*
1943  * After looking up dst_if in our forwarding table we still have to
1944  * deal with channel bonding.  Find the best interface in the bonding set.
1945  */
1946 static struct ifnet *
1947 bridge_select_unicast(struct bridge_softc *sc, struct ifnet *dst_if,
1948                       int from_blocking, struct mbuf *m)
1949 {
1950         struct bridge_iflist *bif, *nbif;
1951         struct ifnet *alt_if;
1952         int alt_priority;
1953         int priority;
1954
1955         /*
1956          * Unicast, kinda replicates the output side of bridge_output().
1957          *
1958          * Even though this is a uni-cast packet we may have to select
1959          * an interface from a bonding set.
1960          */
1961         bif = bridge_lookup_member_if(sc, dst_if);
1962         if (bif == NULL) {
1963                 /* Not a member of the bridge (anymore?) */
1964                 return NULL;
1965         }
1966
1967         /*
1968          * If STP is enabled on the target we are an equal opportunity
1969          * employer and do not necessarily output to dst_if.  Instead
1970          * scan available links with the same MAC as the current dst_if
1971          * and choose the best one.
1972          *
1973          * We also need to do this because arp entries tag onto a particular
1974          * interface and if it happens to be dead then the packets will
1975          * go into a bit bucket.
1976          *
1977          * If LINK2 is set the matching links are bonded and we-round robin.
1978          * (the MAC address must be the same for the participating links).
1979          * In this case links in a STP FORWARDING or BONDED state are
1980          * allowed for unicast packets.
1981          */
1982         if (bif->bif_flags & IFBIF_STP) {
1983                 alt_if = NULL;
1984                 alt_priority = 0;
1985                 priority = 0;
1986
1987                 TAILQ_FOREACH_MUTABLE(bif, &sc->sc_iflists[mycpuid],
1988                                      bif_next, nbif) {
1989                         /*
1990                          * dst_if may imply a bonding set so we must compare
1991                          * MAC addresses.
1992                          */
1993                         if (memcmp(IF_LLADDR(bif->bif_ifp),
1994                                    IF_LLADDR(dst_if),
1995                                    ETHER_ADDR_LEN) != 0) {
1996                                 continue;
1997                         }
1998
1999                         if ((bif->bif_ifp->if_flags & IFF_RUNNING) == 0)
2000                                 continue;
2001
2002                         /*
2003                          * NOTE: We allow tranmissions through a BLOCKING
2004                          *       or LEARNING interface only as a last resort.
2005                          *       We DISALLOW both cases if the receiving
2006                          *
2007                          * NOTE: If we send a packet through a learning
2008                          *       interface the receiving end (if also in
2009                          *       LEARNING) will throw it away, so this is
2010                          *       the ultimate last resort.
2011                          */
2012                         switch(bif->bif_state) {
2013                         case BSTP_IFSTATE_BLOCKING:
2014                                 if (from_blocking == 0 &&
2015                                     bif->bif_priority + 256 > alt_priority) {
2016                                         alt_priority = bif->bif_priority + 256;
2017                                         alt_if = bif->bif_ifp;
2018                                 }
2019                                 continue;
2020                         case BSTP_IFSTATE_LEARNING:
2021                                 if (from_blocking == 0 &&
2022                                     bif->bif_priority > alt_priority) {
2023                                         alt_priority = bif->bif_priority;
2024                                         alt_if = bif->bif_ifp;
2025                                 }
2026                                 continue;
2027                         case BSTP_IFSTATE_L1BLOCKING:
2028                         case BSTP_IFSTATE_LISTENING:
2029                         case BSTP_IFSTATE_DISABLED:
2030                                 continue;
2031                         default:
2032                                 /* FORWARDING, BONDED */
2033                                 break;
2034                         }
2035
2036                         /*
2037                          * XXX we need to use the toepliz hash or
2038                          *     something like that instead of
2039                          *     round-robining.
2040                          */
2041                         if (sc->sc_ifp->if_flags & IFF_LINK2) {
2042                                 dst_if = bif->bif_ifp;
2043                                 if (++bif->bif_bond_count >=
2044                                     bif->bif_bond_weight) {
2045                                         bif->bif_bond_count = 0;
2046                                         TAILQ_REMOVE(&sc->sc_iflists[mycpuid],
2047                                                      bif, bif_next);
2048                                         TAILQ_INSERT_TAIL(
2049                                                      &sc->sc_iflists[mycpuid],
2050                                                      bif, bif_next);
2051                                 }
2052                                 priority = 1;
2053                                 break;
2054                         }
2055
2056                         /*
2057                          * Select best interface in the FORWARDING or
2058                          * BONDED set.  Well, there shouldn't be any
2059                          * in a BONDED state if LINK2 is not set (they
2060                          * will all be in a BLOCKING) state, but there
2061                          * could be a transitory condition here.
2062                          */
2063                         if (bif->bif_priority > priority) {
2064                                 priority = bif->bif_priority;
2065                                 dst_if = bif->bif_ifp;
2066                         }
2067                 }
2068
2069                 /*
2070                  * If no suitable interfaces were found but a suitable
2071                  * alternative interface was found, use the alternative
2072                  * interface.
2073                  */
2074                 if (priority == 0 && alt_if)
2075                         dst_if = alt_if;
2076         }
2077
2078         /*
2079          * At this point, we're dealing with a unicast frame
2080          * going to a different interface.
2081          */
2082         if ((dst_if->if_flags & IFF_RUNNING) == 0)
2083                 dst_if = NULL;
2084         return (dst_if);
2085 }
2086
2087
2088 /*
2089  * bridge_output:
2090  *
2091  *      Send output from a bridge member interface.  This
2092  *      performs the bridging function for locally originated
2093  *      packets.
2094  *
2095  *      The mbuf has the Ethernet header already attached.  We must
2096  *      enqueue or free the mbuf before returning.
2097  */
2098 static int
2099 bridge_output(struct ifnet *ifp, struct mbuf *m)
2100 {
2101         struct bridge_softc *sc = ifp->if_bridge;
2102         struct bridge_iflist *bif, *nbif;
2103         struct ether_header *eh;
2104         struct ifnet *dst_if, *alt_if, *bifp;
2105         int from_us;
2106         int alt_priority;
2107
2108         ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp);
2109         mbuftrackid(m, 65);
2110
2111         /*
2112          * Make sure that we are still a member of a bridge interface.
2113          */
2114         if (sc == NULL) {
2115                 m_freem(m);
2116                 return (0);
2117         }
2118         bifp = sc->sc_ifp;
2119
2120         /*
2121          * Acquire header
2122          */
2123         if (m->m_len < ETHER_HDR_LEN) {
2124                 m = m_pullup(m, ETHER_HDR_LEN);
2125                 if (m == NULL) {
2126                         bifp->if_oerrors++;
2127                         return (0);
2128                 }
2129         }
2130         eh = mtod(m, struct ether_header *);
2131         from_us = bridge_from_us(sc, eh);
2132
2133         /*
2134          * If bridge is down, but the original output interface is up,
2135          * go ahead and send out that interface.  Otherwise, the packet
2136          * is dropped below.
2137          */
2138         if ((bifp->if_flags & IFF_RUNNING) == 0) {
2139                 dst_if = ifp;
2140                 goto sendunicast;
2141         }
2142
2143         /*
2144          * If the packet is a multicast, or we don't know a better way to
2145          * get there, send to all interfaces.
2146          */
2147         if (ETHER_IS_MULTICAST(eh->ether_dhost))
2148                 dst_if = NULL;
2149         else
2150                 dst_if = bridge_rtlookup(sc, eh->ether_dhost);
2151
2152         if (dst_if == NULL) {
2153                 struct mbuf *mc;
2154                 int used = 0;
2155                 int found = 0;
2156
2157                 if (sc->sc_span)
2158                         bridge_span(sc, m);
2159
2160                 alt_if = NULL;
2161                 alt_priority = 0;
2162                 TAILQ_FOREACH_MUTABLE(bif, &sc->sc_iflists[mycpuid],
2163                                      bif_next, nbif) {
2164                         dst_if = bif->bif_ifp;
2165
2166                         if ((dst_if->if_flags & IFF_RUNNING) == 0)
2167                                 continue;
2168
2169                         /*
2170                          * If this is not the original output interface,
2171                          * and the interface is participating in spanning
2172                          * tree, make sure the port is in a state that
2173                          * allows forwarding.
2174                          *
2175                          * We keep track of a possible backup IF if we are
2176                          * unable to find any interfaces to forward through.
2177                          *
2178                          * NOTE: Currently round-robining is not implemented
2179                          *       across bonded interface groups (needs an
2180                          *       algorithm to track each group somehow).
2181                          *
2182                          *       Similarly we track only one alternative
2183                          *       interface if no suitable interfaces are
2184                          *       found.
2185                          */
2186                         if (dst_if != ifp &&
2187                             (bif->bif_flags & IFBIF_STP) != 0) {
2188                                 switch (bif->bif_state) {
2189                                 case BSTP_IFSTATE_BONDED:
2190                                         if (bif->bif_priority + 512 >
2191                                             alt_priority) {
2192                                                 alt_priority =
2193                                                     bif->bif_priority + 512;
2194                                                 alt_if = bif->bif_ifp;
2195                                         }
2196                                         continue;
2197                                 case BSTP_IFSTATE_BLOCKING:
2198                                         if (bif->bif_priority + 256 >
2199                                             alt_priority) {
2200                                                 alt_priority =
2201                                                     bif->bif_priority + 256;
2202                                                 alt_if = bif->bif_ifp;
2203                                         }
2204                                         continue;
2205                                 case BSTP_IFSTATE_LEARNING:
2206                                         if (bif->bif_priority > alt_priority) {
2207                                                 alt_priority =
2208                                                     bif->bif_priority;
2209                                                 alt_if = bif->bif_ifp;
2210                                         }
2211                                         continue;
2212                                 case BSTP_IFSTATE_L1BLOCKING:
2213                                 case BSTP_IFSTATE_LISTENING:
2214                                 case BSTP_IFSTATE_DISABLED:
2215                                         continue;
2216                                 default:
2217                                         /* FORWARDING */
2218                                         break;
2219                                 }
2220                         }
2221
2222                         KKASSERT(used == 0);
2223                         if (TAILQ_NEXT(bif, bif_next) == NULL) {
2224                                 used = 1;
2225                                 mc = m;
2226                         } else {
2227                                 mc = m_copypacket(m, MB_DONTWAIT);
2228                                 if (mc == NULL) {
2229                                         bifp->if_oerrors++;
2230                                         continue;
2231                                 }
2232                         }
2233
2234                         /*
2235                          * If the packet is 'from' us override ether_shost.
2236                          */
2237                         bridge_handoff(sc, dst_if, mc, from_us);
2238                         found = 1;
2239
2240                         if (nbif != NULL && !nbif->bif_onlist) {
2241                                 KKASSERT(bif->bif_onlist);
2242                                 nbif = TAILQ_NEXT(bif, bif_next);
2243                         }
2244                 }
2245
2246                 /*
2247                  * If we couldn't find anything use the backup interface
2248                  * if we have one.
2249                  */
2250                 if (found == 0 && alt_if) {
2251                         KKASSERT(used == 0);
2252                         mc = m;
2253                         used = 1;
2254                         bridge_handoff(sc, alt_if, mc, from_us);
2255                 }
2256
2257                 if (used == 0)
2258                         m_freem(m);
2259                 return (0);
2260         }
2261
2262         /*
2263          * Unicast
2264          */
2265 sendunicast:
2266         dst_if = bridge_select_unicast(sc, dst_if, 0, m);
2267
2268         if (sc->sc_span)
2269                 bridge_span(sc, m);
2270         if (dst_if == NULL)
2271                 m_freem(m);
2272         else
2273                 bridge_handoff(sc, dst_if, m, from_us);
2274         return (0);
2275 }
2276
2277 /*
2278  * Returns the bridge interface associated with an ifc.
2279  * Pass ifp->if_bridge (must not be NULL).  Used by the ARP
2280  * code to supply the bridge for the is-at info, making
2281  * the bridge responsible for matching local addresses.
2282  *
2283  * Without this the ARP code will supply bridge member interfaces
2284  * for the is-at which makes it difficult the bridge to fail-over
2285  * interfaces (amoung other things).
2286  */
2287 static struct ifnet *
2288 bridge_interface(void *if_bridge)
2289 {
2290         struct bridge_softc *sc = if_bridge;
2291         return (sc->sc_ifp);
2292 }
2293
2294 /*
2295  * bridge_start:
2296  *
2297  *      Start output on a bridge.
2298  */
2299 static void
2300 bridge_start(struct ifnet *ifp)
2301 {
2302         struct bridge_softc *sc = ifp->if_softc;
2303
2304         ASSERT_IFNET_SERIALIZED_TX(ifp);
2305
2306         ifq_set_oactive(&ifp->if_snd);
2307         for (;;) {
2308                 struct ifnet *dst_if = NULL;
2309                 struct ether_header *eh;
2310                 struct mbuf *m;
2311
2312                 m = ifq_dequeue(&ifp->if_snd, NULL);
2313                 if (m == NULL)
2314                         break;
2315                 mbuftrackid(m, 75);
2316
2317                 if (m->m_len < sizeof(*eh)) {
2318                         m = m_pullup(m, sizeof(*eh));
2319                         if (m == NULL) {
2320                                 ifp->if_oerrors++;
2321                                 continue;
2322                         }
2323                 }
2324                 eh = mtod(m, struct ether_header *);
2325
2326                 BPF_MTAP(ifp, m);
2327                 ifp->if_opackets++;
2328
2329                 if ((m->m_flags & (M_BCAST|M_MCAST)) == 0)
2330                         dst_if = bridge_rtlookup(sc, eh->ether_dhost);
2331
2332                 /*
2333                  * Multicast or broadcast
2334                  */
2335                 if (dst_if == NULL) {
2336                         bridge_start_bcast(sc, m);
2337                         continue;
2338                 }
2339
2340                 /*
2341                  * Unicast
2342                  */
2343                 dst_if = bridge_select_unicast(sc, dst_if, 0, m);
2344
2345                 if (dst_if == NULL)
2346                         m_freem(m);
2347                 else
2348                         bridge_enqueue(dst_if, m);
2349         }
2350         ifq_clr_oactive(&ifp->if_snd);
2351 }
2352
2353 /*
2354  * bridge_forward:
2355  *
2356  *      Forward packets received on a bridge interface via the input
2357  *      path.
2358  *
2359  *      This implements the forwarding function of the bridge.
2360  */
2361 static void
2362 bridge_forward(struct bridge_softc *sc, struct mbuf *m)
2363 {
2364         struct bridge_iflist *bif;
2365         struct ifnet *src_if, *dst_if, *ifp;
2366         struct ether_header *eh;
2367         int from_blocking;
2368
2369         mbuftrackid(m, 66);
2370         src_if = m->m_pkthdr.rcvif;
2371         ifp = sc->sc_ifp;
2372
2373         ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp);
2374
2375         ifp->if_ipackets++;
2376         ifp->if_ibytes += m->m_pkthdr.len;
2377
2378         /*
2379          * Look up the bridge_iflist.
2380          */
2381         bif = bridge_lookup_member_if(sc, src_if);
2382         if (bif == NULL) {
2383                 /* Interface is not a bridge member (anymore?) */
2384                 m_freem(m);
2385                 return;
2386         }
2387
2388         /*
2389          * In spanning tree mode receiving a packet from an interface
2390          * in a BLOCKING state is allowed, it could be a member of last
2391          * resort from the sender's point of view, but forwarding it is
2392          * not allowed.
2393          *
2394          * The sender's spanning tree will eventually sync up and the
2395          * sender will go into a BLOCKING state too (but this still may be
2396          * an interface of last resort during state changes).
2397          */
2398         if (bif->bif_flags & IFBIF_STP) {
2399                 switch (bif->bif_state) {
2400                 case BSTP_IFSTATE_L1BLOCKING:
2401                 case BSTP_IFSTATE_LISTENING:
2402                 case BSTP_IFSTATE_DISABLED:
2403                         m_freem(m);
2404                         return;
2405                 default:
2406                         /* learning, blocking, bonded, forwarding */
2407                         break;
2408                 }
2409         }
2410         from_blocking = (bif->bif_state == BSTP_IFSTATE_BLOCKING);
2411
2412         eh = mtod(m, struct ether_header *);
2413
2414         /*
2415          * If the interface is learning, and the source
2416          * address is valid and not multicast, record
2417          * the address.
2418          */
2419         if ((bif->bif_flags & IFBIF_LEARNING) != 0 &&
2420             from_blocking == 0 &&
2421             ETHER_IS_MULTICAST(eh->ether_shost) == 0 &&
2422             (eh->ether_shost[0] == 0 &&
2423              eh->ether_shost[1] == 0 &&
2424              eh->ether_shost[2] == 0 &&
2425              eh->ether_shost[3] == 0 &&
2426              eh->ether_shost[4] == 0 &&
2427              eh->ether_shost[5] == 0) == 0) {
2428                 bridge_rtupdate(sc, eh->ether_shost, src_if, IFBAF_DYNAMIC);
2429         }
2430
2431         /*
2432          * Don't forward from an interface in the listening or learning
2433          * state.  That is, in the learning state we learn information
2434          * but we throw away the packets.
2435          *
2436          * We let through packets on interfaces in the blocking state.
2437          * The blocking state is applicable to the send side, not the
2438          * receive side.
2439          */
2440         if ((bif->bif_flags & IFBIF_STP) != 0 &&
2441             (bif->bif_state == BSTP_IFSTATE_LISTENING ||
2442              bif->bif_state == BSTP_IFSTATE_LEARNING)) {
2443                 m_freem(m);
2444                 return;
2445         }
2446
2447         /*
2448          * At this point, the port either doesn't participate
2449          * in spanning tree or it is in the forwarding state.
2450          */
2451
2452         /*
2453          * If the packet is unicast, destined for someone on
2454          * "this" side of the bridge, drop it.
2455          *
2456          * src_if implies the entire bonding set so we have to compare MAC
2457          * addresses and not just if pointers.
2458          */
2459         if ((m->m_flags & (M_BCAST|M_MCAST)) == 0) {
2460                 dst_if = bridge_rtlookup(sc, eh->ether_dhost);
2461                 if (dst_if && memcmp(IF_LLADDR(src_if), IF_LLADDR(dst_if),
2462                                      ETHER_ADDR_LEN) == 0) {
2463                         m_freem(m);
2464                         return;
2465                 }
2466         } else {
2467                 /* ...forward it to all interfaces. */
2468                 ifp->if_imcasts++;
2469                 dst_if = NULL;
2470         }
2471
2472         /*
2473          * Brodcast if we do not have forwarding information.  However, if
2474          * we received the packet on a blocking interface we do not do this
2475          * (unless you really want to blow up your network).
2476          */
2477         if (dst_if == NULL) {
2478                 if (from_blocking)
2479                         m_freem(m);
2480                 else
2481                         bridge_broadcast(sc, src_if, m);
2482                 return;
2483         }
2484
2485         dst_if = bridge_select_unicast(sc, dst_if, from_blocking, m);
2486
2487         if (dst_if == NULL) {
2488                 m_freem(m);
2489                 return;
2490         }
2491
2492         if (inet_pfil_hook.ph_hashooks > 0
2493 #ifdef INET6
2494             || inet6_pfil_hook.ph_hashooks > 0
2495 #endif
2496             ) {
2497                 if (bridge_pfil(&m, ifp, src_if, PFIL_IN) != 0)
2498                         return;
2499                 if (m == NULL)
2500                         return;
2501
2502                 if (bridge_pfil(&m, ifp, dst_if, PFIL_OUT) != 0)
2503                         return;
2504                 if (m == NULL)
2505                         return;
2506         }
2507         bridge_handoff(sc, dst_if, m, 0);
2508 }
2509
2510 /*
2511  * bridge_input:
2512  *
2513  *      Receive input from a member interface.  Queue the packet for
2514  *      bridging if it is not for us.
2515  */
2516 static struct mbuf *
2517 bridge_input(struct ifnet *ifp, struct mbuf *m)
2518 {
2519         struct bridge_softc *sc = ifp->if_bridge;
2520         struct bridge_iflist *bif;
2521         struct ifnet *bifp, *new_ifp;
2522         struct ether_header *eh;
2523         struct mbuf *mc, *mc2;
2524
2525         ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp);
2526         mbuftrackid(m, 67);
2527
2528         /*
2529          * Make sure that we are still a member of a bridge interface.
2530          */
2531         if (sc == NULL)
2532                 return m;
2533
2534         new_ifp = NULL;
2535         bifp = sc->sc_ifp;
2536
2537         if ((bifp->if_flags & IFF_RUNNING) == 0)
2538                 goto out;
2539
2540         /*
2541          * Implement support for bridge monitoring.  If this flag has been
2542          * set on this interface, discard the packet once we push it through
2543          * the bpf(4) machinery, but before we do, increment various counters
2544          * associated with this bridge.
2545          */
2546         if (bifp->if_flags & IFF_MONITOR) {
2547                 /* Change input interface to this bridge */
2548                 m->m_pkthdr.rcvif = bifp;
2549
2550                 BPF_MTAP(bifp, m);
2551
2552                 /* Update bridge's ifnet statistics */
2553                 bifp->if_ipackets++;
2554                 bifp->if_ibytes += m->m_pkthdr.len;
2555                 if (m->m_flags & (M_MCAST | M_BCAST))
2556                         bifp->if_imcasts++;
2557
2558                 m_freem(m);
2559                 m = NULL;
2560                 goto out;
2561         }
2562
2563         /*
2564          * Handle the ether_header
2565          *
2566          * In all cases if the packet is destined for us via our MAC
2567          * we must clear BRIDGE_MBUF_TAGGED to ensure that we don't
2568          * repeat the source MAC out the same interface.
2569          *
2570          * This first test against our bridge MAC is the fast-path.
2571          *
2572          * NOTE!  The bridge interface can serve as an endpoint for
2573          *        communication but normally there are no IPs associated
2574          *        with it so you cannot route through it.  Instead what
2575          *        you do is point your default route *THROUGH* the bridge
2576          *        to the actual default router for one of the bridged spaces.
2577          *
2578          *        Another possibility is to put all your IP specifications
2579          *        on the bridge instead of on the individual interfaces.  If
2580          *        you do this it should be possible to use the bridge as an
2581          *        end point and route (rather than switch) through it using
2582          *        the default route or ipfw forwarding rules.
2583          */
2584
2585         /*
2586          * Acquire header
2587          */
2588         if (m->m_len < ETHER_HDR_LEN) {
2589                 m = m_pullup(m, ETHER_HDR_LEN);
2590                 if (m == NULL)
2591                         goto out;
2592         }
2593         eh = mtod(m, struct ether_header *);
2594         m->m_pkthdr.fw_flags |= BRIDGE_MBUF_TAGGED;
2595         bcopy(eh, &m->m_pkthdr.br.ether, sizeof(*eh));
2596
2597         if ((bridge_debug & 1) &&
2598             (ntohs(eh->ether_type) == ETHERTYPE_ARP ||
2599             ntohs(eh->ether_type) == ETHERTYPE_REVARP)) {
2600                 kprintf("%02x:%02x:%02x:%02x:%02x:%02x "
2601                         "%02x:%02x:%02x:%02x:%02x:%02x type %04x "
2602                         "lla %02x:%02x:%02x:%02x:%02x:%02x\n",
2603                         eh->ether_dhost[0],
2604                         eh->ether_dhost[1],
2605                         eh->ether_dhost[2],
2606                         eh->ether_dhost[3],
2607                         eh->ether_dhost[4],
2608                         eh->ether_dhost[5],
2609                         eh->ether_shost[0],
2610                         eh->ether_shost[1],
2611                         eh->ether_shost[2],
2612                         eh->ether_shost[3],
2613                         eh->ether_shost[4],
2614                         eh->ether_shost[5],
2615                         eh->ether_type,
2616                         ((u_char *)IF_LLADDR(bifp))[0],
2617                         ((u_char *)IF_LLADDR(bifp))[1],
2618                         ((u_char *)IF_LLADDR(bifp))[2],
2619                         ((u_char *)IF_LLADDR(bifp))[3],
2620                         ((u_char *)IF_LLADDR(bifp))[4],
2621                         ((u_char *)IF_LLADDR(bifp))[5]
2622                 );
2623         }
2624
2625         if (memcmp(eh->ether_dhost, IF_LLADDR(bifp), ETHER_ADDR_LEN) == 0) {
2626                 /*
2627                  * If the packet is for us, set the packets source as the
2628                  * bridge, and return the packet back to ifnet.if_input for
2629                  * local processing.
2630                  */
2631                 m->m_pkthdr.fw_flags &= ~BRIDGE_MBUF_TAGGED;
2632                 KASSERT(bifp->if_bridge == NULL,
2633                         ("loop created in bridge_input"));
2634                 if (pfil_member != 0) {
2635                         if (inet_pfil_hook.ph_hashooks > 0
2636 #ifdef INET6
2637                             || inet6_pfil_hook.ph_hashooks > 0
2638 #endif
2639                         ) {
2640                                 if (bridge_pfil(&m, NULL, ifp, PFIL_IN) != 0)
2641                                         goto out;
2642                                 if (m == NULL)
2643                                         goto out;
2644                         }
2645                 }
2646                 new_ifp = bifp;
2647                 goto out;
2648         }
2649
2650         /*
2651          * Tap all packets arriving on the bridge, no matter if
2652          * they are local destinations or not.  In is in.
2653          */
2654         BPF_MTAP(bifp, m);
2655
2656         bif = bridge_lookup_member_if(sc, ifp);
2657         if (bif == NULL)
2658                 goto out;
2659
2660         if (sc->sc_span)
2661                 bridge_span(sc, m);
2662
2663         if (m->m_flags & (M_BCAST | M_MCAST)) {
2664                 /*
2665                  * Tap off 802.1D packets; they do not get forwarded.
2666                  */
2667                 if (memcmp(eh->ether_dhost, bstp_etheraddr,
2668                             ETHER_ADDR_LEN) == 0) {
2669                         ifnet_serialize_all(bifp);
2670                         bstp_input(sc, bif, m);
2671                         ifnet_deserialize_all(bifp);
2672
2673                         /* m is freed by bstp_input */
2674                         m = NULL;
2675                         goto out;
2676                 }
2677
2678                 /*
2679                  * Other than 802.11d packets, ignore packets if the
2680                  * interface is not in a good state.
2681                  *
2682                  * NOTE: Broadcast/mcast packets received on a blocking or
2683                  *       learning interface are allowed for local processing.
2684                  *
2685                  *       The sending side of a blocked port will stop
2686                  *       transmitting when a better alternative is found.
2687                  *       However, later on we will disallow the forwarding
2688                  *       of bcast/mcsat packets over a blocking interface.
2689                  */
2690                 if (bif->bif_flags & IFBIF_STP) {
2691                         switch (bif->bif_state) {
2692                         case BSTP_IFSTATE_L1BLOCKING:
2693                         case BSTP_IFSTATE_LISTENING:
2694                         case BSTP_IFSTATE_DISABLED:
2695                                 goto out;
2696                         default:
2697                                 /* blocking, learning, bonded, forwarding */
2698                                 break;
2699                         }
2700                 }
2701
2702                 /*
2703                  * Make a deep copy of the packet and enqueue the copy
2704                  * for bridge processing; return the original packet for
2705                  * local processing.
2706                  */
2707                 mc = m_dup(m, MB_DONTWAIT);
2708                 if (mc == NULL)
2709                         goto out;
2710
2711                 /*
2712                  * It's just too dangerous to allow bcast/mcast over a
2713                  * blocked interface, eventually the network will sort
2714                  * itself out and a better path will be found.
2715                  */
2716                 if ((bif->bif_flags & IFBIF_STP) == 0 ||
2717                     bif->bif_state != BSTP_IFSTATE_BLOCKING) {
2718                         bridge_forward(sc, mc);
2719                 }
2720
2721                 /*
2722                  * Reinject the mbuf as arriving on the bridge so we have a
2723                  * chance at claiming multicast packets. We can not loop back
2724                  * here from ether_input as a bridge is never a member of a
2725                  * bridge.
2726                  */
2727                 KASSERT(bifp->if_bridge == NULL,
2728                         ("loop created in bridge_input"));
2729                 mc2 = m_dup(m, MB_DONTWAIT);
2730 #ifdef notyet
2731                 if (mc2 != NULL) {
2732                         /* Keep the layer3 header aligned */
2733                         int i = min(mc2->m_pkthdr.len, max_protohdr);
2734                         mc2 = m_copyup(mc2, i, ETHER_ALIGN);
2735                 }
2736 #endif
2737                 if (mc2 != NULL) {
2738                         /*
2739                          * Don't tap to bpf(4) again; we have already done
2740                          * the tapping.
2741                          *
2742                          * Leave m_pkthdr.rcvif alone, so ARP replies are
2743                          * processed as coming in on the correct interface.
2744                          *
2745                          * Clear the bridge flag for local processing in
2746                          * case the packet gets routed.
2747                          */
2748                         mc2->m_pkthdr.fw_flags &= ~BRIDGE_MBUF_TAGGED;
2749                         ether_reinput_oncpu(bifp, mc2, 0);
2750                 }
2751
2752                 /* Return the original packet for local processing. */
2753                 goto out;
2754         }
2755
2756         /*
2757          * Input of a unicast packet.  We have to allow unicast packets
2758          * input from links in the BLOCKING state as this might be an
2759          * interface of last resort.
2760          *
2761          * NOTE: We explicitly ignore normal packets received on a link
2762          *       in the BLOCKING state.  The point of being in that state
2763          *       is to avoid getting duplicate packets.
2764          *
2765          *       HOWEVER, if LINK2 is set the normal spanning tree code
2766          *       will mark an interface BLOCKING to avoid multi-cast/broadcast
2767          *       loops.  Unicast packets CAN still loop if we allow the
2768          *       case (hence we only do it in LINK2), but it isn't quite as
2769          *       bad as a broadcast packet looping.
2770          */
2771         if (bif->bif_flags & IFBIF_STP) {
2772                 switch (bif->bif_state) {
2773                 case BSTP_IFSTATE_L1BLOCKING:
2774                 case BSTP_IFSTATE_LISTENING:
2775                 case BSTP_IFSTATE_DISABLED:
2776                         goto out;
2777                 default:
2778                         /* blocking, bonded, forwarding, learning */
2779                         break;
2780                 }
2781         }
2782
2783         /*
2784          * Unicast.  Make sure it's not for us.
2785          *
2786          * This loop is MPSAFE; the only blocking operation (bridge_rtupdate)
2787          * is followed by breaking out of the loop.
2788          */
2789         TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
2790                 if (bif->bif_ifp->if_type != IFT_ETHER)
2791                         continue;
2792
2793                 /*
2794                  * It is destined for an interface linked to the bridge.
2795                  * We want the bridge itself to take care of link level
2796                  * forwarding to member interfaces so reinput on the bridge.
2797                  * i.e. if you ping an IP on a target interface associated
2798                  * with the bridge, the arp is-at response should indicate
2799                  * the bridge MAC.
2800                  *
2801                  * Only update our addr list when learning if the port
2802                  * is not in a blocking state.  If it is we still allow
2803                  * the packet but we do not try to learn from it.
2804                  */
2805                 if (memcmp(IF_LLADDR(bif->bif_ifp), eh->ether_dhost,
2806                            ETHER_ADDR_LEN) == 0) {
2807                         if (bif->bif_ifp != ifp) {
2808                                 /* XXX loop prevention */
2809                                 m->m_flags |= M_ETHER_BRIDGED;
2810                         }
2811                         if ((bif->bif_flags & IFBIF_LEARNING) &&
2812                             bif->bif_state != BSTP_IFSTATE_BLOCKING) {
2813                                 bridge_rtupdate(sc, eh->ether_shost,
2814                                                 ifp, IFBAF_DYNAMIC);
2815                         }
2816                         new_ifp = bifp; /* not bif->bif_ifp */
2817                         m->m_pkthdr.fw_flags &= ~BRIDGE_MBUF_TAGGED;
2818                         goto out;
2819                 }
2820
2821                 /*
2822                  * Ignore received packets that were sent by us.
2823                  */
2824                 if (memcmp(IF_LLADDR(bif->bif_ifp), eh->ether_shost,
2825                            ETHER_ADDR_LEN) == 0) {
2826                         m_freem(m);
2827                         m = NULL;
2828                         goto out;
2829                 }
2830         }
2831
2832         /*
2833          * It isn't for us.
2834          *
2835          * Perform the bridge forwarding function, but disallow bridging
2836          * to interfaces in the blocking state if the packet came in on
2837          * an interface in the blocking state.
2838          */
2839         bridge_forward(sc, m);
2840         m = NULL;
2841
2842         /*
2843          * ether_reinput_oncpu() will reprocess rcvif as
2844          * coming from new_ifp (since we do not specify
2845          * REINPUT_KEEPRCVIF).
2846          */
2847 out:
2848         if (new_ifp != NULL) {
2849                 /*
2850                  * Clear the bridge flag for local processing in
2851                  * case the packet gets routed.
2852                  */
2853                 ether_reinput_oncpu(new_ifp, m, REINPUT_RUNBPF);
2854                 m = NULL;
2855         }
2856         return (m);
2857 }
2858
2859 /*
2860  * bridge_start_bcast:
2861  *
2862  *      Broadcast the packet sent from bridge to all member
2863  *      interfaces.
2864  *      This is a simplified version of bridge_broadcast(), however,
2865  *      this function expects caller to hold bridge's serializer.
2866  */
2867 static void
2868 bridge_start_bcast(struct bridge_softc *sc, struct mbuf *m)
2869 {
2870         struct bridge_iflist *bif;
2871         struct mbuf *mc;
2872         struct ifnet *dst_if, *alt_if, *bifp;
2873         int used = 0;
2874         int found = 0;
2875         int alt_priority;
2876
2877         mbuftrackid(m, 68);
2878         bifp = sc->sc_ifp;
2879         ASSERT_IFNET_SERIALIZED_ALL(bifp);
2880
2881         /*
2882          * Following loop is MPSAFE; nothing is blocking
2883          * in the loop body.
2884          *
2885          * NOTE: We transmit through an member in the BLOCKING state only
2886          *       as a last resort.
2887          */
2888         alt_if = NULL;
2889         alt_priority = 0;
2890
2891         TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
2892                 dst_if = bif->bif_ifp;
2893
2894                 if (bif->bif_flags & IFBIF_STP) {
2895                         switch (bif->bif_state) {
2896                         case BSTP_IFSTATE_BLOCKING:
2897                                 if (bif->bif_priority > alt_priority) {
2898                                         alt_priority = bif->bif_priority;
2899                                         alt_if = bif->bif_ifp;
2900                                 }
2901                                 /* fall through */
2902                         case BSTP_IFSTATE_L1BLOCKING:
2903                         case BSTP_IFSTATE_DISABLED:
2904                                 continue;
2905                         default:
2906                                 /* listening, learning, bonded, forwarding */
2907                                 break;
2908                         }
2909                 }
2910
2911                 if ((bif->bif_flags & IFBIF_DISCOVER) == 0 &&
2912                     (m->m_flags & (M_BCAST|M_MCAST)) == 0)
2913                         continue;
2914
2915                 if ((dst_if->if_flags & IFF_RUNNING) == 0)
2916                         continue;
2917
2918                 if (TAILQ_NEXT(bif, bif_next) == NULL) {
2919                         mc = m;
2920                         used = 1;
2921                 } else {
2922                         mc = m_copypacket(m, MB_DONTWAIT);
2923                         if (mc == NULL) {
2924                                 bifp->if_oerrors++;
2925                                 continue;
2926                         }
2927                 }
2928                 found = 1;
2929                 bridge_enqueue(dst_if, mc);
2930         }
2931
2932         if (found == 0 && alt_if) {
2933                 KKASSERT(used == 0);
2934                 mc = m;
2935                 used = 1;
2936                 bridge_enqueue(alt_if, mc);
2937         }
2938
2939         if (used == 0)
2940                 m_freem(m);
2941 }
2942
2943 /*
2944  * bridge_broadcast:
2945  *
2946  *      Send a frame to all interfaces that are members of
2947  *      the bridge, except for the one on which the packet
2948  *      arrived.
2949  */
2950 static void
2951 bridge_broadcast(struct bridge_softc *sc, struct ifnet *src_if,
2952                  struct mbuf *m)
2953 {
2954         struct bridge_iflist *bif, *nbif;
2955         struct ether_header *eh;
2956         struct mbuf *mc;
2957         struct ifnet *dst_if, *alt_if, *bifp;
2958         int used;
2959         int found;
2960         int alt_priority;
2961         int from_us;
2962
2963         mbuftrackid(m, 69);
2964         bifp = sc->sc_ifp;
2965         ASSERT_IFNET_NOT_SERIALIZED_ALL(bifp);
2966
2967         eh = mtod(m, struct ether_header *);
2968         from_us = bridge_from_us(sc, eh);
2969
2970         if (inet_pfil_hook.ph_hashooks > 0
2971 #ifdef INET6
2972             || inet6_pfil_hook.ph_hashooks > 0
2973 #endif
2974             ) {
2975                 if (bridge_pfil(&m, bifp, src_if, PFIL_IN) != 0)
2976                         return;
2977                 if (m == NULL)
2978                         return;
2979
2980                 /* Filter on the bridge interface before broadcasting */
2981                 if (bridge_pfil(&m, bifp, NULL, PFIL_OUT) != 0)
2982                         return;
2983                 if (m == NULL)
2984                         return;
2985         }
2986
2987         alt_if = NULL;
2988         alt_priority = 0;
2989         found = 0;
2990         used = 0;
2991
2992         TAILQ_FOREACH_MUTABLE(bif, &sc->sc_iflists[mycpuid], bif_next, nbif) {
2993                 dst_if = bif->bif_ifp;
2994
2995                 if ((dst_if->if_flags & IFF_RUNNING) == 0)
2996                         continue;
2997
2998                 /*
2999                  * Don't bounce the packet out the same interface it came
3000                  * in on.  We have to test MAC addresses because a packet
3001                  * can come in a bonded interface and we don't want it to
3002                  * be echod out the forwarding interface for the same bonding
3003                  * set.
3004                  */
3005                 if (src_if && memcmp(IF_LLADDR(src_if), IF_LLADDR(dst_if),
3006                                      ETHER_ADDR_LEN) == 0) {
3007                         continue;
3008                 }
3009
3010                 /*
3011                  * Generally speaking we only broadcast through forwarding
3012                  * interfaces.  If no interfaces are available we select
3013                  * a BONDED, BLOCKING, or LEARNING interface to forward
3014                  * through.
3015                  */
3016                 if (bif->bif_flags & IFBIF_STP) {
3017                         switch (bif->bif_state) {
3018                         case BSTP_IFSTATE_BONDED:
3019                                 if (bif->bif_priority + 512 > alt_priority) {
3020                                         alt_priority = bif->bif_priority + 512;
3021                                         alt_if = bif->bif_ifp;
3022                                 }
3023                                 continue;
3024                         case BSTP_IFSTATE_BLOCKING:
3025                                 if (bif->bif_priority + 256 > alt_priority) {
3026                                         alt_priority = bif->bif_priority + 256;
3027                                         alt_if = bif->bif_ifp;
3028                                 }
3029                                 continue;
3030                         case BSTP_IFSTATE_LEARNING:
3031                                 if (bif->bif_priority > alt_priority) {
3032                                         alt_priority = bif->bif_priority;
3033                                         alt_if = bif->bif_ifp;
3034                                 }
3035                                 continue;
3036                         case BSTP_IFSTATE_L1BLOCKING:
3037                         case BSTP_IFSTATE_DISABLED:
3038                         case BSTP_IFSTATE_LISTENING:
3039                                 continue;
3040                         default:
3041                                 /* forwarding */
3042                                 break;
3043                         }
3044                 }
3045
3046                 if ((bif->bif_flags & IFBIF_DISCOVER) == 0 &&
3047                     (m->m_flags & (M_BCAST|M_MCAST)) == 0) {
3048                         continue;
3049                 }
3050
3051                 if (TAILQ_NEXT(bif, bif_next) == NULL) {
3052                         mc = m;
3053                         used = 1;
3054                 } else {
3055                         mc = m_copypacket(m, MB_DONTWAIT);
3056                         if (mc == NULL) {
3057                                 sc->sc_ifp->if_oerrors++;
3058                                 continue;
3059                         }
3060                 }
3061                 found = 1;
3062
3063                 /*
3064                  * Filter on the output interface.  Pass a NULL bridge
3065                  * interface pointer so we do not redundantly filter on
3066                  * the bridge for each interface we broadcast on.
3067                  */
3068                 if (inet_pfil_hook.ph_hashooks > 0
3069 #ifdef INET6
3070                     || inet6_pfil_hook.ph_hashooks > 0
3071 #endif
3072                     ) {
3073                         if (bridge_pfil(&mc, NULL, dst_if, PFIL_OUT) != 0)
3074                                 continue;
3075                         if (mc == NULL)
3076                                 continue;
3077                 }
3078                 bridge_handoff(sc, dst_if, mc, from_us);
3079
3080                 if (nbif != NULL && !nbif->bif_onlist) {
3081                         KKASSERT(bif->bif_onlist);
3082                         nbif = TAILQ_NEXT(bif, bif_next);
3083                 }
3084         }
3085
3086         if (found == 0 && alt_if) {
3087                 KKASSERT(used == 0);
3088                 mc = m;
3089                 used = 1;
3090                 bridge_enqueue(alt_if, mc);
3091         }
3092
3093         if (used == 0)
3094                 m_freem(m);
3095 }
3096
3097 /*
3098  * bridge_span:
3099  *
3100  *      Duplicate a packet out one or more interfaces that are in span mode,
3101  *      the original mbuf is unmodified.
3102  */
3103 static void
3104 bridge_span(struct bridge_softc *sc, struct mbuf *m)
3105 {
3106         struct bridge_iflist *bif;
3107         struct ifnet *dst_if, *bifp;
3108         struct mbuf *mc;
3109
3110         mbuftrackid(m, 70);
3111         bifp = sc->sc_ifp;
3112         ifnet_serialize_all(bifp);
3113
3114         TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) {
3115                 dst_if = bif->bif_ifp;
3116
3117                 if ((dst_if->if_flags & IFF_RUNNING) == 0)
3118                         continue;
3119
3120                 mc = m_copypacket(m, MB_DONTWAIT);
3121                 if (mc == NULL) {
3122                         sc->sc_ifp->if_oerrors++;
3123                         continue;
3124                 }
3125                 bridge_enqueue(dst_if, mc);
3126         }
3127
3128         ifnet_deserialize_all(bifp);
3129 }
3130
3131 static void
3132 bridge_rtmsg_sync_handler(netmsg_t msg)
3133 {
3134         ifnet_forwardmsg(&msg->lmsg, mycpuid + 1);
3135 }
3136
3137 static void
3138 bridge_rtmsg_sync(struct bridge_softc *sc)
3139 {
3140         struct netmsg_base msg;
3141
3142         ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
3143
3144         netmsg_init(&msg, NULL, &curthread->td_msgport,
3145                     0, bridge_rtmsg_sync_handler);
3146         ifnet_domsg(&msg.lmsg, 0);
3147 }
3148
3149 static __inline void
3150 bridge_rtinfo_update(struct bridge_rtinfo *bri, struct ifnet *dst_if,
3151                      int setflags, uint8_t flags, uint32_t timeo)
3152 {
3153         if ((bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
3154             bri->bri_ifp != dst_if)
3155                 bri->bri_ifp = dst_if;
3156         if ((flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
3157             bri->bri_expire != time_second + timeo)
3158                 bri->bri_expire = time_second + timeo;
3159         if (setflags)
3160                 bri->bri_flags = flags;
3161 }
3162
3163 static int
3164 bridge_rtinstall_oncpu(struct bridge_softc *sc, const uint8_t *dst,
3165                        struct ifnet *dst_if, int setflags, uint8_t flags,
3166                        struct bridge_rtinfo **bri0)
3167 {
3168         struct bridge_rtnode *brt;
3169         struct bridge_rtinfo *bri;
3170
3171         if (mycpuid == 0) {
3172                 brt = bridge_rtnode_lookup(sc, dst);
3173                 if (brt != NULL) {
3174                         /*
3175                          * rtnode for 'dst' already exists.  We inform the
3176                          * caller about this by leaving bri0 as NULL.  The
3177                          * caller will terminate the intallation upon getting
3178                          * NULL bri0.  However, we still need to update the
3179                          * rtinfo.
3180                          */
3181                         KKASSERT(*bri0 == NULL);
3182
3183                         /* Update rtinfo */
3184                         bridge_rtinfo_update(brt->brt_info, dst_if, setflags,
3185                                              flags, sc->sc_brttimeout);
3186                         return 0;
3187                 }
3188
3189                 /*
3190                  * We only need to check brtcnt on CPU0, since if limit
3191                  * is to be exceeded, ENOSPC is returned.  Caller knows
3192                  * this and will terminate the installation.
3193                  */
3194                 if (sc->sc_brtcnt >= sc->sc_brtmax)
3195                         return ENOSPC;
3196
3197                 KKASSERT(*bri0 == NULL);
3198                 bri = kmalloc(sizeof(struct bridge_rtinfo), M_DEVBUF,
3199                                   M_WAITOK | M_ZERO);
3200                 *bri0 = bri;
3201
3202                 /* Setup rtinfo */
3203                 bri->bri_flags = IFBAF_DYNAMIC;
3204                 bridge_rtinfo_update(bri, dst_if, setflags, flags,
3205                                      sc->sc_brttimeout);
3206         } else {
3207                 bri = *bri0;
3208                 KKASSERT(bri != NULL);
3209         }
3210
3211         brt = kmalloc(sizeof(struct bridge_rtnode), M_DEVBUF,
3212                       M_WAITOK | M_ZERO);
3213         memcpy(brt->brt_addr, dst, ETHER_ADDR_LEN);
3214         brt->brt_info = bri;
3215
3216         bridge_rtnode_insert(sc, brt);
3217         return 0;
3218 }
3219
3220 static void
3221 bridge_rtinstall_handler(netmsg_t msg)
3222 {
3223         struct netmsg_brsaddr *brmsg = (struct netmsg_brsaddr *)msg;
3224         int error;
3225
3226         error = bridge_rtinstall_oncpu(brmsg->br_softc,
3227                                        brmsg->br_dst, brmsg->br_dst_if,
3228                                        brmsg->br_setflags, brmsg->br_flags,
3229                                        &brmsg->br_rtinfo);
3230         if (error) {
3231                 KKASSERT(mycpuid == 0 && brmsg->br_rtinfo == NULL);
3232                 lwkt_replymsg(&brmsg->base.lmsg, error);
3233                 return;
3234         } else if (brmsg->br_rtinfo == NULL) {
3235                 /* rtnode already exists for 'dst' */
3236                 KKASSERT(mycpuid == 0);
3237                 lwkt_replymsg(&brmsg->base.lmsg, 0);
3238                 return;
3239         }
3240         ifnet_forwardmsg(&brmsg->base.lmsg, mycpuid + 1);
3241 }
3242
3243 /*
3244  * bridge_rtupdate:
3245  *
3246  *      Add/Update a bridge routing entry.
3247  */
3248 static int
3249 bridge_rtupdate(struct bridge_softc *sc, const uint8_t *dst,
3250                 struct ifnet *dst_if, uint8_t flags)
3251 {
3252         struct bridge_rtnode *brt;
3253
3254         /*
3255          * A route for this destination might already exist.  If so,
3256          * update it, otherwise create a new one.
3257          */
3258         if ((brt = bridge_rtnode_lookup(sc, dst)) == NULL) {
3259                 struct netmsg_brsaddr *brmsg;
3260
3261                 if (sc->sc_brtcnt >= sc->sc_brtmax)
3262                         return ENOSPC;
3263
3264                 brmsg = kmalloc(sizeof(*brmsg), M_LWKTMSG, M_WAITOK | M_NULLOK);
3265                 if (brmsg == NULL)
3266                         return ENOMEM;
3267
3268                 netmsg_init(&brmsg->base, NULL, &netisr_afree_rport,
3269                             0, bridge_rtinstall_handler);
3270                 memcpy(brmsg->br_dst, dst, ETHER_ADDR_LEN);
3271                 brmsg->br_dst_if = dst_if;
3272                 brmsg->br_flags = flags;
3273                 brmsg->br_setflags = 0;
3274                 brmsg->br_softc = sc;
3275                 brmsg->br_rtinfo = NULL;
3276
3277                 ifnet_sendmsg(&brmsg->base.lmsg, 0);
3278                 return 0;
3279         }
3280         bridge_rtinfo_update(brt->brt_info, dst_if, 0, flags,
3281                              sc->sc_brttimeout);
3282         return 0;
3283 }
3284
3285 static int
3286 bridge_rtsaddr(struct bridge_softc *sc, const uint8_t *dst,
3287                struct ifnet *dst_if, uint8_t flags)
3288 {
3289         struct netmsg_brsaddr brmsg;
3290
3291         ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
3292
3293         netmsg_init(&brmsg.base, NULL, &curthread->td_msgport,
3294                     0, bridge_rtinstall_handler);
3295         memcpy(brmsg.br_dst, dst, ETHER_ADDR_LEN);
3296         brmsg.br_dst_if = dst_if;
3297         brmsg.br_flags = flags;
3298         brmsg.br_setflags = 1;
3299         brmsg.br_softc = sc;
3300         brmsg.br_rtinfo = NULL;
3301
3302         return ifnet_domsg(&brmsg.base.lmsg, 0);
3303 }
3304
3305 /*
3306  * bridge_rtlookup:
3307  *
3308  *      Lookup the destination interface for an address.
3309  */
3310 static struct ifnet *
3311 bridge_rtlookup(struct bridge_softc *sc, const uint8_t *addr)
3312 {
3313         struct bridge_rtnode *brt;
3314
3315         if ((brt = bridge_rtnode_lookup(sc, addr)) == NULL)
3316                 return NULL;
3317         return brt->brt_info->bri_ifp;
3318 }
3319
3320 static void
3321 bridge_rtreap_handler(netmsg_t msg)
3322 {
3323         struct bridge_softc *sc = msg->lmsg.u.ms_resultp;
3324         struct bridge_rtnode *brt, *nbrt;
3325
3326         LIST_FOREACH_MUTABLE(brt, &sc->sc_rtlists[mycpuid], brt_list, nbrt) {
3327                 if (brt->brt_info->bri_dead)
3328                         bridge_rtnode_destroy(sc, brt);
3329         }
3330         ifnet_forwardmsg(&msg->lmsg, mycpuid + 1);
3331 }
3332
3333 static void
3334 bridge_rtreap(struct bridge_softc *sc)
3335 {
3336         struct netmsg_base msg;
3337
3338         ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
3339
3340         netmsg_init(&msg, NULL, &curthread->td_msgport,
3341                     0, bridge_rtreap_handler);
3342         msg.lmsg.u.ms_resultp = sc;
3343
3344         ifnet_domsg(&msg.lmsg, 0);
3345 }
3346
3347 static void
3348 bridge_rtreap_async(struct bridge_softc *sc)
3349 {
3350         struct netmsg_base *msg;
3351
3352         msg = kmalloc(sizeof(*msg), M_LWKTMSG, M_WAITOK);
3353
3354         netmsg_init(msg, NULL, &netisr_afree_rport,
3355                     0, bridge_rtreap_handler);
3356         msg->lmsg.u.ms_resultp = sc;
3357
3358         ifnet_sendmsg(&msg->lmsg, 0);
3359 }
3360
3361 /*
3362  * bridge_rttrim:
3363  *
3364  *      Trim the routine table so that we have a number
3365  *      of routing entries less than or equal to the
3366  *      maximum number.
3367  */
3368 static void
3369 bridge_rttrim(struct bridge_softc *sc)
3370 {
3371         struct bridge_rtnode *brt;
3372         int dead;
3373
3374         ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
3375
3376         /* Make sure we actually need to do this. */
3377         if (sc->sc_brtcnt <= sc->sc_brtmax)
3378                 return;
3379
3380         /*
3381          * Find out how many rtnodes are dead
3382          */
3383         dead = bridge_rtage_finddead(sc);
3384         KKASSERT(dead <= sc->sc_brtcnt);
3385
3386         if (sc->sc_brtcnt - dead <= sc->sc_brtmax) {
3387                 /* Enough dead rtnodes are found */
3388                 bridge_rtreap(sc);
3389                 return;
3390         }
3391
3392         /*
3393          * Kill some dynamic rtnodes to meet the brtmax
3394          */
3395         LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
3396                 struct bridge_rtinfo *bri = brt->brt_info;
3397
3398                 if (bri->bri_dead) {
3399                         /*
3400                          * We have counted this rtnode in
3401                          * bridge_rtage_finddead()
3402                          */
3403                         continue;
3404                 }
3405
3406                 if ((bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) {
3407                         bri->bri_dead = 1;
3408                         ++dead;
3409                         KKASSERT(dead <= sc->sc_brtcnt);
3410
3411                         if (sc->sc_brtcnt - dead <= sc->sc_brtmax) {
3412                                 /* Enough rtnodes are collected */
3413                                 break;
3414                         }
3415                 }
3416         }
3417         if (dead)
3418                 bridge_rtreap(sc);
3419 }
3420
3421 /*
3422  * bridge_timer:
3423  *
3424  *      Aging timer for the bridge.
3425  */
3426 static void
3427 bridge_timer(void *arg)
3428 {
3429         struct bridge_softc *sc = arg;
3430         struct netmsg_base *msg;
3431
3432         KKASSERT(mycpuid == BRIDGE_CFGCPU);
3433
3434         crit_enter();
3435
3436         if (callout_pending(&sc->sc_brcallout) ||
3437             !callout_active(&sc->sc_brcallout)) {
3438                 crit_exit();
3439                 return;
3440         }
3441         callout_deactivate(&sc->sc_brcallout);
3442
3443         msg = &sc->sc_brtimemsg;
3444         KKASSERT(msg->lmsg.ms_flags & MSGF_DONE);
3445         lwkt_sendmsg(BRIDGE_CFGPORT, &msg->lmsg);
3446
3447         crit_exit();
3448 }
3449
3450 static void
3451 bridge_timer_handler(netmsg_t msg)
3452 {
3453         struct bridge_softc *sc = msg->lmsg.u.ms_resultp;
3454
3455         KKASSERT(&curthread->td_msgport == BRIDGE_CFGPORT);
3456
3457         crit_enter();
3458         /* Reply ASAP */
3459         lwkt_replymsg(&msg->lmsg, 0);
3460         crit_exit();
3461
3462         bridge_rtage(sc);
3463         if (sc->sc_ifp->if_flags & IFF_RUNNING) {
3464                 callout_reset(&sc->sc_brcallout,
3465                     bridge_rtable_prune_period * hz, bridge_timer, sc);
3466         }
3467 }
3468
3469 static int
3470 bridge_rtage_finddead(struct bridge_softc *sc)
3471 {
3472         struct bridge_rtnode *brt;
3473         int dead = 0;
3474
3475         LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
3476                 struct bridge_rtinfo *bri = brt->brt_info;
3477
3478                 if ((bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
3479                     time_second >= bri->bri_expire) {
3480                         bri->bri_dead = 1;
3481                         ++dead;
3482                         KKASSERT(dead <= sc->sc_brtcnt);
3483                 }
3484         }
3485         return dead;
3486 }
3487
3488 /*
3489  * bridge_rtage:
3490  *
3491  *      Perform an aging cycle.
3492  */
3493 static void
3494 bridge_rtage(struct bridge_softc *sc)
3495 {
3496         ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
3497
3498         if (bridge_rtage_finddead(sc))
3499                 bridge_rtreap(sc);
3500 }
3501
3502 /*
3503  * bridge_rtflush:
3504  *
3505  *      Remove all dynamic addresses from the bridge.
3506  */
3507 static void
3508 bridge_rtflush(struct bridge_softc *sc, int bf)
3509 {
3510         struct bridge_rtnode *brt;
3511         int reap;
3512
3513         reap = 0;
3514         LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
3515                 struct bridge_rtinfo *bri = brt->brt_info;
3516
3517                 if ((bf & IFBF_FLUSHALL) ||
3518                     (bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) {
3519                         bri->bri_dead = 1;
3520                         reap = 1;
3521                 }
3522         }
3523         if (reap) {
3524                 if (bf & IFBF_FLUSHSYNC)
3525                         bridge_rtreap(sc);
3526                 else
3527                         bridge_rtreap_async(sc);
3528         }
3529 }
3530
3531 /*
3532  * bridge_rtdaddr:
3533  *
3534  *      Remove an address from the table.
3535  */
3536 static int
3537 bridge_rtdaddr(struct bridge_softc *sc, const uint8_t *addr)
3538 {
3539         struct bridge_rtnode *brt;
3540
3541         ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
3542
3543         if ((brt = bridge_rtnode_lookup(sc, addr)) == NULL)
3544                 return (ENOENT);
3545
3546         /* TODO: add a cheaper delete operation */
3547         brt->brt_info->bri_dead = 1;
3548         bridge_rtreap(sc);
3549         return (0);
3550 }
3551
3552 /*
3553  * bridge_rtdelete:
3554  *
3555  *      Delete routes to a speicifc member interface.
3556  */
3557 void
3558 bridge_rtdelete(struct bridge_softc *sc, struct ifnet *ifp, int bf)
3559 {
3560         struct bridge_rtnode *brt;
3561         int reap;
3562
3563         reap = 0;
3564         LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
3565                 struct bridge_rtinfo *bri = brt->brt_info;
3566
3567                 if (bri->bri_ifp == ifp &&
3568                     ((bf & IFBF_FLUSHALL) ||
3569                      (bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC)) {
3570                         bri->bri_dead = 1;
3571                         reap = 1;
3572                 }
3573         }
3574         if (reap) {
3575                 if (bf & IFBF_FLUSHSYNC)
3576                         bridge_rtreap(sc);
3577                 else
3578                         bridge_rtreap_async(sc);
3579         }
3580 }
3581
3582 /*
3583  * bridge_rtable_init:
3584  *
3585  *      Initialize the route table for this bridge.
3586  */
3587 static void
3588 bridge_rtable_init(struct bridge_softc *sc)
3589 {
3590         int cpu;
3591
3592         /*
3593          * Initialize per-cpu hash tables
3594          */
3595         sc->sc_rthashs = kmalloc(sizeof(*sc->sc_rthashs) * ncpus,
3596                                  M_DEVBUF, M_WAITOK);
3597         for (cpu = 0; cpu < ncpus; ++cpu) {
3598                 int i;
3599
3600                 sc->sc_rthashs[cpu] =
3601                 kmalloc(sizeof(struct bridge_rtnode_head) * BRIDGE_RTHASH_SIZE,
3602                         M_DEVBUF, M_WAITOK);
3603
3604                 for (i = 0; i < BRIDGE_RTHASH_SIZE; i++)
3605                         LIST_INIT(&sc->sc_rthashs[cpu][i]);
3606         }
3607         sc->sc_rthash_key = karc4random();
3608
3609         /*
3610          * Initialize per-cpu lists
3611          */
3612         sc->sc_rtlists = kmalloc(sizeof(struct bridge_rtnode_head) * ncpus,
3613                                  M_DEVBUF, M_WAITOK);
3614         for (cpu = 0; cpu < ncpus; ++cpu)
3615                 LIST_INIT(&sc->sc_rtlists[cpu]);
3616 }
3617
3618 /*
3619  * bridge_rtable_fini:
3620  *
3621  *      Deconstruct the route table for this bridge.
3622  */
3623 static void
3624 bridge_rtable_fini(struct bridge_softc *sc)
3625 {
3626         int cpu;
3627
3628         /*
3629          * Free per-cpu hash tables
3630          */
3631         for (cpu = 0; cpu < ncpus; ++cpu)
3632                 kfree(sc->sc_rthashs[cpu], M_DEVBUF);
3633         kfree(sc->sc_rthashs, M_DEVBUF);
3634
3635         /*
3636          * Free per-cpu lists
3637          */
3638         kfree(sc->sc_rtlists, M_DEVBUF);
3639 }
3640
3641 /*
3642  * The following hash function is adapted from "Hash Functions" by Bob Jenkins
3643  * ("Algorithm Alley", Dr. Dobbs Journal, September 1997).
3644  */
3645 #define mix(a, b, c)                                                    \
3646 do {                                                                    \
3647         a -= b; a -= c; a ^= (c >> 13);                                 \
3648         b -= c; b -= a; b ^= (a << 8);                                  \
3649         c -= a; c -= b; c ^= (b >> 13);                                 \
3650         a -= b; a -= c; a ^= (c >> 12);                                 \
3651         b -= c; b -= a; b ^= (a << 16);                                 \
3652         c -= a; c -= b; c ^= (b >> 5);                                  \
3653         a -= b; a -= c; a ^= (c >> 3);                                  \
3654         b -= c; b -= a; b ^= (a << 10);                                 \
3655         c -= a; c -= b; c ^= (b >> 15);                                 \
3656 } while (/*CONSTCOND*/0)
3657
3658 static __inline uint32_t
3659 bridge_rthash(struct bridge_softc *sc, const uint8_t *addr)
3660 {
3661         uint32_t a = 0x9e3779b9, b = 0x9e3779b9, c = sc->sc_rthash_key;
3662
3663         b += addr[5] << 8;
3664         b += addr[4];
3665         a += addr[3] << 24;
3666         a += addr[2] << 16;
3667         a += addr[1] << 8;
3668         a += addr[0];
3669
3670         mix(a, b, c);
3671
3672         return (c & BRIDGE_RTHASH_MASK);
3673 }
3674
3675 #undef mix
3676
3677 static int
3678 bridge_rtnode_addr_cmp(const uint8_t *a, const uint8_t *b)
3679 {
3680         int i, d;
3681
3682         for (i = 0, d = 0; i < ETHER_ADDR_LEN && d == 0; i++) {
3683                 d = ((int)a[i]) - ((int)b[i]);
3684         }
3685
3686         return (d);
3687 }
3688
3689 /*
3690  * bridge_rtnode_lookup:
3691  *
3692  *      Look up a bridge route node for the specified destination.
3693  */
3694 static struct bridge_rtnode *
3695 bridge_rtnode_lookup(struct bridge_softc *sc, const uint8_t *addr)
3696 {
3697         struct bridge_rtnode *brt;
3698         uint32_t hash;
3699         int dir;
3700
3701         hash = bridge_rthash(sc, addr);
3702         LIST_FOREACH(brt, &sc->sc_rthashs[mycpuid][hash], brt_hash) {
3703                 dir = bridge_rtnode_addr_cmp(addr, brt->brt_addr);
3704                 if (dir == 0)
3705                         return (brt);
3706                 if (dir > 0)
3707                         return (NULL);
3708         }
3709
3710         return (NULL);
3711 }
3712
3713 /*
3714  * bridge_rtnode_insert:
3715  *
3716  *      Insert the specified bridge node into the route table.
3717  *      Caller has to make sure that rtnode does not exist.
3718  */
3719 static void
3720 bridge_rtnode_insert(struct bridge_softc *sc, struct bridge_rtnode *brt)
3721 {
3722         struct bridge_rtnode *lbrt;
3723         uint32_t hash;
3724         int dir;
3725
3726         hash = bridge_rthash(sc, brt->brt_addr);
3727
3728         lbrt = LIST_FIRST(&sc->sc_rthashs[mycpuid][hash]);
3729         if (lbrt == NULL) {
3730                 LIST_INSERT_HEAD(&sc->sc_rthashs[mycpuid][hash],
3731                                   brt, brt_hash);
3732                 goto out;
3733         }
3734
3735         do {
3736                 dir = bridge_rtnode_addr_cmp(brt->brt_addr, lbrt->brt_addr);
3737                 KASSERT(dir != 0, ("rtnode already exist"));
3738
3739                 if (dir > 0) {
3740                         LIST_INSERT_BEFORE(lbrt, brt, brt_hash);
3741                         goto out;
3742                 }
3743                 if (LIST_NEXT(lbrt, brt_hash) == NULL) {
3744                         LIST_INSERT_AFTER(lbrt, brt, brt_hash);
3745                         goto out;
3746                 }
3747                 lbrt = LIST_NEXT(lbrt, brt_hash);
3748         } while (lbrt != NULL);
3749
3750         panic("no suitable position found for rtnode");
3751 out:
3752         LIST_INSERT_HEAD(&sc->sc_rtlists[mycpuid], brt, brt_list);
3753         if (mycpuid == 0) {
3754                 /*
3755                  * Update the brtcnt.
3756                  * We only need to do it once and we do it on CPU0.
3757                  */
3758                 sc->sc_brtcnt++;
3759         }
3760 }
3761
3762 /*
3763  * bridge_rtnode_destroy:
3764  *
3765  *      Destroy a bridge rtnode.
3766  */
3767 static void
3768 bridge_rtnode_destroy(struct bridge_softc *sc, struct bridge_rtnode *brt)
3769 {
3770         LIST_REMOVE(brt, brt_hash);
3771         LIST_REMOVE(brt, brt_list);
3772
3773         if (mycpuid + 1 == ncpus) {
3774                 /* Free rtinfo associated with rtnode on the last cpu */
3775                 kfree(brt->brt_info, M_DEVBUF);
3776         }
3777         kfree(brt, M_DEVBUF);
3778
3779         if (mycpuid == 0) {
3780                 /* Update brtcnt only on CPU0 */
3781                 sc->sc_brtcnt--;
3782         }
3783 }
3784
3785 static __inline int
3786 bridge_post_pfil(struct mbuf *m)
3787 {
3788         if (m->m_pkthdr.fw_flags & IPFORWARD_MBUF_TAGGED)
3789                 return EOPNOTSUPP;
3790
3791         /* Not yet */
3792         if (m->m_pkthdr.fw_flags & DUMMYNET_MBUF_TAGGED)
3793                 return EOPNOTSUPP;
3794
3795         return 0;
3796 }
3797
3798 /*
3799  * Send bridge packets through pfil if they are one of the types pfil can deal
3800  * with, or if they are ARP or REVARP.  (pfil will pass ARP and REVARP without
3801  * question.) If *bifp or *ifp are NULL then packet filtering is skipped for
3802  * that interface.
3803  */
3804 static int
3805 bridge_pfil(struct mbuf **mp, struct ifnet *bifp, struct ifnet *ifp, int dir)
3806 {
3807         int snap, error, i, hlen;
3808         struct ether_header *eh1, eh2;
3809         struct ip *ip;
3810         struct llc llc1;
3811         u_int16_t ether_type;
3812
3813         snap = 0;
3814         error = -1;     /* Default error if not error == 0 */
3815
3816         if (pfil_bridge == 0 && pfil_member == 0)
3817                 return (0); /* filtering is disabled */
3818
3819         i = min((*mp)->m_pkthdr.len, max_protohdr);
3820         if ((*mp)->m_len < i) {
3821                 *mp = m_pullup(*mp, i);
3822                 if (*mp == NULL) {
3823                         kprintf("%s: m_pullup failed\n", __func__);
3824                         return (-1);
3825                 }
3826         }
3827
3828         eh1 = mtod(*mp, struct ether_header *);
3829         ether_type = ntohs(eh1->ether_type);
3830
3831         /*
3832          * Check for SNAP/LLC.
3833          */
3834         if (ether_type < ETHERMTU) {
3835                 struct llc *llc2 = (struct llc *)(eh1 + 1);
3836
3837                 if ((*mp)->m_len >= ETHER_HDR_LEN + 8 &&
3838                     llc2->llc_dsap == LLC_SNAP_LSAP &&
3839                     llc2->llc_ssap == LLC_SNAP_LSAP &&
3840                     llc2->llc_control == LLC_UI) {
3841                         ether_type = htons(llc2->llc_un.type_snap.ether_type);
3842                         snap = 1;
3843                 }
3844         }
3845
3846         /*
3847          * If we're trying to filter bridge traffic, don't look at anything
3848          * other than IP and ARP traffic.  If the filter doesn't understand
3849          * IPv6, don't allow IPv6 through the bridge either.  This is lame
3850          * since if we really wanted, say, an AppleTalk filter, we are hosed,
3851          * but of course we don't have an AppleTalk filter to begin with.
3852          * (Note that since pfil doesn't understand ARP it will pass *ALL*
3853          * ARP traffic.)
3854          */
3855         switch (ether_type) {
3856         case ETHERTYPE_ARP:
3857         case ETHERTYPE_REVARP:
3858                 return (0); /* Automatically pass */
3859
3860         case ETHERTYPE_IP:
3861 #ifdef INET6
3862         case ETHERTYPE_IPV6:
3863 #endif /* INET6 */
3864                 break;
3865
3866         default:
3867                 /*
3868                  * Check to see if the user wants to pass non-ip
3869                  * packets, these will not be checked by pfil(9)
3870                  * and passed unconditionally so the default is to drop.
3871                  */
3872                 if (pfil_onlyip)
3873                         goto bad;
3874         }
3875
3876         /* Strip off the Ethernet header and keep a copy. */
3877         m_copydata(*mp, 0, ETHER_HDR_LEN, (caddr_t) &eh2);
3878         m_adj(*mp, ETHER_HDR_LEN);
3879
3880         /* Strip off snap header, if present */
3881         if (snap) {
3882                 m_copydata(*mp, 0, sizeof(struct llc), (caddr_t) &llc1);
3883                 m_adj(*mp, sizeof(struct llc));
3884         }
3885
3886         /*
3887          * Check the IP header for alignment and errors
3888          */
3889         if (dir == PFIL_IN) {
3890                 switch (ether_type) {
3891                 case ETHERTYPE_IP:
3892                         error = bridge_ip_checkbasic(mp);
3893                         break;
3894 #ifdef INET6
3895                 case ETHERTYPE_IPV6:
3896                         error = bridge_ip6_checkbasic(mp);
3897                         break;
3898 #endif /* INET6 */
3899                 default:
3900                         error = 0;
3901                 }
3902                 if (error)
3903                         goto bad;
3904         }
3905
3906         error = 0;
3907
3908         /*
3909          * Run the packet through pfil
3910          */
3911         switch (ether_type) {
3912         case ETHERTYPE_IP:
3913                 /*
3914                  * before calling the firewall, swap fields the same as
3915                  * IP does. here we assume the header is contiguous
3916                  */
3917                 ip = mtod(*mp, struct ip *);
3918
3919                 ip->ip_len = ntohs(ip->ip_len);
3920                 ip->ip_off = ntohs(ip->ip_off);
3921
3922                 /*
3923                  * Run pfil on the member interface and the bridge, both can
3924                  * be skipped by clearing pfil_member or pfil_bridge.
3925                  *
3926                  * Keep the order:
3927                  *   in_if -> bridge_if -> out_if
3928                  */
3929                 if (pfil_bridge && dir == PFIL_OUT && bifp != NULL) {
3930                         error = pfil_run_hooks(&inet_pfil_hook, mp, bifp, dir);
3931                         if (*mp == NULL || error != 0) /* filter may consume */
3932                                 break;
3933                         error = bridge_post_pfil(*mp);
3934                         if (error)
3935                                 break;
3936                 }
3937
3938                 if (pfil_member && ifp != NULL) {
3939                         error = pfil_run_hooks(&inet_pfil_hook, mp, ifp, dir);
3940                         if (*mp == NULL || error != 0) /* filter may consume */
3941                                 break;
3942                         error = bridge_post_pfil(*mp);
3943                         if (error)
3944                                 break;
3945                 }
3946
3947                 if (pfil_bridge && dir == PFIL_IN && bifp != NULL) {
3948                         error = pfil_run_hooks(&inet_pfil_hook, mp, bifp, dir);
3949                         if (*mp == NULL || error != 0) /* filter may consume */
3950                                 break;
3951                         error = bridge_post_pfil(*mp);
3952                         if (error)
3953                                 break;
3954                 }
3955
3956                 /* check if we need to fragment the packet */
3957                 if (pfil_member && ifp != NULL && dir == PFIL_OUT) {
3958                         i = (*mp)->m_pkthdr.len;
3959                         if (i > ifp->if_mtu) {
3960                                 error = bridge_fragment(ifp, *mp, &eh2, snap,
3961                                             &llc1);
3962                                 return (error);
3963                         }
3964                 }
3965
3966                 /* Recalculate the ip checksum and restore byte ordering */
3967                 ip = mtod(*mp, struct ip *);
3968                 hlen = ip->ip_hl << 2;
3969                 if (hlen < sizeof(struct ip))
3970                         goto bad;
3971                 if (hlen > (*mp)->m_len) {
3972                         if ((*mp = m_pullup(*mp, hlen)) == NULL)
3973                                 goto bad;
3974                         ip = mtod(*mp, struct ip *);
3975                         if (ip == NULL)
3976                                 goto bad;
3977                 }
3978                 ip->ip_len = htons(ip->ip_len);
3979                 ip->ip_off = htons(ip->ip_off);
3980                 ip->ip_sum = 0;
3981                 if (hlen == sizeof(struct ip))
3982                         ip->ip_sum = in_cksum_hdr(ip);
3983                 else
3984                         ip->ip_sum = in_cksum(*mp, hlen);
3985
3986                 break;
3987 #ifdef INET6
3988         case ETHERTYPE_IPV6:
3989                 if (pfil_bridge && dir == PFIL_OUT && bifp != NULL)
3990                         error = pfil_run_hooks(&inet6_pfil_hook, mp, bifp,
3991                                         dir);
3992
3993                 if (*mp == NULL || error != 0) /* filter may consume */
3994                         break;
3995
3996                 if (pfil_member && ifp != NULL)
3997                         error = pfil_run_hooks(&inet6_pfil_hook, mp, ifp,
3998                                         dir);
3999
4000                 if (*mp == NULL || error != 0) /* filter may consume */
4001                         break;
4002
4003                 if (pfil_bridge && dir == PFIL_IN && bifp != NULL)
4004                         error = pfil_run_hooks(&inet6_pfil_hook, mp, bifp,
4005                                         dir);
4006                 break;
4007 #endif
4008         default:
4009                 error = 0;
4010                 break;
4011         }
4012
4013         if (*mp == NULL)
4014                 return (error);
4015         if (error != 0)
4016                 goto bad;
4017
4018         error = -1;
4019
4020         /*
4021          * Finally, put everything back the way it was and return
4022          */
4023         if (snap) {
4024                 M_PREPEND(*mp, sizeof(struct llc), MB_DONTWAIT);
4025                 if (*mp == NULL)
4026                         return (error);
4027                 bcopy(&llc1, mtod(*mp, caddr_t), sizeof(struct llc));
4028         }
4029
4030         M_PREPEND(*mp, ETHER_HDR_LEN, MB_DONTWAIT);
4031         if (*mp == NU