| 1 | /* |
| 2 | * Copyright (c) 2004-2024 Apple Inc. All rights reserved. |
| 3 | * |
| 4 | * @APPLE_OSREFERENCE_LICENSE_HEADER_START@ |
| 5 | * |
| 6 | * This file contains Original Code and/or Modifications of Original Code |
| 7 | * as defined in and that are subject to the Apple Public Source License |
| 8 | * Version 2.0 (the 'License'). You may not use this file except in |
| 9 | * compliance with the License. The rights granted to you under the License |
| 10 | * may not be used to create, or enable the creation or redistribution of, |
| 11 | * unlawful or unlicensed copies of an Apple operating system, or to |
| 12 | * circumvent, violate, or enable the circumvention or violation of, any |
| 13 | * terms of an Apple operating system software license agreement. |
| 14 | * |
| 15 | * Please obtain a copy of the License at |
| 16 | * http://www.opensource.apple.com/apsl/ and read it before using this file. |
| 17 | * |
| 18 | * The Original Code and all software distributed under the License are |
| 19 | * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER |
| 20 | * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES, |
| 21 | * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY, |
| 22 | * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT. |
| 23 | * Please see the License for the specific language governing rights and |
| 24 | * limitations under the License. |
| 25 | * |
| 26 | * @APPLE_OSREFERENCE_LICENSE_HEADER_END@ |
| 27 | */ |
| 28 | |
| 29 | /* $NetBSD: if_bridge.c,v 1.31 2005/06/01 19:45:34 jdc Exp $ */ |
| 30 | /* |
| 31 | * Copyright 2001 Wasabi Systems, Inc. |
| 32 | * All rights reserved. |
| 33 | * |
| 34 | * Written by Jason R. Thorpe for Wasabi Systems, Inc. |
| 35 | * |
| 36 | * Redistribution and use in source and binary forms, with or without |
| 37 | * modification, are permitted provided that the following conditions |
| 38 | * are met: |
| 39 | * 1. Redistributions of source code must retain the above copyright |
| 40 | * notice, this list of conditions and the following disclaimer. |
| 41 | * 2. Redistributions in binary form must reproduce the above copyright |
| 42 | * notice, this list of conditions and the following disclaimer in the |
| 43 | * documentation and/or other materials provided with the distribution. |
| 44 | * 3. All advertising materials mentioning features or use of this software |
| 45 | * must display the following acknowledgement: |
| 46 | * This product includes software developed for the NetBSD Project by |
| 47 | * Wasabi Systems, Inc. |
| 48 | * 4. The name of Wasabi Systems, Inc. may not be used to endorse |
| 49 | * or promote products derived from this software without specific prior |
| 50 | * written permission. |
| 51 | * |
| 52 | * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND |
| 53 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED |
| 54 | * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
| 55 | * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC |
| 56 | * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| 57 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| 58 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| 59 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| 60 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| 61 | * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| 62 | * POSSIBILITY OF SUCH DAMAGE. |
| 63 | */ |
| 64 | |
| 65 | /* |
| 66 | * Copyright (c) 1999, 2000 Jason L. Wright (jason@thought.net) |
| 67 | * All rights reserved. |
| 68 | * |
| 69 | * Redistribution and use in source and binary forms, with or without |
| 70 | * modification, are permitted provided that the following conditions |
| 71 | * are met: |
| 72 | * 1. Redistributions of source code must retain the above copyright |
| 73 | * notice, this list of conditions and the following disclaimer. |
| 74 | * 2. Redistributions in binary form must reproduce the above copyright |
| 75 | * notice, this list of conditions and the following disclaimer in the |
| 76 | * documentation and/or other materials provided with the distribution. |
| 77 | * |
| 78 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| 79 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| 80 | * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
| 81 | * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, |
| 82 | * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
| 83 | * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
| 84 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
| 85 | * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, |
| 86 | * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN |
| 87 | * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| 88 | * POSSIBILITY OF SUCH DAMAGE. |
| 89 | * |
| 90 | * OpenBSD: if_bridge.c,v 1.60 2001/06/15 03:38:33 itojun Exp |
| 91 | */ |
| 92 | |
| 93 | /* |
| 94 | * Network interface bridge support. |
| 95 | * |
| 96 | * TODO: |
| 97 | * |
| 98 | * - Currently only supports Ethernet-like interfaces (Ethernet, |
| 99 | * 802.11, VLANs on Ethernet, etc.) Figure out a nice way |
| 100 | * to bridge other types of interfaces (FDDI-FDDI, and maybe |
| 101 | * consider heterogenous bridges). |
| 102 | * |
| 103 | * - GIF isn't handled due to the lack of IPPROTO_ETHERIP support. |
| 104 | */ |
| 105 | |
| 106 | #include <sys/cdefs.h> |
| 107 | |
| 108 | #include <sys/param.h> |
| 109 | #include <sys/mbuf.h> |
| 110 | #include <sys/malloc.h> |
| 111 | #include <sys/protosw.h> |
| 112 | #include <sys/systm.h> |
| 113 | #include <sys/time.h> |
| 114 | #include <sys/socket.h> /* for net/if.h */ |
| 115 | #include <sys/sockio.h> |
| 116 | #include <sys/kernel.h> |
| 117 | #include <sys/random.h> |
| 118 | #include <sys/syslog.h> |
| 119 | #include <sys/sysctl.h> |
| 120 | #include <sys/proc.h> |
| 121 | #include <sys/lock.h> |
| 122 | #include <sys/mcache.h> |
| 123 | |
| 124 | #include <sys/kauth.h> |
| 125 | |
| 126 | #include <kern/thread_call.h> |
| 127 | |
| 128 | #include <libkern/libkern.h> |
| 129 | |
| 130 | #include <kern/zalloc.h> |
| 131 | |
| 132 | #if NBPFILTER > 0 |
| 133 | #include <net/bpf.h> |
| 134 | #endif |
| 135 | #include <net/if.h> |
| 136 | #include <net/if_dl.h> |
| 137 | #include <net/if_types.h> |
| 138 | #include <net/if_var.h> |
| 139 | #include <net/if_media.h> |
| 140 | #include <net/net_api_stats.h> |
| 141 | #include <net/pfvar.h> |
| 142 | |
| 143 | #include <netinet/in.h> /* for struct arpcom */ |
| 144 | #include <netinet/tcp.h> /* for struct tcphdr */ |
| 145 | #include <netinet/in_systm.h> |
| 146 | #include <netinet/in_var.h> |
| 147 | #define _IP_VHL |
| 148 | #include <netinet/ip.h> |
| 149 | #include <netinet/ip_var.h> |
| 150 | #include <netinet/ip6.h> |
| 151 | #include <netinet6/ip6_var.h> |
| 152 | #ifdef DEV_CARP |
| 153 | #include <netinet/ip_carp.h> |
| 154 | #endif |
| 155 | #include <netinet/if_ether.h> /* for struct arpcom */ |
| 156 | #include <net/bridgestp.h> |
| 157 | #include <net/if_bridgevar.h> |
| 158 | #include <net/if_llc.h> |
| 159 | #if NVLAN > 0 |
| 160 | #include <net/if_vlan_var.h> |
| 161 | #endif /* NVLAN > 0 */ |
| 162 | |
| 163 | #include <net/if_ether.h> |
| 164 | #include <net/dlil.h> |
| 165 | #include <net/kpi_interfacefilter.h> |
| 166 | |
| 167 | #include <net/route.h> |
| 168 | #include <dev/random/randomdev.h> |
| 169 | |
| 170 | #include <netinet/bootp.h> |
| 171 | #include <netinet/dhcp.h> |
| 172 | |
| 173 | #if SKYWALK |
| 174 | #include <skywalk/nexus/netif/nx_netif.h> |
| 175 | #endif /* SKYWALK */ |
| 176 | |
| 177 | #include <net/sockaddr_utils.h> |
| 178 | |
| 179 | #include <os/log.h> |
| 180 | |
| 181 | /* |
| 182 | * if_bridge_debug, BR_DBGF_* |
| 183 | * - 'if_bridge_debug' is a bitmask of BR_DBGF_* flags that can be set |
| 184 | * to enable additional logs for the corresponding bridge function |
| 185 | * - "sysctl net.link.bridge.debug" controls the value of |
| 186 | * 'if_bridge_debug' |
| 187 | */ |
| 188 | static uint32_t if_bridge_debug = 0; |
| 189 | #define BR_DBGF_LIFECYCLE 0x0001 |
| 190 | #define BR_DBGF_INPUT 0x0002 |
| 191 | #define BR_DBGF_OUTPUT 0x0004 |
| 192 | #define BR_DBGF_RT_TABLE 0x0008 |
| 193 | #define BR_DBGF_DELAYED_CALL 0x0010 |
| 194 | #define BR_DBGF_IOCTL 0x0020 |
| 195 | #define BR_DBGF_MBUF 0x0040 |
| 196 | #define BR_DBGF_MCAST 0x0080 |
| 197 | #define BR_DBGF_HOSTFILTER 0x0100 |
| 198 | #define BR_DBGF_CHECKSUM 0x0200 |
| 199 | #define BR_DBGF_MAC_NAT 0x0400 |
| 200 | |
| 201 | /* |
| 202 | * if_bridge_log_level |
| 203 | * - 'if_bridge_log_level' ensures that by default important logs are |
| 204 | * logged regardless of if_bridge_debug by comparing the log level |
| 205 | * in BRIDGE_LOG to if_bridge_log_level |
| 206 | * - use "sysctl net.link.bridge.log_level" controls the value of |
| 207 | * 'if_bridge_log_level' |
| 208 | * - the default value of 'if_bridge_log_level' is LOG_NOTICE; important |
| 209 | * logs must use LOG_NOTICE to ensure they appear by default |
| 210 | */ |
| 211 | static int if_bridge_log_level = LOG_NOTICE; |
| 212 | |
| 213 | #define BRIDGE_DBGF_ENABLED(__flag) ((if_bridge_debug & __flag) != 0) |
| 214 | |
| 215 | /* |
| 216 | * BRIDGE_LOG, BRIDGE_LOG_SIMPLE |
| 217 | * - macros to generate the specified log conditionally based on |
| 218 | * the specified log level and debug flags |
| 219 | * - BRIDGE_LOG_SIMPLE does not include the function name in the log |
| 220 | */ |
| 221 | #define BRIDGE_LOG(__level, __dbgf, __string, ...) \ |
| 222 | do { \ |
| 223 | if (__level <= if_bridge_log_level || \ |
| 224 | BRIDGE_DBGF_ENABLED(__dbgf)) { \ |
| 225 | os_log(OS_LOG_DEFAULT, "%s: " __string, \ |
| 226 | __func__, ## __VA_ARGS__); \ |
| 227 | } \ |
| 228 | } while (0) |
| 229 | #define BRIDGE_LOG_SIMPLE(__level, __dbgf, __string, ...) \ |
| 230 | do { \ |
| 231 | if (__level <= if_bridge_log_level || \ |
| 232 | BRIDGE_DBGF_ENABLED(__dbgf)) { \ |
| 233 | os_log(OS_LOG_DEFAULT, __string, ## __VA_ARGS__); \ |
| 234 | } \ |
| 235 | } while (0) |
| 236 | |
| 237 | #define _BRIDGE_LOCK(_sc) lck_mtx_lock(&(_sc)->sc_mtx) |
| 238 | #define _BRIDGE_UNLOCK(_sc) lck_mtx_unlock(&(_sc)->sc_mtx) |
| 239 | #define BRIDGE_LOCK_ASSERT_HELD(_sc) \ |
| 240 | LCK_MTX_ASSERT(&(_sc)->sc_mtx, LCK_MTX_ASSERT_OWNED) |
| 241 | #define BRIDGE_LOCK_ASSERT_NOTHELD(_sc) \ |
| 242 | LCK_MTX_ASSERT(&(_sc)->sc_mtx, LCK_MTX_ASSERT_NOTOWNED) |
| 243 | |
| 244 | #define BRIDGE_LOCK_DEBUG 1 |
| 245 | #if BRIDGE_LOCK_DEBUG |
| 246 | |
| 247 | #define BR_LCKDBG_MAX 4 |
| 248 | |
| 249 | #define BRIDGE_LOCK(_sc) bridge_lock(_sc) |
| 250 | #define BRIDGE_UNLOCK(_sc) bridge_unlock(_sc) |
| 251 | #define BRIDGE_LOCK2REF(_sc, _err) _err = bridge_lock2ref(_sc) |
| 252 | #define BRIDGE_UNREF(_sc) bridge_unref(_sc) |
| 253 | #define BRIDGE_XLOCK(_sc) bridge_xlock(_sc) |
| 254 | #define BRIDGE_XDROP(_sc) bridge_xdrop(_sc) |
| 255 | |
| 256 | #else /* !BRIDGE_LOCK_DEBUG */ |
| 257 | |
| 258 | #define BRIDGE_LOCK(_sc) _BRIDGE_LOCK(_sc) |
| 259 | #define BRIDGE_UNLOCK(_sc) _BRIDGE_UNLOCK(_sc) |
| 260 | #define BRIDGE_LOCK2REF(_sc, _err) do { \ |
| 261 | BRIDGE_LOCK_ASSERT_HELD(_sc); \ |
| 262 | if ((_sc)->sc_iflist_xcnt > 0) \ |
| 263 | (_err) = EBUSY; \ |
| 264 | else { \ |
| 265 | (_sc)->sc_iflist_ref++; \ |
| 266 | (_err) = 0; \ |
| 267 | } \ |
| 268 | _BRIDGE_UNLOCK(_sc); \ |
| 269 | } while (0) |
| 270 | #define BRIDGE_UNREF(_sc) do { \ |
| 271 | _BRIDGE_LOCK(_sc); \ |
| 272 | (_sc)->sc_iflist_ref--; \ |
| 273 | if (((_sc)->sc_iflist_xcnt > 0) && ((_sc)->sc_iflist_ref == 0)) { \ |
| 274 | _BRIDGE_UNLOCK(_sc); \ |
| 275 | wakeup(&(_sc)->sc_cv); \ |
| 276 | } else \ |
| 277 | _BRIDGE_UNLOCK(_sc); \ |
| 278 | } while (0) |
| 279 | #define BRIDGE_XLOCK(_sc) do { \ |
| 280 | BRIDGE_LOCK_ASSERT_HELD(_sc); \ |
| 281 | (_sc)->sc_iflist_xcnt++; \ |
| 282 | while ((_sc)->sc_iflist_ref > 0) \ |
| 283 | msleep(&(_sc)->sc_cv, &(_sc)->sc_mtx, PZERO, \ |
| 284 | "BRIDGE_XLOCK", NULL); \ |
| 285 | } while (0) |
| 286 | #define BRIDGE_XDROP(_sc) do { \ |
| 287 | BRIDGE_LOCK_ASSERT_HELD(_sc); \ |
| 288 | (_sc)->sc_iflist_xcnt--; \ |
| 289 | } while (0) |
| 290 | |
| 291 | #endif /* BRIDGE_LOCK_DEBUG */ |
| 292 | |
| 293 | #if NBPFILTER > 0 |
| 294 | #define BRIDGE_BPF_MTAP_INPUT(sc, m) \ |
| 295 | if (sc->sc_bpf_input != NULL) \ |
| 296 | bridge_bpf_input(sc->sc_ifp, m, __func__, __LINE__) |
| 297 | #else /* NBPFILTER */ |
| 298 | #define BRIDGE_BPF_MTAP_INPUT(ifp, m) |
| 299 | #endif /* NBPFILTER */ |
| 300 | |
| 301 | /* |
| 302 | * Initial size of the route hash table. Must be a power of two. |
| 303 | */ |
| 304 | #ifndef BRIDGE_RTHASH_SIZE |
| 305 | #define BRIDGE_RTHASH_SIZE 16 |
| 306 | #endif |
| 307 | |
| 308 | /* |
| 309 | * Maximum size of the routing hash table |
| 310 | */ |
| 311 | #define BRIDGE_RTHASH_SIZE_MAX 2048 |
| 312 | |
| 313 | #define BRIDGE_RTHASH_MASK(sc) ((sc)->sc_rthash_size - 1) |
| 314 | |
| 315 | /* |
| 316 | * Maximum number of addresses to cache. |
| 317 | */ |
| 318 | #ifndef BRIDGE_RTABLE_MAX |
| 319 | #define BRIDGE_RTABLE_MAX 100 |
| 320 | #endif |
| 321 | |
| 322 | |
| 323 | /* |
| 324 | * Timeout (in seconds) for entries learned dynamically. |
| 325 | */ |
| 326 | #ifndef BRIDGE_RTABLE_TIMEOUT |
| 327 | #define BRIDGE_RTABLE_TIMEOUT (20 * 60) /* same as ARP */ |
| 328 | #endif |
| 329 | |
| 330 | /* |
| 331 | * Number of seconds between walks of the route list. |
| 332 | */ |
| 333 | #ifndef BRIDGE_RTABLE_PRUNE_PERIOD |
| 334 | #define BRIDGE_RTABLE_PRUNE_PERIOD (5 * 60) |
| 335 | #endif |
| 336 | |
| 337 | /* |
| 338 | * Number of MAC NAT entries |
| 339 | * - sized based on 16 clients (including MAC NAT interface) |
| 340 | * each with 4 addresses |
| 341 | */ |
| 342 | #ifndef BRIDGE_MAC_NAT_ENTRY_MAX |
| 343 | #define BRIDGE_MAC_NAT_ENTRY_MAX 64 |
| 344 | #endif /* BRIDGE_MAC_NAT_ENTRY_MAX */ |
| 345 | |
| 346 | /* |
| 347 | * List of capabilities to possibly mask on the member interface. |
| 348 | */ |
| 349 | #define BRIDGE_IFCAPS_MASK (IFCAP_TSO | IFCAP_TXCSUM) |
| 350 | /* |
| 351 | * List of capabilities to disable on the member interface. |
| 352 | */ |
| 353 | #define BRIDGE_IFCAPS_STRIP IFCAP_LRO |
| 354 | |
| 355 | /* |
| 356 | * Bridge interface list entry. |
| 357 | */ |
| 358 | struct bridge_iflist { |
| 359 | TAILQ_ENTRY(bridge_iflist) bif_next; |
| 360 | struct ifnet *bif_ifp; /* member if */ |
| 361 | struct bstp_port bif_stp; /* STP state */ |
| 362 | uint32_t bif_ifflags; /* member if flags */ |
| 363 | int bif_savedcaps; /* saved capabilities */ |
| 364 | uint32_t bif_addrmax; /* max # of addresses */ |
| 365 | uint32_t bif_addrcnt; /* cur. # of addresses */ |
| 366 | uint32_t bif_addrexceeded; /* # of address violations */ |
| 367 | |
| 368 | interface_filter_t bif_iff_ref; |
| 369 | struct bridge_softc *bif_sc; |
| 370 | uint32_t bif_flags; |
| 371 | |
| 372 | /* host filter */ |
| 373 | struct in_addr bif_hf_ipsrc; |
| 374 | uint8_t bif_hf_hwsrc[ETHER_ADDR_LEN]; |
| 375 | |
| 376 | struct ifbrmstats bif_stats; |
| 377 | }; |
| 378 | |
| 379 | static inline bool |
| 380 | bif_ifflags_are_set(struct bridge_iflist * bif, uint32_t flags) |
| 381 | { |
| 382 | return (bif->bif_ifflags & flags) == flags; |
| 383 | } |
| 384 | |
| 385 | static inline bool |
| 386 | bif_has_checksum_offload(struct bridge_iflist * bif) |
| 387 | { |
| 388 | return bif_ifflags_are_set(bif, IFBIF_CHECKSUM_OFFLOAD); |
| 389 | } |
| 390 | |
| 391 | /* fake errors to make the code clearer */ |
| 392 | #define _EBADIP EJUSTRETURN |
| 393 | #define _EBADIPCHECKSUM EJUSTRETURN |
| 394 | #define _EBADIPV6 EJUSTRETURN |
| 395 | #define _EBADUDP EJUSTRETURN |
| 396 | #define _EBADTCP EJUSTRETURN |
| 397 | #define _EBADUDPCHECKSUM EJUSTRETURN |
| 398 | #define _EBADTCPCHECKSUM EJUSTRETURN |
| 399 | |
| 400 | #define BIFF_PROMISC 0x01 /* promiscuous mode set */ |
| 401 | #define BIFF_PROTO_ATTACHED 0x02 /* protocol attached */ |
| 402 | #define BIFF_FILTER_ATTACHED 0x04 /* interface filter attached */ |
| 403 | #define BIFF_MEDIA_ACTIVE 0x08 /* interface media active */ |
| 404 | #define BIFF_HOST_FILTER 0x10 /* host filter enabled */ |
| 405 | #define BIFF_HF_HWSRC 0x20 /* host filter source MAC is set */ |
| 406 | #define BIFF_HF_IPSRC 0x40 /* host filter source IP is set */ |
| 407 | #define BIFF_INPUT_BROADCAST 0x80 /* send broadcast packets in */ |
| 408 | #define BIFF_IN_MEMBER_LIST 0x100 /* added to the member list */ |
| 409 | #define BIFF_WIFI_INFRA 0x200 /* interface is Wi-Fi infra */ |
| 410 | #define BIFF_ALL_MULTI 0x400 /* allmulti set */ |
| 411 | #define BIFF_LRO_DISABLED 0x800 /* LRO was disabled */ |
| 412 | #if SKYWALK |
| 413 | #define BIFF_FLOWSWITCH_ATTACHED 0x1000 /* we attached the flowswitch */ |
| 414 | #define BIFF_NETAGENT_REMOVED 0x2000 /* we removed the netagent */ |
| 415 | #endif /* SKYWALK */ |
| 416 | |
| 417 | /* |
| 418 | * mac_nat_entry |
| 419 | * - translates between an IP address and MAC address on a specific |
| 420 | * bridge interface member |
| 421 | */ |
| 422 | struct mac_nat_entry { |
| 423 | LIST_ENTRY(mac_nat_entry) mne_list; /* list linkage */ |
| 424 | struct bridge_iflist *mne_bif; /* originating interface */ |
| 425 | unsigned long mne_expire; /* expiration time */ |
| 426 | union { |
| 427 | struct in_addr mneu_ip; /* originating IPv4 address */ |
| 428 | struct in6_addr mneu_ip6; /* originating IPv6 address */ |
| 429 | } mne_u; |
| 430 | uint8_t mne_mac[ETHER_ADDR_LEN]; |
| 431 | uint8_t mne_flags; |
| 432 | uint8_t mne_reserved; |
| 433 | }; |
| 434 | #define mne_ip mne_u.mneu_ip |
| 435 | #define mne_ip6 mne_u.mneu_ip6 |
| 436 | |
| 437 | #define MNE_FLAGS_IPV6 0x01 /* IPv6 address */ |
| 438 | |
| 439 | LIST_HEAD(mac_nat_entry_list, mac_nat_entry); |
| 440 | |
| 441 | /* |
| 442 | * mac_nat_record |
| 443 | * - used by bridge_mac_nat_output() to convey the translation that needs |
| 444 | * to take place in bridge_mac_nat_translate |
| 445 | * - holds enough information so that the translation can be done later without |
| 446 | * holding the bridge lock |
| 447 | */ |
| 448 | struct mac_nat_record { |
| 449 | uint16_t mnr_ether_type; |
| 450 | union { |
| 451 | uint16_t mnru_arp_offset; |
| 452 | struct { |
| 453 | uint16_t mnruip_dhcp_flags; |
| 454 | uint16_t mnruip_udp_csum; |
| 455 | uint8_t ; |
| 456 | } mnru_ip; |
| 457 | struct { |
| 458 | uint16_t mnruip6_icmp6_len; |
| 459 | uint16_t mnruip6_lladdr_offset; |
| 460 | uint8_t mnruip6_icmp6_type; |
| 461 | uint8_t ; |
| 462 | } mnru_ip6; |
| 463 | } mnr_u; |
| 464 | }; |
| 465 | |
| 466 | #define mnr_arp_offset mnr_u.mnru_arp_offset |
| 467 | |
| 468 | #define mnr_u.mnru_ip.mnruip_header_len |
| 469 | #define mnr_ip_dhcp_flags mnr_u.mnru_ip.mnruip_dhcp_flags |
| 470 | #define mnr_ip_udp_csum mnr_u.mnru_ip.mnruip_udp_csum |
| 471 | |
| 472 | #define mnr_ip6_icmp6_len mnr_u.mnru_ip6.mnruip6_icmp6_len |
| 473 | #define mnr_ip6_icmp6_type mnr_u.mnru_ip6.mnruip6_icmp6_type |
| 474 | #define mnr_u.mnru_ip6.mnruip6_header_len |
| 475 | #define mnr_ip6_lladdr_offset mnr_u.mnru_ip6.mnruip6_lladdr_offset |
| 476 | |
| 477 | /* |
| 478 | * Bridge route node. |
| 479 | */ |
| 480 | struct bridge_rtnode { |
| 481 | LIST_ENTRY(bridge_rtnode) brt_hash; /* hash table linkage */ |
| 482 | LIST_ENTRY(bridge_rtnode) brt_list; /* list linkage */ |
| 483 | struct bridge_iflist *brt_dst; /* destination if */ |
| 484 | unsigned long brt_expire; /* expiration time */ |
| 485 | uint8_t brt_flags; /* address flags */ |
| 486 | uint8_t brt_addr[ETHER_ADDR_LEN]; |
| 487 | uint16_t brt_vlan; /* vlan id */ |
| 488 | |
| 489 | }; |
| 490 | #define brt_ifp brt_dst->bif_ifp |
| 491 | |
| 492 | /* |
| 493 | * Bridge delayed function call context |
| 494 | */ |
| 495 | typedef void (*bridge_delayed_func_t)(struct bridge_softc *); |
| 496 | |
| 497 | struct bridge_delayed_call { |
| 498 | struct bridge_softc *bdc_sc; |
| 499 | bridge_delayed_func_t bdc_func; /* Function to call */ |
| 500 | struct timespec bdc_ts; /* Time to call */ |
| 501 | u_int32_t bdc_flags; |
| 502 | thread_call_t bdc_thread_call; |
| 503 | }; |
| 504 | |
| 505 | #define BDCF_OUTSTANDING 0x01 /* Delayed call has been scheduled */ |
| 506 | #define BDCF_CANCELLING 0x02 /* May be waiting for call completion */ |
| 507 | |
| 508 | /* |
| 509 | * Software state for each bridge. |
| 510 | */ |
| 511 | LIST_HEAD(_bridge_rtnode_list, bridge_rtnode); |
| 512 | |
| 513 | struct bridge_softc { |
| 514 | struct ifnet *sc_ifp; /* make this an interface */ |
| 515 | u_int32_t sc_flags; |
| 516 | LIST_ENTRY(bridge_softc) sc_list; |
| 517 | decl_lck_mtx_data(, sc_mtx); |
| 518 | struct _bridge_rtnode_list *sc_rthash; /* our forwarding table */ |
| 519 | struct _bridge_rtnode_list sc_rtlist; /* list version of above */ |
| 520 | uint32_t sc_rthash_key; /* key for hash */ |
| 521 | uint32_t sc_rthash_size; /* size of the hash table */ |
| 522 | struct bridge_delayed_call sc_aging_timer; |
| 523 | struct bridge_delayed_call sc_resize_call; |
| 524 | TAILQ_HEAD(, bridge_iflist) sc_spanlist; /* span ports list */ |
| 525 | struct bstp_state sc_stp; /* STP state */ |
| 526 | bpf_packet_func sc_bpf_input; |
| 527 | bpf_packet_func sc_bpf_output; |
| 528 | void *sc_cv; |
| 529 | uint32_t sc_brtmax; /* max # of addresses */ |
| 530 | uint32_t sc_brtcnt; /* cur. # of addresses */ |
| 531 | uint32_t sc_brttimeout; /* rt timeout in seconds */ |
| 532 | uint32_t sc_iflist_ref; /* refcount for sc_iflist */ |
| 533 | uint32_t sc_iflist_xcnt; /* refcount for sc_iflist */ |
| 534 | TAILQ_HEAD(, bridge_iflist) sc_iflist; /* member interface list */ |
| 535 | uint32_t sc_brtexceeded; /* # of cache drops */ |
| 536 | uint32_t sc_filter_flags; /* ipf and flags */ |
| 537 | struct ifnet *sc_ifaddr; /* member mac copied from */ |
| 538 | u_char sc_defaddr[6]; /* Default MAC address */ |
| 539 | char sc_if_xname[IFNAMSIZ]; |
| 540 | |
| 541 | struct bridge_iflist *sc_mac_nat_bif; /* single MAC NAT interface */ |
| 542 | struct mac_nat_entry_list sc_mne_list; /* MAC NAT IPv4 */ |
| 543 | struct mac_nat_entry_list sc_mne_list_v6;/* MAC NAT IPv6 */ |
| 544 | uint32_t sc_mne_max; /* max # of entries */ |
| 545 | uint32_t sc_mne_count; /* cur. # of entries */ |
| 546 | uint32_t sc_mne_allocation_failures; |
| 547 | #if BRIDGE_LOCK_DEBUG |
| 548 | /* |
| 549 | * Locking and unlocking calling history |
| 550 | */ |
| 551 | void *lock_lr[BR_LCKDBG_MAX]; |
| 552 | int next_lock_lr; |
| 553 | void *unlock_lr[BR_LCKDBG_MAX]; |
| 554 | int next_unlock_lr; |
| 555 | #endif /* BRIDGE_LOCK_DEBUG */ |
| 556 | }; |
| 557 | |
| 558 | #define SCF_DETACHING 0x01 |
| 559 | #define SCF_RESIZING 0x02 |
| 560 | #define SCF_MEDIA_ACTIVE 0x04 |
| 561 | |
| 562 | typedef enum { |
| 563 | CHECKSUM_OPERATION_NONE = 0, |
| 564 | CHECKSUM_OPERATION_CLEAR_OFFLOAD = 1, |
| 565 | CHECKSUM_OPERATION_FINALIZE = 2, |
| 566 | CHECKSUM_OPERATION_COMPUTE = 3, |
| 567 | } ChecksumOperation; |
| 568 | |
| 569 | union iphdr { |
| 570 | struct ip *ip; |
| 571 | struct ip6_hdr *ip6; |
| 572 | void * ptr; |
| 573 | }; |
| 574 | |
| 575 | typedef struct { |
| 576 | u_int ip_hlen; /* IP header length */ |
| 577 | u_int ip_pay_len; /* length of payload (exclusive of ip_hlen) */ |
| 578 | u_int ip_opt_len; /* IPv6 options headers length */ |
| 579 | uint8_t ip_proto; /* IPPROTO_TCP, IPPROTO_UDP, etc. */ |
| 580 | bool ip_is_ipv4; |
| 581 | bool ip_is_fragmented; |
| 582 | union iphdr ip_hdr; /* pointer to IP header */ |
| 583 | void * ip_proto_hdr; /* ptr to protocol header (TCP) */ |
| 584 | } ip_packet_info, *ip_packet_info_t; |
| 585 | |
| 586 | struct bridge_hostfilter_stats bridge_hostfilter_stats; |
| 587 | |
| 588 | static LCK_GRP_DECLARE(bridge_lock_grp, "if_bridge" ); |
| 589 | #if BRIDGE_LOCK_DEBUG |
| 590 | static LCK_ATTR_DECLARE(bridge_lock_attr, 0, 0); |
| 591 | #else |
| 592 | static LCK_ATTR_DECLARE(bridge_lock_attr, LCK_ATTR_DEBUG, 0); |
| 593 | #endif |
| 594 | static LCK_MTX_DECLARE_ATTR(bridge_list_mtx, &bridge_lock_grp, &bridge_lock_attr); |
| 595 | |
| 596 | static int bridge_rtable_prune_period = BRIDGE_RTABLE_PRUNE_PERIOD; |
| 597 | |
| 598 | static KALLOC_TYPE_DEFINE(bridge_rtnode_pool, struct bridge_rtnode, NET_KT_DEFAULT); |
| 599 | static KALLOC_TYPE_DEFINE(bridge_mne_pool, struct mac_nat_entry, NET_KT_DEFAULT); |
| 600 | |
| 601 | static int bridge_clone_create(struct if_clone *, uint32_t, void *); |
| 602 | static int bridge_clone_destroy(struct ifnet *); |
| 603 | |
| 604 | static errno_t bridge_ioctl(struct ifnet *, u_long, void *); |
| 605 | #if HAS_IF_CAP |
| 606 | static void bridge_mutecaps(struct bridge_softc *); |
| 607 | static void bridge_set_ifcap(struct bridge_softc *, struct bridge_iflist *, |
| 608 | int); |
| 609 | #endif |
| 610 | static errno_t bridge_set_tso(struct bridge_softc *); |
| 611 | static void bridge_proto_attach_changed(struct ifnet *); |
| 612 | static int bridge_init(struct ifnet *); |
| 613 | #if HAS_BRIDGE_DUMMYNET |
| 614 | static void bridge_dummynet(struct mbuf *, struct ifnet *); |
| 615 | #endif |
| 616 | static void bridge_ifstop(struct ifnet *, int); |
| 617 | static int bridge_output(struct ifnet *, struct mbuf *); |
| 618 | static void bridge_finalize_cksum(struct ifnet *, struct mbuf *); |
| 619 | static void bridge_start(struct ifnet *); |
| 620 | static errno_t bridge_input(struct ifnet *, mbuf_t *); |
| 621 | static errno_t bridge_iff_input(void *, ifnet_t, protocol_family_t, |
| 622 | mbuf_t *, char **); |
| 623 | static errno_t bridge_iff_output(void *, ifnet_t, protocol_family_t, |
| 624 | mbuf_t *); |
| 625 | static errno_t bridge_member_output(struct bridge_softc *sc, ifnet_t ifp, |
| 626 | mbuf_t *m); |
| 627 | |
| 628 | static int bridge_enqueue(ifnet_t, struct ifnet *, |
| 629 | struct ifnet *, struct mbuf *, ChecksumOperation); |
| 630 | static void bridge_rtdelete(struct bridge_softc *, struct ifnet *ifp, int); |
| 631 | |
| 632 | static void bridge_forward(struct bridge_softc *, struct bridge_iflist *, |
| 633 | struct mbuf *); |
| 634 | |
| 635 | static void bridge_aging_timer(struct bridge_softc *sc); |
| 636 | |
| 637 | static void bridge_broadcast(struct bridge_softc *, struct bridge_iflist *, |
| 638 | struct mbuf *, int); |
| 639 | static void bridge_span(struct bridge_softc *, struct mbuf *); |
| 640 | |
| 641 | static int bridge_rtupdate(struct bridge_softc *, const uint8_t *, |
| 642 | uint16_t, struct bridge_iflist *, int, uint8_t); |
| 643 | static struct ifnet *bridge_rtlookup(struct bridge_softc *, const uint8_t *, |
| 644 | uint16_t); |
| 645 | static void bridge_rttrim(struct bridge_softc *); |
| 646 | static void bridge_rtage(struct bridge_softc *); |
| 647 | static void bridge_rtflush(struct bridge_softc *, int); |
| 648 | static int bridge_rtdaddr(struct bridge_softc *, const uint8_t *, |
| 649 | uint16_t); |
| 650 | |
| 651 | static int bridge_rtable_init(struct bridge_softc *); |
| 652 | static void bridge_rtable_fini(struct bridge_softc *); |
| 653 | |
| 654 | static void bridge_rthash_resize(struct bridge_softc *); |
| 655 | |
| 656 | static int bridge_rtnode_addr_cmp(const uint8_t *, const uint8_t *); |
| 657 | static struct bridge_rtnode *bridge_rtnode_lookup(struct bridge_softc *, |
| 658 | const uint8_t *, uint16_t); |
| 659 | static int bridge_rtnode_hash(struct bridge_softc *, |
| 660 | struct bridge_rtnode *); |
| 661 | static int bridge_rtnode_insert(struct bridge_softc *, |
| 662 | struct bridge_rtnode *); |
| 663 | static void bridge_rtnode_destroy(struct bridge_softc *, |
| 664 | struct bridge_rtnode *); |
| 665 | #if BRIDGESTP |
| 666 | static void bridge_rtable_expire(struct ifnet *, int); |
| 667 | static void bridge_state_change(struct ifnet *, int); |
| 668 | #endif /* BRIDGESTP */ |
| 669 | |
| 670 | static struct bridge_iflist *bridge_lookup_member(struct bridge_softc *, |
| 671 | const char *name); |
| 672 | static struct bridge_iflist *bridge_lookup_member_if(struct bridge_softc *, |
| 673 | struct ifnet *ifp); |
| 674 | static void bridge_delete_member(struct bridge_softc *, |
| 675 | struct bridge_iflist *); |
| 676 | static void bridge_delete_span(struct bridge_softc *, |
| 677 | struct bridge_iflist *); |
| 678 | |
| 679 | static int bridge_ioctl_add(struct bridge_softc *, void *); |
| 680 | static int bridge_ioctl_del(struct bridge_softc *, void *); |
| 681 | static int bridge_ioctl_gifflags(struct bridge_softc *, void *); |
| 682 | static int bridge_ioctl_sifflags(struct bridge_softc *, void *); |
| 683 | static int bridge_ioctl_scache(struct bridge_softc *, void *); |
| 684 | static int bridge_ioctl_gcache(struct bridge_softc *, void *); |
| 685 | static int bridge_ioctl_gifs32(struct bridge_softc *, void *); |
| 686 | static int bridge_ioctl_gifs64(struct bridge_softc *, void *); |
| 687 | static int bridge_ioctl_rts32(struct bridge_softc *, void *); |
| 688 | static int bridge_ioctl_rts64(struct bridge_softc *, void *); |
| 689 | static int bridge_ioctl_saddr32(struct bridge_softc *, void *); |
| 690 | static int bridge_ioctl_saddr64(struct bridge_softc *, void *); |
| 691 | static int bridge_ioctl_sto(struct bridge_softc *, void *); |
| 692 | static int bridge_ioctl_gto(struct bridge_softc *, void *); |
| 693 | static int bridge_ioctl_daddr32(struct bridge_softc *, void *); |
| 694 | static int bridge_ioctl_daddr64(struct bridge_softc *, void *); |
| 695 | static int bridge_ioctl_flush(struct bridge_softc *, void *); |
| 696 | static int bridge_ioctl_gpri(struct bridge_softc *, void *); |
| 697 | static int bridge_ioctl_spri(struct bridge_softc *, void *); |
| 698 | static int bridge_ioctl_ght(struct bridge_softc *, void *); |
| 699 | static int bridge_ioctl_sht(struct bridge_softc *, void *); |
| 700 | static int bridge_ioctl_gfd(struct bridge_softc *, void *); |
| 701 | static int bridge_ioctl_sfd(struct bridge_softc *, void *); |
| 702 | static int bridge_ioctl_gma(struct bridge_softc *, void *); |
| 703 | static int bridge_ioctl_sma(struct bridge_softc *, void *); |
| 704 | static int bridge_ioctl_sifprio(struct bridge_softc *, void *); |
| 705 | static int bridge_ioctl_sifcost(struct bridge_softc *, void *); |
| 706 | static int bridge_ioctl_sifmaxaddr(struct bridge_softc *, void *); |
| 707 | static int bridge_ioctl_addspan(struct bridge_softc *, void *); |
| 708 | static int bridge_ioctl_delspan(struct bridge_softc *, void *); |
| 709 | static int bridge_ioctl_gbparam32(struct bridge_softc *, void *); |
| 710 | static int bridge_ioctl_gbparam64(struct bridge_softc *, void *); |
| 711 | static int bridge_ioctl_grte(struct bridge_softc *, void *); |
| 712 | static int bridge_ioctl_gifsstp32(struct bridge_softc *, void *); |
| 713 | static int bridge_ioctl_gifsstp64(struct bridge_softc *, void *); |
| 714 | static int bridge_ioctl_sproto(struct bridge_softc *, void *); |
| 715 | static int bridge_ioctl_stxhc(struct bridge_softc *, void *); |
| 716 | static int bridge_ioctl_purge(struct bridge_softc *sc, void *); |
| 717 | static int bridge_ioctl_gfilt(struct bridge_softc *, void *); |
| 718 | static int bridge_ioctl_sfilt(struct bridge_softc *, void *); |
| 719 | static int bridge_ioctl_ghostfilter(struct bridge_softc *, void *); |
| 720 | static int bridge_ioctl_shostfilter(struct bridge_softc *, void *); |
| 721 | static int bridge_ioctl_gmnelist32(struct bridge_softc *, void *); |
| 722 | static int bridge_ioctl_gmnelist64(struct bridge_softc *, void *); |
| 723 | static int bridge_ioctl_gifstats32(struct bridge_softc *, void *); |
| 724 | static int bridge_ioctl_gifstats64(struct bridge_softc *, void *); |
| 725 | |
| 726 | static int bridge_pf(struct mbuf **, struct ifnet *, uint32_t sc_filter_flags, int input); |
| 727 | static int bridge_ip_checkbasic(struct mbuf **); |
| 728 | static int bridge_ip6_checkbasic(struct mbuf **); |
| 729 | |
| 730 | static errno_t bridge_set_bpf_tap(ifnet_t, bpf_tap_mode, bpf_packet_func); |
| 731 | static errno_t bridge_bpf_input(ifnet_t, struct mbuf *, const char *, int); |
| 732 | static errno_t bridge_bpf_output(ifnet_t, struct mbuf *); |
| 733 | |
| 734 | static void bridge_detach(ifnet_t); |
| 735 | static void bridge_link_event(struct ifnet *, u_int32_t); |
| 736 | static void bridge_iflinkevent(struct ifnet *); |
| 737 | static u_int32_t bridge_updatelinkstatus(struct bridge_softc *); |
| 738 | static int interface_media_active(struct ifnet *); |
| 739 | static void bridge_schedule_delayed_call(struct bridge_delayed_call *); |
| 740 | static void bridge_cancel_delayed_call(struct bridge_delayed_call *); |
| 741 | static void bridge_cleanup_delayed_call(struct bridge_delayed_call *); |
| 742 | static int bridge_host_filter(struct bridge_iflist *, mbuf_t *); |
| 743 | |
| 744 | static errno_t bridge_mac_nat_enable(struct bridge_softc *, |
| 745 | struct bridge_iflist *); |
| 746 | static void bridge_mac_nat_disable(struct bridge_softc *sc); |
| 747 | static void bridge_mac_nat_age_entries(struct bridge_softc *sc, unsigned long); |
| 748 | static void bridge_mac_nat_populate_entries(struct bridge_softc *sc); |
| 749 | static void bridge_mac_nat_flush_entries(struct bridge_softc *sc, |
| 750 | struct bridge_iflist *); |
| 751 | static ifnet_t bridge_mac_nat_input(struct bridge_softc *, mbuf_t *, |
| 752 | boolean_t *); |
| 753 | static boolean_t bridge_mac_nat_output(struct bridge_softc *, |
| 754 | struct bridge_iflist *, mbuf_t *, struct mac_nat_record *); |
| 755 | static void bridge_mac_nat_translate(mbuf_t *, struct mac_nat_record *, |
| 756 | const caddr_t); |
| 757 | static bool is_broadcast_ip_packet(mbuf_t *); |
| 758 | static bool in_addr_is_ours(const struct in_addr); |
| 759 | static bool in6_addr_is_ours(const struct in6_addr *, uint32_t); |
| 760 | |
| 761 | #define m_copypacket(m, how) m_copym(m, 0, M_COPYALL, how) |
| 762 | |
| 763 | static int |
| 764 | gso_tcp(struct ifnet *ifp, struct mbuf **mp, u_int mac_hlen, bool is_ipv4, |
| 765 | boolean_t is_tx); |
| 766 | |
| 767 | /* The default bridge vlan is 1 (IEEE 802.1Q-2003 Table 9-2) */ |
| 768 | #define VLANTAGOF(_m) 0 |
| 769 | |
| 770 | u_int8_t bstp_etheraddr[ETHER_ADDR_LEN] = |
| 771 | { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x00 }; |
| 772 | |
| 773 | static u_int8_t ethernulladdr[ETHER_ADDR_LEN] = |
| 774 | { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; |
| 775 | |
| 776 | #if BRIDGESTP |
| 777 | static struct bstp_cb_ops bridge_ops = { |
| 778 | .bcb_state = bridge_state_change, |
| 779 | .bcb_rtage = bridge_rtable_expire |
| 780 | }; |
| 781 | #endif /* BRIDGESTP */ |
| 782 | |
| 783 | SYSCTL_DECL(_net_link); |
| 784 | SYSCTL_NODE(_net_link, IFT_BRIDGE, bridge, CTLFLAG_RW | CTLFLAG_LOCKED, 0, |
| 785 | "Bridge" ); |
| 786 | |
| 787 | static int bridge_inherit_mac = 0; /* share MAC with first bridge member */ |
| 788 | SYSCTL_INT(_net_link_bridge, OID_AUTO, inherit_mac, |
| 789 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 790 | &bridge_inherit_mac, 0, |
| 791 | "Inherit MAC address from the first bridge member" ); |
| 792 | |
| 793 | SYSCTL_INT(_net_link_bridge, OID_AUTO, rtable_prune_period, |
| 794 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 795 | &bridge_rtable_prune_period, 0, |
| 796 | "Interval between pruning of routing table" ); |
| 797 | |
| 798 | static unsigned int bridge_rtable_hash_size_max = BRIDGE_RTHASH_SIZE_MAX; |
| 799 | SYSCTL_UINT(_net_link_bridge, OID_AUTO, rtable_hash_size_max, |
| 800 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 801 | &bridge_rtable_hash_size_max, 0, |
| 802 | "Maximum size of the routing hash table" ); |
| 803 | |
| 804 | #if BRIDGE_DELAYED_CALLBACK_DEBUG |
| 805 | static int bridge_delayed_callback_delay = 0; |
| 806 | SYSCTL_INT(_net_link_bridge, OID_AUTO, delayed_callback_delay, |
| 807 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 808 | &bridge_delayed_callback_delay, 0, |
| 809 | "Delay before calling delayed function" ); |
| 810 | #endif |
| 811 | |
| 812 | SYSCTL_STRUCT(_net_link_bridge, OID_AUTO, |
| 813 | hostfilterstats, CTLFLAG_RD | CTLFLAG_LOCKED, |
| 814 | &bridge_hostfilter_stats, bridge_hostfilter_stats, "" ); |
| 815 | |
| 816 | #if BRIDGESTP |
| 817 | static int log_stp = 0; /* log STP state changes */ |
| 818 | SYSCTL_INT(_net_link_bridge, OID_AUTO, log_stp, CTLFLAG_RW, |
| 819 | &log_stp, 0, "Log STP state changes" ); |
| 820 | #endif /* BRIDGESTP */ |
| 821 | |
| 822 | struct bridge_control { |
| 823 | int (*bc_func)(struct bridge_softc *, void *); |
| 824 | unsigned int bc_argsize; |
| 825 | unsigned int bc_flags; |
| 826 | }; |
| 827 | |
| 828 | #define VMNET_TAG "com.apple.vmnet" |
| 829 | #define VMNET_LOCAL_TAG VMNET_TAG ".local" |
| 830 | #define VMNET_BROADCAST_TAG VMNET_TAG ".broadcast" |
| 831 | #define VMNET_MULTICAST_TAG VMNET_TAG ".multicast" |
| 832 | |
| 833 | static u_int16_t vmnet_tag; |
| 834 | static u_int16_t vmnet_local_tag; |
| 835 | static u_int16_t vmnet_broadcast_tag; |
| 836 | static u_int16_t vmnet_multicast_tag; |
| 837 | |
| 838 | static u_int16_t |
| 839 | allocate_pf_tag(char * name) |
| 840 | { |
| 841 | u_int16_t tag; |
| 842 | |
| 843 | tag = pf_tagname2tag_ext(name); |
| 844 | BRIDGE_LOG(LOG_NOTICE, 0, "%s %d" , name, tag); |
| 845 | return tag; |
| 846 | } |
| 847 | |
| 848 | static void |
| 849 | allocate_vmnet_pf_tags(void) |
| 850 | { |
| 851 | /* allocate tags to use with PF */ |
| 852 | if (vmnet_tag == 0) { |
| 853 | vmnet_tag = allocate_pf_tag(VMNET_TAG); |
| 854 | } |
| 855 | if (vmnet_local_tag == 0) { |
| 856 | vmnet_local_tag = allocate_pf_tag(VMNET_LOCAL_TAG); |
| 857 | } |
| 858 | if (vmnet_broadcast_tag == 0) { |
| 859 | vmnet_broadcast_tag = allocate_pf_tag(VMNET_BROADCAST_TAG); |
| 860 | } |
| 861 | if (vmnet_multicast_tag == 0) { |
| 862 | vmnet_multicast_tag = allocate_pf_tag(VMNET_MULTICAST_TAG); |
| 863 | } |
| 864 | } |
| 865 | |
| 866 | #define BC_F_COPYIN 0x01 /* copy arguments in */ |
| 867 | #define BC_F_COPYOUT 0x02 /* copy arguments out */ |
| 868 | #define BC_F_SUSER 0x04 /* do super-user check */ |
| 869 | |
| 870 | static const struct bridge_control bridge_control_table32[] = { |
| 871 | { .bc_func = bridge_ioctl_add, .bc_argsize = sizeof(struct ifbreq), /* 0 */ |
| 872 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 873 | { .bc_func = bridge_ioctl_del, .bc_argsize = sizeof(struct ifbreq), |
| 874 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 875 | |
| 876 | { .bc_func = bridge_ioctl_gifflags, .bc_argsize = sizeof(struct ifbreq), |
| 877 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 878 | { .bc_func = bridge_ioctl_sifflags, .bc_argsize = sizeof(struct ifbreq), |
| 879 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 880 | |
| 881 | { .bc_func = bridge_ioctl_scache, .bc_argsize = sizeof(struct ifbrparam), |
| 882 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 883 | { .bc_func = bridge_ioctl_gcache, .bc_argsize = sizeof(struct ifbrparam), |
| 884 | .bc_flags = BC_F_COPYOUT }, |
| 885 | |
| 886 | { .bc_func = bridge_ioctl_gifs32, .bc_argsize = sizeof(struct ifbifconf32), |
| 887 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 888 | { .bc_func = bridge_ioctl_rts32, .bc_argsize = sizeof(struct ifbaconf32), |
| 889 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 890 | |
| 891 | { .bc_func = bridge_ioctl_saddr32, .bc_argsize = sizeof(struct ifbareq32), |
| 892 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 893 | |
| 894 | { .bc_func = bridge_ioctl_sto, .bc_argsize = sizeof(struct ifbrparam), |
| 895 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 896 | { .bc_func = bridge_ioctl_gto, .bc_argsize = sizeof(struct ifbrparam), /* 10 */ |
| 897 | .bc_flags = BC_F_COPYOUT }, |
| 898 | |
| 899 | { .bc_func = bridge_ioctl_daddr32, .bc_argsize = sizeof(struct ifbareq32), |
| 900 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 901 | |
| 902 | { .bc_func = bridge_ioctl_flush, .bc_argsize = sizeof(struct ifbreq), |
| 903 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 904 | |
| 905 | { .bc_func = bridge_ioctl_gpri, .bc_argsize = sizeof(struct ifbrparam), |
| 906 | .bc_flags = BC_F_COPYOUT }, |
| 907 | { .bc_func = bridge_ioctl_spri, .bc_argsize = sizeof(struct ifbrparam), |
| 908 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 909 | |
| 910 | { .bc_func = bridge_ioctl_ght, .bc_argsize = sizeof(struct ifbrparam), |
| 911 | .bc_flags = BC_F_COPYOUT }, |
| 912 | { .bc_func = bridge_ioctl_sht, .bc_argsize = sizeof(struct ifbrparam), |
| 913 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 914 | |
| 915 | { .bc_func = bridge_ioctl_gfd, .bc_argsize = sizeof(struct ifbrparam), |
| 916 | .bc_flags = BC_F_COPYOUT }, |
| 917 | { .bc_func = bridge_ioctl_sfd, .bc_argsize = sizeof(struct ifbrparam), |
| 918 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 919 | |
| 920 | { .bc_func = bridge_ioctl_gma, .bc_argsize = sizeof(struct ifbrparam), |
| 921 | .bc_flags = BC_F_COPYOUT }, |
| 922 | { .bc_func = bridge_ioctl_sma, .bc_argsize = sizeof(struct ifbrparam), /* 20 */ |
| 923 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 924 | |
| 925 | { .bc_func = bridge_ioctl_sifprio, .bc_argsize = sizeof(struct ifbreq), |
| 926 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 927 | |
| 928 | { .bc_func = bridge_ioctl_sifcost, .bc_argsize = sizeof(struct ifbreq), |
| 929 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 930 | |
| 931 | { .bc_func = bridge_ioctl_gfilt, .bc_argsize = sizeof(struct ifbrparam), |
| 932 | .bc_flags = BC_F_COPYOUT }, |
| 933 | { .bc_func = bridge_ioctl_sfilt, .bc_argsize = sizeof(struct ifbrparam), |
| 934 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 935 | |
| 936 | { .bc_func = bridge_ioctl_purge, .bc_argsize = sizeof(struct ifbreq), |
| 937 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 938 | |
| 939 | { .bc_func = bridge_ioctl_addspan, .bc_argsize = sizeof(struct ifbreq), |
| 940 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 941 | { .bc_func = bridge_ioctl_delspan, .bc_argsize = sizeof(struct ifbreq), |
| 942 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 943 | |
| 944 | { .bc_func = bridge_ioctl_gbparam32, .bc_argsize = sizeof(struct ifbropreq32), |
| 945 | .bc_flags = BC_F_COPYOUT }, |
| 946 | |
| 947 | { .bc_func = bridge_ioctl_grte, .bc_argsize = sizeof(struct ifbrparam), |
| 948 | .bc_flags = BC_F_COPYOUT }, |
| 949 | |
| 950 | { .bc_func = bridge_ioctl_gifsstp32, .bc_argsize = sizeof(struct ifbpstpconf32), /* 30 */ |
| 951 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 952 | |
| 953 | { .bc_func = bridge_ioctl_sproto, .bc_argsize = sizeof(struct ifbrparam), |
| 954 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 955 | |
| 956 | { .bc_func = bridge_ioctl_stxhc, .bc_argsize = sizeof(struct ifbrparam), |
| 957 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 958 | |
| 959 | { .bc_func = bridge_ioctl_sifmaxaddr, .bc_argsize = sizeof(struct ifbreq), |
| 960 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 961 | |
| 962 | { .bc_func = bridge_ioctl_ghostfilter, .bc_argsize = sizeof(struct ifbrhostfilter), |
| 963 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 964 | { .bc_func = bridge_ioctl_shostfilter, .bc_argsize = sizeof(struct ifbrhostfilter), |
| 965 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 966 | |
| 967 | { .bc_func = bridge_ioctl_gmnelist32, |
| 968 | .bc_argsize = sizeof(struct ifbrmnelist32), |
| 969 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 970 | { .bc_func = bridge_ioctl_gifstats32, |
| 971 | .bc_argsize = sizeof(struct ifbrmreq32), |
| 972 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 973 | }; |
| 974 | |
| 975 | static const struct bridge_control bridge_control_table64[] = { |
| 976 | { .bc_func = bridge_ioctl_add, .bc_argsize = sizeof(struct ifbreq), /* 0 */ |
| 977 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 978 | { .bc_func = bridge_ioctl_del, .bc_argsize = sizeof(struct ifbreq), |
| 979 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 980 | |
| 981 | { .bc_func = bridge_ioctl_gifflags, .bc_argsize = sizeof(struct ifbreq), |
| 982 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 983 | { .bc_func = bridge_ioctl_sifflags, .bc_argsize = sizeof(struct ifbreq), |
| 984 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 985 | |
| 986 | { .bc_func = bridge_ioctl_scache, .bc_argsize = sizeof(struct ifbrparam), |
| 987 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 988 | { .bc_func = bridge_ioctl_gcache, .bc_argsize = sizeof(struct ifbrparam), |
| 989 | .bc_flags = BC_F_COPYOUT }, |
| 990 | |
| 991 | { .bc_func = bridge_ioctl_gifs64, .bc_argsize = sizeof(struct ifbifconf64), |
| 992 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 993 | { .bc_func = bridge_ioctl_rts64, .bc_argsize = sizeof(struct ifbaconf64), |
| 994 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 995 | |
| 996 | { .bc_func = bridge_ioctl_saddr64, .bc_argsize = sizeof(struct ifbareq64), |
| 997 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 998 | |
| 999 | { .bc_func = bridge_ioctl_sto, .bc_argsize = sizeof(struct ifbrparam), |
| 1000 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1001 | { .bc_func = bridge_ioctl_gto, .bc_argsize = sizeof(struct ifbrparam), /* 10 */ |
| 1002 | .bc_flags = BC_F_COPYOUT }, |
| 1003 | |
| 1004 | { .bc_func = bridge_ioctl_daddr64, .bc_argsize = sizeof(struct ifbareq64), |
| 1005 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1006 | |
| 1007 | { .bc_func = bridge_ioctl_flush, .bc_argsize = sizeof(struct ifbreq), |
| 1008 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1009 | |
| 1010 | { .bc_func = bridge_ioctl_gpri, .bc_argsize = sizeof(struct ifbrparam), |
| 1011 | .bc_flags = BC_F_COPYOUT }, |
| 1012 | { .bc_func = bridge_ioctl_spri, .bc_argsize = sizeof(struct ifbrparam), |
| 1013 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1014 | |
| 1015 | { .bc_func = bridge_ioctl_ght, .bc_argsize = sizeof(struct ifbrparam), |
| 1016 | .bc_flags = BC_F_COPYOUT }, |
| 1017 | { .bc_func = bridge_ioctl_sht, .bc_argsize = sizeof(struct ifbrparam), |
| 1018 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1019 | |
| 1020 | { .bc_func = bridge_ioctl_gfd, .bc_argsize = sizeof(struct ifbrparam), |
| 1021 | .bc_flags = BC_F_COPYOUT }, |
| 1022 | { .bc_func = bridge_ioctl_sfd, .bc_argsize = sizeof(struct ifbrparam), |
| 1023 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1024 | |
| 1025 | { .bc_func = bridge_ioctl_gma, .bc_argsize = sizeof(struct ifbrparam), |
| 1026 | .bc_flags = BC_F_COPYOUT }, |
| 1027 | { .bc_func = bridge_ioctl_sma, .bc_argsize = sizeof(struct ifbrparam), /* 20 */ |
| 1028 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1029 | |
| 1030 | { .bc_func = bridge_ioctl_sifprio, .bc_argsize = sizeof(struct ifbreq), |
| 1031 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1032 | |
| 1033 | { .bc_func = bridge_ioctl_sifcost, .bc_argsize = sizeof(struct ifbreq), |
| 1034 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1035 | |
| 1036 | { .bc_func = bridge_ioctl_gfilt, .bc_argsize = sizeof(struct ifbrparam), |
| 1037 | .bc_flags = BC_F_COPYOUT }, |
| 1038 | { .bc_func = bridge_ioctl_sfilt, .bc_argsize = sizeof(struct ifbrparam), |
| 1039 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1040 | |
| 1041 | { .bc_func = bridge_ioctl_purge, .bc_argsize = sizeof(struct ifbreq), |
| 1042 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1043 | |
| 1044 | { .bc_func = bridge_ioctl_addspan, .bc_argsize = sizeof(struct ifbreq), |
| 1045 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1046 | { .bc_func = bridge_ioctl_delspan, .bc_argsize = sizeof(struct ifbreq), |
| 1047 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1048 | |
| 1049 | { .bc_func = bridge_ioctl_gbparam64, .bc_argsize = sizeof(struct ifbropreq64), |
| 1050 | .bc_flags = BC_F_COPYOUT }, |
| 1051 | |
| 1052 | { .bc_func = bridge_ioctl_grte, .bc_argsize = sizeof(struct ifbrparam), |
| 1053 | .bc_flags = BC_F_COPYOUT }, |
| 1054 | |
| 1055 | { .bc_func = bridge_ioctl_gifsstp64, .bc_argsize = sizeof(struct ifbpstpconf64), /* 30 */ |
| 1056 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 1057 | |
| 1058 | { .bc_func = bridge_ioctl_sproto, .bc_argsize = sizeof(struct ifbrparam), |
| 1059 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1060 | |
| 1061 | { .bc_func = bridge_ioctl_stxhc, .bc_argsize = sizeof(struct ifbrparam), |
| 1062 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1063 | |
| 1064 | { .bc_func = bridge_ioctl_sifmaxaddr, .bc_argsize = sizeof(struct ifbreq), |
| 1065 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1066 | |
| 1067 | { .bc_func = bridge_ioctl_ghostfilter, .bc_argsize = sizeof(struct ifbrhostfilter), |
| 1068 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 1069 | { .bc_func = bridge_ioctl_shostfilter, .bc_argsize = sizeof(struct ifbrhostfilter), |
| 1070 | .bc_flags = BC_F_COPYIN | BC_F_SUSER }, |
| 1071 | |
| 1072 | { .bc_func = bridge_ioctl_gmnelist64, |
| 1073 | .bc_argsize = sizeof(struct ifbrmnelist64), |
| 1074 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 1075 | { .bc_func = bridge_ioctl_gifstats64, |
| 1076 | .bc_argsize = sizeof(struct ifbrmreq64), |
| 1077 | .bc_flags = BC_F_COPYIN | BC_F_COPYOUT }, |
| 1078 | }; |
| 1079 | |
| 1080 | static const unsigned int bridge_control_table_size = |
| 1081 | sizeof(bridge_control_table32) / sizeof(bridge_control_table32[0]); |
| 1082 | |
| 1083 | static LIST_HEAD(, bridge_softc) bridge_list = |
| 1084 | LIST_HEAD_INITIALIZER(bridge_list); |
| 1085 | |
| 1086 | #define BRIDGENAME "bridge" |
| 1087 | #define BRIDGES_MAX IF_MAXUNIT |
| 1088 | #define BRIDGE_ZONE_MAX_ELEM MIN(IFNETS_MAX, BRIDGES_MAX) |
| 1089 | |
| 1090 | static struct if_clone bridge_cloner = |
| 1091 | IF_CLONE_INITIALIZER(BRIDGENAME, bridge_clone_create, bridge_clone_destroy, |
| 1092 | 0, BRIDGES_MAX); |
| 1093 | |
| 1094 | static int if_bridge_txstart = 0; |
| 1095 | SYSCTL_INT(_net_link_bridge, OID_AUTO, txstart, CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1096 | &if_bridge_txstart, 0, "Bridge interface uses TXSTART model" ); |
| 1097 | |
| 1098 | SYSCTL_INT(_net_link_bridge, OID_AUTO, debug, CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1099 | &if_bridge_debug, 0, "Bridge debug flags" ); |
| 1100 | |
| 1101 | SYSCTL_INT(_net_link_bridge, OID_AUTO, log_level, |
| 1102 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1103 | &if_bridge_log_level, 0, "Bridge log level" ); |
| 1104 | |
| 1105 | static int if_bridge_segmentation = 1; |
| 1106 | SYSCTL_INT(_net_link_bridge, OID_AUTO, segmentation, |
| 1107 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1108 | &if_bridge_segmentation, 0, "Bridge interface enable segmentation" ); |
| 1109 | |
| 1110 | static int if_bridge_vmnet_pf_tagging = 1; |
| 1111 | SYSCTL_INT(_net_link_bridge, OID_AUTO, vmnet_pf_tagging, |
| 1112 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1113 | &if_bridge_segmentation, 0, "Bridge interface enable vmnet PF tagging" ); |
| 1114 | |
| 1115 | #define BRIDGE_TSO_REDUCE_MSS_FORWARDING_MAX 256 |
| 1116 | #define BRIDGE_TSO_REDUCE_MSS_FORWARDING_DEFAULT 110 |
| 1117 | #define BRIDGE_TSO_REDUCE_MSS_TX_MAX 256 |
| 1118 | #define BRIDGE_TSO_REDUCE_MSS_TX_DEFAULT 0 |
| 1119 | |
| 1120 | static u_int if_bridge_tso_reduce_mss_forwarding |
| 1121 | = BRIDGE_TSO_REDUCE_MSS_FORWARDING_DEFAULT; |
| 1122 | static u_int if_bridge_tso_reduce_mss_tx |
| 1123 | = BRIDGE_TSO_REDUCE_MSS_TX_DEFAULT; |
| 1124 | |
| 1125 | static int |
| 1126 | bridge_tso_reduce_mss(struct sysctl_req *req, u_int * val, u_int val_max) |
| 1127 | { |
| 1128 | int changed; |
| 1129 | int error; |
| 1130 | u_int new_value; |
| 1131 | |
| 1132 | error = sysctl_io_number(req, bigValue: *val, valueSize: sizeof(*val), pValue: &new_value, |
| 1133 | changed: &changed); |
| 1134 | if (error == 0 && changed != 0) { |
| 1135 | if (new_value > val_max) { |
| 1136 | return EINVAL; |
| 1137 | } |
| 1138 | *val = new_value; |
| 1139 | } |
| 1140 | return error; |
| 1141 | } |
| 1142 | |
| 1143 | static int |
| 1144 | bridge_tso_reduce_mss_forwarding_sysctl SYSCTL_HANDLER_ARGS |
| 1145 | { |
| 1146 | return bridge_tso_reduce_mss(req, val: &if_bridge_tso_reduce_mss_forwarding, |
| 1147 | BRIDGE_TSO_REDUCE_MSS_FORWARDING_MAX); |
| 1148 | } |
| 1149 | |
| 1150 | SYSCTL_PROC(_net_link_bridge, OID_AUTO, tso_reduce_mss_forwarding, |
| 1151 | CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1152 | 0, 0, bridge_tso_reduce_mss_forwarding_sysctl, "IU" , |
| 1153 | "Bridge tso reduce mss when forwarding" ); |
| 1154 | |
| 1155 | static int |
| 1156 | bridge_tso_reduce_mss_tx_sysctl SYSCTL_HANDLER_ARGS |
| 1157 | { |
| 1158 | return bridge_tso_reduce_mss(req, val: &if_bridge_tso_reduce_mss_tx, |
| 1159 | BRIDGE_TSO_REDUCE_MSS_TX_MAX); |
| 1160 | } |
| 1161 | |
| 1162 | SYSCTL_PROC(_net_link_bridge, OID_AUTO, tso_reduce_mss_tx, |
| 1163 | CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1164 | 0, 0, bridge_tso_reduce_mss_tx_sysctl, "IU" , |
| 1165 | "Bridge tso reduce mss on transmit" ); |
| 1166 | |
| 1167 | #if DEBUG || DEVELOPMENT |
| 1168 | #define BRIDGE_FORCE_ONE 0x00000001 |
| 1169 | #define BRIDGE_FORCE_TWO 0x00000002 |
| 1170 | static u_int32_t if_bridge_force_errors = 0; |
| 1171 | SYSCTL_INT(_net_link_bridge, OID_AUTO, force_errors, |
| 1172 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1173 | &if_bridge_force_errors, 0, "Bridge interface force errors" ); |
| 1174 | static inline bool |
| 1175 | bridge_error_is_forced(u_int32_t flags) |
| 1176 | { |
| 1177 | return (if_bridge_force_errors & flags) != 0; |
| 1178 | } |
| 1179 | |
| 1180 | #define BRIDGE_ERROR_GET_FORCED(__is_forced, __flags) \ |
| 1181 | do { \ |
| 1182 | __is_forced = bridge_error_is_forced(__flags); \ |
| 1183 | if (__is_forced) { \ |
| 1184 | BRIDGE_LOG(LOG_NOTICE, 0, "0x%x forced", __flags); \ |
| 1185 | } \ |
| 1186 | } while (0) |
| 1187 | |
| 1188 | /* |
| 1189 | * net.link.bridge.reduce_tso_mtu |
| 1190 | * - when non-zero, the bridge overrides the interface TSO MTU to a lower |
| 1191 | * value (i.e. 16K) to enable testing the "use GSO instead" path |
| 1192 | */ |
| 1193 | static int if_bridge_reduce_tso_mtu = 0; |
| 1194 | SYSCTL_INT(_net_link_bridge, OID_AUTO, reduce_tso_mtu, |
| 1195 | CTLFLAG_RW | CTLFLAG_LOCKED, |
| 1196 | &if_bridge_reduce_tso_mtu, 0, "Bridge interface reduce TSO MTU" ); |
| 1197 | |
| 1198 | #endif /* DEBUG || DEVELOPMENT */ |
| 1199 | |
| 1200 | static void brlog_ether_header(struct ether_header *); |
| 1201 | static void brlog_mbuf_data(mbuf_t, size_t, size_t); |
| 1202 | static void brlog_mbuf_pkthdr(mbuf_t, const char *, const char *); |
| 1203 | static void brlog_mbuf(mbuf_t, const char *, const char *); |
| 1204 | static void brlog_link(struct bridge_softc * sc); |
| 1205 | |
| 1206 | #if BRIDGE_LOCK_DEBUG |
| 1207 | static void bridge_lock(struct bridge_softc *); |
| 1208 | static void bridge_unlock(struct bridge_softc *); |
| 1209 | static int bridge_lock2ref(struct bridge_softc *); |
| 1210 | static void bridge_unref(struct bridge_softc *); |
| 1211 | static void bridge_xlock(struct bridge_softc *); |
| 1212 | static void bridge_xdrop(struct bridge_softc *); |
| 1213 | |
| 1214 | static void |
| 1215 | bridge_lock(struct bridge_softc *sc) |
| 1216 | { |
| 1217 | void *lr_saved = __builtin_return_address(0); |
| 1218 | |
| 1219 | BRIDGE_LOCK_ASSERT_NOTHELD(sc); |
| 1220 | |
| 1221 | _BRIDGE_LOCK(sc); |
| 1222 | |
| 1223 | sc->lock_lr[sc->next_lock_lr] = lr_saved; |
| 1224 | sc->next_lock_lr = (sc->next_lock_lr + 1) % SO_LCKDBG_MAX; |
| 1225 | } |
| 1226 | |
| 1227 | static void |
| 1228 | bridge_unlock(struct bridge_softc *sc) |
| 1229 | { |
| 1230 | void *lr_saved = __builtin_return_address(0); |
| 1231 | |
| 1232 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 1233 | |
| 1234 | sc->unlock_lr[sc->next_unlock_lr] = lr_saved; |
| 1235 | sc->next_unlock_lr = (sc->next_unlock_lr + 1) % SO_LCKDBG_MAX; |
| 1236 | |
| 1237 | _BRIDGE_UNLOCK(sc); |
| 1238 | } |
| 1239 | |
| 1240 | static int |
| 1241 | bridge_lock2ref(struct bridge_softc *sc) |
| 1242 | { |
| 1243 | int error = 0; |
| 1244 | void *lr_saved = __builtin_return_address(0); |
| 1245 | |
| 1246 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 1247 | |
| 1248 | if (sc->sc_iflist_xcnt > 0) { |
| 1249 | error = EBUSY; |
| 1250 | } else { |
| 1251 | sc->sc_iflist_ref++; |
| 1252 | } |
| 1253 | |
| 1254 | sc->unlock_lr[sc->next_unlock_lr] = lr_saved; |
| 1255 | sc->next_unlock_lr = (sc->next_unlock_lr + 1) % SO_LCKDBG_MAX; |
| 1256 | |
| 1257 | _BRIDGE_UNLOCK(sc); |
| 1258 | |
| 1259 | return error; |
| 1260 | } |
| 1261 | |
| 1262 | static void |
| 1263 | bridge_unref(struct bridge_softc *sc) |
| 1264 | { |
| 1265 | void *lr_saved = __builtin_return_address(0); |
| 1266 | |
| 1267 | BRIDGE_LOCK_ASSERT_NOTHELD(sc); |
| 1268 | |
| 1269 | _BRIDGE_LOCK(sc); |
| 1270 | sc->lock_lr[sc->next_lock_lr] = lr_saved; |
| 1271 | sc->next_lock_lr = (sc->next_lock_lr + 1) % SO_LCKDBG_MAX; |
| 1272 | |
| 1273 | sc->sc_iflist_ref--; |
| 1274 | |
| 1275 | sc->unlock_lr[sc->next_unlock_lr] = lr_saved; |
| 1276 | sc->next_unlock_lr = (sc->next_unlock_lr + 1) % SO_LCKDBG_MAX; |
| 1277 | if ((sc->sc_iflist_xcnt > 0) && (sc->sc_iflist_ref == 0)) { |
| 1278 | _BRIDGE_UNLOCK(sc); |
| 1279 | wakeup(chan: &sc->sc_cv); |
| 1280 | } else { |
| 1281 | _BRIDGE_UNLOCK(sc); |
| 1282 | } |
| 1283 | } |
| 1284 | |
| 1285 | static void |
| 1286 | bridge_xlock(struct bridge_softc *sc) |
| 1287 | { |
| 1288 | void *lr_saved = __builtin_return_address(0); |
| 1289 | |
| 1290 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 1291 | |
| 1292 | sc->sc_iflist_xcnt++; |
| 1293 | while (sc->sc_iflist_ref > 0) { |
| 1294 | sc->unlock_lr[sc->next_unlock_lr] = lr_saved; |
| 1295 | sc->next_unlock_lr = (sc->next_unlock_lr + 1) % SO_LCKDBG_MAX; |
| 1296 | |
| 1297 | msleep(chan: &sc->sc_cv, mtx: &sc->sc_mtx, PZERO, wmesg: "BRIDGE_XLOCK" , NULL); |
| 1298 | |
| 1299 | sc->lock_lr[sc->next_lock_lr] = lr_saved; |
| 1300 | sc->next_lock_lr = (sc->next_lock_lr + 1) % SO_LCKDBG_MAX; |
| 1301 | } |
| 1302 | } |
| 1303 | |
| 1304 | static void |
| 1305 | bridge_xdrop(struct bridge_softc *sc) |
| 1306 | { |
| 1307 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 1308 | |
| 1309 | sc->sc_iflist_xcnt--; |
| 1310 | } |
| 1311 | |
| 1312 | #endif /* BRIDGE_LOCK_DEBUG */ |
| 1313 | |
| 1314 | static void |
| 1315 | brlog_mbuf_pkthdr(mbuf_t m, const char *prefix, const char *suffix) |
| 1316 | { |
| 1317 | if (m) { |
| 1318 | BRIDGE_LOG_SIMPLE(LOG_NOTICE, 0, |
| 1319 | "%spktlen: %u rcvif: 0x%llx header: 0x%llx nextpkt: 0x%llx%s" , |
| 1320 | prefix ? prefix : "" , (unsigned int)mbuf_pkthdr_len(m), |
| 1321 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_pkthdr_rcvif(m)), |
| 1322 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_pkthdr_header(m)), |
| 1323 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_nextpkt(m)), |
| 1324 | suffix ? suffix : "" ); |
| 1325 | } else { |
| 1326 | BRIDGE_LOG_SIMPLE(LOG_NOTICE, 0, "%s<NULL>%s" , prefix, suffix); |
| 1327 | } |
| 1328 | } |
| 1329 | |
| 1330 | static void |
| 1331 | brlog_mbuf(mbuf_t m, const char *prefix, const char *suffix) |
| 1332 | { |
| 1333 | if (m) { |
| 1334 | BRIDGE_LOG_SIMPLE(LOG_NOTICE, 0, |
| 1335 | "%s0x%llx type: %u flags: 0x%x len: %u data: 0x%llx " |
| 1336 | "maxlen: %u datastart: 0x%llx next: 0x%llx%s" , |
| 1337 | prefix ? prefix : "" , (uint64_t)VM_KERNEL_ADDRPERM(m), |
| 1338 | mbuf_type(m), mbuf_flags(m), (unsigned int)mbuf_len(m), |
| 1339 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_data(m)), |
| 1340 | (unsigned int)mbuf_maxlen(m), |
| 1341 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_datastart(m)), |
| 1342 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_next(m)), |
| 1343 | !suffix || (mbuf_flags(m) & MBUF_PKTHDR) ? "" : suffix); |
| 1344 | if ((mbuf_flags(mbuf: m) & MBUF_PKTHDR)) { |
| 1345 | brlog_mbuf_pkthdr(m, prefix: "" , suffix); |
| 1346 | } |
| 1347 | } else { |
| 1348 | BRIDGE_LOG_SIMPLE(LOG_NOTICE, 0, "%s<NULL>%s" , prefix, suffix); |
| 1349 | } |
| 1350 | } |
| 1351 | |
| 1352 | static void |
| 1353 | brlog_mbuf_data(mbuf_t m, size_t offset, size_t len) |
| 1354 | { |
| 1355 | mbuf_t n; |
| 1356 | size_t i, j; |
| 1357 | size_t pktlen, mlen, maxlen; |
| 1358 | unsigned char *ptr; |
| 1359 | |
| 1360 | pktlen = mbuf_pkthdr_len(mbuf: m); |
| 1361 | |
| 1362 | if (offset > pktlen) { |
| 1363 | return; |
| 1364 | } |
| 1365 | |
| 1366 | maxlen = (pktlen - offset > len) ? len : pktlen - offset; |
| 1367 | n = m; |
| 1368 | mlen = mbuf_len(mbuf: n); |
| 1369 | ptr = mbuf_data(mbuf: n); |
| 1370 | for (i = 0, j = 0; i < maxlen; i++, j++) { |
| 1371 | if (j >= mlen) { |
| 1372 | n = mbuf_next(mbuf: n); |
| 1373 | if (n == 0) { |
| 1374 | break; |
| 1375 | } |
| 1376 | ptr = mbuf_data(mbuf: n); |
| 1377 | mlen = mbuf_len(mbuf: n); |
| 1378 | j = 0; |
| 1379 | } |
| 1380 | if (i >= offset) { |
| 1381 | BRIDGE_LOG_SIMPLE(LOG_NOTICE, 0, |
| 1382 | "%02x%s" , ptr[j], i % 2 ? " " : "" ); |
| 1383 | } |
| 1384 | } |
| 1385 | } |
| 1386 | |
| 1387 | static void |
| 1388 | (struct ether_header *eh) |
| 1389 | { |
| 1390 | BRIDGE_LOG_SIMPLE(LOG_NOTICE, 0, |
| 1391 | "%02x:%02x:%02x:%02x:%02x:%02x > " |
| 1392 | "%02x:%02x:%02x:%02x:%02x:%02x 0x%04x " , |
| 1393 | eh->ether_shost[0], eh->ether_shost[1], eh->ether_shost[2], |
| 1394 | eh->ether_shost[3], eh->ether_shost[4], eh->ether_shost[5], |
| 1395 | eh->ether_dhost[0], eh->ether_dhost[1], eh->ether_dhost[2], |
| 1396 | eh->ether_dhost[3], eh->ether_dhost[4], eh->ether_dhost[5], |
| 1397 | ntohs(eh->ether_type)); |
| 1398 | } |
| 1399 | |
| 1400 | static char * |
| 1401 | ether_ntop(char *buf, size_t len, const u_char *ap) |
| 1402 | { |
| 1403 | snprintf(buf, count: len, "%02x:%02x:%02x:%02x:%02x:%02x" , |
| 1404 | ap[0], ap[1], ap[2], ap[3], ap[4], ap[5]); |
| 1405 | |
| 1406 | return buf; |
| 1407 | } |
| 1408 | |
| 1409 | static void |
| 1410 | brlog_link(struct bridge_softc * sc) |
| 1411 | { |
| 1412 | int i; |
| 1413 | uint32_t sdl_buffer[(offsetof(struct sockaddr_dl, sdl_data) + |
| 1414 | IFNAMSIZ + ETHER_ADDR_LEN)]; |
| 1415 | struct sockaddr_dl *sdl = SDL((uint8_t*)&sdl_buffer); /* SDL requires byte pointer */ |
| 1416 | const u_char * lladdr; |
| 1417 | char lladdr_str[48]; |
| 1418 | |
| 1419 | memset(s: sdl, c: 0, n: sizeof(sdl_buffer)); |
| 1420 | sdl->sdl_family = AF_LINK; |
| 1421 | sdl->sdl_nlen = strlen(s: sc->sc_if_xname); |
| 1422 | sdl->sdl_alen = ETHER_ADDR_LEN; |
| 1423 | sdl->sdl_len = offsetof(struct sockaddr_dl, sdl_data); |
| 1424 | memcpy(dst: sdl->sdl_data, src: sc->sc_if_xname, n: sdl->sdl_nlen); |
| 1425 | memcpy(LLADDR(sdl), src: sc->sc_defaddr, ETHER_ADDR_LEN); |
| 1426 | lladdr_str[0] = '\0'; |
| 1427 | for (i = 0, lladdr = CONST_LLADDR(sdl); |
| 1428 | i < sdl->sdl_alen; |
| 1429 | i++, lladdr++) { |
| 1430 | char byte_str[4]; |
| 1431 | |
| 1432 | snprintf(byte_str, count: sizeof(byte_str), "%s%x" , i ? ":" : "" , |
| 1433 | *lladdr); |
| 1434 | strlcat(dst: lladdr_str, src: byte_str, n: sizeof(lladdr_str)); |
| 1435 | } |
| 1436 | BRIDGE_LOG_SIMPLE(LOG_NOTICE, 0, |
| 1437 | "%s sdl len %d index %d family %d type 0x%x nlen %d alen %d" |
| 1438 | " slen %d addr %s" , sc->sc_if_xname, |
| 1439 | sdl->sdl_len, sdl->sdl_index, |
| 1440 | sdl->sdl_family, sdl->sdl_type, sdl->sdl_nlen, |
| 1441 | sdl->sdl_alen, sdl->sdl_slen, lladdr_str); |
| 1442 | } |
| 1443 | |
| 1444 | |
| 1445 | /* |
| 1446 | * bridgeattach: |
| 1447 | * |
| 1448 | * Pseudo-device attach routine. |
| 1449 | */ |
| 1450 | __private_extern__ int |
| 1451 | bridgeattach(int n) |
| 1452 | { |
| 1453 | #pragma unused(n) |
| 1454 | int error; |
| 1455 | |
| 1456 | LIST_INIT(&bridge_list); |
| 1457 | |
| 1458 | #if BRIDGESTP |
| 1459 | bstp_sys_init(); |
| 1460 | #endif /* BRIDGESTP */ |
| 1461 | |
| 1462 | error = if_clone_attach(&bridge_cloner); |
| 1463 | if (error != 0) { |
| 1464 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_clone_attach failed %d" , error); |
| 1465 | } |
| 1466 | return error; |
| 1467 | } |
| 1468 | |
| 1469 | |
| 1470 | static errno_t |
| 1471 | bridge_ifnet_set_attrs(struct ifnet * ifp) |
| 1472 | { |
| 1473 | errno_t error; |
| 1474 | |
| 1475 | error = ifnet_set_mtu(interface: ifp, ETHERMTU); |
| 1476 | if (error != 0) { |
| 1477 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_set_mtu failed %d" , error); |
| 1478 | goto done; |
| 1479 | } |
| 1480 | error = ifnet_set_addrlen(interface: ifp, ETHER_ADDR_LEN); |
| 1481 | if (error != 0) { |
| 1482 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_set_addrlen failed %d" , error); |
| 1483 | goto done; |
| 1484 | } |
| 1485 | error = ifnet_set_hdrlen(interface: ifp, ETHER_HDR_LEN); |
| 1486 | if (error != 0) { |
| 1487 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_set_hdrlen failed %d" , error); |
| 1488 | goto done; |
| 1489 | } |
| 1490 | error = ifnet_set_flags(interface: ifp, |
| 1491 | IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS | IFF_MULTICAST, |
| 1492 | mask: 0xffff); |
| 1493 | |
| 1494 | if (error != 0) { |
| 1495 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_set_flags failed %d" , error); |
| 1496 | goto done; |
| 1497 | } |
| 1498 | done: |
| 1499 | return error; |
| 1500 | } |
| 1501 | |
| 1502 | /* |
| 1503 | * bridge_clone_create: |
| 1504 | * |
| 1505 | * Create a new bridge instance. |
| 1506 | */ |
| 1507 | static int |
| 1508 | bridge_clone_create(struct if_clone *ifc, uint32_t unit, void *params) |
| 1509 | { |
| 1510 | #pragma unused(params) |
| 1511 | struct ifnet *ifp = NULL; |
| 1512 | struct bridge_softc *sc = NULL; |
| 1513 | struct bridge_softc *sc2 = NULL; |
| 1514 | struct ifnet_init_eparams init_params; |
| 1515 | errno_t error = 0; |
| 1516 | uint8_t eth_hostid[ETHER_ADDR_LEN]; |
| 1517 | int fb, retry, has_hostid; |
| 1518 | |
| 1519 | sc = kalloc_type(struct bridge_softc, Z_WAITOK_ZERO_NOFAIL); |
| 1520 | lck_mtx_init(lck: &sc->sc_mtx, grp: &bridge_lock_grp, attr: &bridge_lock_attr); |
| 1521 | sc->sc_brtmax = BRIDGE_RTABLE_MAX; |
| 1522 | sc->sc_mne_max = BRIDGE_MAC_NAT_ENTRY_MAX; |
| 1523 | sc->sc_brttimeout = BRIDGE_RTABLE_TIMEOUT; |
| 1524 | sc->sc_filter_flags = 0; |
| 1525 | |
| 1526 | TAILQ_INIT(&sc->sc_iflist); |
| 1527 | |
| 1528 | /* use the interface name as the unique id for ifp recycle */ |
| 1529 | snprintf(sc->sc_if_xname, count: sizeof(sc->sc_if_xname), "%s%d" , |
| 1530 | ifc->ifc_name, unit); |
| 1531 | bzero(s: &init_params, n: sizeof(init_params)); |
| 1532 | init_params.ver = IFNET_INIT_CURRENT_VERSION; |
| 1533 | init_params.len = sizeof(init_params); |
| 1534 | /* Initialize our routing table. */ |
| 1535 | error = bridge_rtable_init(sc); |
| 1536 | if (error != 0) { |
| 1537 | BRIDGE_LOG(LOG_NOTICE, 0, "bridge_rtable_init failed %d" , error); |
| 1538 | goto done; |
| 1539 | } |
| 1540 | TAILQ_INIT(&sc->sc_spanlist); |
| 1541 | if (if_bridge_txstart) { |
| 1542 | init_params.start = bridge_start; |
| 1543 | } else { |
| 1544 | init_params.flags = IFNET_INIT_LEGACY; |
| 1545 | init_params.output = bridge_output; |
| 1546 | } |
| 1547 | init_params.set_bpf_tap = bridge_set_bpf_tap; |
| 1548 | init_params.uniqueid = sc->sc_if_xname; |
| 1549 | init_params.uniqueid_len = strlen(s: sc->sc_if_xname); |
| 1550 | init_params.sndq_maxlen = IFQ_MAXLEN; |
| 1551 | init_params.name = ifc->ifc_name; |
| 1552 | init_params.unit = unit; |
| 1553 | init_params.family = IFNET_FAMILY_ETHERNET; |
| 1554 | init_params.type = IFT_BRIDGE; |
| 1555 | init_params.demux = ether_demux; |
| 1556 | init_params.add_proto = ether_add_proto; |
| 1557 | init_params.del_proto = ether_del_proto; |
| 1558 | init_params.check_multi = ether_check_multi; |
| 1559 | init_params.framer_extended = ether_frameout_extended; |
| 1560 | init_params.softc = sc; |
| 1561 | init_params.ioctl = bridge_ioctl; |
| 1562 | init_params.detach = bridge_detach; |
| 1563 | init_params.broadcast_addr = etherbroadcastaddr; |
| 1564 | init_params.broadcast_len = ETHER_ADDR_LEN; |
| 1565 | |
| 1566 | error = ifnet_allocate_extended(init: &init_params, interface: &ifp); |
| 1567 | if (error != 0) { |
| 1568 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_allocate failed %d" , error); |
| 1569 | goto done; |
| 1570 | } |
| 1571 | LIST_INIT(&sc->sc_mne_list); |
| 1572 | LIST_INIT(&sc->sc_mne_list_v6); |
| 1573 | sc->sc_ifp = ifp; |
| 1574 | error = bridge_ifnet_set_attrs(ifp); |
| 1575 | if (error != 0) { |
| 1576 | BRIDGE_LOG(LOG_NOTICE, 0, "bridge_ifnet_set_attrs failed %d" , |
| 1577 | error); |
| 1578 | goto done; |
| 1579 | } |
| 1580 | /* |
| 1581 | * Generate an ethernet address with a locally administered address. |
| 1582 | * |
| 1583 | * Since we are using random ethernet addresses for the bridge, it is |
| 1584 | * possible that we might have address collisions, so make sure that |
| 1585 | * this hardware address isn't already in use on another bridge. |
| 1586 | * The first try uses the "hostid" and falls back to read_frandom(); |
| 1587 | * for "hostid", we use the MAC address of the first-encountered |
| 1588 | * Ethernet-type interface that is currently configured. |
| 1589 | */ |
| 1590 | fb = 0; |
| 1591 | has_hostid = (uuid_get_ethernet(ð_hostid[0]) == 0); |
| 1592 | for (retry = 1; retry != 0;) { |
| 1593 | if (fb || has_hostid == 0) { |
| 1594 | read_frandom(buffer: &sc->sc_defaddr, ETHER_ADDR_LEN); |
| 1595 | sc->sc_defaddr[0] &= ~1; /* clear multicast bit */ |
| 1596 | sc->sc_defaddr[0] |= 2; /* set the LAA bit */ |
| 1597 | } else { |
| 1598 | bcopy(src: ð_hostid[0], dst: &sc->sc_defaddr, |
| 1599 | ETHER_ADDR_LEN); |
| 1600 | sc->sc_defaddr[0] &= ~1; /* clear multicast bit */ |
| 1601 | sc->sc_defaddr[0] |= 2; /* set the LAA bit */ |
| 1602 | sc->sc_defaddr[3] = /* stir it up a bit */ |
| 1603 | ((sc->sc_defaddr[3] & 0x0f) << 4) | |
| 1604 | ((sc->sc_defaddr[3] & 0xf0) >> 4); |
| 1605 | /* |
| 1606 | * Mix in the LSB as it's actually pretty significant, |
| 1607 | * see rdar://14076061 |
| 1608 | */ |
| 1609 | sc->sc_defaddr[4] = |
| 1610 | (((sc->sc_defaddr[4] & 0x0f) << 4) | |
| 1611 | ((sc->sc_defaddr[4] & 0xf0) >> 4)) ^ |
| 1612 | sc->sc_defaddr[5]; |
| 1613 | sc->sc_defaddr[5] = ifp->if_unit & 0xff; |
| 1614 | } |
| 1615 | |
| 1616 | fb = 1; |
| 1617 | retry = 0; |
| 1618 | lck_mtx_lock(lck: &bridge_list_mtx); |
| 1619 | LIST_FOREACH(sc2, &bridge_list, sc_list) { |
| 1620 | if (_ether_cmp(a: sc->sc_defaddr, |
| 1621 | IF_LLADDR(sc2->sc_ifp)) == 0) { |
| 1622 | retry = 1; |
| 1623 | } |
| 1624 | } |
| 1625 | lck_mtx_unlock(lck: &bridge_list_mtx); |
| 1626 | } |
| 1627 | |
| 1628 | sc->sc_flags &= ~SCF_MEDIA_ACTIVE; |
| 1629 | |
| 1630 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_LIFECYCLE)) { |
| 1631 | brlog_link(sc); |
| 1632 | } |
| 1633 | error = ifnet_attach(interface: ifp, NULL); |
| 1634 | if (error != 0) { |
| 1635 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_attach failed %d" , error); |
| 1636 | goto done; |
| 1637 | } |
| 1638 | |
| 1639 | error = ifnet_set_lladdr_and_type(interface: ifp, lladdr: sc->sc_defaddr, ETHER_ADDR_LEN, |
| 1640 | IFT_ETHER); |
| 1641 | if (error != 0) { |
| 1642 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_set_lladdr_and_type failed %d" , |
| 1643 | error); |
| 1644 | goto done; |
| 1645 | } |
| 1646 | |
| 1647 | ifnet_set_offload(interface: ifp, |
| 1648 | offload: IFNET_CSUM_IP | IFNET_CSUM_TCP | IFNET_CSUM_UDP | |
| 1649 | IFNET_CSUM_TCPIPV6 | IFNET_CSUM_UDPIPV6 | IFNET_MULTIPAGES); |
| 1650 | error = bridge_set_tso(sc); |
| 1651 | if (error != 0) { |
| 1652 | BRIDGE_LOG(LOG_NOTICE, 0, "bridge_set_tso failed %d" , error); |
| 1653 | goto done; |
| 1654 | } |
| 1655 | #if BRIDGESTP |
| 1656 | bstp_attach(&sc->sc_stp, &bridge_ops); |
| 1657 | #endif /* BRIDGESTP */ |
| 1658 | |
| 1659 | lck_mtx_lock(lck: &bridge_list_mtx); |
| 1660 | LIST_INSERT_HEAD(&bridge_list, sc, sc_list); |
| 1661 | lck_mtx_unlock(lck: &bridge_list_mtx); |
| 1662 | |
| 1663 | /* attach as ethernet */ |
| 1664 | error = bpf_attach(interface: ifp, DLT_EN10MB, header_length: sizeof(struct ether_header), |
| 1665 | NULL, NULL); |
| 1666 | |
| 1667 | done: |
| 1668 | if (error != 0) { |
| 1669 | BRIDGE_LOG(LOG_NOTICE, 0, "failed error %d" , error); |
| 1670 | /* TBD: Clean up: sc, sc_rthash etc */ |
| 1671 | } |
| 1672 | |
| 1673 | return error; |
| 1674 | } |
| 1675 | |
| 1676 | /* |
| 1677 | * bridge_clone_destroy: |
| 1678 | * |
| 1679 | * Destroy a bridge instance. |
| 1680 | */ |
| 1681 | static int |
| 1682 | bridge_clone_destroy(struct ifnet *ifp) |
| 1683 | { |
| 1684 | struct bridge_softc *sc = ifp->if_softc; |
| 1685 | struct bridge_iflist *bif; |
| 1686 | errno_t error; |
| 1687 | |
| 1688 | BRIDGE_LOCK(sc); |
| 1689 | if ((sc->sc_flags & SCF_DETACHING)) { |
| 1690 | BRIDGE_UNLOCK(sc); |
| 1691 | return 0; |
| 1692 | } |
| 1693 | sc->sc_flags |= SCF_DETACHING; |
| 1694 | |
| 1695 | bridge_ifstop(ifp, 1); |
| 1696 | |
| 1697 | bridge_cancel_delayed_call(&sc->sc_resize_call); |
| 1698 | |
| 1699 | bridge_cleanup_delayed_call(&sc->sc_resize_call); |
| 1700 | bridge_cleanup_delayed_call(&sc->sc_aging_timer); |
| 1701 | |
| 1702 | error = ifnet_set_flags(interface: ifp, new_flags: 0, IFF_UP); |
| 1703 | if (error != 0) { |
| 1704 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_set_flags failed %d" , error); |
| 1705 | } |
| 1706 | |
| 1707 | while ((bif = TAILQ_FIRST(&sc->sc_iflist)) != NULL) { |
| 1708 | bridge_delete_member(sc, bif); |
| 1709 | } |
| 1710 | |
| 1711 | while ((bif = TAILQ_FIRST(&sc->sc_spanlist)) != NULL) { |
| 1712 | bridge_delete_span(sc, bif); |
| 1713 | } |
| 1714 | BRIDGE_UNLOCK(sc); |
| 1715 | |
| 1716 | error = ifnet_detach(interface: ifp); |
| 1717 | if (error != 0) { |
| 1718 | panic("%s (%d): ifnet_detach(%p) failed %d" , |
| 1719 | __func__, __LINE__, ifp, error); |
| 1720 | } |
| 1721 | return 0; |
| 1722 | } |
| 1723 | |
| 1724 | #define DRVSPEC do { \ |
| 1725 | if (ifd->ifd_cmd >= bridge_control_table_size) { \ |
| 1726 | error = EINVAL; \ |
| 1727 | break; \ |
| 1728 | } \ |
| 1729 | bc = &bridge_control_table[ifd->ifd_cmd]; \ |
| 1730 | \ |
| 1731 | if (cmd == SIOCGDRVSPEC && \ |
| 1732 | (bc->bc_flags & BC_F_COPYOUT) == 0) { \ |
| 1733 | error = EINVAL; \ |
| 1734 | break; \ |
| 1735 | } else if (cmd == SIOCSDRVSPEC && \ |
| 1736 | (bc->bc_flags & BC_F_COPYOUT) != 0) { \ |
| 1737 | error = EINVAL; \ |
| 1738 | break; \ |
| 1739 | } \ |
| 1740 | \ |
| 1741 | if (bc->bc_flags & BC_F_SUSER) { \ |
| 1742 | error = kauth_authorize_generic(kauth_cred_get(), \ |
| 1743 | KAUTH_GENERIC_ISSUSER); \ |
| 1744 | if (error) \ |
| 1745 | break; \ |
| 1746 | } \ |
| 1747 | \ |
| 1748 | if (ifd->ifd_len != bc->bc_argsize || \ |
| 1749 | ifd->ifd_len > sizeof (args)) { \ |
| 1750 | error = EINVAL; \ |
| 1751 | break; \ |
| 1752 | } \ |
| 1753 | \ |
| 1754 | bzero(&args, sizeof (args)); \ |
| 1755 | if (bc->bc_flags & BC_F_COPYIN) { \ |
| 1756 | error = copyin(ifd->ifd_data, &args, ifd->ifd_len); \ |
| 1757 | if (error) \ |
| 1758 | break; \ |
| 1759 | } \ |
| 1760 | \ |
| 1761 | BRIDGE_LOCK(sc); \ |
| 1762 | error = (*bc->bc_func)(sc, &args); \ |
| 1763 | BRIDGE_UNLOCK(sc); \ |
| 1764 | if (error) \ |
| 1765 | break; \ |
| 1766 | \ |
| 1767 | if (bc->bc_flags & BC_F_COPYOUT) \ |
| 1768 | error = copyout(&args, ifd->ifd_data, ifd->ifd_len); \ |
| 1769 | } while (0) |
| 1770 | |
| 1771 | static boolean_t |
| 1772 | interface_needs_input_broadcast(struct ifnet * ifp) |
| 1773 | { |
| 1774 | /* |
| 1775 | * Selectively enable input broadcast only when necessary. |
| 1776 | * The bridge interface itself attaches a fake protocol |
| 1777 | * so checking for at least two protocols means that the |
| 1778 | * interface is being used for something besides bridging |
| 1779 | * and needs to see broadcast packets from other members. |
| 1780 | */ |
| 1781 | return if_get_protolist(ifp, NULL, count: 0) >= 2; |
| 1782 | } |
| 1783 | |
| 1784 | static boolean_t |
| 1785 | bif_set_input_broadcast(struct bridge_iflist * bif, boolean_t input_broadcast) |
| 1786 | { |
| 1787 | boolean_t old_input_broadcast; |
| 1788 | |
| 1789 | old_input_broadcast = (bif->bif_flags & BIFF_INPUT_BROADCAST) != 0; |
| 1790 | if (input_broadcast) { |
| 1791 | bif->bif_flags |= BIFF_INPUT_BROADCAST; |
| 1792 | } else { |
| 1793 | bif->bif_flags &= ~BIFF_INPUT_BROADCAST; |
| 1794 | } |
| 1795 | return old_input_broadcast != input_broadcast; |
| 1796 | } |
| 1797 | |
| 1798 | /* |
| 1799 | * bridge_ioctl: |
| 1800 | * |
| 1801 | * Handle a control request from the operator. |
| 1802 | */ |
| 1803 | static errno_t |
| 1804 | bridge_ioctl(struct ifnet *ifp, u_long cmd, void *data) |
| 1805 | { |
| 1806 | struct bridge_softc *sc = ifp->if_softc; |
| 1807 | struct ifreq *ifr = (struct ifreq *)data; |
| 1808 | struct bridge_iflist *bif; |
| 1809 | int error = 0; |
| 1810 | |
| 1811 | BRIDGE_LOCK_ASSERT_NOTHELD(sc); |
| 1812 | |
| 1813 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_IOCTL, |
| 1814 | "ifp %s cmd 0x%08lx (%c%c [%lu] %c %lu)" , |
| 1815 | ifp->if_xname, cmd, (cmd & IOC_IN) ? 'I' : ' ', |
| 1816 | (cmd & IOC_OUT) ? 'O' : ' ', IOCPARM_LEN(cmd), |
| 1817 | (char)IOCGROUP(cmd), cmd & 0xff); |
| 1818 | |
| 1819 | switch (cmd) { |
| 1820 | case SIOCSIFADDR: |
| 1821 | case SIOCAIFADDR: |
| 1822 | ifnet_set_flags(interface: ifp, IFF_UP, IFF_UP); |
| 1823 | break; |
| 1824 | |
| 1825 | case SIOCGIFMEDIA32: |
| 1826 | case SIOCGIFMEDIA64: { |
| 1827 | struct ifmediareq *ifmr = (struct ifmediareq *)data; |
| 1828 | user_addr_t user_addr; |
| 1829 | |
| 1830 | user_addr = (cmd == SIOCGIFMEDIA64) ? |
| 1831 | ((struct ifmediareq64 *)ifmr)->ifmu_ulist : |
| 1832 | CAST_USER_ADDR_T(((struct ifmediareq32 *)ifmr)->ifmu_ulist); |
| 1833 | |
| 1834 | ifmr->ifm_status = IFM_AVALID; |
| 1835 | ifmr->ifm_mask = 0; |
| 1836 | ifmr->ifm_count = 1; |
| 1837 | |
| 1838 | BRIDGE_LOCK(sc); |
| 1839 | if (!(sc->sc_flags & SCF_DETACHING) && |
| 1840 | (sc->sc_flags & SCF_MEDIA_ACTIVE)) { |
| 1841 | ifmr->ifm_status |= IFM_ACTIVE; |
| 1842 | ifmr->ifm_active = ifmr->ifm_current = |
| 1843 | IFM_ETHER | IFM_AUTO; |
| 1844 | } else { |
| 1845 | ifmr->ifm_active = ifmr->ifm_current = IFM_NONE; |
| 1846 | } |
| 1847 | BRIDGE_UNLOCK(sc); |
| 1848 | |
| 1849 | if (user_addr != USER_ADDR_NULL) { |
| 1850 | error = copyout(&ifmr->ifm_current, user_addr, |
| 1851 | sizeof(int)); |
| 1852 | } |
| 1853 | break; |
| 1854 | } |
| 1855 | |
| 1856 | case SIOCADDMULTI: |
| 1857 | case SIOCDELMULTI: |
| 1858 | break; |
| 1859 | |
| 1860 | case SIOCSDRVSPEC32: |
| 1861 | case SIOCGDRVSPEC32: { |
| 1862 | union { |
| 1863 | struct ifbreq ifbreq; |
| 1864 | struct ifbifconf32 ifbifconf; |
| 1865 | struct ifbareq32 ifbareq; |
| 1866 | struct ifbaconf32 ifbaconf; |
| 1867 | struct ifbrparam ifbrparam; |
| 1868 | struct ifbropreq32 ifbropreq; |
| 1869 | } args; |
| 1870 | struct ifdrv32 *ifd = (struct ifdrv32 *)data; |
| 1871 | const struct bridge_control *bridge_control_table = |
| 1872 | bridge_control_table32, *bc; |
| 1873 | |
| 1874 | DRVSPEC; |
| 1875 | |
| 1876 | break; |
| 1877 | } |
| 1878 | case SIOCSDRVSPEC64: |
| 1879 | case SIOCGDRVSPEC64: { |
| 1880 | union { |
| 1881 | struct ifbreq ifbreq; |
| 1882 | struct ifbifconf64 ifbifconf; |
| 1883 | struct ifbareq64 ifbareq; |
| 1884 | struct ifbaconf64 ifbaconf; |
| 1885 | struct ifbrparam ifbrparam; |
| 1886 | struct ifbropreq64 ifbropreq; |
| 1887 | } args; |
| 1888 | struct ifdrv64 *ifd = (struct ifdrv64 *)data; |
| 1889 | const struct bridge_control *bridge_control_table = |
| 1890 | bridge_control_table64, *bc; |
| 1891 | |
| 1892 | DRVSPEC; |
| 1893 | |
| 1894 | break; |
| 1895 | } |
| 1896 | |
| 1897 | case SIOCSIFFLAGS: |
| 1898 | if (!(ifp->if_flags & IFF_UP) && |
| 1899 | (ifp->if_flags & IFF_RUNNING)) { |
| 1900 | /* |
| 1901 | * If interface is marked down and it is running, |
| 1902 | * then stop and disable it. |
| 1903 | */ |
| 1904 | BRIDGE_LOCK(sc); |
| 1905 | bridge_ifstop(ifp, 1); |
| 1906 | BRIDGE_UNLOCK(sc); |
| 1907 | } else if ((ifp->if_flags & IFF_UP) && |
| 1908 | !(ifp->if_flags & IFF_RUNNING)) { |
| 1909 | /* |
| 1910 | * If interface is marked up and it is stopped, then |
| 1911 | * start it. |
| 1912 | */ |
| 1913 | BRIDGE_LOCK(sc); |
| 1914 | error = bridge_init(ifp); |
| 1915 | BRIDGE_UNLOCK(sc); |
| 1916 | } |
| 1917 | break; |
| 1918 | |
| 1919 | case SIOCSIFLLADDR: |
| 1920 | error = ifnet_set_lladdr(interface: ifp, lladdr: ifr->ifr_addr.sa_data, |
| 1921 | lladdr_len: ifr->ifr_addr.sa_len); |
| 1922 | if (error != 0) { |
| 1923 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_IOCTL, |
| 1924 | "%s SIOCSIFLLADDR error %d" , ifp->if_xname, |
| 1925 | error); |
| 1926 | } |
| 1927 | break; |
| 1928 | |
| 1929 | case SIOCSIFMTU: |
| 1930 | if (ifr->ifr_mtu < 576) { |
| 1931 | error = EINVAL; |
| 1932 | break; |
| 1933 | } |
| 1934 | BRIDGE_LOCK(sc); |
| 1935 | if (TAILQ_EMPTY(&sc->sc_iflist)) { |
| 1936 | sc->sc_ifp->if_mtu = ifr->ifr_mtu; |
| 1937 | BRIDGE_UNLOCK(sc); |
| 1938 | break; |
| 1939 | } |
| 1940 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { |
| 1941 | if (bif->bif_ifp->if_mtu != (unsigned)ifr->ifr_mtu) { |
| 1942 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 1943 | "%s invalid MTU: %u(%s) != %d" , |
| 1944 | sc->sc_ifp->if_xname, |
| 1945 | bif->bif_ifp->if_mtu, |
| 1946 | bif->bif_ifp->if_xname, ifr->ifr_mtu); |
| 1947 | error = EINVAL; |
| 1948 | break; |
| 1949 | } |
| 1950 | } |
| 1951 | if (!error) { |
| 1952 | sc->sc_ifp->if_mtu = ifr->ifr_mtu; |
| 1953 | } |
| 1954 | BRIDGE_UNLOCK(sc); |
| 1955 | break; |
| 1956 | |
| 1957 | default: |
| 1958 | error = ether_ioctl(interface: ifp, command: cmd, data); |
| 1959 | if (error != 0 && error != EOPNOTSUPP) { |
| 1960 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_IOCTL, |
| 1961 | "ifp %s cmd 0x%08lx " |
| 1962 | "(%c%c [%lu] %c %lu) failed error: %d" , |
| 1963 | ifp->if_xname, cmd, |
| 1964 | (cmd & IOC_IN) ? 'I' : ' ', |
| 1965 | (cmd & IOC_OUT) ? 'O' : ' ', |
| 1966 | IOCPARM_LEN(cmd), (char)IOCGROUP(cmd), |
| 1967 | cmd & 0xff, error); |
| 1968 | } |
| 1969 | break; |
| 1970 | } |
| 1971 | BRIDGE_LOCK_ASSERT_NOTHELD(sc); |
| 1972 | |
| 1973 | return error; |
| 1974 | } |
| 1975 | |
| 1976 | #if HAS_IF_CAP |
| 1977 | /* |
| 1978 | * bridge_mutecaps: |
| 1979 | * |
| 1980 | * Clear or restore unwanted capabilities on the member interface |
| 1981 | */ |
| 1982 | static void |
| 1983 | bridge_mutecaps(struct bridge_softc *sc) |
| 1984 | { |
| 1985 | struct bridge_iflist *bif; |
| 1986 | int enabled, mask; |
| 1987 | |
| 1988 | /* Initial bitmask of capabilities to test */ |
| 1989 | mask = BRIDGE_IFCAPS_MASK; |
| 1990 | |
| 1991 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { |
| 1992 | /* Every member must support it or its disabled */ |
| 1993 | mask &= bif->bif_savedcaps; |
| 1994 | } |
| 1995 | |
| 1996 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { |
| 1997 | enabled = bif->bif_ifp->if_capenable; |
| 1998 | enabled &= ~BRIDGE_IFCAPS_STRIP; |
| 1999 | /* strip off mask bits and enable them again if allowed */ |
| 2000 | enabled &= ~BRIDGE_IFCAPS_MASK; |
| 2001 | enabled |= mask; |
| 2002 | |
| 2003 | bridge_set_ifcap(sc, bif, enabled); |
| 2004 | } |
| 2005 | } |
| 2006 | |
| 2007 | static void |
| 2008 | bridge_set_ifcap(struct bridge_softc *sc, struct bridge_iflist *bif, int set) |
| 2009 | { |
| 2010 | struct ifnet *ifp = bif->bif_ifp; |
| 2011 | struct ifreq ifr; |
| 2012 | int error; |
| 2013 | |
| 2014 | bzero(&ifr, sizeof(ifr)); |
| 2015 | ifr.ifr_reqcap = set; |
| 2016 | |
| 2017 | if (ifp->if_capenable != set) { |
| 2018 | IFF_LOCKGIANT(ifp); |
| 2019 | error = (*ifp->if_ioctl)(ifp, SIOCSIFCAP, (caddr_t)&ifr); |
| 2020 | IFF_UNLOCKGIANT(ifp); |
| 2021 | if (error) { |
| 2022 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2023 | "%s error setting interface capabilities on %s" , |
| 2024 | sc->sc_ifp->if_xname, ifp->if_xname); |
| 2025 | } |
| 2026 | } |
| 2027 | } |
| 2028 | #endif /* HAS_IF_CAP */ |
| 2029 | |
| 2030 | static errno_t |
| 2031 | siocsifcap(struct ifnet * ifp, uint32_t cap_enable) |
| 2032 | { |
| 2033 | struct ifreq ifr; |
| 2034 | |
| 2035 | bzero(s: &ifr, n: sizeof(ifr)); |
| 2036 | ifr.ifr_reqcap = cap_enable; |
| 2037 | return ifnet_ioctl(interface: ifp, protocol: 0, SIOCSIFCAP, ioctl_arg: &ifr); |
| 2038 | } |
| 2039 | |
| 2040 | static const char * |
| 2041 | enable_disable_str(boolean_t enable) |
| 2042 | { |
| 2043 | return enable ? "enable" : "disable" ; |
| 2044 | } |
| 2045 | |
| 2046 | static boolean_t |
| 2047 | bridge_set_lro(struct ifnet * ifp, boolean_t enable) |
| 2048 | { |
| 2049 | uint32_t cap_enable; |
| 2050 | uint32_t cap_supported; |
| 2051 | boolean_t changed = FALSE; |
| 2052 | boolean_t lro_enabled; |
| 2053 | |
| 2054 | cap_supported = ifnet_capabilities_supported(interface: ifp); |
| 2055 | if ((cap_supported & IFCAP_LRO) == 0) { |
| 2056 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_LIFECYCLE, |
| 2057 | "%s doesn't support LRO" , |
| 2058 | ifp->if_xname); |
| 2059 | goto done; |
| 2060 | } |
| 2061 | cap_enable = ifnet_capabilities_enabled(interface: ifp); |
| 2062 | lro_enabled = (cap_enable & IFCAP_LRO) != 0; |
| 2063 | if (lro_enabled != enable) { |
| 2064 | errno_t error; |
| 2065 | |
| 2066 | if (enable) { |
| 2067 | cap_enable |= IFCAP_LRO; |
| 2068 | } else { |
| 2069 | cap_enable &= ~IFCAP_LRO; |
| 2070 | } |
| 2071 | error = siocsifcap(ifp, cap_enable); |
| 2072 | if (error != 0) { |
| 2073 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2074 | "%s %s failed (cap 0x%x) %d" , |
| 2075 | ifp->if_xname, |
| 2076 | enable_disable_str(enable), |
| 2077 | cap_enable, |
| 2078 | error); |
| 2079 | } else { |
| 2080 | changed = TRUE; |
| 2081 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_LIFECYCLE, |
| 2082 | "%s %s success (cap 0x%x)" , |
| 2083 | ifp->if_xname, |
| 2084 | enable_disable_str(enable), |
| 2085 | cap_enable); |
| 2086 | } |
| 2087 | } |
| 2088 | done: |
| 2089 | return changed; |
| 2090 | } |
| 2091 | |
| 2092 | static errno_t |
| 2093 | bridge_set_tso(struct bridge_softc *sc) |
| 2094 | { |
| 2095 | struct bridge_iflist *bif; |
| 2096 | u_int32_t tso_v4_mtu; |
| 2097 | u_int32_t tso_v6_mtu; |
| 2098 | ifnet_offload_t offload; |
| 2099 | errno_t error = 0; |
| 2100 | |
| 2101 | /* By default, support TSO */ |
| 2102 | offload = sc->sc_ifp->if_hwassist | IFNET_TSO_IPV4 | IFNET_TSO_IPV6; |
| 2103 | tso_v4_mtu = IP_MAXPACKET; |
| 2104 | tso_v6_mtu = IP_MAXPACKET; |
| 2105 | |
| 2106 | /* Use the lowest common denominator of the members */ |
| 2107 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { |
| 2108 | ifnet_t ifp = bif->bif_ifp; |
| 2109 | |
| 2110 | if (ifp == NULL) { |
| 2111 | continue; |
| 2112 | } |
| 2113 | |
| 2114 | if (offload & IFNET_TSO_IPV4) { |
| 2115 | if (ifp->if_hwassist & IFNET_TSO_IPV4) { |
| 2116 | if (tso_v4_mtu > ifp->if_tso_v4_mtu) { |
| 2117 | tso_v4_mtu = ifp->if_tso_v4_mtu; |
| 2118 | } |
| 2119 | } else { |
| 2120 | offload &= ~IFNET_TSO_IPV4; |
| 2121 | tso_v4_mtu = 0; |
| 2122 | } |
| 2123 | } |
| 2124 | if (offload & IFNET_TSO_IPV6) { |
| 2125 | if (ifp->if_hwassist & IFNET_TSO_IPV6) { |
| 2126 | if (tso_v6_mtu > ifp->if_tso_v6_mtu) { |
| 2127 | tso_v6_mtu = ifp->if_tso_v6_mtu; |
| 2128 | } |
| 2129 | } else { |
| 2130 | offload &= ~IFNET_TSO_IPV6; |
| 2131 | tso_v6_mtu = 0; |
| 2132 | } |
| 2133 | } |
| 2134 | } |
| 2135 | |
| 2136 | if (offload != sc->sc_ifp->if_hwassist) { |
| 2137 | error = ifnet_set_offload(interface: sc->sc_ifp, offload); |
| 2138 | if (error != 0) { |
| 2139 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_LIFECYCLE, |
| 2140 | "ifnet_set_offload(%s, 0x%x) failed %d" , |
| 2141 | sc->sc_ifp->if_xname, offload, error); |
| 2142 | goto done; |
| 2143 | } |
| 2144 | /* |
| 2145 | * For ifnet_set_tso_mtu() sake, the TSO MTU must be at least |
| 2146 | * as large as the interface MTU |
| 2147 | */ |
| 2148 | if (sc->sc_ifp->if_hwassist & IFNET_TSO_IPV4) { |
| 2149 | if (tso_v4_mtu < sc->sc_ifp->if_mtu) { |
| 2150 | tso_v4_mtu = sc->sc_ifp->if_mtu; |
| 2151 | } |
| 2152 | error = ifnet_set_tso_mtu(interface: sc->sc_ifp, AF_INET, |
| 2153 | mtuLen: tso_v4_mtu); |
| 2154 | if (error != 0) { |
| 2155 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_LIFECYCLE, |
| 2156 | "ifnet_set_tso_mtu(%s, " |
| 2157 | "AF_INET, %u) failed %d" , |
| 2158 | sc->sc_ifp->if_xname, |
| 2159 | tso_v4_mtu, error); |
| 2160 | goto done; |
| 2161 | } |
| 2162 | } |
| 2163 | if (sc->sc_ifp->if_hwassist & IFNET_TSO_IPV6) { |
| 2164 | if (tso_v6_mtu < sc->sc_ifp->if_mtu) { |
| 2165 | tso_v6_mtu = sc->sc_ifp->if_mtu; |
| 2166 | } |
| 2167 | error = ifnet_set_tso_mtu(interface: sc->sc_ifp, AF_INET6, |
| 2168 | mtuLen: tso_v6_mtu); |
| 2169 | if (error != 0) { |
| 2170 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_LIFECYCLE, |
| 2171 | "ifnet_set_tso_mtu(%s, " |
| 2172 | "AF_INET6, %u) failed %d" , |
| 2173 | sc->sc_ifp->if_xname, |
| 2174 | tso_v6_mtu, error); |
| 2175 | goto done; |
| 2176 | } |
| 2177 | } |
| 2178 | } |
| 2179 | done: |
| 2180 | return error; |
| 2181 | } |
| 2182 | |
| 2183 | /* |
| 2184 | * bridge_lookup_member: |
| 2185 | * |
| 2186 | * Lookup a bridge member interface. |
| 2187 | */ |
| 2188 | static struct bridge_iflist * |
| 2189 | bridge_lookup_member(struct bridge_softc *sc, const char *name) |
| 2190 | { |
| 2191 | struct bridge_iflist *bif; |
| 2192 | struct ifnet *ifp; |
| 2193 | |
| 2194 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 2195 | |
| 2196 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { |
| 2197 | ifp = bif->bif_ifp; |
| 2198 | if (strcmp(s1: ifp->if_xname, s2: name) == 0) { |
| 2199 | return bif; |
| 2200 | } |
| 2201 | } |
| 2202 | |
| 2203 | return NULL; |
| 2204 | } |
| 2205 | |
| 2206 | /* |
| 2207 | * bridge_lookup_member_if: |
| 2208 | * |
| 2209 | * Lookup a bridge member interface by ifnet*. |
| 2210 | */ |
| 2211 | static struct bridge_iflist * |
| 2212 | bridge_lookup_member_if(struct bridge_softc *sc, struct ifnet *member_ifp) |
| 2213 | { |
| 2214 | struct bridge_iflist *bif; |
| 2215 | |
| 2216 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 2217 | |
| 2218 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { |
| 2219 | if (bif->bif_ifp == member_ifp) { |
| 2220 | return bif; |
| 2221 | } |
| 2222 | } |
| 2223 | |
| 2224 | return NULL; |
| 2225 | } |
| 2226 | |
| 2227 | static errno_t |
| 2228 | bridge_iff_input(void *cookie, ifnet_t ifp, protocol_family_t protocol, |
| 2229 | mbuf_t *data, char **frame_ptr) |
| 2230 | { |
| 2231 | #pragma unused(protocol) |
| 2232 | errno_t error = 0; |
| 2233 | struct bridge_iflist *bif = (struct bridge_iflist *)cookie; |
| 2234 | struct bridge_softc *sc = bif->bif_sc; |
| 2235 | int included = 0; |
| 2236 | size_t frmlen = 0; |
| 2237 | mbuf_t m = *data; |
| 2238 | |
| 2239 | if ((m->m_flags & M_PROTO1)) { |
| 2240 | goto out; |
| 2241 | } |
| 2242 | |
| 2243 | if (*frame_ptr >= (char *)mbuf_datastart(mbuf: m) && |
| 2244 | *frame_ptr <= (char *)mbuf_data(mbuf: m)) { |
| 2245 | included = 1; |
| 2246 | frmlen = (char *)mbuf_data(mbuf: m) - *frame_ptr; |
| 2247 | } |
| 2248 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, |
| 2249 | "%s from %s m 0x%llx data 0x%llx frame 0x%llx %s " |
| 2250 | "frmlen %lu" , sc->sc_ifp->if_xname, |
| 2251 | ifp->if_xname, (uint64_t)VM_KERNEL_ADDRPERM(m), |
| 2252 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_data(m)), |
| 2253 | (uint64_t)VM_KERNEL_ADDRPERM(*frame_ptr), |
| 2254 | included ? "inside" : "outside" , frmlen); |
| 2255 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MBUF)) { |
| 2256 | brlog_mbuf(m, prefix: "bridge_iff_input[" , suffix: "" ); |
| 2257 | brlog_ether_header(eh: (struct ether_header *) |
| 2258 | (void *)*frame_ptr); |
| 2259 | brlog_mbuf_data(m, offset: 0, len: 20); |
| 2260 | } |
| 2261 | if (included == 0) { |
| 2262 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, "frame_ptr outside mbuf" ); |
| 2263 | goto out; |
| 2264 | } |
| 2265 | |
| 2266 | /* Move data pointer to start of frame to the link layer header */ |
| 2267 | (void) mbuf_setdata(mbuf: m, data: (char *)mbuf_data(mbuf: m) - frmlen, |
| 2268 | len: mbuf_len(mbuf: m) + frmlen); |
| 2269 | (void) mbuf_pkthdr_adjustlen(mbuf: m, amount: frmlen); |
| 2270 | |
| 2271 | /* make sure we can access the ethernet header */ |
| 2272 | if (mbuf_pkthdr_len(mbuf: m) < sizeof(struct ether_header)) { |
| 2273 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, |
| 2274 | "short frame %lu < %lu" , |
| 2275 | mbuf_pkthdr_len(m), sizeof(struct ether_header)); |
| 2276 | goto out; |
| 2277 | } |
| 2278 | if (mbuf_len(mbuf: m) < sizeof(struct ether_header)) { |
| 2279 | error = mbuf_pullup(mbuf: data, len: sizeof(struct ether_header)); |
| 2280 | if (error != 0) { |
| 2281 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, |
| 2282 | "mbuf_pullup(%lu) failed %d" , |
| 2283 | sizeof(struct ether_header), |
| 2284 | error); |
| 2285 | error = EJUSTRETURN; |
| 2286 | goto out; |
| 2287 | } |
| 2288 | if (m != *data) { |
| 2289 | m = *data; |
| 2290 | *frame_ptr = mbuf_data(mbuf: m); |
| 2291 | } |
| 2292 | } |
| 2293 | |
| 2294 | error = bridge_input(ifp, data); |
| 2295 | |
| 2296 | /* Adjust packet back to original */ |
| 2297 | if (error == 0) { |
| 2298 | /* bridge_input might have modified *data */ |
| 2299 | if (*data != m) { |
| 2300 | m = *data; |
| 2301 | *frame_ptr = mbuf_data(mbuf: m); |
| 2302 | } |
| 2303 | (void) mbuf_setdata(mbuf: m, data: (char *)mbuf_data(mbuf: m) + frmlen, |
| 2304 | len: mbuf_len(mbuf: m) - frmlen); |
| 2305 | (void) mbuf_pkthdr_adjustlen(mbuf: m, amount: -frmlen); |
| 2306 | } |
| 2307 | |
| 2308 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MBUF) && |
| 2309 | BRIDGE_DBGF_ENABLED(BR_DBGF_INPUT)) { |
| 2310 | brlog_mbuf(m, prefix: "bridge_iff_input]" , suffix: "" ); |
| 2311 | } |
| 2312 | |
| 2313 | out: |
| 2314 | BRIDGE_LOCK_ASSERT_NOTHELD(sc); |
| 2315 | |
| 2316 | return error; |
| 2317 | } |
| 2318 | |
| 2319 | static errno_t |
| 2320 | bridge_iff_output(void *cookie, ifnet_t ifp, protocol_family_t protocol, |
| 2321 | mbuf_t *data) |
| 2322 | { |
| 2323 | #pragma unused(protocol) |
| 2324 | errno_t error = 0; |
| 2325 | struct bridge_iflist *bif = (struct bridge_iflist *)cookie; |
| 2326 | struct bridge_softc *sc = bif->bif_sc; |
| 2327 | mbuf_t m = *data; |
| 2328 | |
| 2329 | if ((m->m_flags & M_PROTO1)) { |
| 2330 | goto out; |
| 2331 | } |
| 2332 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_OUTPUT, |
| 2333 | "%s from %s m 0x%llx data 0x%llx" , |
| 2334 | sc->sc_ifp->if_xname, ifp->if_xname, |
| 2335 | (uint64_t)VM_KERNEL_ADDRPERM(m), |
| 2336 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_data(m))); |
| 2337 | |
| 2338 | error = bridge_member_output(sc, ifp, m: data); |
| 2339 | if (error != 0 && error != EJUSTRETURN) { |
| 2340 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_OUTPUT, |
| 2341 | "bridge_member_output failed error %d" , |
| 2342 | error); |
| 2343 | } |
| 2344 | out: |
| 2345 | BRIDGE_LOCK_ASSERT_NOTHELD(sc); |
| 2346 | |
| 2347 | return error; |
| 2348 | } |
| 2349 | |
| 2350 | static void |
| 2351 | bridge_iff_event(void *cookie, ifnet_t ifp, protocol_family_t protocol, |
| 2352 | const struct kev_msg *event_msg) |
| 2353 | { |
| 2354 | #pragma unused(protocol) |
| 2355 | struct bridge_iflist *bif = (struct bridge_iflist *)cookie; |
| 2356 | struct bridge_softc *sc = bif->bif_sc; |
| 2357 | |
| 2358 | if (event_msg->vendor_code == KEV_VENDOR_APPLE && |
| 2359 | event_msg->kev_class == KEV_NETWORK_CLASS && |
| 2360 | event_msg->kev_subclass == KEV_DL_SUBCLASS) { |
| 2361 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, |
| 2362 | "%s event_code %u - %s" , |
| 2363 | ifp->if_xname, event_msg->event_code, |
| 2364 | dlil_kev_dl_code_str(event_msg->event_code)); |
| 2365 | |
| 2366 | switch (event_msg->event_code) { |
| 2367 | case KEV_DL_LINK_OFF: |
| 2368 | case KEV_DL_LINK_ON: { |
| 2369 | bridge_iflinkevent(ifp); |
| 2370 | #if BRIDGESTP |
| 2371 | bstp_linkstate(ifp, event_msg->event_code); |
| 2372 | #endif /* BRIDGESTP */ |
| 2373 | break; |
| 2374 | } |
| 2375 | case KEV_DL_SIFFLAGS: { |
| 2376 | if ((ifp->if_flags & IFF_UP) == 0) { |
| 2377 | break; |
| 2378 | } |
| 2379 | if ((bif->bif_flags & BIFF_PROMISC) == 0) { |
| 2380 | errno_t error; |
| 2381 | |
| 2382 | error = ifnet_set_promiscuous(interface: ifp, on: 1); |
| 2383 | if (error != 0) { |
| 2384 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2385 | "ifnet_set_promiscuous (%s)" |
| 2386 | " failed %d" , ifp->if_xname, |
| 2387 | error); |
| 2388 | } else { |
| 2389 | bif->bif_flags |= BIFF_PROMISC; |
| 2390 | } |
| 2391 | } |
| 2392 | if ((bif->bif_flags & BIFF_WIFI_INFRA) != 0 && |
| 2393 | (bif->bif_flags & BIFF_ALL_MULTI) == 0) { |
| 2394 | errno_t error; |
| 2395 | |
| 2396 | error = if_allmulti(ifp, 1); |
| 2397 | if (error != 0) { |
| 2398 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2399 | "if_allmulti (%s)" |
| 2400 | " failed %d" , ifp->if_xname, |
| 2401 | error); |
| 2402 | } else { |
| 2403 | bif->bif_flags |= BIFF_ALL_MULTI; |
| 2404 | #ifdef XNU_PLATFORM_AppleTVOS |
| 2405 | ip6_forwarding = 1; |
| 2406 | #endif /* XNU_PLATFORM_AppleTVOS */ |
| 2407 | } |
| 2408 | } |
| 2409 | break; |
| 2410 | } |
| 2411 | case KEV_DL_IFCAP_CHANGED: { |
| 2412 | BRIDGE_LOCK(sc); |
| 2413 | bridge_set_tso(sc); |
| 2414 | BRIDGE_UNLOCK(sc); |
| 2415 | break; |
| 2416 | } |
| 2417 | case KEV_DL_PROTO_DETACHED: |
| 2418 | case KEV_DL_PROTO_ATTACHED: { |
| 2419 | bridge_proto_attach_changed(ifp); |
| 2420 | break; |
| 2421 | } |
| 2422 | default: |
| 2423 | break; |
| 2424 | } |
| 2425 | } |
| 2426 | } |
| 2427 | |
| 2428 | /* |
| 2429 | * bridge_iff_detached: |
| 2430 | * |
| 2431 | * Called when our interface filter has been detached from a |
| 2432 | * member interface. |
| 2433 | */ |
| 2434 | static void |
| 2435 | bridge_iff_detached(void *cookie, ifnet_t ifp) |
| 2436 | { |
| 2437 | #pragma unused(cookie) |
| 2438 | struct bridge_iflist *bif; |
| 2439 | struct bridge_softc *sc = ifp->if_bridge; |
| 2440 | |
| 2441 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, "%s" , ifp->if_xname); |
| 2442 | |
| 2443 | /* Check if the interface is a bridge member */ |
| 2444 | if (sc != NULL) { |
| 2445 | BRIDGE_LOCK(sc); |
| 2446 | bif = bridge_lookup_member_if(sc, member_ifp: ifp); |
| 2447 | if (bif != NULL) { |
| 2448 | bridge_delete_member(sc, bif); |
| 2449 | } |
| 2450 | BRIDGE_UNLOCK(sc); |
| 2451 | return; |
| 2452 | } |
| 2453 | /* Check if the interface is a span port */ |
| 2454 | lck_mtx_lock(lck: &bridge_list_mtx); |
| 2455 | LIST_FOREACH(sc, &bridge_list, sc_list) { |
| 2456 | BRIDGE_LOCK(sc); |
| 2457 | TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) |
| 2458 | if (ifp == bif->bif_ifp) { |
| 2459 | bridge_delete_span(sc, bif); |
| 2460 | break; |
| 2461 | } |
| 2462 | BRIDGE_UNLOCK(sc); |
| 2463 | } |
| 2464 | lck_mtx_unlock(lck: &bridge_list_mtx); |
| 2465 | } |
| 2466 | |
| 2467 | static errno_t |
| 2468 | bridge_proto_input(ifnet_t ifp, protocol_family_t protocol, mbuf_t packet, |
| 2469 | char *) |
| 2470 | { |
| 2471 | #pragma unused(protocol, packet, header) |
| 2472 | BRIDGE_LOG(LOG_NOTICE, 0, "%s unexpected packet" , |
| 2473 | ifp->if_xname); |
| 2474 | return 0; |
| 2475 | } |
| 2476 | |
| 2477 | static int |
| 2478 | bridge_attach_protocol(struct ifnet *ifp) |
| 2479 | { |
| 2480 | int error; |
| 2481 | struct ifnet_attach_proto_param reg; |
| 2482 | |
| 2483 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, "%s" , ifp->if_xname); |
| 2484 | bzero(s: ®, n: sizeof(reg)); |
| 2485 | reg.input = bridge_proto_input; |
| 2486 | |
| 2487 | error = ifnet_attach_protocol(interface: ifp, PF_BRIDGE, proto_details: ®); |
| 2488 | if (error) { |
| 2489 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2490 | "ifnet_attach_protocol(%s) failed, %d" , |
| 2491 | ifp->if_xname, error); |
| 2492 | } |
| 2493 | |
| 2494 | return error; |
| 2495 | } |
| 2496 | |
| 2497 | static int |
| 2498 | bridge_detach_protocol(struct ifnet *ifp) |
| 2499 | { |
| 2500 | int error; |
| 2501 | |
| 2502 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, "%s" , ifp->if_xname); |
| 2503 | error = ifnet_detach_protocol(interface: ifp, PF_BRIDGE); |
| 2504 | if (error) { |
| 2505 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2506 | "ifnet_detach_protocol(%s) failed, %d" , |
| 2507 | ifp->if_xname, error); |
| 2508 | } |
| 2509 | |
| 2510 | return error; |
| 2511 | } |
| 2512 | |
| 2513 | /* |
| 2514 | * bridge_delete_member: |
| 2515 | * |
| 2516 | * Delete the specified member interface. |
| 2517 | */ |
| 2518 | static void |
| 2519 | bridge_delete_member(struct bridge_softc *sc, struct bridge_iflist *bif) |
| 2520 | { |
| 2521 | #if SKYWALK |
| 2522 | boolean_t add_netagent = FALSE; |
| 2523 | #endif /* SKYWALK */ |
| 2524 | uint32_t bif_flags; |
| 2525 | struct ifnet *ifs = bif->bif_ifp, *bifp = sc->sc_ifp; |
| 2526 | int lladdr_changed = 0, error; |
| 2527 | uint8_t eaddr[ETHER_ADDR_LEN]; |
| 2528 | u_int32_t event_code = 0; |
| 2529 | |
| 2530 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 2531 | VERIFY(ifs != NULL); |
| 2532 | |
| 2533 | /* |
| 2534 | * Remove the member from the list first so it cannot be found anymore |
| 2535 | * when we release the bridge lock below |
| 2536 | */ |
| 2537 | if ((bif->bif_flags & BIFF_IN_MEMBER_LIST) != 0) { |
| 2538 | BRIDGE_XLOCK(sc); |
| 2539 | TAILQ_REMOVE(&sc->sc_iflist, bif, bif_next); |
| 2540 | BRIDGE_XDROP(sc); |
| 2541 | } |
| 2542 | if (sc->sc_mac_nat_bif != NULL) { |
| 2543 | if (bif == sc->sc_mac_nat_bif) { |
| 2544 | bridge_mac_nat_disable(sc); |
| 2545 | } else { |
| 2546 | bridge_mac_nat_flush_entries(sc, bif); |
| 2547 | } |
| 2548 | } |
| 2549 | #if BRIDGESTP |
| 2550 | if ((bif->bif_ifflags & IFBIF_STP) != 0) { |
| 2551 | bstp_disable(&bif->bif_stp); |
| 2552 | } |
| 2553 | #endif /* BRIDGESTP */ |
| 2554 | |
| 2555 | /* |
| 2556 | * If removing the interface that gave the bridge its mac address, set |
| 2557 | * the mac address of the bridge to the address of the next member, or |
| 2558 | * to its default address if no members are left. |
| 2559 | */ |
| 2560 | if (bridge_inherit_mac && sc->sc_ifaddr == ifs) { |
| 2561 | ifnet_release(interface: sc->sc_ifaddr); |
| 2562 | if (TAILQ_EMPTY(&sc->sc_iflist)) { |
| 2563 | bcopy(src: sc->sc_defaddr, dst: eaddr, ETHER_ADDR_LEN); |
| 2564 | sc->sc_ifaddr = NULL; |
| 2565 | } else { |
| 2566 | struct ifnet *fif = |
| 2567 | TAILQ_FIRST(&sc->sc_iflist)->bif_ifp; |
| 2568 | bcopy(IF_LLADDR(fif), dst: eaddr, ETHER_ADDR_LEN); |
| 2569 | sc->sc_ifaddr = fif; |
| 2570 | ifnet_reference(interface: fif); /* for sc_ifaddr */ |
| 2571 | } |
| 2572 | lladdr_changed = 1; |
| 2573 | } |
| 2574 | |
| 2575 | #if HAS_IF_CAP |
| 2576 | bridge_mutecaps(sc); /* recalculate now this interface is removed */ |
| 2577 | #endif /* HAS_IF_CAP */ |
| 2578 | |
| 2579 | error = bridge_set_tso(sc); |
| 2580 | if (error != 0) { |
| 2581 | BRIDGE_LOG(LOG_NOTICE, 0, "bridge_set_tso failed %d" , error); |
| 2582 | } |
| 2583 | |
| 2584 | bridge_rtdelete(sc, ifp: ifs, IFBF_FLUSHALL); |
| 2585 | |
| 2586 | KASSERT(bif->bif_addrcnt == 0, |
| 2587 | ("%s: %d bridge routes referenced" , __func__, bif->bif_addrcnt)); |
| 2588 | |
| 2589 | /* |
| 2590 | * Update link status of the bridge based on its remaining members |
| 2591 | */ |
| 2592 | event_code = bridge_updatelinkstatus(sc); |
| 2593 | bif_flags = bif->bif_flags; |
| 2594 | BRIDGE_UNLOCK(sc); |
| 2595 | |
| 2596 | /* only perform these steps if the interface is still attached */ |
| 2597 | if (ifnet_is_attached(ifs, refio: 1)) { |
| 2598 | #if SKYWALK |
| 2599 | add_netagent = (bif_flags & BIFF_NETAGENT_REMOVED) != 0; |
| 2600 | |
| 2601 | if ((bif_flags & BIFF_FLOWSWITCH_ATTACHED) != 0) { |
| 2602 | ifnet_detach_flowswitch_nexus(ifp: ifs); |
| 2603 | } |
| 2604 | #endif /* SKYWALK */ |
| 2605 | /* disable promiscuous mode */ |
| 2606 | if ((bif_flags & BIFF_PROMISC) != 0) { |
| 2607 | (void) ifnet_set_promiscuous(interface: ifs, on: 0); |
| 2608 | } |
| 2609 | /* disable all multi */ |
| 2610 | if ((bif_flags & BIFF_ALL_MULTI) != 0) { |
| 2611 | (void)if_allmulti(ifs, 0); |
| 2612 | } |
| 2613 | #if HAS_IF_CAP |
| 2614 | /* re-enable any interface capabilities */ |
| 2615 | bridge_set_ifcap(sc, bif, bif->bif_savedcaps); |
| 2616 | #endif |
| 2617 | /* detach bridge "protocol" */ |
| 2618 | if ((bif_flags & BIFF_PROTO_ATTACHED) != 0) { |
| 2619 | (void)bridge_detach_protocol(ifp: ifs); |
| 2620 | } |
| 2621 | /* detach interface filter */ |
| 2622 | if ((bif_flags & BIFF_FILTER_ATTACHED) != 0) { |
| 2623 | iflt_detach(filter_ref: bif->bif_iff_ref); |
| 2624 | } |
| 2625 | /* re-enable LRO */ |
| 2626 | if ((bif_flags & BIFF_LRO_DISABLED) != 0) { |
| 2627 | (void)bridge_set_lro(ifp: ifs, TRUE); |
| 2628 | } |
| 2629 | ifnet_decr_iorefcnt(ifs); |
| 2630 | } |
| 2631 | |
| 2632 | if (lladdr_changed && |
| 2633 | (error = ifnet_set_lladdr(interface: bifp, lladdr: eaddr, ETHER_ADDR_LEN)) != 0) { |
| 2634 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_set_lladdr failed %d" , error); |
| 2635 | } |
| 2636 | |
| 2637 | if (event_code != 0) { |
| 2638 | bridge_link_event(bifp, event_code); |
| 2639 | } |
| 2640 | |
| 2641 | #if BRIDGESTP |
| 2642 | bstp_destroy(&bif->bif_stp); /* prepare to free */ |
| 2643 | #endif /* BRIDGESTP */ |
| 2644 | |
| 2645 | kfree_type(struct bridge_iflist, bif); |
| 2646 | ifs->if_bridge = NULL; |
| 2647 | #if SKYWALK |
| 2648 | if (add_netagent && ifnet_is_attached(ifs, refio: 1)) { |
| 2649 | (void)ifnet_add_netagent(ifp: ifs); |
| 2650 | ifnet_decr_iorefcnt(ifs); |
| 2651 | } |
| 2652 | #endif /* SKYWALK */ |
| 2653 | |
| 2654 | ifnet_release(interface: ifs); |
| 2655 | |
| 2656 | BRIDGE_LOCK(sc); |
| 2657 | } |
| 2658 | |
| 2659 | /* |
| 2660 | * bridge_delete_span: |
| 2661 | * |
| 2662 | * Delete the specified span interface. |
| 2663 | */ |
| 2664 | static void |
| 2665 | bridge_delete_span(struct bridge_softc *sc, struct bridge_iflist *bif) |
| 2666 | { |
| 2667 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 2668 | |
| 2669 | KASSERT(bif->bif_ifp->if_bridge == NULL, |
| 2670 | ("%s: not a span interface" , __func__)); |
| 2671 | |
| 2672 | ifnet_release(interface: bif->bif_ifp); |
| 2673 | |
| 2674 | TAILQ_REMOVE(&sc->sc_spanlist, bif, bif_next); |
| 2675 | kfree_type(struct bridge_iflist, bif); |
| 2676 | } |
| 2677 | |
| 2678 | static int |
| 2679 | bridge_ioctl_add(struct bridge_softc *sc, void *arg) |
| 2680 | { |
| 2681 | struct ifbreq *req = arg; |
| 2682 | struct bridge_iflist *bif = NULL; |
| 2683 | struct ifnet *ifs, *bifp = sc->sc_ifp; |
| 2684 | int error = 0, lladdr_changed = 0; |
| 2685 | uint8_t eaddr[ETHER_ADDR_LEN]; |
| 2686 | struct iff_filter iff; |
| 2687 | u_int32_t event_code = 0; |
| 2688 | boolean_t input_broadcast; |
| 2689 | int media_active; |
| 2690 | boolean_t wifi_infra = FALSE; |
| 2691 | |
| 2692 | ifs = ifunit(req->ifbr_ifsname); |
| 2693 | if (ifs == NULL) { |
| 2694 | return ENOENT; |
| 2695 | } |
| 2696 | if (ifs->if_ioctl == NULL) { /* must be supported */ |
| 2697 | return EINVAL; |
| 2698 | } |
| 2699 | |
| 2700 | if (IFNET_IS_INTCOPROC(ifs) || IFNET_IS_MANAGEMENT(ifs)) { |
| 2701 | return EINVAL; |
| 2702 | } |
| 2703 | |
| 2704 | /* If it's in the span list, it can't be a member. */ |
| 2705 | TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) { |
| 2706 | if (ifs == bif->bif_ifp) { |
| 2707 | return EBUSY; |
| 2708 | } |
| 2709 | } |
| 2710 | |
| 2711 | if (ifs->if_bridge == sc) { |
| 2712 | return EEXIST; |
| 2713 | } |
| 2714 | |
| 2715 | if (ifs->if_bridge != NULL) { |
| 2716 | return EBUSY; |
| 2717 | } |
| 2718 | |
| 2719 | switch (ifs->if_type) { |
| 2720 | case IFT_ETHER: |
| 2721 | if (strcmp(s1: ifs->if_name, s2: "en" ) == 0 && |
| 2722 | ifs->if_subfamily == IFNET_SUBFAMILY_WIFI && |
| 2723 | (ifs->if_eflags & IFEF_IPV4_ROUTER) == 0) { |
| 2724 | /* XXX is there a better way to identify Wi-Fi STA? */ |
| 2725 | wifi_infra = TRUE; |
| 2726 | } |
| 2727 | break; |
| 2728 | case IFT_L2VLAN: |
| 2729 | case IFT_IEEE8023ADLAG: |
| 2730 | break; |
| 2731 | case IFT_GIF: |
| 2732 | /* currently not supported */ |
| 2733 | /* FALLTHRU */ |
| 2734 | default: |
| 2735 | return EINVAL; |
| 2736 | } |
| 2737 | |
| 2738 | /* fail to add the interface if the MTU doesn't match */ |
| 2739 | if (!TAILQ_EMPTY(&sc->sc_iflist) && sc->sc_ifp->if_mtu != ifs->if_mtu) { |
| 2740 | BRIDGE_LOG(LOG_NOTICE, 0, "%s invalid MTU for %s" , |
| 2741 | sc->sc_ifp->if_xname, |
| 2742 | ifs->if_xname); |
| 2743 | return EINVAL; |
| 2744 | } |
| 2745 | |
| 2746 | /* there's already an interface that's doing MAC NAT */ |
| 2747 | if (wifi_infra && sc->sc_mac_nat_bif != NULL) { |
| 2748 | return EBUSY; |
| 2749 | } |
| 2750 | |
| 2751 | /* prevent the interface from detaching while we add the member */ |
| 2752 | if (!ifnet_is_attached(ifs, refio: 1)) { |
| 2753 | return ENXIO; |
| 2754 | } |
| 2755 | |
| 2756 | /* allocate a new member */ |
| 2757 | bif = kalloc_type(struct bridge_iflist, Z_WAITOK | Z_ZERO | Z_NOFAIL); |
| 2758 | bif->bif_ifp = ifs; |
| 2759 | ifnet_reference(interface: ifs); |
| 2760 | bif->bif_ifflags |= IFBIF_LEARNING | IFBIF_DISCOVER; |
| 2761 | #if HAS_IF_CAP |
| 2762 | bif->bif_savedcaps = ifs->if_capenable; |
| 2763 | #endif /* HAS_IF_CAP */ |
| 2764 | bif->bif_sc = sc; |
| 2765 | if (wifi_infra) { |
| 2766 | (void)bridge_mac_nat_enable(sc, bif); |
| 2767 | } |
| 2768 | |
| 2769 | if (IFNET_IS_VMNET(ifs)) { |
| 2770 | allocate_vmnet_pf_tags(); |
| 2771 | } |
| 2772 | /* Allow the first Ethernet member to define the MTU */ |
| 2773 | if (TAILQ_EMPTY(&sc->sc_iflist)) { |
| 2774 | sc->sc_ifp->if_mtu = ifs->if_mtu; |
| 2775 | } |
| 2776 | |
| 2777 | /* |
| 2778 | * Assign the interface's MAC address to the bridge if it's the first |
| 2779 | * member and the MAC address of the bridge has not been changed from |
| 2780 | * the default (randomly) generated one. |
| 2781 | */ |
| 2782 | if (bridge_inherit_mac && TAILQ_EMPTY(&sc->sc_iflist) && |
| 2783 | _ether_cmp(IF_LLADDR(sc->sc_ifp), b: sc->sc_defaddr) == 0) { |
| 2784 | bcopy(IF_LLADDR(ifs), dst: eaddr, ETHER_ADDR_LEN); |
| 2785 | sc->sc_ifaddr = ifs; |
| 2786 | ifnet_reference(interface: ifs); /* for sc_ifaddr */ |
| 2787 | lladdr_changed = 1; |
| 2788 | } |
| 2789 | |
| 2790 | ifs->if_bridge = sc; |
| 2791 | #if BRIDGESTP |
| 2792 | bstp_create(&sc->sc_stp, &bif->bif_stp, bif->bif_ifp); |
| 2793 | #endif /* BRIDGESTP */ |
| 2794 | |
| 2795 | #if HAS_IF_CAP |
| 2796 | /* Set interface capabilities to the intersection set of all members */ |
| 2797 | bridge_mutecaps(sc); |
| 2798 | #endif /* HAS_IF_CAP */ |
| 2799 | |
| 2800 | |
| 2801 | /* |
| 2802 | * Respect lock ordering with DLIL lock for the following operations |
| 2803 | */ |
| 2804 | BRIDGE_UNLOCK(sc); |
| 2805 | |
| 2806 | /* enable promiscuous mode */ |
| 2807 | error = ifnet_set_promiscuous(interface: ifs, on: 1); |
| 2808 | switch (error) { |
| 2809 | case 0: |
| 2810 | bif->bif_flags |= BIFF_PROMISC; |
| 2811 | break; |
| 2812 | case ENETDOWN: |
| 2813 | case EPWROFF: |
| 2814 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2815 | "ifnet_set_promiscuous(%s) failed %d, ignoring" , |
| 2816 | ifs->if_xname, error); |
| 2817 | /* Ignore error when device is not up */ |
| 2818 | error = 0; |
| 2819 | break; |
| 2820 | default: |
| 2821 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2822 | "ifnet_set_promiscuous(%s) failed %d" , |
| 2823 | ifs->if_xname, error); |
| 2824 | BRIDGE_LOCK(sc); |
| 2825 | goto out; |
| 2826 | } |
| 2827 | if (wifi_infra) { |
| 2828 | int this_error; |
| 2829 | |
| 2830 | /* Wi-Fi doesn't really support promiscuous, set allmulti */ |
| 2831 | bif->bif_flags |= BIFF_WIFI_INFRA; |
| 2832 | this_error = if_allmulti(ifs, 1); |
| 2833 | if (this_error == 0) { |
| 2834 | bif->bif_flags |= BIFF_ALL_MULTI; |
| 2835 | #ifdef XNU_PLATFORM_AppleTVOS |
| 2836 | ip6_forwarding = 1; |
| 2837 | #endif /* XNU_PLATFORM_AppleTVOS */ |
| 2838 | } else { |
| 2839 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2840 | "if_allmulti(%s) failed %d, ignoring" , |
| 2841 | ifs->if_xname, this_error); |
| 2842 | } |
| 2843 | } |
| 2844 | #if SKYWALK |
| 2845 | /* ensure that the flowswitch is present for native interface */ |
| 2846 | if (SKYWALK_NATIVE(ifs)) { |
| 2847 | if (ifnet_attach_flowswitch_nexus(ifp: ifs)) { |
| 2848 | bif->bif_flags |= BIFF_FLOWSWITCH_ATTACHED; |
| 2849 | } |
| 2850 | } |
| 2851 | /* remove the netagent on the flowswitch (rdar://75050182) */ |
| 2852 | if (if_is_fsw_netagent_enabled()) { |
| 2853 | (void)ifnet_remove_netagent(ifp: ifs); |
| 2854 | bif->bif_flags |= BIFF_NETAGENT_REMOVED; |
| 2855 | } |
| 2856 | #endif /* SKYWALK */ |
| 2857 | |
| 2858 | /* |
| 2859 | * install an interface filter |
| 2860 | */ |
| 2861 | memset(s: &iff, c: 0, n: sizeof(struct iff_filter)); |
| 2862 | iff.iff_cookie = bif; |
| 2863 | iff.iff_name = "com.apple.kernel.bsd.net.if_bridge" ; |
| 2864 | iff.iff_input = bridge_iff_input; |
| 2865 | iff.iff_output = bridge_iff_output; |
| 2866 | iff.iff_event = bridge_iff_event; |
| 2867 | iff.iff_detached = bridge_iff_detached; |
| 2868 | error = dlil_attach_filter(ifs, &iff, &bif->bif_iff_ref, |
| 2869 | DLIL_IFF_TSO | DLIL_IFF_INTERNAL); |
| 2870 | if (error != 0) { |
| 2871 | BRIDGE_LOG(LOG_NOTICE, 0, "iflt_attach failed %d" , error); |
| 2872 | BRIDGE_LOCK(sc); |
| 2873 | goto out; |
| 2874 | } |
| 2875 | bif->bif_flags |= BIFF_FILTER_ATTACHED; |
| 2876 | |
| 2877 | /* |
| 2878 | * install a dummy "bridge" protocol |
| 2879 | */ |
| 2880 | if ((error = bridge_attach_protocol(ifp: ifs)) != 0) { |
| 2881 | if (error != 0) { |
| 2882 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 2883 | "bridge_attach_protocol failed %d" , error); |
| 2884 | BRIDGE_LOCK(sc); |
| 2885 | goto out; |
| 2886 | } |
| 2887 | } |
| 2888 | bif->bif_flags |= BIFF_PROTO_ATTACHED; |
| 2889 | |
| 2890 | if (lladdr_changed && |
| 2891 | (error = ifnet_set_lladdr(interface: bifp, lladdr: eaddr, ETHER_ADDR_LEN)) != 0) { |
| 2892 | BRIDGE_LOG(LOG_NOTICE, 0, "ifnet_set_lladdr failed %d" , error); |
| 2893 | } |
| 2894 | |
| 2895 | media_active = interface_media_active(ifs); |
| 2896 | |
| 2897 | /* disable LRO */ |
| 2898 | if (bridge_set_lro(ifp: ifs, FALSE)) { |
| 2899 | bif->bif_flags |= BIFF_LRO_DISABLED; |
| 2900 | } |
| 2901 | |
| 2902 | /* |
| 2903 | * No failures past this point. Add the member to the list. |
| 2904 | */ |
| 2905 | BRIDGE_LOCK(sc); |
| 2906 | bif->bif_flags |= BIFF_IN_MEMBER_LIST; |
| 2907 | BRIDGE_XLOCK(sc); |
| 2908 | TAILQ_INSERT_TAIL(&sc->sc_iflist, bif, bif_next); |
| 2909 | BRIDGE_XDROP(sc); |
| 2910 | |
| 2911 | /* cache the member link status */ |
| 2912 | if (media_active != 0) { |
| 2913 | bif->bif_flags |= BIFF_MEDIA_ACTIVE; |
| 2914 | } else { |
| 2915 | bif->bif_flags &= ~BIFF_MEDIA_ACTIVE; |
| 2916 | } |
| 2917 | |
| 2918 | /* the new member may change the link status of the bridge interface */ |
| 2919 | event_code = bridge_updatelinkstatus(sc); |
| 2920 | |
| 2921 | /* check whether we need input broadcast or not */ |
| 2922 | input_broadcast = interface_needs_input_broadcast(ifp: ifs); |
| 2923 | bif_set_input_broadcast(bif, input_broadcast); |
| 2924 | BRIDGE_UNLOCK(sc); |
| 2925 | |
| 2926 | if (event_code != 0) { |
| 2927 | bridge_link_event(bifp, event_code); |
| 2928 | } |
| 2929 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, |
| 2930 | "%s input broadcast %s" , ifs->if_xname, |
| 2931 | input_broadcast ? "ENABLED" : "DISABLED" ); |
| 2932 | |
| 2933 | BRIDGE_LOCK(sc); |
| 2934 | bridge_set_tso(sc); |
| 2935 | |
| 2936 | out: |
| 2937 | /* allow the interface to detach */ |
| 2938 | ifnet_decr_iorefcnt(ifs); |
| 2939 | |
| 2940 | if (error != 0) { |
| 2941 | if (bif != NULL) { |
| 2942 | bridge_delete_member(sc, bif); |
| 2943 | } |
| 2944 | } else if (IFNET_IS_VMNET(ifs)) { |
| 2945 | INC_ATOMIC_INT64_LIM(net_api_stats.nas_vmnet_total); |
| 2946 | } |
| 2947 | |
| 2948 | return error; |
| 2949 | } |
| 2950 | |
| 2951 | static int |
| 2952 | bridge_ioctl_del(struct bridge_softc *sc, void *arg) |
| 2953 | { |
| 2954 | struct ifbreq *req = arg; |
| 2955 | struct bridge_iflist *bif; |
| 2956 | |
| 2957 | bif = bridge_lookup_member(sc, name: req->ifbr_ifsname); |
| 2958 | if (bif == NULL) { |
| 2959 | return ENOENT; |
| 2960 | } |
| 2961 | |
| 2962 | bridge_delete_member(sc, bif); |
| 2963 | |
| 2964 | return 0; |
| 2965 | } |
| 2966 | |
| 2967 | static int |
| 2968 | bridge_ioctl_purge(struct bridge_softc *sc, void *arg) |
| 2969 | { |
| 2970 | #pragma unused(sc, arg) |
| 2971 | return 0; |
| 2972 | } |
| 2973 | |
| 2974 | static int |
| 2975 | bridge_ioctl_gifflags(struct bridge_softc *sc, void *arg) |
| 2976 | { |
| 2977 | struct ifbreq *req = arg; |
| 2978 | struct bridge_iflist *bif; |
| 2979 | |
| 2980 | bif = bridge_lookup_member(sc, name: req->ifbr_ifsname); |
| 2981 | if (bif == NULL) { |
| 2982 | return ENOENT; |
| 2983 | } |
| 2984 | |
| 2985 | struct bstp_port *bp; |
| 2986 | |
| 2987 | bp = &bif->bif_stp; |
| 2988 | req->ifbr_state = bp->bp_state; |
| 2989 | req->ifbr_priority = bp->bp_priority; |
| 2990 | req->ifbr_path_cost = bp->bp_path_cost; |
| 2991 | req->ifbr_proto = bp->bp_protover; |
| 2992 | req->ifbr_role = bp->bp_role; |
| 2993 | req->ifbr_stpflags = bp->bp_flags; |
| 2994 | req->ifbr_ifsflags = bif->bif_ifflags; |
| 2995 | |
| 2996 | /* Copy STP state options as flags */ |
| 2997 | if (bp->bp_operedge) { |
| 2998 | req->ifbr_ifsflags |= IFBIF_BSTP_EDGE; |
| 2999 | } |
| 3000 | if (bp->bp_flags & BSTP_PORT_AUTOEDGE) { |
| 3001 | req->ifbr_ifsflags |= IFBIF_BSTP_AUTOEDGE; |
| 3002 | } |
| 3003 | if (bp->bp_ptp_link) { |
| 3004 | req->ifbr_ifsflags |= IFBIF_BSTP_PTP; |
| 3005 | } |
| 3006 | if (bp->bp_flags & BSTP_PORT_AUTOPTP) { |
| 3007 | req->ifbr_ifsflags |= IFBIF_BSTP_AUTOPTP; |
| 3008 | } |
| 3009 | if (bp->bp_flags & BSTP_PORT_ADMEDGE) { |
| 3010 | req->ifbr_ifsflags |= IFBIF_BSTP_ADMEDGE; |
| 3011 | } |
| 3012 | if (bp->bp_flags & BSTP_PORT_ADMCOST) { |
| 3013 | req->ifbr_ifsflags |= IFBIF_BSTP_ADMCOST; |
| 3014 | } |
| 3015 | |
| 3016 | req->ifbr_portno = bif->bif_ifp->if_index & 0xfff; |
| 3017 | req->ifbr_addrcnt = bif->bif_addrcnt; |
| 3018 | req->ifbr_addrmax = bif->bif_addrmax; |
| 3019 | req->ifbr_addrexceeded = bif->bif_addrexceeded; |
| 3020 | |
| 3021 | return 0; |
| 3022 | } |
| 3023 | |
| 3024 | static int |
| 3025 | bridge_ioctl_sifflags(struct bridge_softc *sc, void *arg) |
| 3026 | { |
| 3027 | struct ifbreq *req = arg; |
| 3028 | struct bridge_iflist *bif; |
| 3029 | #if BRIDGESTP |
| 3030 | struct bstp_port *bp; |
| 3031 | int error; |
| 3032 | #endif /* BRIDGESTP */ |
| 3033 | |
| 3034 | bif = bridge_lookup_member(sc, name: req->ifbr_ifsname); |
| 3035 | if (bif == NULL) { |
| 3036 | return ENOENT; |
| 3037 | } |
| 3038 | |
| 3039 | if (req->ifbr_ifsflags & IFBIF_SPAN) { |
| 3040 | /* SPAN is readonly */ |
| 3041 | return EINVAL; |
| 3042 | } |
| 3043 | #define _EXCLUSIVE_FLAGS (IFBIF_CHECKSUM_OFFLOAD | IFBIF_MAC_NAT) |
| 3044 | if ((req->ifbr_ifsflags & _EXCLUSIVE_FLAGS) == _EXCLUSIVE_FLAGS) { |
| 3045 | /* can't specify both MAC-NAT and checksum offload */ |
| 3046 | return EINVAL; |
| 3047 | } |
| 3048 | if ((req->ifbr_ifsflags & IFBIF_MAC_NAT) != 0) { |
| 3049 | errno_t error; |
| 3050 | |
| 3051 | error = bridge_mac_nat_enable(sc, bif); |
| 3052 | if (error != 0) { |
| 3053 | return error; |
| 3054 | } |
| 3055 | } else if (sc->sc_mac_nat_bif == bif) { |
| 3056 | bridge_mac_nat_disable(sc); |
| 3057 | } |
| 3058 | |
| 3059 | |
| 3060 | #if BRIDGESTP |
| 3061 | if (req->ifbr_ifsflags & IFBIF_STP) { |
| 3062 | if ((bif->bif_ifflags & IFBIF_STP) == 0) { |
| 3063 | error = bstp_enable(&bif->bif_stp); |
| 3064 | if (error) { |
| 3065 | return error; |
| 3066 | } |
| 3067 | } |
| 3068 | } else { |
| 3069 | if ((bif->bif_ifflags & IFBIF_STP) != 0) { |
| 3070 | bstp_disable(&bif->bif_stp); |
| 3071 | } |
| 3072 | } |
| 3073 | |
| 3074 | /* Pass on STP flags */ |
| 3075 | bp = &bif->bif_stp; |
| 3076 | bstp_set_edge(bp, req->ifbr_ifsflags & IFBIF_BSTP_EDGE ? 1 : 0); |
| 3077 | bstp_set_autoedge(bp, req->ifbr_ifsflags & IFBIF_BSTP_AUTOEDGE ? 1 : 0); |
| 3078 | bstp_set_ptp(bp, req->ifbr_ifsflags & IFBIF_BSTP_PTP ? 1 : 0); |
| 3079 | bstp_set_autoptp(bp, req->ifbr_ifsflags & IFBIF_BSTP_AUTOPTP ? 1 : 0); |
| 3080 | #else /* !BRIDGESTP */ |
| 3081 | if (req->ifbr_ifsflags & IFBIF_STP) { |
| 3082 | return EOPNOTSUPP; |
| 3083 | } |
| 3084 | #endif /* !BRIDGESTP */ |
| 3085 | |
| 3086 | /* Save the bits relating to the bridge */ |
| 3087 | bif->bif_ifflags = req->ifbr_ifsflags & IFBIFMASK; |
| 3088 | |
| 3089 | |
| 3090 | return 0; |
| 3091 | } |
| 3092 | |
| 3093 | static int |
| 3094 | bridge_ioctl_scache(struct bridge_softc *sc, void *arg) |
| 3095 | { |
| 3096 | struct ifbrparam *param = arg; |
| 3097 | |
| 3098 | sc->sc_brtmax = param->ifbrp_csize; |
| 3099 | bridge_rttrim(sc); |
| 3100 | return 0; |
| 3101 | } |
| 3102 | |
| 3103 | static int |
| 3104 | bridge_ioctl_gcache(struct bridge_softc *sc, void *arg) |
| 3105 | { |
| 3106 | struct ifbrparam *param = arg; |
| 3107 | |
| 3108 | param->ifbrp_csize = sc->sc_brtmax; |
| 3109 | |
| 3110 | return 0; |
| 3111 | } |
| 3112 | |
| 3113 | #define BRIDGE_IOCTL_GIFS do { \ |
| 3114 | struct bridge_iflist *bif; \ |
| 3115 | struct ifbreq breq; \ |
| 3116 | char *buf, *outbuf; \ |
| 3117 | unsigned int count, buflen, len; \ |
| 3118 | \ |
| 3119 | count = 0; \ |
| 3120 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) \ |
| 3121 | count++; \ |
| 3122 | TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) \ |
| 3123 | count++; \ |
| 3124 | \ |
| 3125 | buflen = sizeof (breq) * count; \ |
| 3126 | if (bifc->ifbic_len == 0) { \ |
| 3127 | bifc->ifbic_len = buflen; \ |
| 3128 | return (0); \ |
| 3129 | } \ |
| 3130 | BRIDGE_UNLOCK(sc); \ |
| 3131 | outbuf = (char *)kalloc_data(buflen, Z_WAITOK | Z_ZERO); \ |
| 3132 | BRIDGE_LOCK(sc); \ |
| 3133 | \ |
| 3134 | count = 0; \ |
| 3135 | buf = outbuf; \ |
| 3136 | len = min(bifc->ifbic_len, buflen); \ |
| 3137 | bzero(&breq, sizeof (breq)); \ |
| 3138 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { \ |
| 3139 | if (len < sizeof (breq)) \ |
| 3140 | break; \ |
| 3141 | \ |
| 3142 | snprintf(breq.ifbr_ifsname, sizeof (breq.ifbr_ifsname), \ |
| 3143 | "%s", bif->bif_ifp->if_xname); \ |
| 3144 | /* Fill in the ifbreq structure */ \ |
| 3145 | error = bridge_ioctl_gifflags(sc, &breq); \ |
| 3146 | if (error) \ |
| 3147 | break; \ |
| 3148 | memcpy(buf, &breq, sizeof (breq)); \ |
| 3149 | count++; \ |
| 3150 | buf += sizeof (breq); \ |
| 3151 | len -= sizeof (breq); \ |
| 3152 | } \ |
| 3153 | TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) { \ |
| 3154 | if (len < sizeof (breq)) \ |
| 3155 | break; \ |
| 3156 | \ |
| 3157 | snprintf(breq.ifbr_ifsname, \ |
| 3158 | sizeof (breq.ifbr_ifsname), \ |
| 3159 | "%s", bif->bif_ifp->if_xname); \ |
| 3160 | breq.ifbr_ifsflags = bif->bif_ifflags; \ |
| 3161 | breq.ifbr_portno \ |
| 3162 | = bif->bif_ifp->if_index & 0xfff; \ |
| 3163 | memcpy(buf, &breq, sizeof (breq)); \ |
| 3164 | count++; \ |
| 3165 | buf += sizeof (breq); \ |
| 3166 | len -= sizeof (breq); \ |
| 3167 | } \ |
| 3168 | \ |
| 3169 | BRIDGE_UNLOCK(sc); \ |
| 3170 | bifc->ifbic_len = sizeof (breq) * count; \ |
| 3171 | error = copyout(outbuf, bifc->ifbic_req, bifc->ifbic_len); \ |
| 3172 | BRIDGE_LOCK(sc); \ |
| 3173 | kfree_data(outbuf, buflen); \ |
| 3174 | } while (0) |
| 3175 | |
| 3176 | static int |
| 3177 | bridge_ioctl_gifs64(struct bridge_softc *sc, void *arg) |
| 3178 | { |
| 3179 | struct ifbifconf64 *bifc = arg; |
| 3180 | int error = 0; |
| 3181 | |
| 3182 | BRIDGE_IOCTL_GIFS; |
| 3183 | |
| 3184 | return error; |
| 3185 | } |
| 3186 | |
| 3187 | static int |
| 3188 | bridge_ioctl_gifs32(struct bridge_softc *sc, void *arg) |
| 3189 | { |
| 3190 | struct ifbifconf32 *bifc = arg; |
| 3191 | int error = 0; |
| 3192 | |
| 3193 | BRIDGE_IOCTL_GIFS; |
| 3194 | |
| 3195 | return error; |
| 3196 | } |
| 3197 | |
| 3198 | #define BRIDGE_IOCTL_RTS do { \ |
| 3199 | struct bridge_rtnode *brt; \ |
| 3200 | char *buf; \ |
| 3201 | char *outbuf = NULL; \ |
| 3202 | unsigned int count, buflen, len; \ |
| 3203 | unsigned long now; \ |
| 3204 | \ |
| 3205 | if (bac->ifbac_len == 0) \ |
| 3206 | return (0); \ |
| 3207 | \ |
| 3208 | bzero(&bareq, sizeof (bareq)); \ |
| 3209 | count = 0; \ |
| 3210 | LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) \ |
| 3211 | count++; \ |
| 3212 | buflen = sizeof (bareq) * count; \ |
| 3213 | \ |
| 3214 | BRIDGE_UNLOCK(sc); \ |
| 3215 | outbuf = (char *)kalloc_data(buflen, Z_WAITOK | Z_ZERO); \ |
| 3216 | BRIDGE_LOCK(sc); \ |
| 3217 | \ |
| 3218 | count = 0; \ |
| 3219 | buf = outbuf; \ |
| 3220 | len = min(bac->ifbac_len, buflen); \ |
| 3221 | LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) { \ |
| 3222 | if (len < sizeof (bareq)) \ |
| 3223 | goto out; \ |
| 3224 | snprintf(bareq.ifba_ifsname, sizeof (bareq.ifba_ifsname), \ |
| 3225 | "%s", brt->brt_ifp->if_xname); \ |
| 3226 | memcpy(bareq.ifba_dst, brt->brt_addr, sizeof (brt->brt_addr)); \ |
| 3227 | bareq.ifba_vlan = brt->brt_vlan; \ |
| 3228 | if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) { \ |
| 3229 | now = (unsigned long) net_uptime(); \ |
| 3230 | if (now < brt->brt_expire) \ |
| 3231 | bareq.ifba_expire = \ |
| 3232 | brt->brt_expire - now; \ |
| 3233 | } else \ |
| 3234 | bareq.ifba_expire = 0; \ |
| 3235 | bareq.ifba_flags = brt->brt_flags; \ |
| 3236 | \ |
| 3237 | memcpy(buf, &bareq, sizeof (bareq)); \ |
| 3238 | count++; \ |
| 3239 | buf += sizeof (bareq); \ |
| 3240 | len -= sizeof (bareq); \ |
| 3241 | } \ |
| 3242 | out: \ |
| 3243 | bac->ifbac_len = sizeof (bareq) * count; \ |
| 3244 | if (outbuf != NULL) { \ |
| 3245 | BRIDGE_UNLOCK(sc); \ |
| 3246 | error = copyout(outbuf, bac->ifbac_req, bac->ifbac_len); \ |
| 3247 | kfree_data(outbuf, buflen); \ |
| 3248 | BRIDGE_LOCK(sc); \ |
| 3249 | } \ |
| 3250 | return (error); \ |
| 3251 | } while (0) |
| 3252 | |
| 3253 | static int |
| 3254 | bridge_ioctl_rts64(struct bridge_softc *sc, void *arg) |
| 3255 | { |
| 3256 | struct ifbaconf64 *bac = arg; |
| 3257 | struct ifbareq64 bareq; |
| 3258 | int error = 0; |
| 3259 | |
| 3260 | BRIDGE_IOCTL_RTS; |
| 3261 | return error; |
| 3262 | } |
| 3263 | |
| 3264 | static int |
| 3265 | bridge_ioctl_rts32(struct bridge_softc *sc, void *arg) |
| 3266 | { |
| 3267 | struct ifbaconf32 *bac = arg; |
| 3268 | struct ifbareq32 bareq; |
| 3269 | int error = 0; |
| 3270 | |
| 3271 | BRIDGE_IOCTL_RTS; |
| 3272 | return error; |
| 3273 | } |
| 3274 | |
| 3275 | static int |
| 3276 | bridge_ioctl_saddr32(struct bridge_softc *sc, void *arg) |
| 3277 | { |
| 3278 | struct ifbareq32 *req = arg; |
| 3279 | struct bridge_iflist *bif; |
| 3280 | int error; |
| 3281 | |
| 3282 | bif = bridge_lookup_member(sc, name: req->ifba_ifsname); |
| 3283 | if (bif == NULL) { |
| 3284 | return ENOENT; |
| 3285 | } |
| 3286 | |
| 3287 | error = bridge_rtupdate(sc, req->ifba_dst, req->ifba_vlan, bif, 1, |
| 3288 | req->ifba_flags); |
| 3289 | |
| 3290 | return error; |
| 3291 | } |
| 3292 | |
| 3293 | static int |
| 3294 | bridge_ioctl_saddr64(struct bridge_softc *sc, void *arg) |
| 3295 | { |
| 3296 | struct ifbareq64 *req = arg; |
| 3297 | struct bridge_iflist *bif; |
| 3298 | int error; |
| 3299 | |
| 3300 | bif = bridge_lookup_member(sc, name: req->ifba_ifsname); |
| 3301 | if (bif == NULL) { |
| 3302 | return ENOENT; |
| 3303 | } |
| 3304 | |
| 3305 | error = bridge_rtupdate(sc, req->ifba_dst, req->ifba_vlan, bif, 1, |
| 3306 | req->ifba_flags); |
| 3307 | |
| 3308 | return error; |
| 3309 | } |
| 3310 | |
| 3311 | static int |
| 3312 | bridge_ioctl_sto(struct bridge_softc *sc, void *arg) |
| 3313 | { |
| 3314 | struct ifbrparam *param = arg; |
| 3315 | |
| 3316 | sc->sc_brttimeout = param->ifbrp_ctime; |
| 3317 | return 0; |
| 3318 | } |
| 3319 | |
| 3320 | static int |
| 3321 | bridge_ioctl_gto(struct bridge_softc *sc, void *arg) |
| 3322 | { |
| 3323 | struct ifbrparam *param = arg; |
| 3324 | |
| 3325 | param->ifbrp_ctime = sc->sc_brttimeout; |
| 3326 | return 0; |
| 3327 | } |
| 3328 | |
| 3329 | static int |
| 3330 | bridge_ioctl_daddr32(struct bridge_softc *sc, void *arg) |
| 3331 | { |
| 3332 | struct ifbareq32 *req = arg; |
| 3333 | |
| 3334 | return bridge_rtdaddr(sc, req->ifba_dst, req->ifba_vlan); |
| 3335 | } |
| 3336 | |
| 3337 | static int |
| 3338 | bridge_ioctl_daddr64(struct bridge_softc *sc, void *arg) |
| 3339 | { |
| 3340 | struct ifbareq64 *req = arg; |
| 3341 | |
| 3342 | return bridge_rtdaddr(sc, req->ifba_dst, req->ifba_vlan); |
| 3343 | } |
| 3344 | |
| 3345 | static int |
| 3346 | bridge_ioctl_flush(struct bridge_softc *sc, void *arg) |
| 3347 | { |
| 3348 | struct ifbreq *req = arg; |
| 3349 | |
| 3350 | bridge_rtflush(sc, req->ifbr_ifsflags); |
| 3351 | return 0; |
| 3352 | } |
| 3353 | |
| 3354 | static int |
| 3355 | bridge_ioctl_gpri(struct bridge_softc *sc, void *arg) |
| 3356 | { |
| 3357 | struct ifbrparam *param = arg; |
| 3358 | struct bstp_state *bs = &sc->sc_stp; |
| 3359 | |
| 3360 | param->ifbrp_prio = bs->bs_bridge_priority; |
| 3361 | return 0; |
| 3362 | } |
| 3363 | |
| 3364 | static int |
| 3365 | bridge_ioctl_spri(struct bridge_softc *sc, void *arg) |
| 3366 | { |
| 3367 | #if BRIDGESTP |
| 3368 | struct ifbrparam *param = arg; |
| 3369 | |
| 3370 | return bstp_set_priority(&sc->sc_stp, param->ifbrp_prio); |
| 3371 | #else /* !BRIDGESTP */ |
| 3372 | #pragma unused(sc, arg) |
| 3373 | return EOPNOTSUPP; |
| 3374 | #endif /* !BRIDGESTP */ |
| 3375 | } |
| 3376 | |
| 3377 | static int |
| 3378 | bridge_ioctl_ght(struct bridge_softc *sc, void *arg) |
| 3379 | { |
| 3380 | struct ifbrparam *param = arg; |
| 3381 | struct bstp_state *bs = &sc->sc_stp; |
| 3382 | |
| 3383 | param->ifbrp_hellotime = bs->bs_bridge_htime >> 8; |
| 3384 | return 0; |
| 3385 | } |
| 3386 | |
| 3387 | static int |
| 3388 | bridge_ioctl_sht(struct bridge_softc *sc, void *arg) |
| 3389 | { |
| 3390 | #if BRIDGESTP |
| 3391 | struct ifbrparam *param = arg; |
| 3392 | |
| 3393 | return bstp_set_htime(&sc->sc_stp, param->ifbrp_hellotime); |
| 3394 | #else /* !BRIDGESTP */ |
| 3395 | #pragma unused(sc, arg) |
| 3396 | return EOPNOTSUPP; |
| 3397 | #endif /* !BRIDGESTP */ |
| 3398 | } |
| 3399 | |
| 3400 | static int |
| 3401 | bridge_ioctl_gfd(struct bridge_softc *sc, void *arg) |
| 3402 | { |
| 3403 | struct ifbrparam *param; |
| 3404 | struct bstp_state *bs; |
| 3405 | |
| 3406 | param = arg; |
| 3407 | bs = &sc->sc_stp; |
| 3408 | param->ifbrp_fwddelay = bs->bs_bridge_fdelay >> 8; |
| 3409 | return 0; |
| 3410 | } |
| 3411 | |
| 3412 | static int |
| 3413 | bridge_ioctl_sfd(struct bridge_softc *sc, void *arg) |
| 3414 | { |
| 3415 | #if BRIDGESTP |
| 3416 | struct ifbrparam *param = arg; |
| 3417 | |
| 3418 | return bstp_set_fdelay(&sc->sc_stp, param->ifbrp_fwddelay); |
| 3419 | #else /* !BRIDGESTP */ |
| 3420 | #pragma unused(sc, arg) |
| 3421 | return EOPNOTSUPP; |
| 3422 | #endif /* !BRIDGESTP */ |
| 3423 | } |
| 3424 | |
| 3425 | static int |
| 3426 | bridge_ioctl_gma(struct bridge_softc *sc, void *arg) |
| 3427 | { |
| 3428 | struct ifbrparam *param; |
| 3429 | struct bstp_state *bs; |
| 3430 | |
| 3431 | param = arg; |
| 3432 | bs = &sc->sc_stp; |
| 3433 | param->ifbrp_maxage = bs->bs_bridge_max_age >> 8; |
| 3434 | return 0; |
| 3435 | } |
| 3436 | |
| 3437 | static int |
| 3438 | bridge_ioctl_sma(struct bridge_softc *sc, void *arg) |
| 3439 | { |
| 3440 | #if BRIDGESTP |
| 3441 | struct ifbrparam *param = arg; |
| 3442 | |
| 3443 | return bstp_set_maxage(&sc->sc_stp, param->ifbrp_maxage); |
| 3444 | #else /* !BRIDGESTP */ |
| 3445 | #pragma unused(sc, arg) |
| 3446 | return EOPNOTSUPP; |
| 3447 | #endif /* !BRIDGESTP */ |
| 3448 | } |
| 3449 | |
| 3450 | static int |
| 3451 | bridge_ioctl_sifprio(struct bridge_softc *sc, void *arg) |
| 3452 | { |
| 3453 | #if BRIDGESTP |
| 3454 | struct ifbreq *req = arg; |
| 3455 | struct bridge_iflist *bif; |
| 3456 | |
| 3457 | bif = bridge_lookup_member(sc, req->ifbr_ifsname); |
| 3458 | if (bif == NULL) { |
| 3459 | return ENOENT; |
| 3460 | } |
| 3461 | |
| 3462 | return bstp_set_port_priority(&bif->bif_stp, req->ifbr_priority); |
| 3463 | #else /* !BRIDGESTP */ |
| 3464 | #pragma unused(sc, arg) |
| 3465 | return EOPNOTSUPP; |
| 3466 | #endif /* !BRIDGESTP */ |
| 3467 | } |
| 3468 | |
| 3469 | static int |
| 3470 | bridge_ioctl_sifcost(struct bridge_softc *sc, void *arg) |
| 3471 | { |
| 3472 | #if BRIDGESTP |
| 3473 | struct ifbreq *req = arg; |
| 3474 | struct bridge_iflist *bif; |
| 3475 | |
| 3476 | bif = bridge_lookup_member(sc, req->ifbr_ifsname); |
| 3477 | if (bif == NULL) { |
| 3478 | return ENOENT; |
| 3479 | } |
| 3480 | |
| 3481 | return bstp_set_path_cost(&bif->bif_stp, req->ifbr_path_cost); |
| 3482 | #else /* !BRIDGESTP */ |
| 3483 | #pragma unused(sc, arg) |
| 3484 | return EOPNOTSUPP; |
| 3485 | #endif /* !BRIDGESTP */ |
| 3486 | } |
| 3487 | |
| 3488 | static int |
| 3489 | bridge_ioctl_gfilt(struct bridge_softc *sc, void *arg) |
| 3490 | { |
| 3491 | struct ifbrparam *param = arg; |
| 3492 | |
| 3493 | param->ifbrp_filter = sc->sc_filter_flags; |
| 3494 | |
| 3495 | return 0; |
| 3496 | } |
| 3497 | |
| 3498 | static int |
| 3499 | bridge_ioctl_sfilt(struct bridge_softc *sc, void *arg) |
| 3500 | { |
| 3501 | struct ifbrparam *param = arg; |
| 3502 | |
| 3503 | if (param->ifbrp_filter & ~IFBF_FILT_MASK) { |
| 3504 | return EINVAL; |
| 3505 | } |
| 3506 | |
| 3507 | if (param->ifbrp_filter & IFBF_FILT_USEIPF) { |
| 3508 | return EINVAL; |
| 3509 | } |
| 3510 | |
| 3511 | sc->sc_filter_flags = param->ifbrp_filter; |
| 3512 | |
| 3513 | return 0; |
| 3514 | } |
| 3515 | |
| 3516 | static int |
| 3517 | bridge_ioctl_sifmaxaddr(struct bridge_softc *sc, void *arg) |
| 3518 | { |
| 3519 | struct ifbreq *req = arg; |
| 3520 | struct bridge_iflist *bif; |
| 3521 | |
| 3522 | bif = bridge_lookup_member(sc, name: req->ifbr_ifsname); |
| 3523 | if (bif == NULL) { |
| 3524 | return ENOENT; |
| 3525 | } |
| 3526 | |
| 3527 | bif->bif_addrmax = req->ifbr_addrmax; |
| 3528 | return 0; |
| 3529 | } |
| 3530 | |
| 3531 | static int |
| 3532 | bridge_ioctl_addspan(struct bridge_softc *sc, void *arg) |
| 3533 | { |
| 3534 | struct ifbreq *req = arg; |
| 3535 | struct bridge_iflist *bif = NULL; |
| 3536 | struct ifnet *ifs; |
| 3537 | |
| 3538 | ifs = ifunit(req->ifbr_ifsname); |
| 3539 | if (ifs == NULL) { |
| 3540 | return ENOENT; |
| 3541 | } |
| 3542 | |
| 3543 | if (IFNET_IS_INTCOPROC(ifs) || IFNET_IS_MANAGEMENT(ifs)) { |
| 3544 | return EINVAL; |
| 3545 | } |
| 3546 | |
| 3547 | TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) |
| 3548 | if (ifs == bif->bif_ifp) { |
| 3549 | return EBUSY; |
| 3550 | } |
| 3551 | |
| 3552 | if (ifs->if_bridge != NULL) { |
| 3553 | return EBUSY; |
| 3554 | } |
| 3555 | |
| 3556 | switch (ifs->if_type) { |
| 3557 | case IFT_ETHER: |
| 3558 | case IFT_L2VLAN: |
| 3559 | case IFT_IEEE8023ADLAG: |
| 3560 | break; |
| 3561 | case IFT_GIF: |
| 3562 | /* currently not supported */ |
| 3563 | /* FALLTHRU */ |
| 3564 | default: |
| 3565 | return EINVAL; |
| 3566 | } |
| 3567 | |
| 3568 | bif = kalloc_type(struct bridge_iflist, Z_WAITOK | Z_ZERO | Z_NOFAIL); |
| 3569 | |
| 3570 | bif->bif_ifp = ifs; |
| 3571 | bif->bif_ifflags = IFBIF_SPAN; |
| 3572 | |
| 3573 | ifnet_reference(interface: bif->bif_ifp); |
| 3574 | |
| 3575 | TAILQ_INSERT_HEAD(&sc->sc_spanlist, bif, bif_next); |
| 3576 | |
| 3577 | return 0; |
| 3578 | } |
| 3579 | |
| 3580 | static int |
| 3581 | bridge_ioctl_delspan(struct bridge_softc *sc, void *arg) |
| 3582 | { |
| 3583 | struct ifbreq *req = arg; |
| 3584 | struct bridge_iflist *bif; |
| 3585 | struct ifnet *ifs; |
| 3586 | |
| 3587 | ifs = ifunit(req->ifbr_ifsname); |
| 3588 | if (ifs == NULL) { |
| 3589 | return ENOENT; |
| 3590 | } |
| 3591 | |
| 3592 | TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) |
| 3593 | if (ifs == bif->bif_ifp) { |
| 3594 | break; |
| 3595 | } |
| 3596 | |
| 3597 | if (bif == NULL) { |
| 3598 | return ENOENT; |
| 3599 | } |
| 3600 | |
| 3601 | bridge_delete_span(sc, bif); |
| 3602 | |
| 3603 | return 0; |
| 3604 | } |
| 3605 | |
| 3606 | #define BRIDGE_IOCTL_GBPARAM do { \ |
| 3607 | struct bstp_state *bs = &sc->sc_stp; \ |
| 3608 | struct bstp_port *root_port; \ |
| 3609 | \ |
| 3610 | req->ifbop_maxage = bs->bs_bridge_max_age >> 8; \ |
| 3611 | req->ifbop_hellotime = bs->bs_bridge_htime >> 8; \ |
| 3612 | req->ifbop_fwddelay = bs->bs_bridge_fdelay >> 8; \ |
| 3613 | \ |
| 3614 | root_port = bs->bs_root_port; \ |
| 3615 | if (root_port == NULL) \ |
| 3616 | req->ifbop_root_port = 0; \ |
| 3617 | else \ |
| 3618 | req->ifbop_root_port = root_port->bp_ifp->if_index; \ |
| 3619 | \ |
| 3620 | req->ifbop_holdcount = bs->bs_txholdcount; \ |
| 3621 | req->ifbop_priority = bs->bs_bridge_priority; \ |
| 3622 | req->ifbop_protocol = bs->bs_protover; \ |
| 3623 | req->ifbop_root_path_cost = bs->bs_root_pv.pv_cost; \ |
| 3624 | req->ifbop_bridgeid = bs->bs_bridge_pv.pv_dbridge_id; \ |
| 3625 | req->ifbop_designated_root = bs->bs_root_pv.pv_root_id; \ |
| 3626 | req->ifbop_designated_bridge = bs->bs_root_pv.pv_dbridge_id; \ |
| 3627 | req->ifbop_last_tc_time.tv_sec = bs->bs_last_tc_time.tv_sec; \ |
| 3628 | req->ifbop_last_tc_time.tv_usec = bs->bs_last_tc_time.tv_usec; \ |
| 3629 | } while (0) |
| 3630 | |
| 3631 | static int |
| 3632 | bridge_ioctl_gbparam32(struct bridge_softc *sc, void *arg) |
| 3633 | { |
| 3634 | struct ifbropreq32 *req = arg; |
| 3635 | |
| 3636 | BRIDGE_IOCTL_GBPARAM; |
| 3637 | return 0; |
| 3638 | } |
| 3639 | |
| 3640 | static int |
| 3641 | bridge_ioctl_gbparam64(struct bridge_softc *sc, void *arg) |
| 3642 | { |
| 3643 | struct ifbropreq64 *req = arg; |
| 3644 | |
| 3645 | BRIDGE_IOCTL_GBPARAM; |
| 3646 | return 0; |
| 3647 | } |
| 3648 | |
| 3649 | static int |
| 3650 | bridge_ioctl_grte(struct bridge_softc *sc, void *arg) |
| 3651 | { |
| 3652 | struct ifbrparam *param = arg; |
| 3653 | |
| 3654 | param->ifbrp_cexceeded = sc->sc_brtexceeded; |
| 3655 | return 0; |
| 3656 | } |
| 3657 | |
| 3658 | #define BRIDGE_IOCTL_GIFSSTP do { \ |
| 3659 | struct bridge_iflist *bif; \ |
| 3660 | struct bstp_port *bp; \ |
| 3661 | struct ifbpstpreq bpreq; \ |
| 3662 | char *buf, *outbuf; \ |
| 3663 | unsigned int count, buflen, len; \ |
| 3664 | \ |
| 3665 | count = 0; \ |
| 3666 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { \ |
| 3667 | if ((bif->bif_ifflags & IFBIF_STP) != 0) \ |
| 3668 | count++; \ |
| 3669 | } \ |
| 3670 | \ |
| 3671 | buflen = sizeof (bpreq) * count; \ |
| 3672 | if (bifstp->ifbpstp_len == 0) { \ |
| 3673 | bifstp->ifbpstp_len = buflen; \ |
| 3674 | return (0); \ |
| 3675 | } \ |
| 3676 | \ |
| 3677 | BRIDGE_UNLOCK(sc); \ |
| 3678 | outbuf = (char *)kalloc_data(buflen, Z_WAITOK | Z_ZERO); \ |
| 3679 | BRIDGE_LOCK(sc); \ |
| 3680 | \ |
| 3681 | count = 0; \ |
| 3682 | buf = outbuf; \ |
| 3683 | len = min(bifstp->ifbpstp_len, buflen); \ |
| 3684 | bzero(&bpreq, sizeof (bpreq)); \ |
| 3685 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { \ |
| 3686 | if (len < sizeof (bpreq)) \ |
| 3687 | break; \ |
| 3688 | \ |
| 3689 | if ((bif->bif_ifflags & IFBIF_STP) == 0) \ |
| 3690 | continue; \ |
| 3691 | \ |
| 3692 | bp = &bif->bif_stp; \ |
| 3693 | bpreq.ifbp_portno = bif->bif_ifp->if_index & 0xfff; \ |
| 3694 | bpreq.ifbp_fwd_trans = bp->bp_forward_transitions; \ |
| 3695 | bpreq.ifbp_design_cost = bp->bp_desg_pv.pv_cost; \ |
| 3696 | bpreq.ifbp_design_port = bp->bp_desg_pv.pv_port_id; \ |
| 3697 | bpreq.ifbp_design_bridge = bp->bp_desg_pv.pv_dbridge_id; \ |
| 3698 | bpreq.ifbp_design_root = bp->bp_desg_pv.pv_root_id; \ |
| 3699 | \ |
| 3700 | memcpy(buf, &bpreq, sizeof (bpreq)); \ |
| 3701 | count++; \ |
| 3702 | buf += sizeof (bpreq); \ |
| 3703 | len -= sizeof (bpreq); \ |
| 3704 | } \ |
| 3705 | \ |
| 3706 | BRIDGE_UNLOCK(sc); \ |
| 3707 | bifstp->ifbpstp_len = sizeof (bpreq) * count; \ |
| 3708 | error = copyout(outbuf, bifstp->ifbpstp_req, bifstp->ifbpstp_len); \ |
| 3709 | BRIDGE_LOCK(sc); \ |
| 3710 | kfree_data(outbuf, buflen); \ |
| 3711 | return (error); \ |
| 3712 | } while (0) |
| 3713 | |
| 3714 | static int |
| 3715 | bridge_ioctl_gifsstp32(struct bridge_softc *sc, void *arg) |
| 3716 | { |
| 3717 | struct ifbpstpconf32 *bifstp = arg; |
| 3718 | int error = 0; |
| 3719 | |
| 3720 | BRIDGE_IOCTL_GIFSSTP; |
| 3721 | return error; |
| 3722 | } |
| 3723 | |
| 3724 | static int |
| 3725 | bridge_ioctl_gifsstp64(struct bridge_softc *sc, void *arg) |
| 3726 | { |
| 3727 | struct ifbpstpconf64 *bifstp = arg; |
| 3728 | int error = 0; |
| 3729 | |
| 3730 | BRIDGE_IOCTL_GIFSSTP; |
| 3731 | return error; |
| 3732 | } |
| 3733 | |
| 3734 | static int |
| 3735 | bridge_ioctl_sproto(struct bridge_softc *sc, void *arg) |
| 3736 | { |
| 3737 | #if BRIDGESTP |
| 3738 | struct ifbrparam *param = arg; |
| 3739 | |
| 3740 | return bstp_set_protocol(&sc->sc_stp, param->ifbrp_proto); |
| 3741 | #else /* !BRIDGESTP */ |
| 3742 | #pragma unused(sc, arg) |
| 3743 | return EOPNOTSUPP; |
| 3744 | #endif /* !BRIDGESTP */ |
| 3745 | } |
| 3746 | |
| 3747 | static int |
| 3748 | bridge_ioctl_stxhc(struct bridge_softc *sc, void *arg) |
| 3749 | { |
| 3750 | #if BRIDGESTP |
| 3751 | struct ifbrparam *param = arg; |
| 3752 | |
| 3753 | return bstp_set_holdcount(&sc->sc_stp, param->ifbrp_txhc); |
| 3754 | #else /* !BRIDGESTP */ |
| 3755 | #pragma unused(sc, arg) |
| 3756 | return EOPNOTSUPP; |
| 3757 | #endif /* !BRIDGESTP */ |
| 3758 | } |
| 3759 | |
| 3760 | |
| 3761 | static int |
| 3762 | bridge_ioctl_ghostfilter(struct bridge_softc *sc, void *arg) |
| 3763 | { |
| 3764 | struct ifbrhostfilter *req = arg; |
| 3765 | struct bridge_iflist *bif; |
| 3766 | |
| 3767 | bif = bridge_lookup_member(sc, name: req->ifbrhf_ifsname); |
| 3768 | if (bif == NULL) { |
| 3769 | return ENOENT; |
| 3770 | } |
| 3771 | |
| 3772 | bzero(s: req, n: sizeof(struct ifbrhostfilter)); |
| 3773 | if (bif->bif_flags & BIFF_HOST_FILTER) { |
| 3774 | req->ifbrhf_flags |= IFBRHF_ENABLED; |
| 3775 | bcopy(src: bif->bif_hf_hwsrc, dst: req->ifbrhf_hwsrca, |
| 3776 | ETHER_ADDR_LEN); |
| 3777 | req->ifbrhf_ipsrc = bif->bif_hf_ipsrc.s_addr; |
| 3778 | } |
| 3779 | return 0; |
| 3780 | } |
| 3781 | |
| 3782 | static int |
| 3783 | bridge_ioctl_shostfilter(struct bridge_softc *sc, void *arg) |
| 3784 | { |
| 3785 | struct ifbrhostfilter *req = arg; |
| 3786 | struct bridge_iflist *bif; |
| 3787 | |
| 3788 | bif = bridge_lookup_member(sc, name: req->ifbrhf_ifsname); |
| 3789 | if (bif == NULL) { |
| 3790 | return ENOENT; |
| 3791 | } |
| 3792 | |
| 3793 | if (req->ifbrhf_flags & IFBRHF_ENABLED) { |
| 3794 | bif->bif_flags |= BIFF_HOST_FILTER; |
| 3795 | |
| 3796 | if (req->ifbrhf_flags & IFBRHF_HWSRC) { |
| 3797 | bcopy(src: req->ifbrhf_hwsrca, dst: bif->bif_hf_hwsrc, |
| 3798 | ETHER_ADDR_LEN); |
| 3799 | if (bcmp(s1: req->ifbrhf_hwsrca, s2: ethernulladdr, |
| 3800 | ETHER_ADDR_LEN) != 0) { |
| 3801 | bif->bif_flags |= BIFF_HF_HWSRC; |
| 3802 | } else { |
| 3803 | bif->bif_flags &= ~BIFF_HF_HWSRC; |
| 3804 | } |
| 3805 | } |
| 3806 | if (req->ifbrhf_flags & IFBRHF_IPSRC) { |
| 3807 | bif->bif_hf_ipsrc.s_addr = req->ifbrhf_ipsrc; |
| 3808 | if (bif->bif_hf_ipsrc.s_addr != INADDR_ANY) { |
| 3809 | bif->bif_flags |= BIFF_HF_IPSRC; |
| 3810 | } else { |
| 3811 | bif->bif_flags &= ~BIFF_HF_IPSRC; |
| 3812 | } |
| 3813 | } |
| 3814 | } else { |
| 3815 | bif->bif_flags &= ~(BIFF_HOST_FILTER | BIFF_HF_HWSRC | |
| 3816 | BIFF_HF_IPSRC); |
| 3817 | bzero(s: bif->bif_hf_hwsrc, ETHER_ADDR_LEN); |
| 3818 | bif->bif_hf_ipsrc.s_addr = INADDR_ANY; |
| 3819 | } |
| 3820 | |
| 3821 | return 0; |
| 3822 | } |
| 3823 | |
| 3824 | static char * |
| 3825 | bridge_mac_nat_entry_out(struct mac_nat_entry_list * list, |
| 3826 | unsigned int * count_p, char *buf, unsigned int *len_p) |
| 3827 | { |
| 3828 | unsigned int count = *count_p; |
| 3829 | struct ifbrmne ifbmne; |
| 3830 | unsigned int len = *len_p; |
| 3831 | struct mac_nat_entry *mne; |
| 3832 | unsigned long now; |
| 3833 | |
| 3834 | bzero(s: &ifbmne, n: sizeof(ifbmne)); |
| 3835 | LIST_FOREACH(mne, list, mne_list) { |
| 3836 | if (len < sizeof(ifbmne)) { |
| 3837 | break; |
| 3838 | } |
| 3839 | snprintf(ifbmne.ifbmne_ifname, count: sizeof(ifbmne.ifbmne_ifname), |
| 3840 | "%s" , mne->mne_bif->bif_ifp->if_xname); |
| 3841 | memcpy(dst: ifbmne.ifbmne_mac, src: mne->mne_mac, |
| 3842 | n: sizeof(ifbmne.ifbmne_mac)); |
| 3843 | now = (unsigned long) net_uptime(); |
| 3844 | if (now < mne->mne_expire) { |
| 3845 | ifbmne.ifbmne_expire = mne->mne_expire - now; |
| 3846 | } else { |
| 3847 | ifbmne.ifbmne_expire = 0; |
| 3848 | } |
| 3849 | if ((mne->mne_flags & MNE_FLAGS_IPV6) != 0) { |
| 3850 | ifbmne.ifbmne_af = AF_INET6; |
| 3851 | ifbmne.ifbmne_ip6_addr = mne->mne_ip6; |
| 3852 | } else { |
| 3853 | ifbmne.ifbmne_af = AF_INET; |
| 3854 | ifbmne.ifbmne_ip_addr = mne->mne_ip; |
| 3855 | } |
| 3856 | memcpy(dst: buf, src: &ifbmne, n: sizeof(ifbmne)); |
| 3857 | count++; |
| 3858 | buf += sizeof(ifbmne); |
| 3859 | len -= sizeof(ifbmne); |
| 3860 | } |
| 3861 | *count_p = count; |
| 3862 | *len_p = len; |
| 3863 | return buf; |
| 3864 | } |
| 3865 | |
| 3866 | /* |
| 3867 | * bridge_ioctl_gmnelist() |
| 3868 | * Perform the get mac_nat_entry list ioctl. |
| 3869 | * |
| 3870 | * Note: |
| 3871 | * The struct ifbrmnelist32 and struct ifbrmnelist64 have the same |
| 3872 | * field size/layout except for the last field ifbml_buf, the user-supplied |
| 3873 | * buffer pointer. That is passed in separately via the 'user_addr' |
| 3874 | * parameter from the respective 32-bit or 64-bit ioctl routine. |
| 3875 | */ |
| 3876 | static int |
| 3877 | bridge_ioctl_gmnelist(struct bridge_softc *sc, struct ifbrmnelist32 *mnl, |
| 3878 | user_addr_t user_addr) |
| 3879 | { |
| 3880 | unsigned int count; |
| 3881 | char *buf; |
| 3882 | int error = 0; |
| 3883 | char *outbuf = NULL; |
| 3884 | struct mac_nat_entry *mne; |
| 3885 | unsigned int buflen; |
| 3886 | unsigned int len; |
| 3887 | |
| 3888 | mnl->ifbml_elsize = sizeof(struct ifbrmne); |
| 3889 | count = 0; |
| 3890 | LIST_FOREACH(mne, &sc->sc_mne_list, mne_list) { |
| 3891 | count++; |
| 3892 | } |
| 3893 | LIST_FOREACH(mne, &sc->sc_mne_list_v6, mne_list) { |
| 3894 | count++; |
| 3895 | } |
| 3896 | buflen = sizeof(struct ifbrmne) * count; |
| 3897 | if (buflen == 0 || mnl->ifbml_len == 0) { |
| 3898 | mnl->ifbml_len = buflen; |
| 3899 | return error; |
| 3900 | } |
| 3901 | BRIDGE_UNLOCK(sc); |
| 3902 | outbuf = (char *)kalloc_data(buflen, Z_WAITOK | Z_ZERO); |
| 3903 | BRIDGE_LOCK(sc); |
| 3904 | count = 0; |
| 3905 | buf = outbuf; |
| 3906 | len = min(a: mnl->ifbml_len, b: buflen); |
| 3907 | buf = bridge_mac_nat_entry_out(list: &sc->sc_mne_list, count_p: &count, buf, len_p: &len); |
| 3908 | buf = bridge_mac_nat_entry_out(list: &sc->sc_mne_list_v6, count_p: &count, buf, len_p: &len); |
| 3909 | mnl->ifbml_len = count * sizeof(struct ifbrmne); |
| 3910 | BRIDGE_UNLOCK(sc); |
| 3911 | error = copyout(outbuf, user_addr, mnl->ifbml_len); |
| 3912 | kfree_data(outbuf, buflen); |
| 3913 | BRIDGE_LOCK(sc); |
| 3914 | return error; |
| 3915 | } |
| 3916 | |
| 3917 | static int |
| 3918 | bridge_ioctl_gmnelist64(struct bridge_softc *sc, void *arg) |
| 3919 | { |
| 3920 | struct ifbrmnelist64 *mnl = arg; |
| 3921 | |
| 3922 | return bridge_ioctl_gmnelist(sc, mnl: arg, user_addr: mnl->ifbml_buf); |
| 3923 | } |
| 3924 | |
| 3925 | static int |
| 3926 | bridge_ioctl_gmnelist32(struct bridge_softc *sc, void *arg) |
| 3927 | { |
| 3928 | struct ifbrmnelist32 *mnl = arg; |
| 3929 | |
| 3930 | return bridge_ioctl_gmnelist(sc, mnl: arg, |
| 3931 | CAST_USER_ADDR_T(mnl->ifbml_buf)); |
| 3932 | } |
| 3933 | |
| 3934 | /* |
| 3935 | * bridge_ioctl_gifstats() |
| 3936 | * Return per-member stats. |
| 3937 | * |
| 3938 | * Note: |
| 3939 | * The ifbrmreq32 and ifbrmreq64 structures have the same |
| 3940 | * field size/layout except for the last field brmr_buf, the user-supplied |
| 3941 | * buffer pointer. That is passed in separately via the 'user_addr' |
| 3942 | * parameter from the respective 32-bit or 64-bit ioctl routine. |
| 3943 | */ |
| 3944 | static int |
| 3945 | bridge_ioctl_gifstats(struct bridge_softc *sc, struct ifbrmreq32 *mreq, |
| 3946 | user_addr_t user_addr) |
| 3947 | { |
| 3948 | struct bridge_iflist *bif; |
| 3949 | int error = 0; |
| 3950 | unsigned int buflen; |
| 3951 | |
| 3952 | bif = bridge_lookup_member(sc, name: mreq->brmr_ifname); |
| 3953 | if (bif == NULL) { |
| 3954 | error = ENOENT; |
| 3955 | goto done; |
| 3956 | } |
| 3957 | |
| 3958 | buflen = mreq->brmr_elsize = sizeof(struct ifbrmstats); |
| 3959 | if (buflen == 0 || mreq->brmr_len == 0) { |
| 3960 | mreq->brmr_len = buflen; |
| 3961 | goto done; |
| 3962 | } |
| 3963 | if (mreq->brmr_len != 0 && mreq->brmr_len < buflen) { |
| 3964 | error = ENOBUFS; |
| 3965 | goto done; |
| 3966 | } |
| 3967 | mreq->brmr_len = buflen; |
| 3968 | error = copyout(&bif->bif_stats, user_addr, buflen); |
| 3969 | done: |
| 3970 | return error; |
| 3971 | } |
| 3972 | |
| 3973 | static int |
| 3974 | bridge_ioctl_gifstats32(struct bridge_softc *sc, void *arg) |
| 3975 | { |
| 3976 | struct ifbrmreq32 *mreq = arg; |
| 3977 | |
| 3978 | return bridge_ioctl_gifstats(sc, mreq: arg, user_addr: mreq->brmr_buf); |
| 3979 | } |
| 3980 | |
| 3981 | static int |
| 3982 | bridge_ioctl_gifstats64(struct bridge_softc *sc, void *arg) |
| 3983 | { |
| 3984 | struct ifbrmreq64 *mreq = arg; |
| 3985 | |
| 3986 | return bridge_ioctl_gifstats(sc, mreq: arg, user_addr: mreq->brmr_buf); |
| 3987 | } |
| 3988 | |
| 3989 | /* |
| 3990 | * bridge_proto_attach_changed |
| 3991 | * |
| 3992 | * Called when protocol attachment on the interface changes. |
| 3993 | */ |
| 3994 | static void |
| 3995 | bridge_proto_attach_changed(struct ifnet *ifp) |
| 3996 | { |
| 3997 | boolean_t changed = FALSE; |
| 3998 | struct bridge_iflist *bif; |
| 3999 | boolean_t input_broadcast; |
| 4000 | struct bridge_softc *sc = ifp->if_bridge; |
| 4001 | |
| 4002 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, "%s" , ifp->if_xname); |
| 4003 | if (sc == NULL) { |
| 4004 | return; |
| 4005 | } |
| 4006 | input_broadcast = interface_needs_input_broadcast(ifp); |
| 4007 | BRIDGE_LOCK(sc); |
| 4008 | bif = bridge_lookup_member_if(sc, member_ifp: ifp); |
| 4009 | if (bif != NULL) { |
| 4010 | changed = bif_set_input_broadcast(bif, input_broadcast); |
| 4011 | } |
| 4012 | BRIDGE_UNLOCK(sc); |
| 4013 | if (changed) { |
| 4014 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, |
| 4015 | "%s input broadcast %s" , ifp->if_xname, |
| 4016 | input_broadcast ? "ENABLED" : "DISABLED" ); |
| 4017 | } |
| 4018 | return; |
| 4019 | } |
| 4020 | |
| 4021 | /* |
| 4022 | * interface_media_active: |
| 4023 | * |
| 4024 | * Tells if an interface media is active. |
| 4025 | */ |
| 4026 | static int |
| 4027 | interface_media_active(struct ifnet *ifp) |
| 4028 | { |
| 4029 | struct ifmediareq ifmr; |
| 4030 | int status = 0; |
| 4031 | |
| 4032 | bzero(s: &ifmr, n: sizeof(ifmr)); |
| 4033 | if (ifnet_ioctl(interface: ifp, protocol: 0, SIOCGIFMEDIA, ioctl_arg: &ifmr) == 0) { |
| 4034 | if ((ifmr.ifm_status & IFM_AVALID) && ifmr.ifm_count > 0) { |
| 4035 | status = ifmr.ifm_status & IFM_ACTIVE ? 1 : 0; |
| 4036 | } |
| 4037 | } |
| 4038 | |
| 4039 | return status; |
| 4040 | } |
| 4041 | |
| 4042 | /* |
| 4043 | * bridge_updatelinkstatus: |
| 4044 | * |
| 4045 | * Update the media active status of the bridge based on the |
| 4046 | * media active status of its member. |
| 4047 | * If changed, return the corresponding onf/off link event. |
| 4048 | */ |
| 4049 | static u_int32_t |
| 4050 | bridge_updatelinkstatus(struct bridge_softc *sc) |
| 4051 | { |
| 4052 | struct bridge_iflist *bif; |
| 4053 | int active_member = 0; |
| 4054 | u_int32_t event_code = 0; |
| 4055 | |
| 4056 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 4057 | |
| 4058 | /* |
| 4059 | * Find out if we have an active interface |
| 4060 | */ |
| 4061 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { |
| 4062 | if (bif->bif_flags & BIFF_MEDIA_ACTIVE) { |
| 4063 | active_member = 1; |
| 4064 | break; |
| 4065 | } |
| 4066 | } |
| 4067 | |
| 4068 | if (active_member && !(sc->sc_flags & SCF_MEDIA_ACTIVE)) { |
| 4069 | sc->sc_flags |= SCF_MEDIA_ACTIVE; |
| 4070 | event_code = KEV_DL_LINK_ON; |
| 4071 | } else if (!active_member && (sc->sc_flags & SCF_MEDIA_ACTIVE)) { |
| 4072 | sc->sc_flags &= ~SCF_MEDIA_ACTIVE; |
| 4073 | event_code = KEV_DL_LINK_OFF; |
| 4074 | } |
| 4075 | |
| 4076 | return event_code; |
| 4077 | } |
| 4078 | |
| 4079 | /* |
| 4080 | * bridge_iflinkevent: |
| 4081 | */ |
| 4082 | static void |
| 4083 | bridge_iflinkevent(struct ifnet *ifp) |
| 4084 | { |
| 4085 | struct bridge_softc *sc = ifp->if_bridge; |
| 4086 | struct bridge_iflist *bif; |
| 4087 | u_int32_t event_code = 0; |
| 4088 | int media_active; |
| 4089 | |
| 4090 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, "%s" , ifp->if_xname); |
| 4091 | |
| 4092 | /* Check if the interface is a bridge member */ |
| 4093 | if (sc == NULL) { |
| 4094 | return; |
| 4095 | } |
| 4096 | |
| 4097 | media_active = interface_media_active(ifp); |
| 4098 | BRIDGE_LOCK(sc); |
| 4099 | bif = bridge_lookup_member_if(sc, member_ifp: ifp); |
| 4100 | if (bif != NULL) { |
| 4101 | if (media_active) { |
| 4102 | bif->bif_flags |= BIFF_MEDIA_ACTIVE; |
| 4103 | } else { |
| 4104 | bif->bif_flags &= ~BIFF_MEDIA_ACTIVE; |
| 4105 | } |
| 4106 | if (sc->sc_mac_nat_bif != NULL) { |
| 4107 | bridge_mac_nat_flush_entries(sc, bif); |
| 4108 | } |
| 4109 | |
| 4110 | event_code = bridge_updatelinkstatus(sc); |
| 4111 | } |
| 4112 | BRIDGE_UNLOCK(sc); |
| 4113 | |
| 4114 | if (event_code != 0) { |
| 4115 | bridge_link_event(sc->sc_ifp, event_code); |
| 4116 | } |
| 4117 | } |
| 4118 | |
| 4119 | /* |
| 4120 | * bridge_delayed_callback: |
| 4121 | * |
| 4122 | * Makes a delayed call |
| 4123 | */ |
| 4124 | static void |
| 4125 | bridge_delayed_callback(void *param, __unused void *param2) |
| 4126 | { |
| 4127 | struct bridge_delayed_call *call = (struct bridge_delayed_call *)param; |
| 4128 | struct bridge_softc *sc = call->bdc_sc; |
| 4129 | |
| 4130 | #if BRIDGE_DELAYED_CALLBACK_DEBUG |
| 4131 | if (bridge_delayed_callback_delay > 0) { |
| 4132 | struct timespec ts; |
| 4133 | |
| 4134 | ts.tv_sec = bridge_delayed_callback_delay; |
| 4135 | ts.tv_nsec = 0; |
| 4136 | |
| 4137 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 4138 | "sleeping for %d seconds" , |
| 4139 | bridge_delayed_callback_delay); |
| 4140 | |
| 4141 | msleep(&bridge_delayed_callback_delay, NULL, PZERO, |
| 4142 | __func__, &ts); |
| 4143 | |
| 4144 | BRIDGE_LOG(LOG_NOTICE, 0, "awoken" ); |
| 4145 | } |
| 4146 | #endif /* BRIDGE_DELAYED_CALLBACK_DEBUG */ |
| 4147 | |
| 4148 | BRIDGE_LOCK(sc); |
| 4149 | |
| 4150 | #if BRIDGE_DELAYED_CALLBACK_DEBUG |
| 4151 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_DELAYED_CALL, |
| 4152 | "%s call 0x%llx flags 0x%x" , |
| 4153 | sc->sc_if_xname, (uint64_t)VM_KERNEL_ADDRPERM(call), |
| 4154 | call->bdc_flags); |
| 4155 | } |
| 4156 | #endif /* BRIDGE_DELAYED_CALLBACK_DEBUG */ |
| 4157 | |
| 4158 | if (call->bdc_flags & BDCF_CANCELLING) { |
| 4159 | wakeup(chan: call); |
| 4160 | } else { |
| 4161 | if ((sc->sc_flags & SCF_DETACHING) == 0) { |
| 4162 | (*call->bdc_func)(sc); |
| 4163 | } |
| 4164 | } |
| 4165 | call->bdc_flags &= ~BDCF_OUTSTANDING; |
| 4166 | BRIDGE_UNLOCK(sc); |
| 4167 | } |
| 4168 | |
| 4169 | /* |
| 4170 | * bridge_schedule_delayed_call: |
| 4171 | * |
| 4172 | * Schedule a function to be called on a separate thread |
| 4173 | * The actual call may be scheduled to run at a given time or ASAP. |
| 4174 | */ |
| 4175 | static void |
| 4176 | bridge_schedule_delayed_call(struct bridge_delayed_call *call) |
| 4177 | { |
| 4178 | uint64_t deadline = 0; |
| 4179 | struct bridge_softc *sc = call->bdc_sc; |
| 4180 | |
| 4181 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 4182 | |
| 4183 | if ((sc->sc_flags & SCF_DETACHING) || |
| 4184 | (call->bdc_flags & (BDCF_OUTSTANDING | BDCF_CANCELLING))) { |
| 4185 | return; |
| 4186 | } |
| 4187 | |
| 4188 | if (call->bdc_ts.tv_sec || call->bdc_ts.tv_nsec) { |
| 4189 | nanoseconds_to_absolutetime( |
| 4190 | nanoseconds: (uint64_t)call->bdc_ts.tv_sec * NSEC_PER_SEC + |
| 4191 | call->bdc_ts.tv_nsec, result: &deadline); |
| 4192 | clock_absolutetime_interval_to_deadline(abstime: deadline, result: &deadline); |
| 4193 | } |
| 4194 | |
| 4195 | call->bdc_flags = BDCF_OUTSTANDING; |
| 4196 | |
| 4197 | #if BRIDGE_DELAYED_CALLBACK_DEBUG |
| 4198 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_DELAYED_CALL, |
| 4199 | "%s call 0x%llx flags 0x%x" , |
| 4200 | sc->sc_if_xname, (uint64_t)VM_KERNEL_ADDRPERM(call), |
| 4201 | call->bdc_flags); |
| 4202 | } |
| 4203 | #endif /* BRIDGE_DELAYED_CALLBACK_DEBUG */ |
| 4204 | |
| 4205 | if (call->bdc_ts.tv_sec || call->bdc_ts.tv_nsec) { |
| 4206 | thread_call_func_delayed( |
| 4207 | func: (thread_call_func_t)bridge_delayed_callback, |
| 4208 | param: call, deadline); |
| 4209 | } else { |
| 4210 | if (call->bdc_thread_call == NULL) { |
| 4211 | call->bdc_thread_call = thread_call_allocate( |
| 4212 | func: (thread_call_func_t)bridge_delayed_callback, |
| 4213 | param0: call); |
| 4214 | } |
| 4215 | thread_call_enter(call: call->bdc_thread_call); |
| 4216 | } |
| 4217 | } |
| 4218 | |
| 4219 | /* |
| 4220 | * bridge_cancel_delayed_call: |
| 4221 | * |
| 4222 | * Cancel a queued or running delayed call. |
| 4223 | * If call is running, does not return until the call is done to |
| 4224 | * prevent race condition with the brigde interface getting destroyed |
| 4225 | */ |
| 4226 | static void |
| 4227 | bridge_cancel_delayed_call(struct bridge_delayed_call *call) |
| 4228 | { |
| 4229 | boolean_t result; |
| 4230 | struct bridge_softc *sc = call->bdc_sc; |
| 4231 | |
| 4232 | /* |
| 4233 | * The call was never scheduled |
| 4234 | */ |
| 4235 | if (sc == NULL) { |
| 4236 | return; |
| 4237 | } |
| 4238 | |
| 4239 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 4240 | |
| 4241 | call->bdc_flags |= BDCF_CANCELLING; |
| 4242 | |
| 4243 | while (call->bdc_flags & BDCF_OUTSTANDING) { |
| 4244 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_DELAYED_CALL, |
| 4245 | "%s call 0x%llx flags 0x%x" , |
| 4246 | sc->sc_if_xname, (uint64_t)VM_KERNEL_ADDRPERM(call), |
| 4247 | call->bdc_flags); |
| 4248 | result = thread_call_func_cancel( |
| 4249 | func: (thread_call_func_t)bridge_delayed_callback, param: call, FALSE); |
| 4250 | |
| 4251 | if (result) { |
| 4252 | /* |
| 4253 | * We managed to dequeue the delayed call |
| 4254 | */ |
| 4255 | call->bdc_flags &= ~BDCF_OUTSTANDING; |
| 4256 | } else { |
| 4257 | /* |
| 4258 | * Wait for delayed call do be done running |
| 4259 | */ |
| 4260 | msleep(chan: call, mtx: &sc->sc_mtx, PZERO, wmesg: __func__, NULL); |
| 4261 | } |
| 4262 | } |
| 4263 | call->bdc_flags &= ~BDCF_CANCELLING; |
| 4264 | } |
| 4265 | |
| 4266 | /* |
| 4267 | * bridge_cleanup_delayed_call: |
| 4268 | * |
| 4269 | * Dispose resource allocated for a delayed call |
| 4270 | * Assume the delayed call is not queued or running . |
| 4271 | */ |
| 4272 | static void |
| 4273 | bridge_cleanup_delayed_call(struct bridge_delayed_call *call) |
| 4274 | { |
| 4275 | boolean_t result; |
| 4276 | struct bridge_softc *sc = call->bdc_sc; |
| 4277 | |
| 4278 | /* |
| 4279 | * The call was never scheduled |
| 4280 | */ |
| 4281 | if (sc == NULL) { |
| 4282 | return; |
| 4283 | } |
| 4284 | |
| 4285 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 4286 | |
| 4287 | VERIFY((call->bdc_flags & BDCF_OUTSTANDING) == 0); |
| 4288 | VERIFY((call->bdc_flags & BDCF_CANCELLING) == 0); |
| 4289 | |
| 4290 | if (call->bdc_thread_call != NULL) { |
| 4291 | result = thread_call_free(call: call->bdc_thread_call); |
| 4292 | if (result == FALSE) { |
| 4293 | panic("%s thread_call_free() failed for call %p" , |
| 4294 | __func__, call); |
| 4295 | } |
| 4296 | call->bdc_thread_call = NULL; |
| 4297 | } |
| 4298 | } |
| 4299 | |
| 4300 | /* |
| 4301 | * bridge_init: |
| 4302 | * |
| 4303 | * Initialize a bridge interface. |
| 4304 | */ |
| 4305 | static int |
| 4306 | bridge_init(struct ifnet *ifp) |
| 4307 | { |
| 4308 | struct bridge_softc *sc = (struct bridge_softc *)ifp->if_softc; |
| 4309 | errno_t error; |
| 4310 | |
| 4311 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 4312 | |
| 4313 | if ((ifnet_flags(interface: ifp) & IFF_RUNNING)) { |
| 4314 | return 0; |
| 4315 | } |
| 4316 | |
| 4317 | error = ifnet_set_flags(interface: ifp, IFF_RUNNING, IFF_RUNNING); |
| 4318 | |
| 4319 | /* |
| 4320 | * Calling bridge_aging_timer() is OK as there are no entries to |
| 4321 | * age so we're just going to arm the timer |
| 4322 | */ |
| 4323 | bridge_aging_timer(sc); |
| 4324 | #if BRIDGESTP |
| 4325 | if (error == 0) { |
| 4326 | bstp_init(&sc->sc_stp); /* Initialize Spanning Tree */ |
| 4327 | } |
| 4328 | #endif /* BRIDGESTP */ |
| 4329 | return error; |
| 4330 | } |
| 4331 | |
| 4332 | /* |
| 4333 | * bridge_ifstop: |
| 4334 | * |
| 4335 | * Stop the bridge interface. |
| 4336 | */ |
| 4337 | static void |
| 4338 | bridge_ifstop(struct ifnet *ifp, int disable) |
| 4339 | { |
| 4340 | #pragma unused(disable) |
| 4341 | struct bridge_softc *sc = ifp->if_softc; |
| 4342 | |
| 4343 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 4344 | |
| 4345 | if ((ifnet_flags(interface: ifp) & IFF_RUNNING) == 0) { |
| 4346 | return; |
| 4347 | } |
| 4348 | |
| 4349 | bridge_cancel_delayed_call(call: &sc->sc_aging_timer); |
| 4350 | |
| 4351 | #if BRIDGESTP |
| 4352 | bstp_stop(&sc->sc_stp); |
| 4353 | #endif /* BRIDGESTP */ |
| 4354 | |
| 4355 | bridge_rtflush(sc, IFBF_FLUSHDYN); |
| 4356 | (void) ifnet_set_flags(interface: ifp, new_flags: 0, IFF_RUNNING); |
| 4357 | } |
| 4358 | |
| 4359 | /* |
| 4360 | * bridge_compute_cksum: |
| 4361 | * |
| 4362 | * If the packet has checksum flags, compare the hardware checksum |
| 4363 | * capabilities of the source and destination interfaces. If they |
| 4364 | * are the same, there's nothing to do. If they are different, |
| 4365 | * finalize the checksum so that it can be sent on the destination |
| 4366 | * interface. |
| 4367 | */ |
| 4368 | static void |
| 4369 | bridge_compute_cksum(struct ifnet *src_if, struct ifnet *dst_if, struct mbuf *m) |
| 4370 | { |
| 4371 | uint32_t csum_flags; |
| 4372 | uint16_t dst_hw_csum; |
| 4373 | uint32_t did_sw = 0; |
| 4374 | struct ether_header *eh; |
| 4375 | uint16_t src_hw_csum; |
| 4376 | |
| 4377 | if (src_if == dst_if) { |
| 4378 | return; |
| 4379 | } |
| 4380 | csum_flags = m->m_pkthdr.csum_flags & IF_HWASSIST_CSUM_MASK; |
| 4381 | if (csum_flags == 0) { |
| 4382 | /* no checksum offload */ |
| 4383 | return; |
| 4384 | } |
| 4385 | |
| 4386 | /* |
| 4387 | * if destination/source differ in checksum offload |
| 4388 | * capabilities, finalize/compute the checksum |
| 4389 | */ |
| 4390 | dst_hw_csum = IF_HWASSIST_CSUM_FLAGS(dst_if->if_hwassist); |
| 4391 | src_hw_csum = IF_HWASSIST_CSUM_FLAGS(src_if->if_hwassist); |
| 4392 | if (dst_hw_csum == src_hw_csum) { |
| 4393 | return; |
| 4394 | } |
| 4395 | eh = mtod(m, struct ether_header *); |
| 4396 | switch (ntohs(eh->ether_type)) { |
| 4397 | case ETHERTYPE_IP: |
| 4398 | did_sw = in_finalize_cksum(m, sizeof(*eh), csum_flags); |
| 4399 | break; |
| 4400 | case ETHERTYPE_IPV6: |
| 4401 | did_sw = in6_finalize_cksum(m, sizeof(*eh), -1, -1, csum_flags); |
| 4402 | break; |
| 4403 | } |
| 4404 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4405 | "[%s -> %s] before 0x%x did 0x%x after 0x%x" , |
| 4406 | src_if->if_xname, dst_if->if_xname, csum_flags, did_sw, |
| 4407 | m->m_pkthdr.csum_flags); |
| 4408 | } |
| 4409 | |
| 4410 | static errno_t |
| 4411 | bridge_transmit(struct ifnet * ifp, struct mbuf *m) |
| 4412 | { |
| 4413 | struct flowadv adv = { .code = FADV_SUCCESS }; |
| 4414 | errno_t error; |
| 4415 | |
| 4416 | error = dlil_output(ifp, 0, m, NULL, NULL, 1, &adv); |
| 4417 | if (error == 0) { |
| 4418 | if (adv.code == FADV_FLOW_CONTROLLED) { |
| 4419 | error = EQFULL; |
| 4420 | } else if (adv.code == FADV_SUSPENDED) { |
| 4421 | error = EQSUSPENDED; |
| 4422 | } |
| 4423 | } |
| 4424 | return error; |
| 4425 | } |
| 4426 | |
| 4427 | static int |
| 4428 | get_last_ip6_hdr(struct mbuf *m, int off, int proto, int * nxtp, |
| 4429 | bool *is_fragmented) |
| 4430 | { |
| 4431 | int newoff; |
| 4432 | |
| 4433 | *is_fragmented = false; |
| 4434 | while (1) { |
| 4435 | newoff = ip6_nexthdr(m, off, proto, nxtp); |
| 4436 | if (newoff < 0) { |
| 4437 | return off; |
| 4438 | } else if (newoff < off) { |
| 4439 | return -1; /* invalid */ |
| 4440 | } else if (newoff == off) { |
| 4441 | return newoff; |
| 4442 | } |
| 4443 | off = newoff; |
| 4444 | proto = *nxtp; |
| 4445 | if (proto == IPPROTO_FRAGMENT) { |
| 4446 | *is_fragmented = true; |
| 4447 | } |
| 4448 | } |
| 4449 | } |
| 4450 | |
| 4451 | static int |
| 4452 | bridge_get_ip_proto(struct mbuf * * mp, u_int mac_hlen, bool is_ipv4, |
| 4453 | ip_packet_info_t info_p, struct bripstats * stats_p) |
| 4454 | { |
| 4455 | int error = 0; |
| 4456 | u_int hlen; |
| 4457 | u_int ip_hlen; |
| 4458 | u_int ip_pay_len; |
| 4459 | struct mbuf * m0 = *mp; |
| 4460 | int off; |
| 4461 | int opt_len = 0; |
| 4462 | int proto = 0; |
| 4463 | |
| 4464 | bzero(s: info_p, n: sizeof(*info_p)); |
| 4465 | if (is_ipv4) { |
| 4466 | struct ip * ip; |
| 4467 | u_int ip_total_len; |
| 4468 | |
| 4469 | /* IPv4 */ |
| 4470 | hlen = mac_hlen + sizeof(struct ip); |
| 4471 | if (m0->m_pkthdr.len < hlen) { |
| 4472 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4473 | "Short IP packet %d < %d" , |
| 4474 | m0->m_pkthdr.len, hlen); |
| 4475 | error = _EBADIP; |
| 4476 | stats_p->bips_bad_ip++; |
| 4477 | goto done; |
| 4478 | } |
| 4479 | if (m0->m_len < hlen) { |
| 4480 | *mp = m0 = m_pullup(m0, hlen); |
| 4481 | if (m0 == NULL) { |
| 4482 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4483 | "m_pullup failed hlen %d" , |
| 4484 | hlen); |
| 4485 | error = ENOBUFS; |
| 4486 | stats_p->bips_bad_ip++; |
| 4487 | goto done; |
| 4488 | } |
| 4489 | } |
| 4490 | ip = (struct ip *)(void *)(mtod(m0, uint8_t *) + mac_hlen); |
| 4491 | if (IP_VHL_V(ip->ip_vhl) != IPVERSION) { |
| 4492 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4493 | "bad IP version" ); |
| 4494 | error = _EBADIP; |
| 4495 | stats_p->bips_bad_ip++; |
| 4496 | goto done; |
| 4497 | } |
| 4498 | ip_hlen = IP_VHL_HL(ip->ip_vhl) << 2; |
| 4499 | if (ip_hlen < sizeof(struct ip)) { |
| 4500 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4501 | "bad IP header length %d < %d" , |
| 4502 | ip_hlen, |
| 4503 | (int)sizeof(struct ip)); |
| 4504 | error = _EBADIP; |
| 4505 | stats_p->bips_bad_ip++; |
| 4506 | goto done; |
| 4507 | } |
| 4508 | hlen = mac_hlen + ip_hlen; |
| 4509 | if (m0->m_len < hlen) { |
| 4510 | *mp = m0 = m_pullup(m0, hlen); |
| 4511 | if (m0 == NULL) { |
| 4512 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4513 | "m_pullup failed hlen %d" , |
| 4514 | hlen); |
| 4515 | error = ENOBUFS; |
| 4516 | stats_p->bips_bad_ip++; |
| 4517 | goto done; |
| 4518 | } |
| 4519 | } |
| 4520 | |
| 4521 | ip_total_len = ntohs(ip->ip_len); |
| 4522 | if (ip_total_len < ip_hlen) { |
| 4523 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4524 | "IP total len %d < header len %d" , |
| 4525 | ip_total_len, ip_hlen); |
| 4526 | error = _EBADIP; |
| 4527 | stats_p->bips_bad_ip++; |
| 4528 | goto done; |
| 4529 | } |
| 4530 | if (ip_total_len > (m0->m_pkthdr.len - mac_hlen)) { |
| 4531 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4532 | "invalid IP payload length %d > %d" , |
| 4533 | ip_total_len, |
| 4534 | (m0->m_pkthdr.len - mac_hlen)); |
| 4535 | error = _EBADIP; |
| 4536 | stats_p->bips_bad_ip++; |
| 4537 | goto done; |
| 4538 | } |
| 4539 | ip_pay_len = ip_total_len - ip_hlen; |
| 4540 | info_p->ip_proto = ip->ip_p; |
| 4541 | info_p->ip_hdr.ip = ip; |
| 4542 | #define FRAG_BITS (IP_OFFMASK | IP_MF) |
| 4543 | if ((ntohs(ip->ip_off) & FRAG_BITS) != 0) { |
| 4544 | info_p->ip_is_fragmented = true; |
| 4545 | } |
| 4546 | stats_p->bips_ip++; |
| 4547 | } else { |
| 4548 | struct ip6_hdr *ip6; |
| 4549 | |
| 4550 | /* IPv6 */ |
| 4551 | hlen = mac_hlen + sizeof(struct ip6_hdr); |
| 4552 | if (m0->m_pkthdr.len < hlen) { |
| 4553 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4554 | "short IPv6 packet %d < %d" , |
| 4555 | m0->m_pkthdr.len, hlen); |
| 4556 | error = _EBADIPV6; |
| 4557 | stats_p->bips_bad_ip6++; |
| 4558 | goto done; |
| 4559 | } |
| 4560 | if (m0->m_len < hlen) { |
| 4561 | *mp = m0 = m_pullup(m0, hlen); |
| 4562 | if (m0 == NULL) { |
| 4563 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4564 | "m_pullup failed hlen %d" , |
| 4565 | hlen); |
| 4566 | error = ENOBUFS; |
| 4567 | stats_p->bips_bad_ip6++; |
| 4568 | goto done; |
| 4569 | } |
| 4570 | } |
| 4571 | ip6 = (struct ip6_hdr *)(mtod(m0, uint8_t *) + mac_hlen); |
| 4572 | if ((ip6->ip6_vfc & IPV6_VERSION_MASK) != IPV6_VERSION) { |
| 4573 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4574 | "bad IPv6 version" ); |
| 4575 | error = _EBADIPV6; |
| 4576 | stats_p->bips_bad_ip6++; |
| 4577 | goto done; |
| 4578 | } |
| 4579 | off = get_last_ip6_hdr(m: m0, off: mac_hlen, IPPROTO_IPV6, nxtp: &proto, |
| 4580 | is_fragmented: &info_p->ip_is_fragmented); |
| 4581 | if (off < 0 || m0->m_pkthdr.len < off) { |
| 4582 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4583 | "ip6_lasthdr() returned %d" , |
| 4584 | off); |
| 4585 | error = _EBADIPV6; |
| 4586 | stats_p->bips_bad_ip6++; |
| 4587 | goto done; |
| 4588 | } |
| 4589 | ip_hlen = sizeof(*ip6); |
| 4590 | opt_len = off - mac_hlen - ip_hlen; |
| 4591 | if (opt_len < 0) { |
| 4592 | error = _EBADIPV6; |
| 4593 | stats_p->bips_bad_ip6++; |
| 4594 | goto done; |
| 4595 | } |
| 4596 | info_p->ip_proto = proto; |
| 4597 | info_p->ip_hdr.ip6 = ip6; |
| 4598 | ip_pay_len = ntohs(ip6->ip6_plen); |
| 4599 | if (ip_pay_len > (m0->m_pkthdr.len - mac_hlen - ip_hlen)) { |
| 4600 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4601 | "invalid IPv6 payload length %d > %d" , |
| 4602 | ip_pay_len, |
| 4603 | (m0->m_pkthdr.len - mac_hlen - ip_hlen)); |
| 4604 | error = _EBADIPV6; |
| 4605 | stats_p->bips_bad_ip6++; |
| 4606 | goto done; |
| 4607 | } |
| 4608 | stats_p->bips_ip6++; |
| 4609 | } |
| 4610 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4611 | "IPv%c proto %d ip %u pay %u opt %u pkt %u%s" , |
| 4612 | is_ipv4 ? '4' : '6', |
| 4613 | proto, ip_hlen, ip_pay_len, opt_len, |
| 4614 | m0->m_pkthdr.len, info_p->ip_is_fragmented ? " frag" : "" ); |
| 4615 | info_p->ip_hlen = ip_hlen; |
| 4616 | info_p->ip_pay_len = ip_pay_len; |
| 4617 | info_p->ip_opt_len = opt_len; |
| 4618 | info_p->ip_is_ipv4 = is_ipv4; |
| 4619 | done: |
| 4620 | return error; |
| 4621 | } |
| 4622 | |
| 4623 | static int |
| 4624 | (struct mbuf * * mp, u_int mac_hlen, bool is_ipv4, |
| 4625 | ip_packet_info_t info_p, struct bripstats * stats_p) |
| 4626 | { |
| 4627 | int error; |
| 4628 | u_int hlen; |
| 4629 | |
| 4630 | error = bridge_get_ip_proto(mp, mac_hlen, is_ipv4, info_p, stats_p); |
| 4631 | if (error != 0) { |
| 4632 | goto done; |
| 4633 | } |
| 4634 | if (info_p->ip_proto != IPPROTO_TCP) { |
| 4635 | /* not a TCP frame, not an error, just a bad guess */ |
| 4636 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4637 | "non-TCP (%d) IPv%c frame %d bytes" , |
| 4638 | info_p->ip_proto, is_ipv4 ? '4' : '6', |
| 4639 | (*mp)->m_pkthdr.len); |
| 4640 | goto done; |
| 4641 | } |
| 4642 | if (info_p->ip_is_fragmented) { |
| 4643 | /* both TSO and IP fragmentation don't make sense */ |
| 4644 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_CHECKSUM, |
| 4645 | "fragmented TSO packet?" ); |
| 4646 | stats_p->bips_bad_tcp++; |
| 4647 | error = _EBADTCP; |
| 4648 | goto done; |
| 4649 | } |
| 4650 | hlen = mac_hlen + info_p->ip_hlen + sizeof(struct tcphdr) + |
| 4651 | info_p->ip_opt_len; |
| 4652 | if ((*mp)->m_len < hlen) { |
| 4653 | *mp = m_pullup(*mp, hlen); |
| 4654 | if (*mp == NULL) { |
| 4655 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4656 | "m_pullup %d failed" , |
| 4657 | hlen); |
| 4658 | stats_p->bips_bad_tcp++; |
| 4659 | error = _EBADTCP; |
| 4660 | goto done; |
| 4661 | } |
| 4662 | } |
| 4663 | info_p->ip_proto_hdr = ((caddr_t)info_p->ip_hdr.ptr) + |
| 4664 | info_p->ip_hlen + info_p->ip_opt_len; |
| 4665 | done: |
| 4666 | return error; |
| 4667 | } |
| 4668 | |
| 4669 | static inline void |
| 4670 | proto_csum_stats_increment(uint8_t proto, struct brcsumstats * stats_p) |
| 4671 | { |
| 4672 | if (proto == IPPROTO_TCP) { |
| 4673 | stats_p->brcs_tcp_checksum++; |
| 4674 | } else { |
| 4675 | stats_p->brcs_udp_checksum++; |
| 4676 | } |
| 4677 | return; |
| 4678 | } |
| 4679 | |
| 4680 | static bool |
| 4681 | (struct ether_header * eh, bool *is_ipv4) |
| 4682 | { |
| 4683 | uint16_t ether_type; |
| 4684 | bool is_ip = TRUE; |
| 4685 | |
| 4686 | ether_type = ntohs(eh->ether_type); |
| 4687 | switch (ether_type) { |
| 4688 | case ETHERTYPE_IP: |
| 4689 | *is_ipv4 = TRUE; |
| 4690 | break; |
| 4691 | case ETHERTYPE_IPV6: |
| 4692 | *is_ipv4 = FALSE; |
| 4693 | break; |
| 4694 | default: |
| 4695 | is_ip = FALSE; |
| 4696 | break; |
| 4697 | } |
| 4698 | return is_ip; |
| 4699 | } |
| 4700 | |
| 4701 | static errno_t |
| 4702 | bridge_verify_checksum(struct mbuf * * mp, struct ifbrmstats *stats_p) |
| 4703 | { |
| 4704 | struct brcsumstats *csum_stats_p; |
| 4705 | struct ether_header *eh; |
| 4706 | errno_t error = 0; |
| 4707 | ip_packet_info info; |
| 4708 | bool is_ipv4; |
| 4709 | struct mbuf * m; |
| 4710 | u_int mac_hlen = sizeof(struct ether_header); |
| 4711 | uint16_t sum; |
| 4712 | bool valid; |
| 4713 | |
| 4714 | eh = mtod(*mp, struct ether_header *); |
| 4715 | if (!ether_header_type_is_ip(eh, is_ipv4: &is_ipv4)) { |
| 4716 | goto done; |
| 4717 | } |
| 4718 | error = bridge_get_ip_proto(mp, mac_hlen, is_ipv4, info_p: &info, |
| 4719 | stats_p: &stats_p->brms_out_ip); |
| 4720 | m = *mp; |
| 4721 | if (error != 0) { |
| 4722 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4723 | "bridge_get_ip_proto failed %d" , |
| 4724 | error); |
| 4725 | goto done; |
| 4726 | } |
| 4727 | if (is_ipv4) { |
| 4728 | if ((m->m_pkthdr.csum_flags & CSUM_IP_CHECKED) != 0) { |
| 4729 | /* hardware offloaded IP header checksum */ |
| 4730 | valid = (m->m_pkthdr.csum_flags & CSUM_IP_VALID) != 0; |
| 4731 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4732 | "IP checksum HW %svalid" , |
| 4733 | valid ? "" : "in" ); |
| 4734 | if (!valid) { |
| 4735 | stats_p->brms_out_cksum_bad_hw.brcs_ip_checksum++; |
| 4736 | error = _EBADIPCHECKSUM; |
| 4737 | goto done; |
| 4738 | } |
| 4739 | stats_p->brms_out_cksum_good_hw.brcs_ip_checksum++; |
| 4740 | } else { |
| 4741 | /* verify */ |
| 4742 | sum = inet_cksum(m, 0, mac_hlen, info.ip_hlen); |
| 4743 | valid = (sum == 0); |
| 4744 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4745 | "IP checksum SW %svalid" , |
| 4746 | valid ? "" : "in" ); |
| 4747 | if (!valid) { |
| 4748 | stats_p->brms_out_cksum_bad.brcs_ip_checksum++; |
| 4749 | error = _EBADIPCHECKSUM; |
| 4750 | goto done; |
| 4751 | } |
| 4752 | stats_p->brms_out_cksum_good.brcs_ip_checksum++; |
| 4753 | } |
| 4754 | } |
| 4755 | if (info.ip_is_fragmented) { |
| 4756 | /* can't verify checksum on fragmented packets */ |
| 4757 | goto done; |
| 4758 | } |
| 4759 | switch (info.ip_proto) { |
| 4760 | case IPPROTO_TCP: |
| 4761 | stats_p->brms_out_ip.bips_tcp++; |
| 4762 | break; |
| 4763 | case IPPROTO_UDP: |
| 4764 | stats_p->brms_out_ip.bips_udp++; |
| 4765 | break; |
| 4766 | default: |
| 4767 | goto done; |
| 4768 | } |
| 4769 | /* check for hardware offloaded UDP/TCP checksum */ |
| 4770 | #define HW_CSUM (CSUM_DATA_VALID | CSUM_PSEUDO_HDR) |
| 4771 | if ((m->m_pkthdr.csum_flags & HW_CSUM) == HW_CSUM) { |
| 4772 | /* checksum verified by hardware */ |
| 4773 | valid = (m->m_pkthdr.csum_rx_val == 0xffff); |
| 4774 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4775 | "IPv%c %s checksum HW 0x%x %svalid" , |
| 4776 | is_ipv4 ? '4' : '6', |
| 4777 | (info.ip_proto == IPPROTO_TCP) |
| 4778 | ? "TCP" : "UDP" , |
| 4779 | m->m_pkthdr.csum_data, |
| 4780 | valid ? "" : "in" ); |
| 4781 | if (!valid) { |
| 4782 | /* bad checksum */ |
| 4783 | csum_stats_p = &stats_p->brms_out_cksum_bad_hw; |
| 4784 | error = (info.ip_proto == IPPROTO_TCP) ? _EBADTCPCHECKSUM |
| 4785 | : _EBADTCPCHECKSUM; |
| 4786 | } else { |
| 4787 | /* good checksum */ |
| 4788 | csum_stats_p = &stats_p->brms_out_cksum_good_hw; |
| 4789 | } |
| 4790 | proto_csum_stats_increment(proto: info.ip_proto, stats_p: csum_stats_p); |
| 4791 | goto done; |
| 4792 | } |
| 4793 | m->m_data += mac_hlen; |
| 4794 | m->m_len -= mac_hlen; |
| 4795 | m->m_pkthdr.len -= mac_hlen; |
| 4796 | if (is_ipv4) { |
| 4797 | sum = inet_cksum(m, info.ip_proto, |
| 4798 | info.ip_hlen, |
| 4799 | info.ip_pay_len); |
| 4800 | } else { |
| 4801 | sum = inet6_cksum(m, info.ip_proto, |
| 4802 | info.ip_hlen + info.ip_opt_len, |
| 4803 | info.ip_pay_len - info.ip_opt_len); |
| 4804 | } |
| 4805 | valid = (sum == 0); |
| 4806 | if (valid) { |
| 4807 | csum_stats_p = &stats_p->brms_out_cksum_good; |
| 4808 | } else { |
| 4809 | csum_stats_p = &stats_p->brms_out_cksum_bad; |
| 4810 | error = (info.ip_proto == IPPROTO_TCP) |
| 4811 | ? _EBADTCPCHECKSUM : _EBADUDPCHECKSUM; |
| 4812 | } |
| 4813 | proto_csum_stats_increment(proto: info.ip_proto, stats_p: csum_stats_p); |
| 4814 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4815 | "IPv%c %s checksum SW %svalid (0x%x) hlen %d paylen %d" , |
| 4816 | is_ipv4 ? '4' : '6', |
| 4817 | (info.ip_proto == IPPROTO_TCP) ? "TCP" : "UDP" , |
| 4818 | valid ? "" : "in" , |
| 4819 | sum, info.ip_hlen, info.ip_pay_len); |
| 4820 | m->m_data -= mac_hlen; |
| 4821 | m->m_len += mac_hlen; |
| 4822 | m->m_pkthdr.len += mac_hlen; |
| 4823 | done: |
| 4824 | return error; |
| 4825 | } |
| 4826 | |
| 4827 | static errno_t |
| 4828 | bridge_offload_checksum(struct mbuf * * mp, ip_packet_info * info_p, |
| 4829 | struct ifbrmstats * stats_p) |
| 4830 | { |
| 4831 | uint16_t * csum_p; |
| 4832 | errno_t error = 0; |
| 4833 | u_int hlen; |
| 4834 | struct mbuf * m0 = *mp; |
| 4835 | u_int mac_hlen = sizeof(struct ether_header); |
| 4836 | u_int pkt_hdr_len; |
| 4837 | struct tcphdr * tcp; |
| 4838 | u_int tcp_hlen; |
| 4839 | struct udphdr * udp; |
| 4840 | |
| 4841 | if (info_p->ip_is_ipv4) { |
| 4842 | /* compute IP header checksum */ |
| 4843 | info_p->ip_hdr.ip->ip_sum = 0; |
| 4844 | info_p->ip_hdr.ip->ip_sum = inet_cksum(m0, 0, mac_hlen, |
| 4845 | info_p->ip_hlen); |
| 4846 | stats_p->brms_in_computed_cksum.brcs_ip_checksum++; |
| 4847 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4848 | "IPv4 checksum 0x%x" , |
| 4849 | ntohs(info_p->ip_hdr.ip->ip_sum)); |
| 4850 | } |
| 4851 | if (info_p->ip_is_fragmented) { |
| 4852 | /* can't compute checksum on fragmented packets */ |
| 4853 | goto done; |
| 4854 | } |
| 4855 | pkt_hdr_len = m0->m_pkthdr.len; |
| 4856 | switch (info_p->ip_proto) { |
| 4857 | case IPPROTO_TCP: |
| 4858 | hlen = mac_hlen + info_p->ip_hlen + info_p->ip_opt_len |
| 4859 | + sizeof(struct tcphdr); |
| 4860 | if (m0->m_len < hlen) { |
| 4861 | *mp = m0 = m_pullup(m0, hlen); |
| 4862 | if (m0 == NULL) { |
| 4863 | stats_p->brms_in_ip.bips_bad_tcp++; |
| 4864 | error = _EBADTCP; |
| 4865 | goto done; |
| 4866 | } |
| 4867 | } |
| 4868 | tcp = (struct tcphdr *)(void *) |
| 4869 | ((caddr_t)info_p->ip_hdr.ptr + info_p->ip_hlen |
| 4870 | + info_p->ip_opt_len); |
| 4871 | tcp_hlen = tcp->th_off << 2; |
| 4872 | hlen = mac_hlen + info_p->ip_hlen + info_p->ip_opt_len + tcp_hlen; |
| 4873 | if (hlen > pkt_hdr_len) { |
| 4874 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4875 | "bad tcp header length %u" , |
| 4876 | tcp_hlen); |
| 4877 | stats_p->brms_in_ip.bips_bad_tcp++; |
| 4878 | error = _EBADTCP; |
| 4879 | goto done; |
| 4880 | } |
| 4881 | csum_p = &tcp->th_sum; |
| 4882 | stats_p->brms_in_ip.bips_tcp++; |
| 4883 | break; |
| 4884 | case IPPROTO_UDP: |
| 4885 | hlen = mac_hlen + info_p->ip_hlen + info_p->ip_opt_len + sizeof(*udp); |
| 4886 | if (m0->m_len < hlen) { |
| 4887 | *mp = m0 = m_pullup(m0, hlen); |
| 4888 | if (m0 == NULL) { |
| 4889 | stats_p->brms_in_ip.bips_bad_udp++; |
| 4890 | error = ENOBUFS; |
| 4891 | goto done; |
| 4892 | } |
| 4893 | } |
| 4894 | udp = (struct udphdr *)(void *) |
| 4895 | ((caddr_t)info_p->ip_hdr.ptr + info_p->ip_hlen |
| 4896 | + info_p->ip_opt_len); |
| 4897 | csum_p = &udp->uh_sum; |
| 4898 | stats_p->brms_in_ip.bips_udp++; |
| 4899 | break; |
| 4900 | default: |
| 4901 | /* not TCP or UDP */ |
| 4902 | goto done; |
| 4903 | } |
| 4904 | *csum_p = 0; |
| 4905 | m0->m_data += mac_hlen; |
| 4906 | m0->m_len -= mac_hlen; |
| 4907 | m0->m_pkthdr.len -= mac_hlen; |
| 4908 | if (info_p->ip_is_ipv4) { |
| 4909 | *csum_p = inet_cksum(m0, info_p->ip_proto, info_p->ip_hlen, |
| 4910 | info_p->ip_pay_len); |
| 4911 | } else { |
| 4912 | *csum_p = inet6_cksum(m0, info_p->ip_proto, |
| 4913 | info_p->ip_hlen + info_p->ip_opt_len, |
| 4914 | info_p->ip_pay_len - info_p->ip_opt_len); |
| 4915 | } |
| 4916 | if (info_p->ip_proto == IPPROTO_UDP && *csum_p == 0) { |
| 4917 | /* RFC 1122 4.1.3.4 */ |
| 4918 | *csum_p = 0xffff; |
| 4919 | } |
| 4920 | m0->m_data -= mac_hlen; |
| 4921 | m0->m_len += mac_hlen; |
| 4922 | m0->m_pkthdr.len += mac_hlen; |
| 4923 | proto_csum_stats_increment(proto: info_p->ip_proto, |
| 4924 | stats_p: &stats_p->brms_in_computed_cksum); |
| 4925 | |
| 4926 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 4927 | "IPv%c %s set checksum 0x%x" , |
| 4928 | info_p->ip_is_ipv4 ? '4' : '6', |
| 4929 | (info_p->ip_proto == IPPROTO_TCP) ? "TCP" : "UDP" , |
| 4930 | ntohs(*csum_p)); |
| 4931 | done: |
| 4932 | return error; |
| 4933 | } |
| 4934 | |
| 4935 | static errno_t |
| 4936 | bridge_send(struct ifnet *src_ifp, |
| 4937 | struct ifnet *dst_ifp, struct mbuf *m, ChecksumOperation cksum_op) |
| 4938 | { |
| 4939 | switch (cksum_op) { |
| 4940 | case CHECKSUM_OPERATION_CLEAR_OFFLOAD: |
| 4941 | m->m_pkthdr.csum_flags &= ~CSUM_TX_FLAGS; |
| 4942 | break; |
| 4943 | case CHECKSUM_OPERATION_FINALIZE: |
| 4944 | /* the checksum might not be correct, finalize now */ |
| 4945 | bridge_finalize_cksum(dst_ifp, m); |
| 4946 | break; |
| 4947 | case CHECKSUM_OPERATION_COMPUTE: |
| 4948 | bridge_compute_cksum(src_if: src_ifp, dst_if: dst_ifp, m); |
| 4949 | break; |
| 4950 | default: |
| 4951 | break; |
| 4952 | } |
| 4953 | #if HAS_IF_CAP |
| 4954 | /* |
| 4955 | * If underlying interface can not do VLAN tag insertion itself |
| 4956 | * then attach a packet tag that holds it. |
| 4957 | */ |
| 4958 | if ((m->m_flags & M_VLANTAG) && |
| 4959 | (dst_ifp->if_capenable & IFCAP_VLAN_HWTAGGING) == 0) { |
| 4960 | m = ether_vlanencap(m, m->m_pkthdr.ether_vtag); |
| 4961 | if (m == NULL) { |
| 4962 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_CHECKSUM, |
| 4963 | "%s: unable to prepend VLAN header" , |
| 4964 | dst_ifp->if_xname); |
| 4965 | (void) ifnet_stat_increment_out(dst_ifp, |
| 4966 | 0, 0, 1); |
| 4967 | return 0; |
| 4968 | } |
| 4969 | m->m_flags &= ~M_VLANTAG; |
| 4970 | } |
| 4971 | #endif /* HAS_IF_CAP */ |
| 4972 | return bridge_transmit(ifp: dst_ifp, m); |
| 4973 | } |
| 4974 | |
| 4975 | static errno_t |
| 4976 | bridge_send_tso(struct ifnet *dst_ifp, struct mbuf *m, bool is_ipv4) |
| 4977 | { |
| 4978 | errno_t error; |
| 4979 | u_int mac_hlen; |
| 4980 | |
| 4981 | mac_hlen = sizeof(struct ether_header); |
| 4982 | |
| 4983 | #if HAS_IF_CAP |
| 4984 | /* |
| 4985 | * If underlying interface can not do VLAN tag insertion itself |
| 4986 | * then attach a packet tag that holds it. |
| 4987 | */ |
| 4988 | if ((m->m_flags & M_VLANTAG) && |
| 4989 | (dst_ifp->if_capenable & IFCAP_VLAN_HWTAGGING) == 0) { |
| 4990 | m = ether_vlanencap(m, m->m_pkthdr.ether_vtag); |
| 4991 | if (m == NULL) { |
| 4992 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_CHECKSUM, |
| 4993 | "%s: unable to prepend VLAN header" , |
| 4994 | dst_ifp->if_xname); |
| 4995 | (void) ifnet_stat_increment_out(dst_ifp, |
| 4996 | 0, 0, 1); |
| 4997 | error = ENOBUFS; |
| 4998 | goto done; |
| 4999 | } |
| 5000 | m->m_flags &= ~M_VLANTAG; |
| 5001 | mac_hlen += ETHER_VLAN_ENCAP_LEN; |
| 5002 | } |
| 5003 | #endif /* HAS_IF_CAP */ |
| 5004 | error = gso_tcp(ifp: dst_ifp, mp: &m, mac_hlen, is_ipv4, TRUE); |
| 5005 | return error; |
| 5006 | } |
| 5007 | |
| 5008 | static uint32_t |
| 5009 | get_if_tso_mtu(struct ifnet * ifp, bool is_ipv4) |
| 5010 | { |
| 5011 | uint32_t tso_mtu; |
| 5012 | |
| 5013 | tso_mtu = is_ipv4 ? ifp->if_tso_v4_mtu : ifp->if_tso_v6_mtu; |
| 5014 | if (tso_mtu == 0) { |
| 5015 | tso_mtu = IP_MAXPACKET; |
| 5016 | } |
| 5017 | |
| 5018 | #if DEBUG || DEVELOPMENT |
| 5019 | #define REDUCED_TSO_MTU (16 * 1024) |
| 5020 | if (if_bridge_reduce_tso_mtu != 0 && tso_mtu > REDUCED_TSO_MTU) { |
| 5021 | tso_mtu = REDUCED_TSO_MTU; |
| 5022 | } |
| 5023 | #endif /* DEBUG || DEVELOPMENT */ |
| 5024 | return tso_mtu; |
| 5025 | } |
| 5026 | |
| 5027 | /* |
| 5028 | * tso_hwassist: |
| 5029 | * - determine whether the destination interface supports TSO offload |
| 5030 | * - if the packet is already marked for offload and the hardware supports |
| 5031 | * it, just allow the packet to continue on |
| 5032 | * - if not, parse the packet headers to verify that this is a large TCP |
| 5033 | * packet requiring segmentation; if the hardware doesn't support it |
| 5034 | * set need_sw_tso; otherwise, mark the packet for TSO offload |
| 5035 | */ |
| 5036 | static int |
| 5037 | tso_hwassist(struct mbuf **mp, bool is_ipv4, struct ifnet * ifp, u_int mac_hlen, |
| 5038 | bool * need_sw_tso, bool * is_large_tcp) |
| 5039 | { |
| 5040 | int error = 0; |
| 5041 | u_int32_t if_csum; |
| 5042 | u_int32_t if_tso; |
| 5043 | u_int32_t mbuf_tso; |
| 5044 | bool supports_cksum = false; |
| 5045 | |
| 5046 | *need_sw_tso = false; |
| 5047 | *is_large_tcp = false; |
| 5048 | if (is_ipv4) { |
| 5049 | /* |
| 5050 | * Enable both TCP and IP offload if the hardware supports it. |
| 5051 | * If the hardware doesn't support TCP offload, supports_cksum |
| 5052 | * will be false so we won't set either offload. |
| 5053 | */ |
| 5054 | if_csum = ifp->if_hwassist & (CSUM_TCP | CSUM_IP); |
| 5055 | supports_cksum = (if_csum & CSUM_TCP) != 0; |
| 5056 | if_tso = IFNET_TSO_IPV4; |
| 5057 | mbuf_tso = CSUM_TSO_IPV4; |
| 5058 | } else { |
| 5059 | supports_cksum = (ifp->if_hwassist & CSUM_TCPIPV6) != 0; |
| 5060 | if_csum = CSUM_TCPIPV6; |
| 5061 | if_tso = IFNET_TSO_IPV6; |
| 5062 | mbuf_tso = CSUM_TSO_IPV6; |
| 5063 | } |
| 5064 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 5065 | "%s: does%s support checksum 0x%x if_csum 0x%x" , |
| 5066 | ifp->if_xname, supports_cksum ? "" : " not" , |
| 5067 | ifp->if_hwassist, if_csum); |
| 5068 | if ((ifp->if_hwassist & if_tso) != 0 && |
| 5069 | ((*mp)->m_pkthdr.csum_flags & mbuf_tso) != 0) { |
| 5070 | /* hardware TSO, mbuf already marked */ |
| 5071 | } else { |
| 5072 | /* verify that this is a large TCP frame */ |
| 5073 | uint32_t csum_flags; |
| 5074 | ip_packet_info info; |
| 5075 | int mss; |
| 5076 | uint32_t pkt_mtu; |
| 5077 | struct bripstats stats; |
| 5078 | struct tcphdr * tcp; |
| 5079 | uint32_t tso_mtu; |
| 5080 | |
| 5081 | error = bridge_get_tcp_header(mp, mac_hlen, is_ipv4, |
| 5082 | info_p: &info, stats_p: &stats); |
| 5083 | if (error != 0) { |
| 5084 | /* bad packet */ |
| 5085 | goto done; |
| 5086 | } |
| 5087 | if (info.ip_proto_hdr == NULL) { |
| 5088 | /* not a TCP packet */ |
| 5089 | goto done; |
| 5090 | } |
| 5091 | pkt_mtu = info.ip_hlen + info.ip_pay_len + info.ip_opt_len; |
| 5092 | if (pkt_mtu <= ifp->if_mtu) { |
| 5093 | /* not actually a large packet */ |
| 5094 | goto done; |
| 5095 | } |
| 5096 | if ((ifp->if_hwassist & if_tso) == 0) { |
| 5097 | /* hardware does not support TSO, enable sw tso */ |
| 5098 | *need_sw_tso = if_bridge_segmentation != 0; |
| 5099 | goto done; |
| 5100 | } |
| 5101 | tso_mtu = get_if_tso_mtu(ifp, is_ipv4); |
| 5102 | if (pkt_mtu > tso_mtu) { |
| 5103 | /* hardware can't segment this, enable sw tso */ |
| 5104 | *need_sw_tso = if_bridge_segmentation != 0; |
| 5105 | goto done; |
| 5106 | } |
| 5107 | |
| 5108 | /* use hardware TSO */ |
| 5109 | (*mp)->m_pkthdr.pkt_proto = IPPROTO_TCP; |
| 5110 | tcp = (struct tcphdr *)info.ip_proto_hdr; |
| 5111 | mss = ifp->if_mtu - info.ip_hlen - info.ip_opt_len |
| 5112 | - (tcp->th_off << 2) - if_bridge_tso_reduce_mss_tx; |
| 5113 | assert(mss > 0); |
| 5114 | csum_flags = mbuf_tso; |
| 5115 | if (supports_cksum) { |
| 5116 | csum_flags |= if_csum; |
| 5117 | } |
| 5118 | (*mp)->m_pkthdr.tso_segsz = mss; |
| 5119 | (*mp)->m_pkthdr.csum_flags |= csum_flags; |
| 5120 | (*mp)->m_pkthdr.csum_data = offsetof(struct tcphdr, th_sum); |
| 5121 | *is_large_tcp = true; |
| 5122 | } |
| 5123 | done: |
| 5124 | return error; |
| 5125 | } |
| 5126 | |
| 5127 | /* |
| 5128 | * bridge_enqueue: |
| 5129 | * |
| 5130 | * Enqueue a packet on a bridge member interface. |
| 5131 | * |
| 5132 | */ |
| 5133 | static errno_t |
| 5134 | bridge_enqueue(ifnet_t bridge_ifp, struct ifnet *src_ifp, |
| 5135 | struct ifnet *dst_ifp, struct mbuf *m, ChecksumOperation cksum_op) |
| 5136 | { |
| 5137 | errno_t error = 0; |
| 5138 | int len; |
| 5139 | |
| 5140 | VERIFY(dst_ifp != NULL); |
| 5141 | |
| 5142 | /* |
| 5143 | * We may be sending a fragment so traverse the mbuf |
| 5144 | * |
| 5145 | * NOTE: bridge_fragment() is called only when PFIL_HOOKS is enabled. |
| 5146 | */ |
| 5147 | for (struct mbuf *next_m = NULL; m != NULL; m = next_m) { |
| 5148 | bool need_sw_tso = false; |
| 5149 | bool is_ipv4 = false; |
| 5150 | bool is_large_pkt; |
| 5151 | errno_t _error = 0; |
| 5152 | |
| 5153 | len = m->m_pkthdr.len; |
| 5154 | m->m_flags |= M_PROTO1; /* set to avoid loops */ |
| 5155 | next_m = m->m_nextpkt; |
| 5156 | m->m_nextpkt = NULL; |
| 5157 | /* |
| 5158 | * Need to segment the packet if it is a large frame |
| 5159 | * and the destination interface does not support TSO. |
| 5160 | * |
| 5161 | * Note that with trailers, it's possible for a packet to |
| 5162 | * be large but not actually require segmentation. |
| 5163 | */ |
| 5164 | is_large_pkt = (len > (bridge_ifp->if_mtu + ETHER_HDR_LEN)); |
| 5165 | if (is_large_pkt) { |
| 5166 | struct ether_header *eh; |
| 5167 | bool is_large_tcp = false; |
| 5168 | |
| 5169 | eh = mtod(m, struct ether_header *); |
| 5170 | if (ether_header_type_is_ip(eh, is_ipv4: &is_ipv4)) { |
| 5171 | _error = tso_hwassist(mp: &m, is_ipv4, |
| 5172 | ifp: dst_ifp, mac_hlen: sizeof(struct ether_header), |
| 5173 | need_sw_tso: &need_sw_tso, is_large_tcp: &is_large_tcp); |
| 5174 | if (is_large_tcp) { |
| 5175 | cksum_op = CHECKSUM_OPERATION_NONE; |
| 5176 | } |
| 5177 | } else { |
| 5178 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 5179 | "large non IP packet" ); |
| 5180 | } |
| 5181 | } |
| 5182 | if (_error != 0) { |
| 5183 | if (m != NULL) { |
| 5184 | m_freem(m); |
| 5185 | } |
| 5186 | } else if (need_sw_tso) { |
| 5187 | _error = bridge_send_tso(dst_ifp, m, is_ipv4); |
| 5188 | } else { |
| 5189 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 5190 | "%s bridge_send(%s) len %d op %d" , |
| 5191 | bridge_ifp->if_xname, |
| 5192 | dst_ifp->if_xname, |
| 5193 | len, cksum_op); |
| 5194 | _error = bridge_send(src_ifp, dst_ifp, m, cksum_op); |
| 5195 | } |
| 5196 | |
| 5197 | /* Preserve first error value */ |
| 5198 | if (error == 0 && _error != 0) { |
| 5199 | error = _error; |
| 5200 | } |
| 5201 | if (_error == 0) { |
| 5202 | (void) ifnet_stat_increment_out(interface: bridge_ifp, packets_out: 1, bytes_out: len, errors_out: 0); |
| 5203 | } else { |
| 5204 | (void) ifnet_stat_increment_out(interface: bridge_ifp, packets_out: 0, bytes_out: 0, errors_out: 1); |
| 5205 | } |
| 5206 | } |
| 5207 | |
| 5208 | return error; |
| 5209 | } |
| 5210 | |
| 5211 | #if HAS_BRIDGE_DUMMYNET |
| 5212 | /* |
| 5213 | * bridge_dummynet: |
| 5214 | * |
| 5215 | * Receive a queued packet from dummynet and pass it on to the output |
| 5216 | * interface. |
| 5217 | * |
| 5218 | * The mbuf has the Ethernet header already attached. |
| 5219 | */ |
| 5220 | static void |
| 5221 | bridge_dummynet(struct mbuf *m, struct ifnet *ifp) |
| 5222 | { |
| 5223 | struct bridge_softc *sc; |
| 5224 | |
| 5225 | sc = ifp->if_bridge; |
| 5226 | |
| 5227 | /* |
| 5228 | * The packet didn't originate from a member interface. This should only |
| 5229 | * ever happen if a member interface is removed while packets are |
| 5230 | * queued for it. |
| 5231 | */ |
| 5232 | if (sc == NULL) { |
| 5233 | m_freem(m); |
| 5234 | return; |
| 5235 | } |
| 5236 | |
| 5237 | if (PFIL_HOOKED(&inet_pfil_hook) || PFIL_HOOKED_INET6) { |
| 5238 | if (bridge_pfil(&m, sc->sc_ifp, ifp, PFIL_OUT) != 0) { |
| 5239 | return; |
| 5240 | } |
| 5241 | if (m == NULL) { |
| 5242 | return; |
| 5243 | } |
| 5244 | } |
| 5245 | (void) bridge_enqueue(sc->sc_ifp, NULL, ifp, m, CHECKSUM_OPERATION_NONE); |
| 5246 | } |
| 5247 | |
| 5248 | #endif /* HAS_BRIDGE_DUMMYNET */ |
| 5249 | |
| 5250 | /* |
| 5251 | * bridge_member_output: |
| 5252 | * |
| 5253 | * Send output from a bridge member interface. This |
| 5254 | * performs the bridging function for locally originated |
| 5255 | * packets. |
| 5256 | * |
| 5257 | * The mbuf has the Ethernet header already attached. |
| 5258 | */ |
| 5259 | static errno_t |
| 5260 | bridge_member_output(struct bridge_softc *sc, ifnet_t ifp, mbuf_t *data) |
| 5261 | { |
| 5262 | ifnet_t bridge_ifp; |
| 5263 | struct ether_header *eh; |
| 5264 | struct ifnet *dst_if; |
| 5265 | uint16_t vlan; |
| 5266 | struct bridge_iflist *mac_nat_bif; |
| 5267 | ifnet_t mac_nat_ifp; |
| 5268 | mbuf_t m = *data; |
| 5269 | |
| 5270 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_OUTPUT, |
| 5271 | "ifp %s" , ifp->if_xname); |
| 5272 | if (m->m_len < ETHER_HDR_LEN) { |
| 5273 | m = m_pullup(m, ETHER_HDR_LEN); |
| 5274 | if (m == NULL) { |
| 5275 | *data = NULL; |
| 5276 | return EJUSTRETURN; |
| 5277 | } |
| 5278 | } |
| 5279 | |
| 5280 | eh = mtod(m, struct ether_header *); |
| 5281 | vlan = VLANTAGOF(m); |
| 5282 | |
| 5283 | BRIDGE_LOCK(sc); |
| 5284 | mac_nat_bif = sc->sc_mac_nat_bif; |
| 5285 | mac_nat_ifp = (mac_nat_bif != NULL) ? mac_nat_bif->bif_ifp : NULL; |
| 5286 | if (mac_nat_ifp == ifp) { |
| 5287 | /* record the IP address used by the MAC NAT interface */ |
| 5288 | (void)bridge_mac_nat_output(sc, mac_nat_bif, data, NULL); |
| 5289 | m = *data; |
| 5290 | if (m == NULL) { |
| 5291 | /* packet was deallocated */ |
| 5292 | BRIDGE_UNLOCK(sc); |
| 5293 | return EJUSTRETURN; |
| 5294 | } |
| 5295 | } |
| 5296 | bridge_ifp = sc->sc_ifp; |
| 5297 | |
| 5298 | /* |
| 5299 | * APPLE MODIFICATION |
| 5300 | * If the packet is an 802.1X ethertype, then only send on the |
| 5301 | * original output interface. |
| 5302 | */ |
| 5303 | if (eh->ether_type == htons(ETHERTYPE_PAE)) { |
| 5304 | dst_if = ifp; |
| 5305 | goto sendunicast; |
| 5306 | } |
| 5307 | |
| 5308 | /* |
| 5309 | * If bridge is down, but the original output interface is up, |
| 5310 | * go ahead and send out that interface. Otherwise, the packet |
| 5311 | * is dropped below. |
| 5312 | */ |
| 5313 | if ((bridge_ifp->if_flags & IFF_RUNNING) == 0) { |
| 5314 | dst_if = ifp; |
| 5315 | goto sendunicast; |
| 5316 | } |
| 5317 | |
| 5318 | /* |
| 5319 | * If the packet is a multicast, or we don't know a better way to |
| 5320 | * get there, send to all interfaces. |
| 5321 | */ |
| 5322 | if (ETHER_IS_MULTICAST(eh->ether_dhost)) { |
| 5323 | dst_if = NULL; |
| 5324 | } else { |
| 5325 | dst_if = bridge_rtlookup(sc, eh->ether_dhost, vlan); |
| 5326 | } |
| 5327 | if (dst_if == NULL) { |
| 5328 | struct bridge_iflist *bif; |
| 5329 | struct mbuf *mc; |
| 5330 | errno_t error; |
| 5331 | |
| 5332 | |
| 5333 | bridge_span(sc, m); |
| 5334 | |
| 5335 | BRIDGE_LOCK2REF(sc, error); |
| 5336 | if (error != 0) { |
| 5337 | m_freem(m); |
| 5338 | return EJUSTRETURN; |
| 5339 | } |
| 5340 | |
| 5341 | /* |
| 5342 | * Duplicate and send the packet across all member interfaces |
| 5343 | * except the originating interface. |
| 5344 | */ |
| 5345 | TAILQ_FOREACH(bif, &sc->sc_iflist, bif_next) { |
| 5346 | dst_if = bif->bif_ifp; |
| 5347 | if (dst_if == ifp) { |
| 5348 | /* skip the originating interface */ |
| 5349 | continue; |
| 5350 | } |
| 5351 | /* skip interface with inactive link status */ |
| 5352 | if ((bif->bif_flags & BIFF_MEDIA_ACTIVE) == 0) { |
| 5353 | continue; |
| 5354 | } |
| 5355 | #if 0 |
| 5356 | if (dst_if->if_type == IFT_GIF) { |
| 5357 | continue; |
| 5358 | } |
| 5359 | #endif |
| 5360 | /* skip interface that isn't running */ |
| 5361 | if ((dst_if->if_flags & IFF_RUNNING) == 0) { |
| 5362 | continue; |
| 5363 | } |
| 5364 | /* |
| 5365 | * If the interface is participating in spanning |
| 5366 | * tree, make sure the port is in a state that |
| 5367 | * allows forwarding. |
| 5368 | */ |
| 5369 | if ((bif->bif_ifflags & IFBIF_STP) && |
| 5370 | bif->bif_stp.bp_state == BSTP_IFSTATE_DISCARDING) { |
| 5371 | continue; |
| 5372 | } |
| 5373 | /* |
| 5374 | * If the destination is the MAC NAT interface, |
| 5375 | * skip sending the packet. The packet can't be sent |
| 5376 | * if the source MAC is incorrect. |
| 5377 | */ |
| 5378 | if (dst_if == mac_nat_ifp) { |
| 5379 | continue; |
| 5380 | } |
| 5381 | |
| 5382 | /* make a deep copy to send on this member interface */ |
| 5383 | mc = m_dup(m, M_DONTWAIT); |
| 5384 | if (mc == NULL) { |
| 5385 | (void)ifnet_stat_increment_out(interface: bridge_ifp, |
| 5386 | packets_out: 0, bytes_out: 0, errors_out: 1); |
| 5387 | continue; |
| 5388 | } |
| 5389 | (void)bridge_enqueue(bridge_ifp, src_ifp: ifp, dst_ifp: dst_if, |
| 5390 | m: mc, cksum_op: CHECKSUM_OPERATION_COMPUTE); |
| 5391 | } |
| 5392 | BRIDGE_UNREF(sc); |
| 5393 | |
| 5394 | if ((ifp->if_flags & IFF_RUNNING) == 0) { |
| 5395 | m_freem(m); |
| 5396 | return EJUSTRETURN; |
| 5397 | } |
| 5398 | /* allow packet to continue on the originating interface */ |
| 5399 | return 0; |
| 5400 | } |
| 5401 | |
| 5402 | sendunicast: |
| 5403 | /* |
| 5404 | * XXX Spanning tree consideration here? |
| 5405 | */ |
| 5406 | |
| 5407 | bridge_span(sc, m); |
| 5408 | if ((dst_if->if_flags & IFF_RUNNING) == 0) { |
| 5409 | m_freem(m); |
| 5410 | BRIDGE_UNLOCK(sc); |
| 5411 | return EJUSTRETURN; |
| 5412 | } |
| 5413 | |
| 5414 | BRIDGE_UNLOCK(sc); |
| 5415 | if (dst_if == ifp) { |
| 5416 | /* allow packet to continue on the originating interface */ |
| 5417 | return 0; |
| 5418 | } |
| 5419 | if (dst_if != mac_nat_ifp) { |
| 5420 | (void) bridge_enqueue(bridge_ifp, src_ifp: ifp, dst_ifp: dst_if, m, |
| 5421 | cksum_op: CHECKSUM_OPERATION_COMPUTE); |
| 5422 | } else { |
| 5423 | /* |
| 5424 | * This is not the original output interface |
| 5425 | * and the destination is the MAC NAT interface. |
| 5426 | * Drop the packet because the packet can't be sent |
| 5427 | * if the source MAC is incorrect. |
| 5428 | */ |
| 5429 | m_freem(m); |
| 5430 | } |
| 5431 | return EJUSTRETURN; |
| 5432 | } |
| 5433 | |
| 5434 | /* |
| 5435 | * Output callback. |
| 5436 | * |
| 5437 | * This routine is called externally from above only when if_bridge_txstart |
| 5438 | * is disabled; otherwise it is called internally by bridge_start(). |
| 5439 | */ |
| 5440 | static int |
| 5441 | bridge_output(struct ifnet *ifp, struct mbuf *m) |
| 5442 | { |
| 5443 | struct bridge_softc *sc = ifnet_softc(interface: ifp); |
| 5444 | struct ether_header *eh; |
| 5445 | struct ifnet *dst_if = NULL; |
| 5446 | int error = 0; |
| 5447 | |
| 5448 | eh = mtod(m, struct ether_header *); |
| 5449 | |
| 5450 | BRIDGE_LOCK(sc); |
| 5451 | |
| 5452 | if (!(m->m_flags & (M_BCAST | M_MCAST))) { |
| 5453 | dst_if = bridge_rtlookup(sc, eh->ether_dhost, 0); |
| 5454 | } |
| 5455 | |
| 5456 | (void) ifnet_stat_increment_out(interface: ifp, packets_out: 1, bytes_out: m->m_pkthdr.len, errors_out: 0); |
| 5457 | |
| 5458 | #if NBPFILTER > 0 |
| 5459 | if (sc->sc_bpf_output) { |
| 5460 | bridge_bpf_output(ifp, m); |
| 5461 | } |
| 5462 | #endif |
| 5463 | |
| 5464 | if (dst_if == NULL) { |
| 5465 | /* callee will unlock */ |
| 5466 | bridge_broadcast(sc, NULL, m, 0); |
| 5467 | } else { |
| 5468 | ifnet_t bridge_ifp; |
| 5469 | |
| 5470 | bridge_ifp = sc->sc_ifp; |
| 5471 | BRIDGE_UNLOCK(sc); |
| 5472 | |
| 5473 | error = bridge_enqueue(bridge_ifp, NULL, dst_ifp: dst_if, m, |
| 5474 | cksum_op: CHECKSUM_OPERATION_FINALIZE); |
| 5475 | } |
| 5476 | |
| 5477 | return error; |
| 5478 | } |
| 5479 | |
| 5480 | static void |
| 5481 | bridge_finalize_cksum(struct ifnet *ifp, struct mbuf *m) |
| 5482 | { |
| 5483 | struct ether_header *eh; |
| 5484 | bool is_ipv4; |
| 5485 | uint32_t sw_csum, hwcap; |
| 5486 | uint32_t did_sw; |
| 5487 | uint32_t csum_flags; |
| 5488 | |
| 5489 | eh = mtod(m, struct ether_header *); |
| 5490 | if (!ether_header_type_is_ip(eh, is_ipv4: &is_ipv4)) { |
| 5491 | return; |
| 5492 | } |
| 5493 | |
| 5494 | /* do in software what the hardware cannot */ |
| 5495 | hwcap = (ifp->if_hwassist | CSUM_DATA_VALID); |
| 5496 | csum_flags = m->m_pkthdr.csum_flags; |
| 5497 | sw_csum = csum_flags & ~IF_HWASSIST_CSUM_FLAGS(hwcap); |
| 5498 | sw_csum &= IF_HWASSIST_CSUM_MASK; |
| 5499 | |
| 5500 | if (is_ipv4) { |
| 5501 | if ((hwcap & CSUM_PARTIAL) && !(sw_csum & CSUM_DELAY_DATA) && |
| 5502 | (m->m_pkthdr.csum_flags & CSUM_DELAY_DATA)) { |
| 5503 | if (m->m_pkthdr.csum_flags & CSUM_TCP) { |
| 5504 | uint16_t start = |
| 5505 | sizeof(*eh) + sizeof(struct ip); |
| 5506 | uint16_t ulpoff = |
| 5507 | m->m_pkthdr.csum_data & 0xffff; |
| 5508 | m->m_pkthdr.csum_flags |= |
| 5509 | (CSUM_DATA_VALID | CSUM_PARTIAL); |
| 5510 | m->m_pkthdr.csum_tx_stuff = (ulpoff + start); |
| 5511 | m->m_pkthdr.csum_tx_start = start; |
| 5512 | } else { |
| 5513 | sw_csum |= (CSUM_DELAY_DATA & |
| 5514 | m->m_pkthdr.csum_flags); |
| 5515 | } |
| 5516 | } |
| 5517 | did_sw = in_finalize_cksum(m, sizeof(*eh), sw_csum); |
| 5518 | } else { |
| 5519 | if ((hwcap & CSUM_PARTIAL) && |
| 5520 | !(sw_csum & CSUM_DELAY_IPV6_DATA) && |
| 5521 | (m->m_pkthdr.csum_flags & CSUM_DELAY_IPV6_DATA)) { |
| 5522 | if (m->m_pkthdr.csum_flags & CSUM_TCPIPV6) { |
| 5523 | uint16_t start = |
| 5524 | sizeof(*eh) + sizeof(struct ip6_hdr); |
| 5525 | uint16_t ulpoff = |
| 5526 | m->m_pkthdr.csum_data & 0xffff; |
| 5527 | m->m_pkthdr.csum_flags |= |
| 5528 | (CSUM_DATA_VALID | CSUM_PARTIAL); |
| 5529 | m->m_pkthdr.csum_tx_stuff = (ulpoff + start); |
| 5530 | m->m_pkthdr.csum_tx_start = start; |
| 5531 | } else { |
| 5532 | sw_csum |= (CSUM_DELAY_IPV6_DATA & |
| 5533 | m->m_pkthdr.csum_flags); |
| 5534 | } |
| 5535 | } |
| 5536 | did_sw = in6_finalize_cksum(m, sizeof(*eh), -1, -1, sw_csum); |
| 5537 | } |
| 5538 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 5539 | "[%s] before 0x%x hwcap 0x%x sw_csum 0x%x did 0x%x after 0x%x" , |
| 5540 | ifp->if_xname, csum_flags, hwcap, sw_csum, |
| 5541 | did_sw, m->m_pkthdr.csum_flags); |
| 5542 | } |
| 5543 | |
| 5544 | /* |
| 5545 | * bridge_start: |
| 5546 | * |
| 5547 | * Start output on a bridge. |
| 5548 | * |
| 5549 | * This routine is invoked by the start worker thread; because we never call |
| 5550 | * it directly, there is no need do deploy any serialization mechanism other |
| 5551 | * than what's already used by the worker thread, i.e. this is already single |
| 5552 | * threaded. |
| 5553 | * |
| 5554 | * This routine is called only when if_bridge_txstart is enabled. |
| 5555 | */ |
| 5556 | static void |
| 5557 | bridge_start(struct ifnet *ifp) |
| 5558 | { |
| 5559 | struct mbuf *m; |
| 5560 | |
| 5561 | for (;;) { |
| 5562 | if (ifnet_dequeue(interface: ifp, packet: &m) != 0) { |
| 5563 | break; |
| 5564 | } |
| 5565 | |
| 5566 | (void) bridge_output(ifp, m); |
| 5567 | } |
| 5568 | } |
| 5569 | |
| 5570 | /* |
| 5571 | * bridge_forward: |
| 5572 | * |
| 5573 | * The forwarding function of the bridge. |
| 5574 | * |
| 5575 | * NOTE: Releases the lock on return. |
| 5576 | */ |
| 5577 | static void |
| 5578 | bridge_forward(struct bridge_softc *sc, struct bridge_iflist *sbif, |
| 5579 | struct mbuf *m) |
| 5580 | { |
| 5581 | struct bridge_iflist *dbif; |
| 5582 | ifnet_t bridge_ifp; |
| 5583 | struct ifnet *src_if, *dst_if; |
| 5584 | struct ether_header *eh; |
| 5585 | uint16_t vlan; |
| 5586 | uint8_t *dst; |
| 5587 | int error; |
| 5588 | struct mac_nat_record mnr; |
| 5589 | bool translate_mac = FALSE; |
| 5590 | uint32_t sc_filter_flags = 0; |
| 5591 | |
| 5592 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 5593 | |
| 5594 | bridge_ifp = sc->sc_ifp; |
| 5595 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_OUTPUT, |
| 5596 | "%s m 0x%llx" , bridge_ifp->if_xname, |
| 5597 | (uint64_t)VM_KERNEL_ADDRPERM(m)); |
| 5598 | |
| 5599 | src_if = m->m_pkthdr.rcvif; |
| 5600 | if (src_if != sbif->bif_ifp) { |
| 5601 | const char * src_if_name; |
| 5602 | |
| 5603 | src_if_name = (src_if != NULL) ? src_if->if_xname : "?" ; |
| 5604 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 5605 | "src_if %s != bif_ifp %s" , |
| 5606 | src_if_name, sbif->bif_ifp->if_xname); |
| 5607 | goto drop; |
| 5608 | } |
| 5609 | |
| 5610 | (void) ifnet_stat_increment_in(interface: bridge_ifp, packets_in: 1, bytes_in: m->m_pkthdr.len, errors_in: 0); |
| 5611 | vlan = VLANTAGOF(m); |
| 5612 | |
| 5613 | |
| 5614 | if ((sbif->bif_ifflags & IFBIF_STP) && |
| 5615 | sbif->bif_stp.bp_state == BSTP_IFSTATE_DISCARDING) { |
| 5616 | goto drop; |
| 5617 | } |
| 5618 | |
| 5619 | eh = mtod(m, struct ether_header *); |
| 5620 | dst = eh->ether_dhost; |
| 5621 | |
| 5622 | /* If the interface is learning, record the address. */ |
| 5623 | if (sbif->bif_ifflags & IFBIF_LEARNING) { |
| 5624 | error = bridge_rtupdate(sc, eh->ether_shost, vlan, |
| 5625 | sbif, 0, IFBAF_DYNAMIC); |
| 5626 | /* |
| 5627 | * If the interface has addresses limits then deny any source |
| 5628 | * that is not in the cache. |
| 5629 | */ |
| 5630 | if (error && sbif->bif_addrmax) { |
| 5631 | goto drop; |
| 5632 | } |
| 5633 | } |
| 5634 | |
| 5635 | if ((sbif->bif_ifflags & IFBIF_STP) != 0 && |
| 5636 | sbif->bif_stp.bp_state == BSTP_IFSTATE_LEARNING) { |
| 5637 | goto drop; |
| 5638 | } |
| 5639 | |
| 5640 | /* |
| 5641 | * At this point, the port either doesn't participate |
| 5642 | * in spanning tree or it is in the forwarding state. |
| 5643 | */ |
| 5644 | |
| 5645 | /* |
| 5646 | * If the packet is unicast, destined for someone on |
| 5647 | * "this" side of the bridge, drop it. |
| 5648 | */ |
| 5649 | if ((m->m_flags & (M_BCAST | M_MCAST)) == 0) { |
| 5650 | /* unicast */ |
| 5651 | dst_if = bridge_rtlookup(sc, dst, vlan); |
| 5652 | if (src_if == dst_if) { |
| 5653 | goto drop; |
| 5654 | } |
| 5655 | } else { |
| 5656 | /* broadcast/multicast */ |
| 5657 | |
| 5658 | /* |
| 5659 | * Check if its a reserved multicast address, any address |
| 5660 | * listed in 802.1D section 7.12.6 may not be forwarded by the |
| 5661 | * bridge. |
| 5662 | * This is currently 01-80-C2-00-00-00 to 01-80-C2-00-00-0F |
| 5663 | */ |
| 5664 | if (dst[0] == 0x01 && dst[1] == 0x80 && |
| 5665 | dst[2] == 0xc2 && dst[3] == 0x00 && |
| 5666 | dst[4] == 0x00 && dst[5] <= 0x0f) { |
| 5667 | goto drop; |
| 5668 | } |
| 5669 | |
| 5670 | |
| 5671 | /* ...forward it to all interfaces. */ |
| 5672 | os_atomic_inc(&bridge_ifp->if_imcasts, relaxed); |
| 5673 | dst_if = NULL; |
| 5674 | } |
| 5675 | |
| 5676 | /* |
| 5677 | * If we have a destination interface which is a member of our bridge, |
| 5678 | * OR this is a unicast packet, push it through the bpf(4) machinery. |
| 5679 | * For broadcast or multicast packets, don't bother because it will |
| 5680 | * be reinjected into ether_input. We do this before we pass the packets |
| 5681 | * through the pfil(9) framework, as it is possible that pfil(9) will |
| 5682 | * drop the packet, or possibly modify it, making it difficult to debug |
| 5683 | * firewall issues on the bridge. |
| 5684 | */ |
| 5685 | #if NBPFILTER > 0 |
| 5686 | if (eh->ether_type == htons(ETHERTYPE_RSN_PREAUTH) || |
| 5687 | dst_if != NULL || (m->m_flags & (M_BCAST | M_MCAST)) == 0) { |
| 5688 | m->m_pkthdr.rcvif = bridge_ifp; |
| 5689 | BRIDGE_BPF_MTAP_INPUT(sc, m); |
| 5690 | } |
| 5691 | #endif /* NBPFILTER */ |
| 5692 | |
| 5693 | if (dst_if == NULL) { |
| 5694 | /* bridge_broadcast will unlock */ |
| 5695 | bridge_broadcast(sc, sbif, m, 1); |
| 5696 | return; |
| 5697 | } |
| 5698 | |
| 5699 | /* |
| 5700 | * Unicast. |
| 5701 | */ |
| 5702 | /* |
| 5703 | * At this point, we're dealing with a unicast frame |
| 5704 | * going to a different interface. |
| 5705 | */ |
| 5706 | if ((dst_if->if_flags & IFF_RUNNING) == 0) { |
| 5707 | goto drop; |
| 5708 | } |
| 5709 | |
| 5710 | dbif = bridge_lookup_member_if(sc, member_ifp: dst_if); |
| 5711 | if (dbif == NULL) { |
| 5712 | /* Not a member of the bridge (anymore?) */ |
| 5713 | goto drop; |
| 5714 | } |
| 5715 | |
| 5716 | /* Private segments can not talk to each other */ |
| 5717 | if (sbif->bif_ifflags & dbif->bif_ifflags & IFBIF_PRIVATE) { |
| 5718 | goto drop; |
| 5719 | } |
| 5720 | |
| 5721 | if ((dbif->bif_ifflags & IFBIF_STP) && |
| 5722 | dbif->bif_stp.bp_state == BSTP_IFSTATE_DISCARDING) { |
| 5723 | goto drop; |
| 5724 | } |
| 5725 | |
| 5726 | #if HAS_DHCPRA_MASK |
| 5727 | /* APPLE MODIFICATION <rdar:6985737> */ |
| 5728 | if ((dst_if->if_extflags & IFEXTF_DHCPRA_MASK) != 0) { |
| 5729 | m = ip_xdhcpra_output(dst_if, m); |
| 5730 | if (!m) { |
| 5731 | ++bridge_ifp.if_xdhcpra; |
| 5732 | BRIDGE_UNLOCK(sc); |
| 5733 | return; |
| 5734 | } |
| 5735 | } |
| 5736 | #endif /* HAS_DHCPRA_MASK */ |
| 5737 | |
| 5738 | if (dbif == sc->sc_mac_nat_bif) { |
| 5739 | /* determine how to translate the packet */ |
| 5740 | translate_mac |
| 5741 | = bridge_mac_nat_output(sc, sbif, &m, &mnr); |
| 5742 | if (m == NULL) { |
| 5743 | /* packet was deallocated */ |
| 5744 | BRIDGE_UNLOCK(sc); |
| 5745 | return; |
| 5746 | } |
| 5747 | } else if (bif_has_checksum_offload(bif: dbif) && |
| 5748 | !bif_has_checksum_offload(bif: sbif)) { |
| 5749 | /* |
| 5750 | * If the destination interface has checksum offload enabled, |
| 5751 | * verify the checksum now, unless the source interface also has |
| 5752 | * checksum offload enabled. The checksum in that case has |
| 5753 | * already just been computed and verifying it is unnecessary. |
| 5754 | */ |
| 5755 | error = bridge_verify_checksum(mp: &m, stats_p: &dbif->bif_stats); |
| 5756 | if (error != 0) { |
| 5757 | BRIDGE_UNLOCK(sc); |
| 5758 | if (m != NULL) { |
| 5759 | m_freem(m); |
| 5760 | } |
| 5761 | return; |
| 5762 | } |
| 5763 | } |
| 5764 | |
| 5765 | sc_filter_flags = sc->sc_filter_flags; |
| 5766 | |
| 5767 | BRIDGE_UNLOCK(sc); |
| 5768 | if (PF_IS_ENABLED && (sc_filter_flags & IFBF_FILT_MEMBER)) { |
| 5769 | if (bridge_pf(&m, dst_if, sc_filter_flags, FALSE) != 0) { |
| 5770 | return; |
| 5771 | } |
| 5772 | if (m == NULL) { |
| 5773 | return; |
| 5774 | } |
| 5775 | } |
| 5776 | |
| 5777 | /* if we need to, translate the MAC address */ |
| 5778 | if (translate_mac) { |
| 5779 | bridge_mac_nat_translate(&m, &mnr, IF_LLADDR(dst_if)); |
| 5780 | } |
| 5781 | /* |
| 5782 | * We're forwarding an inbound packet in which the checksum must |
| 5783 | * already have been computed and if required, verified. |
| 5784 | */ |
| 5785 | if (m != NULL) { |
| 5786 | (void) bridge_enqueue(bridge_ifp, src_ifp: src_if, dst_ifp: dst_if, m, |
| 5787 | cksum_op: CHECKSUM_OPERATION_CLEAR_OFFLOAD); |
| 5788 | } |
| 5789 | return; |
| 5790 | |
| 5791 | drop: |
| 5792 | BRIDGE_UNLOCK(sc); |
| 5793 | m_freem(m); |
| 5794 | } |
| 5795 | |
| 5796 | static void |
| 5797 | inject_input_packet(ifnet_t ifp, mbuf_t m) |
| 5798 | { |
| 5799 | mbuf_pkthdr_setrcvif(mbuf: m, ifp); |
| 5800 | mbuf_pkthdr_setheader(mbuf: m, header: mbuf_data(mbuf: m)); |
| 5801 | mbuf_setdata(mbuf: m, data: (char *)mbuf_data(mbuf: m) + ETHER_HDR_LEN, |
| 5802 | len: mbuf_len(mbuf: m) - ETHER_HDR_LEN); |
| 5803 | mbuf_pkthdr_adjustlen(mbuf: m, amount: -ETHER_HDR_LEN); |
| 5804 | m->m_flags |= M_PROTO1; /* set to avoid loops */ |
| 5805 | dlil_input_packet_list(ifp, m); |
| 5806 | return; |
| 5807 | } |
| 5808 | |
| 5809 | static bool |
| 5810 | in_addr_is_ours(struct in_addr ip) |
| 5811 | { |
| 5812 | struct in_ifaddr *ia; |
| 5813 | bool ours = false; |
| 5814 | |
| 5815 | lck_rw_lock_shared(lck: &in_ifaddr_rwlock); |
| 5816 | TAILQ_FOREACH(ia, INADDR_HASH(ip.s_addr), ia_hash) { |
| 5817 | if (IA_SIN(ia)->sin_addr.s_addr == ip.s_addr) { |
| 5818 | ours = true; |
| 5819 | break; |
| 5820 | } |
| 5821 | } |
| 5822 | lck_rw_done(lck: &in_ifaddr_rwlock); |
| 5823 | return ours; |
| 5824 | } |
| 5825 | |
| 5826 | static bool |
| 5827 | in6_addr_is_ours(const struct in6_addr * ip6_p, uint32_t ifscope) |
| 5828 | { |
| 5829 | struct in6_ifaddr *ia6; |
| 5830 | bool ours = false; |
| 5831 | |
| 5832 | if (in6_embedded_scope && IN6_IS_ADDR_LINKLOCAL(ip6_p)) { |
| 5833 | struct in6_addr dst_ip; |
| 5834 | |
| 5835 | /* need to embed scope ID for comparison */ |
| 5836 | bcopy(src: ip6_p, dst: &dst_ip, n: sizeof(dst_ip)); |
| 5837 | dst_ip.s6_addr16[1] = htons(ifscope); |
| 5838 | ip6_p = &dst_ip; |
| 5839 | } |
| 5840 | lck_rw_lock_shared(lck: &in6_ifaddr_rwlock); |
| 5841 | TAILQ_FOREACH(ia6, IN6ADDR_HASH(ip6_p), ia6_hash) { |
| 5842 | if (in6_are_addr_equal_scoped(&ia6->ia_addr.sin6_addr, ip6_p, |
| 5843 | ia6->ia_addr.sin6_scope_id, ifscope)) { |
| 5844 | ours = true; |
| 5845 | break; |
| 5846 | } |
| 5847 | } |
| 5848 | lck_rw_done(lck: &in6_ifaddr_rwlock); |
| 5849 | return ours; |
| 5850 | } |
| 5851 | |
| 5852 | static void |
| 5853 | bridge_interface_input(ifnet_t bridge_ifp, mbuf_t m, |
| 5854 | bpf_packet_func bpf_input_func) |
| 5855 | { |
| 5856 | size_t byte_count; |
| 5857 | struct ether_header *eh; |
| 5858 | errno_t error; |
| 5859 | bool is_ipv4; |
| 5860 | int len; |
| 5861 | u_int mac_hlen; |
| 5862 | int pkt_count; |
| 5863 | |
| 5864 | /* segment large packets before sending them up */ |
| 5865 | if (if_bridge_segmentation == 0) { |
| 5866 | goto done; |
| 5867 | } |
| 5868 | len = m->m_pkthdr.len; |
| 5869 | if (len <= (bridge_ifp->if_mtu + ETHER_HDR_LEN)) { |
| 5870 | goto done; |
| 5871 | } |
| 5872 | eh = mtod(m, struct ether_header *); |
| 5873 | if (!ether_header_type_is_ip(eh, is_ipv4: &is_ipv4)) { |
| 5874 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 5875 | "large non IPv4/IPv6 packet" ); |
| 5876 | goto done; |
| 5877 | } |
| 5878 | |
| 5879 | /* |
| 5880 | * We have a large IPv4/IPv6 TCP packet. Segment it if required. |
| 5881 | * |
| 5882 | * If gso_tcp() returns success (0), the packet(s) are |
| 5883 | * ready to be passed up. If the destination is a local IP address, |
| 5884 | * the packet will be passed up as a large, single packet. |
| 5885 | * |
| 5886 | * If gso_tcp() returns an error, the packet has already |
| 5887 | * been freed. |
| 5888 | */ |
| 5889 | mac_hlen = sizeof(*eh); |
| 5890 | error = gso_tcp(ifp: bridge_ifp, mp: &m, mac_hlen, is_ipv4, FALSE); |
| 5891 | if (error != 0) { |
| 5892 | return; |
| 5893 | } |
| 5894 | |
| 5895 | done: |
| 5896 | pkt_count = 0; |
| 5897 | byte_count = 0; |
| 5898 | for (mbuf_t scan = m; scan != NULL; scan = scan->m_nextpkt) { |
| 5899 | /* Mark the packet as arriving on the bridge interface */ |
| 5900 | mbuf_pkthdr_setrcvif(mbuf: scan, ifp: bridge_ifp); |
| 5901 | mbuf_pkthdr_setheader(mbuf: scan, header: mbuf_data(mbuf: scan)); |
| 5902 | if (bpf_input_func != NULL) { |
| 5903 | (*bpf_input_func)(bridge_ifp, scan); |
| 5904 | } |
| 5905 | mbuf_setdata(mbuf: scan, data: (char *)mbuf_data(mbuf: scan) + ETHER_HDR_LEN, |
| 5906 | len: mbuf_len(mbuf: scan) - ETHER_HDR_LEN); |
| 5907 | mbuf_pkthdr_adjustlen(mbuf: scan, amount: -ETHER_HDR_LEN); |
| 5908 | byte_count += mbuf_pkthdr_len(mbuf: scan); |
| 5909 | pkt_count++; |
| 5910 | } |
| 5911 | (void)ifnet_stat_increment_in(interface: bridge_ifp, packets_in: pkt_count, bytes_in: byte_count, errors_in: 0); |
| 5912 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, |
| 5913 | "%s %d packet(s) %ld bytes" , |
| 5914 | bridge_ifp->if_xname, pkt_count, byte_count); |
| 5915 | dlil_input_packet_list(bridge_ifp, m); |
| 5916 | return; |
| 5917 | } |
| 5918 | |
| 5919 | static bool |
| 5920 | is_our_ip(ip_packet_info_t info_p, uint32_t ifscope) |
| 5921 | { |
| 5922 | bool ours; |
| 5923 | |
| 5924 | if (info_p->ip_is_ipv4) { |
| 5925 | struct in_addr dst_ip; |
| 5926 | |
| 5927 | bcopy(src: &info_p->ip_hdr.ip->ip_dst, dst: &dst_ip, n: sizeof(dst_ip)); |
| 5928 | ours = in_addr_is_ours(ip: dst_ip); |
| 5929 | } else { |
| 5930 | ours = in6_addr_is_ours(ip6_p: &info_p->ip_hdr.ip6->ip6_dst, ifscope); |
| 5931 | } |
| 5932 | return ours; |
| 5933 | } |
| 5934 | |
| 5935 | static inline errno_t |
| 5936 | bridge_vmnet_tag_input(ifnet_t bridge_ifp, ifnet_t ifp, |
| 5937 | const u_char * ether_dhost, mbuf_t *mp, |
| 5938 | bool is_broadcast, bool is_ip, bool is_ipv4, |
| 5939 | ip_packet_info * info_p, struct bripstats * stats_p, |
| 5940 | bool *info_initialized) |
| 5941 | { |
| 5942 | errno_t error = 0; |
| 5943 | bool is_local = false; |
| 5944 | struct pf_mtag *pf_mtag; |
| 5945 | u_int16_t tag = vmnet_tag; |
| 5946 | |
| 5947 | *info_initialized = false; |
| 5948 | if (is_broadcast) { |
| 5949 | if (_ether_cmp(a: ether_dhost, b: etherbroadcastaddr) == 0) { |
| 5950 | tag = vmnet_broadcast_tag; |
| 5951 | } else { |
| 5952 | tag = vmnet_multicast_tag; |
| 5953 | } |
| 5954 | } else if (is_ip) { |
| 5955 | unsigned int mac_hlen = sizeof(struct ether_header); |
| 5956 | |
| 5957 | bzero(s: stats_p, n: sizeof(*stats_p)); |
| 5958 | *info_initialized = true; |
| 5959 | error = bridge_get_ip_proto(mp, mac_hlen, is_ipv4, info_p, |
| 5960 | stats_p); |
| 5961 | if (error != 0) { |
| 5962 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_INPUT, |
| 5963 | "%s(%s) bridge_get_ip_proto failed %d" , |
| 5964 | bridge_ifp->if_xname, |
| 5965 | ifp->if_xname, error); |
| 5966 | if (*mp == NULL) { |
| 5967 | return EJUSTRETURN; |
| 5968 | } |
| 5969 | } else { |
| 5970 | is_local = is_our_ip(info_p, ifscope: bridge_ifp->if_index); |
| 5971 | if (is_local) { |
| 5972 | tag = vmnet_local_tag; |
| 5973 | } |
| 5974 | } |
| 5975 | } |
| 5976 | pf_mtag = pf_get_mtag(*mp); |
| 5977 | if (pf_mtag != NULL) { |
| 5978 | pf_mtag->pftag_tag = tag; |
| 5979 | } |
| 5980 | #if DEBUG || DEVELOPMENT |
| 5981 | { |
| 5982 | bool forced; |
| 5983 | |
| 5984 | BRIDGE_ERROR_GET_FORCED(forced, BRIDGE_FORCE_ONE); |
| 5985 | if (forced) { |
| 5986 | m_freem(*mp); |
| 5987 | *mp = NULL; |
| 5988 | error = EJUSTRETURN; |
| 5989 | goto done; |
| 5990 | } |
| 5991 | BRIDGE_ERROR_GET_FORCED(forced, BRIDGE_FORCE_TWO); |
| 5992 | if (forced) { |
| 5993 | error = _EBADIP; |
| 5994 | goto done; |
| 5995 | } |
| 5996 | } |
| 5997 | done: |
| 5998 | #endif /* DEBUG || DEVELOPMENT */ |
| 5999 | return error; |
| 6000 | } |
| 6001 | |
| 6002 | static void |
| 6003 | bripstats_apply(struct bripstats *dst_p, const struct bripstats *src_p) |
| 6004 | { |
| 6005 | dst_p->bips_ip += src_p->bips_ip; |
| 6006 | dst_p->bips_ip6 += src_p->bips_ip6; |
| 6007 | dst_p->bips_udp += src_p->bips_udp; |
| 6008 | dst_p->bips_tcp += src_p->bips_tcp; |
| 6009 | |
| 6010 | dst_p->bips_bad_ip += src_p->bips_bad_ip; |
| 6011 | dst_p->bips_bad_ip6 += src_p->bips_bad_ip6; |
| 6012 | dst_p->bips_bad_udp += src_p->bips_bad_udp; |
| 6013 | dst_p->bips_bad_tcp += src_p->bips_bad_tcp; |
| 6014 | } |
| 6015 | |
| 6016 | static void |
| 6017 | bridge_bripstats_apply(ifnet_t ifp, const struct bripstats *stats_p) |
| 6018 | { |
| 6019 | struct bridge_iflist *bif; |
| 6020 | struct bridge_softc *sc = ifp->if_bridge; |
| 6021 | |
| 6022 | BRIDGE_LOCK(sc); |
| 6023 | bif = bridge_lookup_member_if(sc, member_ifp: ifp); |
| 6024 | if (bif == NULL) { |
| 6025 | goto done; |
| 6026 | } |
| 6027 | if (!bif_has_checksum_offload(bif)) { |
| 6028 | goto done; |
| 6029 | } |
| 6030 | bripstats_apply(dst_p: &bif->bif_stats.brms_in_ip, src_p: stats_p); |
| 6031 | |
| 6032 | done: |
| 6033 | BRIDGE_UNLOCK(sc); |
| 6034 | return; |
| 6035 | } |
| 6036 | |
| 6037 | /* |
| 6038 | * bridge_input: |
| 6039 | * |
| 6040 | * Filter input from a member interface. Queue the packet for |
| 6041 | * bridging if it is not for us. |
| 6042 | */ |
| 6043 | errno_t |
| 6044 | bridge_input(struct ifnet *ifp, mbuf_t *data) |
| 6045 | { |
| 6046 | struct bridge_softc *sc = ifp->if_bridge; |
| 6047 | struct bridge_iflist *bif, *bif2; |
| 6048 | struct ether_header eh_in; |
| 6049 | bool is_ip = false; |
| 6050 | bool is_ipv4 = false; |
| 6051 | ifnet_t bridge_ifp; |
| 6052 | struct mbuf *mc, *mc2; |
| 6053 | unsigned int mac_hlen = sizeof(struct ether_header); |
| 6054 | uint16_t vlan; |
| 6055 | errno_t error; |
| 6056 | ip_packet_info info; |
| 6057 | struct bripstats stats; |
| 6058 | bool info_initialized = false; |
| 6059 | errno_t ip_packet_error = 0; |
| 6060 | bool is_broadcast; |
| 6061 | bool is_ip_broadcast = false; |
| 6062 | bool is_ifp_mac = false; |
| 6063 | mbuf_t m = *data; |
| 6064 | uint32_t sc_filter_flags = 0; |
| 6065 | |
| 6066 | bridge_ifp = sc->sc_ifp; |
| 6067 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, |
| 6068 | "%s from %s m 0x%llx data 0x%llx" , |
| 6069 | bridge_ifp->if_xname, ifp->if_xname, |
| 6070 | (uint64_t)VM_KERNEL_ADDRPERM(m), |
| 6071 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_data(m))); |
| 6072 | if ((sc->sc_ifp->if_flags & IFF_RUNNING) == 0) { |
| 6073 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, |
| 6074 | "%s not running passing along" , |
| 6075 | bridge_ifp->if_xname); |
| 6076 | return 0; |
| 6077 | } |
| 6078 | |
| 6079 | vlan = VLANTAGOF(m); |
| 6080 | |
| 6081 | #ifdef IFF_MONITOR |
| 6082 | /* |
| 6083 | * Implement support for bridge monitoring. If this flag has been |
| 6084 | * set on this interface, discard the packet once we push it through |
| 6085 | * the bpf(4) machinery, but before we do, increment the byte and |
| 6086 | * packet counters associated with this interface. |
| 6087 | */ |
| 6088 | if ((bridge_ifp->if_flags & IFF_MONITOR) != 0) { |
| 6089 | m->m_pkthdr.rcvif = bridge_ifp; |
| 6090 | BRIDGE_BPF_MTAP_INPUT(sc, m); |
| 6091 | (void) ifnet_stat_increment_in(bridge_ifp, 1, m->m_pkthdr.len, 0); |
| 6092 | *data = NULL; |
| 6093 | m_freem(m); |
| 6094 | return EJUSTRETURN; |
| 6095 | } |
| 6096 | #endif /* IFF_MONITOR */ |
| 6097 | |
| 6098 | is_broadcast = (m->m_flags & (M_BCAST | M_MCAST)) != 0; |
| 6099 | |
| 6100 | /* |
| 6101 | * Need to clear the promiscuous flag otherwise it will be |
| 6102 | * dropped by DLIL after processing filters |
| 6103 | */ |
| 6104 | if ((mbuf_flags(mbuf: m) & MBUF_PROMISC)) { |
| 6105 | mbuf_setflags_mask(mbuf: m, flags: 0, mask: MBUF_PROMISC); |
| 6106 | } |
| 6107 | |
| 6108 | /* copy the ethernet header */ |
| 6109 | eh_in = *(mtod(m, struct ether_header *)); |
| 6110 | |
| 6111 | is_ip = ether_header_type_is_ip(eh: &eh_in, is_ipv4: &is_ipv4); |
| 6112 | |
| 6113 | if (if_bridge_vmnet_pf_tagging != 0 && IFNET_IS_VMNET(ifp)) { |
| 6114 | /* tag packets coming from VMNET interfaces */ |
| 6115 | ip_packet_error = bridge_vmnet_tag_input(bridge_ifp, ifp, |
| 6116 | ether_dhost: eh_in.ether_dhost, mp: data, is_broadcast, is_ip, is_ipv4, |
| 6117 | info_p: &info, stats_p: &stats, info_initialized: &info_initialized); |
| 6118 | m = *data; |
| 6119 | if (m == NULL) { |
| 6120 | bridge_bripstats_apply(ifp, stats_p: &stats); |
| 6121 | return EJUSTRETURN; |
| 6122 | } |
| 6123 | } |
| 6124 | |
| 6125 | sc_filter_flags = sc->sc_filter_flags; |
| 6126 | if (PF_IS_ENABLED && (sc_filter_flags & IFBF_FILT_MEMBER)) { |
| 6127 | error = bridge_pf(data, ifp, sc_filter_flags, TRUE); |
| 6128 | m = *data; |
| 6129 | if (error != 0 || m == NULL) { |
| 6130 | return EJUSTRETURN; |
| 6131 | } |
| 6132 | } |
| 6133 | |
| 6134 | BRIDGE_LOCK(sc); |
| 6135 | bif = bridge_lookup_member_if(sc, member_ifp: ifp); |
| 6136 | if (bif == NULL) { |
| 6137 | BRIDGE_UNLOCK(sc); |
| 6138 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, |
| 6139 | "%s bridge_lookup_member_if failed" , |
| 6140 | bridge_ifp->if_xname); |
| 6141 | return 0; |
| 6142 | } |
| 6143 | if (is_ip && bif_has_checksum_offload(bif)) { |
| 6144 | if (info_initialized) { |
| 6145 | bripstats_apply(dst_p: &bif->bif_stats.brms_in_ip, src_p: &stats); |
| 6146 | } else { |
| 6147 | error = bridge_get_ip_proto(mp: data, mac_hlen, is_ipv4, |
| 6148 | info_p: &info, stats_p: &bif->bif_stats.brms_in_ip); |
| 6149 | if (error != 0) { |
| 6150 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_CHECKSUM, |
| 6151 | "%s(%s) bridge_get_ip_proto failed %d" , |
| 6152 | bridge_ifp->if_xname, |
| 6153 | bif->bif_ifp->if_xname, error); |
| 6154 | ip_packet_error = error; |
| 6155 | } |
| 6156 | } |
| 6157 | if (ip_packet_error == 0) { |
| 6158 | /* need to compute IP/UDP/TCP/checksums */ |
| 6159 | error = bridge_offload_checksum(mp: data, info_p: &info, |
| 6160 | stats_p: &bif->bif_stats); |
| 6161 | if (error != 0) { |
| 6162 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_CHECKSUM, |
| 6163 | "%s(%s) bridge_offload_checksum failed %d" , |
| 6164 | bridge_ifp->if_xname, |
| 6165 | bif->bif_ifp->if_xname, error); |
| 6166 | ip_packet_error = error; |
| 6167 | } |
| 6168 | } |
| 6169 | if (ip_packet_error != 0) { |
| 6170 | BRIDGE_UNLOCK(sc); |
| 6171 | if (*data != NULL) { |
| 6172 | m_freem(*data); |
| 6173 | *data = NULL; |
| 6174 | } |
| 6175 | return EJUSTRETURN; |
| 6176 | } |
| 6177 | m = *data; |
| 6178 | } |
| 6179 | |
| 6180 | if (bif->bif_flags & BIFF_HOST_FILTER) { |
| 6181 | error = bridge_host_filter(bif, data); |
| 6182 | if (error != 0) { |
| 6183 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_INPUT, |
| 6184 | "%s bridge_host_filter failed" , |
| 6185 | bif->bif_ifp->if_xname); |
| 6186 | BRIDGE_UNLOCK(sc); |
| 6187 | return EJUSTRETURN; |
| 6188 | } |
| 6189 | m = *data; |
| 6190 | } |
| 6191 | |
| 6192 | if (!is_broadcast && |
| 6193 | _ether_cmp(a: eh_in.ether_dhost, IF_LLADDR(ifp)) == 0) { |
| 6194 | /* the packet is unicast to the interface's MAC address */ |
| 6195 | if (is_ip && sc->sc_mac_nat_bif == bif) { |
| 6196 | /* doing MAC-NAT, check if destination is IP broadcast */ |
| 6197 | is_ip_broadcast = is_broadcast_ip_packet(data); |
| 6198 | if (*data == NULL) { |
| 6199 | BRIDGE_UNLOCK(sc); |
| 6200 | return EJUSTRETURN; |
| 6201 | } |
| 6202 | m = *data; |
| 6203 | } |
| 6204 | if (!is_ip_broadcast) { |
| 6205 | is_ifp_mac = TRUE; |
| 6206 | } |
| 6207 | } |
| 6208 | |
| 6209 | bridge_span(sc, m); |
| 6210 | |
| 6211 | if (is_broadcast || is_ip_broadcast) { |
| 6212 | if (is_broadcast && (m->m_flags & M_MCAST) != 0) { |
| 6213 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MCAST, |
| 6214 | " multicast: " |
| 6215 | "%02x:%02x:%02x:%02x:%02x:%02x" , |
| 6216 | eh_in.ether_dhost[0], eh_in.ether_dhost[1], |
| 6217 | eh_in.ether_dhost[2], eh_in.ether_dhost[3], |
| 6218 | eh_in.ether_dhost[4], eh_in.ether_dhost[5]); |
| 6219 | } |
| 6220 | /* Tap off 802.1D packets; they do not get forwarded. */ |
| 6221 | if (is_broadcast && |
| 6222 | _ether_cmp(a: eh_in.ether_dhost, b: bstp_etheraddr) == 0) { |
| 6223 | #if BRIDGESTP |
| 6224 | m = bstp_input(&bif->bif_stp, ifp, m); |
| 6225 | #else /* !BRIDGESTP */ |
| 6226 | m_freem(m); |
| 6227 | m = NULL; |
| 6228 | #endif /* !BRIDGESTP */ |
| 6229 | if (m == NULL) { |
| 6230 | BRIDGE_UNLOCK(sc); |
| 6231 | return EJUSTRETURN; |
| 6232 | } |
| 6233 | } |
| 6234 | |
| 6235 | if ((bif->bif_ifflags & IFBIF_STP) && |
| 6236 | bif->bif_stp.bp_state == BSTP_IFSTATE_DISCARDING) { |
| 6237 | BRIDGE_UNLOCK(sc); |
| 6238 | return 0; |
| 6239 | } |
| 6240 | |
| 6241 | /* |
| 6242 | * Make a deep copy of the packet and enqueue the copy |
| 6243 | * for bridge processing. |
| 6244 | */ |
| 6245 | mc = m_dup(m, M_DONTWAIT); |
| 6246 | if (mc == NULL) { |
| 6247 | BRIDGE_UNLOCK(sc); |
| 6248 | return 0; |
| 6249 | } |
| 6250 | |
| 6251 | /* |
| 6252 | * Perform the bridge forwarding function with the copy. |
| 6253 | * |
| 6254 | * Note that bridge_forward calls BRIDGE_UNLOCK |
| 6255 | */ |
| 6256 | if (is_ip_broadcast) { |
| 6257 | struct ether_header *eh; |
| 6258 | |
| 6259 | /* make the copy look like it is actually broadcast */ |
| 6260 | mc->m_flags |= M_BCAST; |
| 6261 | eh = mtod(mc, struct ether_header *); |
| 6262 | bcopy(src: etherbroadcastaddr, dst: eh->ether_dhost, |
| 6263 | ETHER_ADDR_LEN); |
| 6264 | } |
| 6265 | bridge_forward(sc, sbif: bif, m: mc); |
| 6266 | |
| 6267 | /* |
| 6268 | * Reinject the mbuf as arriving on the bridge so we have a |
| 6269 | * chance at claiming multicast packets. We can not loop back |
| 6270 | * here from ether_input as a bridge is never a member of a |
| 6271 | * bridge. |
| 6272 | */ |
| 6273 | VERIFY(bridge_ifp->if_bridge == NULL); |
| 6274 | mc2 = m_dup(m, M_DONTWAIT); |
| 6275 | if (mc2 != NULL) { |
| 6276 | /* Keep the layer3 header aligned */ |
| 6277 | int i = min(a: mc2->m_pkthdr.len, b: max_protohdr); |
| 6278 | mc2 = m_copyup(mc2, i, ETHER_ALIGN); |
| 6279 | } |
| 6280 | if (mc2 != NULL) { |
| 6281 | /* mark packet as arriving on the bridge */ |
| 6282 | mc2->m_pkthdr.rcvif = bridge_ifp; |
| 6283 | mc2->m_pkthdr.pkt_hdr = mbuf_data(mbuf: mc2); |
| 6284 | BRIDGE_BPF_MTAP_INPUT(sc, mc2); |
| 6285 | (void) mbuf_setdata(mbuf: mc2, |
| 6286 | data: (char *)mbuf_data(mbuf: mc2) + ETHER_HDR_LEN, |
| 6287 | len: mbuf_len(mbuf: mc2) - ETHER_HDR_LEN); |
| 6288 | (void) mbuf_pkthdr_adjustlen(mbuf: mc2, amount: -ETHER_HDR_LEN); |
| 6289 | (void) ifnet_stat_increment_in(interface: bridge_ifp, packets_in: 1, |
| 6290 | bytes_in: mbuf_pkthdr_len(mbuf: mc2), errors_in: 0); |
| 6291 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MCAST, |
| 6292 | "%s mcast for us" , bridge_ifp->if_xname); |
| 6293 | dlil_input_packet_list(bridge_ifp, mc2); |
| 6294 | } |
| 6295 | |
| 6296 | /* Return the original packet for local processing. */ |
| 6297 | return 0; |
| 6298 | } |
| 6299 | |
| 6300 | if ((bif->bif_ifflags & IFBIF_STP) && |
| 6301 | bif->bif_stp.bp_state == BSTP_IFSTATE_DISCARDING) { |
| 6302 | BRIDGE_UNLOCK(sc); |
| 6303 | return 0; |
| 6304 | } |
| 6305 | |
| 6306 | #ifdef DEV_CARP |
| 6307 | #define CARP_CHECK_WE_ARE_DST(iface) \ |
| 6308 | ((iface)->if_carp &&\ |
| 6309 | carp_forus((iface)->if_carp, eh_in.ether_dhost)) |
| 6310 | #define CARP_CHECK_WE_ARE_SRC(iface) \ |
| 6311 | ((iface)->if_carp &&\ |
| 6312 | carp_forus((iface)->if_carp, eh_in.ether_shost)) |
| 6313 | #else |
| 6314 | #define CARP_CHECK_WE_ARE_DST(iface) 0 |
| 6315 | #define CARP_CHECK_WE_ARE_SRC(iface) 0 |
| 6316 | #endif |
| 6317 | |
| 6318 | #define PFIL_HOOKED_INET6 PFIL_HOOKED(&inet6_pfil_hook) |
| 6319 | |
| 6320 | #define PFIL_PHYS(sc, ifp, m) |
| 6321 | |
| 6322 | #define GRAB_OUR_PACKETS(iface) \ |
| 6323 | if ((iface)->if_type == IFT_GIF) \ |
| 6324 | continue; \ |
| 6325 | /* It is destined for us. */ \ |
| 6326 | if (_ether_cmp(IF_LLADDR((iface)), eh_in.ether_dhost) == 0 || \ |
| 6327 | CARP_CHECK_WE_ARE_DST((iface))) { \ |
| 6328 | if ((iface)->if_type == IFT_BRIDGE) { \ |
| 6329 | BRIDGE_BPF_MTAP_INPUT(sc, m); \ |
| 6330 | /* Filter on the physical interface. */ \ |
| 6331 | PFIL_PHYS(sc, iface, m); \ |
| 6332 | } else { \ |
| 6333 | bpf_tap_in(iface, DLT_EN10MB, m, NULL, 0); \ |
| 6334 | } \ |
| 6335 | if (bif->bif_ifflags & IFBIF_LEARNING) { \ |
| 6336 | error = bridge_rtupdate(sc, eh_in.ether_shost, \ |
| 6337 | vlan, bif, 0, IFBAF_DYNAMIC); \ |
| 6338 | if (error && bif->bif_addrmax) { \ |
| 6339 | BRIDGE_UNLOCK(sc); \ |
| 6340 | m_freem(m); \ |
| 6341 | return (EJUSTRETURN); \ |
| 6342 | } \ |
| 6343 | } \ |
| 6344 | BRIDGE_UNLOCK(sc); \ |
| 6345 | inject_input_packet(iface, m); \ |
| 6346 | return (EJUSTRETURN); \ |
| 6347 | } \ |
| 6348 | \ |
| 6349 | /* We just received a packet that we sent out. */ \ |
| 6350 | if (_ether_cmp(IF_LLADDR((iface)), eh_in.ether_shost) == 0 || \ |
| 6351 | CARP_CHECK_WE_ARE_SRC((iface))) { \ |
| 6352 | BRIDGE_UNLOCK(sc); \ |
| 6353 | m_freem(m); \ |
| 6354 | return (EJUSTRETURN); \ |
| 6355 | } |
| 6356 | |
| 6357 | /* |
| 6358 | * Unicast. |
| 6359 | */ |
| 6360 | |
| 6361 | /* handle MAC-NAT if enabled */ |
| 6362 | if (is_ifp_mac && sc->sc_mac_nat_bif == bif) { |
| 6363 | ifnet_t dst_if; |
| 6364 | boolean_t is_input = FALSE; |
| 6365 | |
| 6366 | dst_if = bridge_mac_nat_input(sc, data, &is_input); |
| 6367 | m = *data; |
| 6368 | if (dst_if == ifp) { |
| 6369 | /* our input packet */ |
| 6370 | } else if (dst_if != NULL || m == NULL) { |
| 6371 | BRIDGE_UNLOCK(sc); |
| 6372 | if (dst_if != NULL) { |
| 6373 | ASSERT(m != NULL); |
| 6374 | if (is_input) { |
| 6375 | inject_input_packet(ifp: dst_if, m); |
| 6376 | } else { |
| 6377 | (void)bridge_enqueue(bridge_ifp, NULL, |
| 6378 | dst_ifp: dst_if, m, |
| 6379 | cksum_op: CHECKSUM_OPERATION_CLEAR_OFFLOAD); |
| 6380 | } |
| 6381 | } |
| 6382 | return EJUSTRETURN; |
| 6383 | } |
| 6384 | } |
| 6385 | |
| 6386 | /* |
| 6387 | * If the packet is for the bridge, pass it up for local processing. |
| 6388 | */ |
| 6389 | if (_ether_cmp(a: eh_in.ether_dhost, IF_LLADDR(bridge_ifp)) == 0 || |
| 6390 | CARP_CHECK_WE_ARE_DST(bridge_ifp)) { |
| 6391 | bpf_packet_func bpf_input_func = sc->sc_bpf_input; |
| 6392 | |
| 6393 | /* |
| 6394 | * If the interface is learning, and the source |
| 6395 | * address is valid and not multicast, record |
| 6396 | * the address. |
| 6397 | */ |
| 6398 | if (bif->bif_ifflags & IFBIF_LEARNING) { |
| 6399 | (void) bridge_rtupdate(sc, eh_in.ether_shost, |
| 6400 | vlan, bif, 0, IFBAF_DYNAMIC); |
| 6401 | } |
| 6402 | BRIDGE_UNLOCK(sc); |
| 6403 | |
| 6404 | bridge_interface_input(bridge_ifp, m, bpf_input_func); |
| 6405 | return EJUSTRETURN; |
| 6406 | } |
| 6407 | |
| 6408 | /* |
| 6409 | * if the destination of the packet is for the MAC address of |
| 6410 | * the member interface itself, then we don't need to forward |
| 6411 | * it -- just pass it back. Note that it'll likely just be |
| 6412 | * dropped by the stack, but if something else is bound to |
| 6413 | * the interface directly (for example, the wireless stats |
| 6414 | * protocol -- although that actually uses BPF right now), |
| 6415 | * then it will consume the packet |
| 6416 | * |
| 6417 | * ALSO, note that we do this check AFTER checking for the |
| 6418 | * bridge's own MAC address, because the bridge may be |
| 6419 | * using the SAME MAC address as one of its interfaces |
| 6420 | */ |
| 6421 | if (is_ifp_mac) { |
| 6422 | |
| 6423 | #ifdef VERY_VERY_VERY_DIAGNOSTIC |
| 6424 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 6425 | "not forwarding packet bound for member interface" ); |
| 6426 | #endif |
| 6427 | |
| 6428 | BRIDGE_UNLOCK(sc); |
| 6429 | return 0; |
| 6430 | } |
| 6431 | |
| 6432 | /* Now check the remaining bridge members. */ |
| 6433 | TAILQ_FOREACH(bif2, &sc->sc_iflist, bif_next) { |
| 6434 | if (bif2->bif_ifp != ifp) { |
| 6435 | GRAB_OUR_PACKETS(bif2->bif_ifp); |
| 6436 | } |
| 6437 | } |
| 6438 | |
| 6439 | #undef CARP_CHECK_WE_ARE_DST |
| 6440 | #undef CARP_CHECK_WE_ARE_SRC |
| 6441 | #undef GRAB_OUR_PACKETS |
| 6442 | |
| 6443 | /* |
| 6444 | * Perform the bridge forwarding function. |
| 6445 | * |
| 6446 | * Note that bridge_forward calls BRIDGE_UNLOCK |
| 6447 | */ |
| 6448 | bridge_forward(sc, sbif: bif, m); |
| 6449 | |
| 6450 | return EJUSTRETURN; |
| 6451 | } |
| 6452 | |
| 6453 | /* |
| 6454 | * bridge_broadcast: |
| 6455 | * |
| 6456 | * Send a frame to all interfaces that are members of |
| 6457 | * the bridge, except for the one on which the packet |
| 6458 | * arrived. |
| 6459 | * |
| 6460 | * NOTE: Releases the lock on return. |
| 6461 | */ |
| 6462 | static void |
| 6463 | bridge_broadcast(struct bridge_softc *sc, struct bridge_iflist * sbif, |
| 6464 | struct mbuf *m, int runfilt) |
| 6465 | { |
| 6466 | ifnet_t bridge_ifp; |
| 6467 | struct bridge_iflist *dbif; |
| 6468 | struct ifnet * src_if; |
| 6469 | struct mbuf *mc; |
| 6470 | struct mbuf *mc_in; |
| 6471 | struct ifnet *dst_if; |
| 6472 | int error = 0, used = 0; |
| 6473 | boolean_t bridge_if_out; |
| 6474 | ChecksumOperation cksum_op; |
| 6475 | struct mac_nat_record mnr; |
| 6476 | struct bridge_iflist *mac_nat_bif = sc->sc_mac_nat_bif; |
| 6477 | boolean_t translate_mac = FALSE; |
| 6478 | uint32_t sc_filter_flags = 0; |
| 6479 | |
| 6480 | bridge_ifp = sc->sc_ifp; |
| 6481 | if (sbif != NULL) { |
| 6482 | bridge_if_out = FALSE; |
| 6483 | src_if = sbif->bif_ifp; |
| 6484 | cksum_op = CHECKSUM_OPERATION_CLEAR_OFFLOAD; |
| 6485 | if (mac_nat_bif != NULL && sbif != mac_nat_bif) { |
| 6486 | /* get the translation record while holding the lock */ |
| 6487 | translate_mac |
| 6488 | = bridge_mac_nat_output(sc, sbif, &m, &mnr); |
| 6489 | if (m == NULL) { |
| 6490 | /* packet was deallocated */ |
| 6491 | BRIDGE_UNLOCK(sc); |
| 6492 | return; |
| 6493 | } |
| 6494 | } |
| 6495 | } else { |
| 6496 | /* |
| 6497 | * sbif is NULL when the bridge interface calls |
| 6498 | * bridge_broadcast(). |
| 6499 | */ |
| 6500 | bridge_if_out = TRUE; |
| 6501 | cksum_op = CHECKSUM_OPERATION_FINALIZE; |
| 6502 | sbif = NULL; |
| 6503 | src_if = NULL; |
| 6504 | } |
| 6505 | |
| 6506 | BRIDGE_LOCK2REF(sc, error); |
| 6507 | if (error) { |
| 6508 | m_freem(m); |
| 6509 | return; |
| 6510 | } |
| 6511 | |
| 6512 | TAILQ_FOREACH(dbif, &sc->sc_iflist, bif_next) { |
| 6513 | dst_if = dbif->bif_ifp; |
| 6514 | if (dst_if == src_if) { |
| 6515 | /* skip the interface that the packet came in on */ |
| 6516 | continue; |
| 6517 | } |
| 6518 | |
| 6519 | /* Private segments can not talk to each other */ |
| 6520 | if (sbif != NULL && |
| 6521 | (sbif->bif_ifflags & dbif->bif_ifflags & IFBIF_PRIVATE)) { |
| 6522 | continue; |
| 6523 | } |
| 6524 | |
| 6525 | if ((dbif->bif_ifflags & IFBIF_STP) && |
| 6526 | dbif->bif_stp.bp_state == BSTP_IFSTATE_DISCARDING) { |
| 6527 | continue; |
| 6528 | } |
| 6529 | |
| 6530 | if ((dbif->bif_ifflags & IFBIF_DISCOVER) == 0 && |
| 6531 | (m->m_flags & (M_BCAST | M_MCAST)) == 0) { |
| 6532 | continue; |
| 6533 | } |
| 6534 | |
| 6535 | if ((dst_if->if_flags & IFF_RUNNING) == 0) { |
| 6536 | continue; |
| 6537 | } |
| 6538 | |
| 6539 | if (!(dbif->bif_flags & BIFF_MEDIA_ACTIVE)) { |
| 6540 | continue; |
| 6541 | } |
| 6542 | |
| 6543 | if (TAILQ_NEXT(dbif, bif_next) == NULL) { |
| 6544 | mc = m; |
| 6545 | used = 1; |
| 6546 | } else { |
| 6547 | mc = m_dup(m, M_DONTWAIT); |
| 6548 | if (mc == NULL) { |
| 6549 | (void) ifnet_stat_increment_out(interface: bridge_ifp, |
| 6550 | packets_out: 0, bytes_out: 0, errors_out: 1); |
| 6551 | continue; |
| 6552 | } |
| 6553 | } |
| 6554 | |
| 6555 | /* |
| 6556 | * If broadcast input is enabled, do so only if this |
| 6557 | * is an input packet. |
| 6558 | */ |
| 6559 | if (!bridge_if_out && |
| 6560 | (dbif->bif_flags & BIFF_INPUT_BROADCAST) != 0) { |
| 6561 | mc_in = m_dup(m: mc, M_DONTWAIT); |
| 6562 | /* this could fail, but we continue anyways */ |
| 6563 | } else { |
| 6564 | mc_in = NULL; |
| 6565 | } |
| 6566 | |
| 6567 | /* out */ |
| 6568 | if (translate_mac && mac_nat_bif == dbif) { |
| 6569 | /* translate the packet without holding the lock */ |
| 6570 | bridge_mac_nat_translate(&mc, &mnr, IF_LLADDR(dst_if)); |
| 6571 | } |
| 6572 | |
| 6573 | sc_filter_flags = sc->sc_filter_flags; |
| 6574 | if (runfilt && |
| 6575 | PF_IS_ENABLED && (sc_filter_flags & IFBF_FILT_MEMBER)) { |
| 6576 | if (used == 0) { |
| 6577 | /* Keep the layer3 header aligned */ |
| 6578 | int i = min(a: mc->m_pkthdr.len, b: max_protohdr); |
| 6579 | mc = m_copyup(mc, i, ETHER_ALIGN); |
| 6580 | if (mc == NULL) { |
| 6581 | (void) ifnet_stat_increment_out( |
| 6582 | interface: sc->sc_ifp, packets_out: 0, bytes_out: 0, errors_out: 1); |
| 6583 | if (mc_in != NULL) { |
| 6584 | m_freem(mc_in); |
| 6585 | mc_in = NULL; |
| 6586 | } |
| 6587 | continue; |
| 6588 | } |
| 6589 | } |
| 6590 | if (bridge_pf(&mc, dst_if, sc_filter_flags, FALSE) != 0) { |
| 6591 | if (mc_in != NULL) { |
| 6592 | m_freem(mc_in); |
| 6593 | mc_in = NULL; |
| 6594 | } |
| 6595 | continue; |
| 6596 | } |
| 6597 | if (mc == NULL) { |
| 6598 | if (mc_in != NULL) { |
| 6599 | m_freem(mc_in); |
| 6600 | mc_in = NULL; |
| 6601 | } |
| 6602 | continue; |
| 6603 | } |
| 6604 | } |
| 6605 | |
| 6606 | if (mc != NULL) { |
| 6607 | /* verify checksum if necessary */ |
| 6608 | if (bif_has_checksum_offload(bif: dbif) && sbif != NULL && |
| 6609 | !bif_has_checksum_offload(bif: sbif)) { |
| 6610 | error = bridge_verify_checksum(mp: &mc, |
| 6611 | stats_p: &dbif->bif_stats); |
| 6612 | if (error != 0) { |
| 6613 | if (mc != NULL) { |
| 6614 | m_freem(mc); |
| 6615 | } |
| 6616 | mc = NULL; |
| 6617 | } |
| 6618 | } |
| 6619 | if (mc != NULL) { |
| 6620 | (void) bridge_enqueue(bridge_ifp, |
| 6621 | NULL, dst_ifp: dst_if, m: mc, cksum_op); |
| 6622 | } |
| 6623 | } |
| 6624 | |
| 6625 | /* in */ |
| 6626 | if (mc_in == NULL) { |
| 6627 | continue; |
| 6628 | } |
| 6629 | bpf_tap_in(interface: dst_if, DLT_EN10MB, packet: mc_in, NULL, header_len: 0); |
| 6630 | mbuf_pkthdr_setrcvif(mbuf: mc_in, ifp: dst_if); |
| 6631 | mbuf_pkthdr_setheader(mbuf: mc_in, header: mbuf_data(mbuf: mc_in)); |
| 6632 | mbuf_setdata(mbuf: mc_in, data: (char *)mbuf_data(mbuf: mc_in) + ETHER_HDR_LEN, |
| 6633 | len: mbuf_len(mbuf: mc_in) - ETHER_HDR_LEN); |
| 6634 | mbuf_pkthdr_adjustlen(mbuf: mc_in, amount: -ETHER_HDR_LEN); |
| 6635 | mc_in->m_flags |= M_PROTO1; /* set to avoid loops */ |
| 6636 | dlil_input_packet_list(dst_if, mc_in); |
| 6637 | } |
| 6638 | if (used == 0) { |
| 6639 | m_freem(m); |
| 6640 | } |
| 6641 | |
| 6642 | |
| 6643 | BRIDGE_UNREF(sc); |
| 6644 | } |
| 6645 | |
| 6646 | /* |
| 6647 | * bridge_span: |
| 6648 | * |
| 6649 | * Duplicate a packet out one or more interfaces that are in span mode, |
| 6650 | * the original mbuf is unmodified. |
| 6651 | */ |
| 6652 | static void |
| 6653 | bridge_span(struct bridge_softc *sc, struct mbuf *m) |
| 6654 | { |
| 6655 | struct bridge_iflist *bif; |
| 6656 | struct ifnet *dst_if; |
| 6657 | struct mbuf *mc; |
| 6658 | |
| 6659 | if (TAILQ_EMPTY(&sc->sc_spanlist)) { |
| 6660 | return; |
| 6661 | } |
| 6662 | |
| 6663 | TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) { |
| 6664 | dst_if = bif->bif_ifp; |
| 6665 | |
| 6666 | if ((dst_if->if_flags & IFF_RUNNING) == 0) { |
| 6667 | continue; |
| 6668 | } |
| 6669 | |
| 6670 | mc = m_copypacket(m, M_DONTWAIT); |
| 6671 | if (mc == NULL) { |
| 6672 | (void) ifnet_stat_increment_out(interface: sc->sc_ifp, packets_out: 0, bytes_out: 0, errors_out: 1); |
| 6673 | continue; |
| 6674 | } |
| 6675 | |
| 6676 | (void) bridge_enqueue(bridge_ifp: sc->sc_ifp, NULL, dst_ifp: dst_if, m: mc, |
| 6677 | cksum_op: CHECKSUM_OPERATION_NONE); |
| 6678 | } |
| 6679 | } |
| 6680 | |
| 6681 | |
| 6682 | /* |
| 6683 | * bridge_rtupdate: |
| 6684 | * |
| 6685 | * Add a bridge routing entry. |
| 6686 | */ |
| 6687 | static int |
| 6688 | bridge_rtupdate(struct bridge_softc *sc, const uint8_t *dst, uint16_t vlan, |
| 6689 | struct bridge_iflist *bif, int setflags, uint8_t flags) |
| 6690 | { |
| 6691 | struct bridge_rtnode *brt; |
| 6692 | int error; |
| 6693 | |
| 6694 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6695 | |
| 6696 | /* Check the source address is valid and not multicast. */ |
| 6697 | if (ETHER_IS_MULTICAST(dst) || |
| 6698 | (dst[0] == 0 && dst[1] == 0 && dst[2] == 0 && |
| 6699 | dst[3] == 0 && dst[4] == 0 && dst[5] == 0) != 0) { |
| 6700 | return EINVAL; |
| 6701 | } |
| 6702 | |
| 6703 | |
| 6704 | /* 802.1p frames map to vlan 1 */ |
| 6705 | if (vlan == 0) { |
| 6706 | vlan = 1; |
| 6707 | } |
| 6708 | |
| 6709 | /* |
| 6710 | * A route for this destination might already exist. If so, |
| 6711 | * update it, otherwise create a new one. |
| 6712 | */ |
| 6713 | if ((brt = bridge_rtnode_lookup(sc, dst, vlan)) == NULL) { |
| 6714 | if (sc->sc_brtcnt >= sc->sc_brtmax) { |
| 6715 | sc->sc_brtexceeded++; |
| 6716 | return ENOSPC; |
| 6717 | } |
| 6718 | /* Check per interface address limits (if enabled) */ |
| 6719 | if (bif->bif_addrmax && bif->bif_addrcnt >= bif->bif_addrmax) { |
| 6720 | bif->bif_addrexceeded++; |
| 6721 | return ENOSPC; |
| 6722 | } |
| 6723 | |
| 6724 | /* |
| 6725 | * Allocate a new bridge forwarding node, and |
| 6726 | * initialize the expiration time and Ethernet |
| 6727 | * address. |
| 6728 | */ |
| 6729 | brt = zalloc_noblock(kt_view: bridge_rtnode_pool); |
| 6730 | if (brt == NULL) { |
| 6731 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_RT_TABLE, |
| 6732 | "zalloc_nolock failed" ); |
| 6733 | return ENOMEM; |
| 6734 | } |
| 6735 | bzero(s: brt, n: sizeof(struct bridge_rtnode)); |
| 6736 | |
| 6737 | if (bif->bif_ifflags & IFBIF_STICKY) { |
| 6738 | brt->brt_flags = IFBAF_STICKY; |
| 6739 | } else { |
| 6740 | brt->brt_flags = IFBAF_DYNAMIC; |
| 6741 | } |
| 6742 | |
| 6743 | memcpy(dst: brt->brt_addr, src: dst, ETHER_ADDR_LEN); |
| 6744 | brt->brt_vlan = vlan; |
| 6745 | |
| 6746 | |
| 6747 | if ((error = bridge_rtnode_insert(sc, brt)) != 0) { |
| 6748 | zfree(bridge_rtnode_pool, brt); |
| 6749 | return error; |
| 6750 | } |
| 6751 | brt->brt_dst = bif; |
| 6752 | bif->bif_addrcnt++; |
| 6753 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_RT_TABLE, |
| 6754 | "added %02x:%02x:%02x:%02x:%02x:%02x " |
| 6755 | "on %s count %u hashsize %u" , |
| 6756 | dst[0], dst[1], dst[2], dst[3], dst[4], dst[5], |
| 6757 | sc->sc_ifp->if_xname, sc->sc_brtcnt, |
| 6758 | sc->sc_rthash_size); |
| 6759 | } |
| 6760 | |
| 6761 | if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC && |
| 6762 | brt->brt_dst != bif) { |
| 6763 | brt->brt_dst->bif_addrcnt--; |
| 6764 | brt->brt_dst = bif; |
| 6765 | brt->brt_dst->bif_addrcnt++; |
| 6766 | } |
| 6767 | |
| 6768 | if ((flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) { |
| 6769 | unsigned long now; |
| 6770 | |
| 6771 | now = (unsigned long) net_uptime(); |
| 6772 | brt->brt_expire = now + sc->sc_brttimeout; |
| 6773 | } |
| 6774 | if (setflags) { |
| 6775 | brt->brt_flags = flags; |
| 6776 | } |
| 6777 | |
| 6778 | |
| 6779 | return 0; |
| 6780 | } |
| 6781 | |
| 6782 | /* |
| 6783 | * bridge_rtlookup: |
| 6784 | * |
| 6785 | * Lookup the destination interface for an address. |
| 6786 | */ |
| 6787 | static struct ifnet * |
| 6788 | bridge_rtlookup(struct bridge_softc *sc, const uint8_t *addr, uint16_t vlan) |
| 6789 | { |
| 6790 | struct bridge_rtnode *brt; |
| 6791 | |
| 6792 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6793 | |
| 6794 | if ((brt = bridge_rtnode_lookup(sc, addr, vlan)) == NULL) { |
| 6795 | return NULL; |
| 6796 | } |
| 6797 | |
| 6798 | return brt->brt_ifp; |
| 6799 | } |
| 6800 | |
| 6801 | /* |
| 6802 | * bridge_rttrim: |
| 6803 | * |
| 6804 | * Trim the routine table so that we have a number |
| 6805 | * of routing entries less than or equal to the |
| 6806 | * maximum number. |
| 6807 | */ |
| 6808 | static void |
| 6809 | bridge_rttrim(struct bridge_softc *sc) |
| 6810 | { |
| 6811 | struct bridge_rtnode *brt, *nbrt; |
| 6812 | |
| 6813 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6814 | |
| 6815 | /* Make sure we actually need to do this. */ |
| 6816 | if (sc->sc_brtcnt <= sc->sc_brtmax) { |
| 6817 | return; |
| 6818 | } |
| 6819 | |
| 6820 | /* Force an aging cycle; this might trim enough addresses. */ |
| 6821 | bridge_rtage(sc); |
| 6822 | if (sc->sc_brtcnt <= sc->sc_brtmax) { |
| 6823 | return; |
| 6824 | } |
| 6825 | |
| 6826 | LIST_FOREACH_SAFE(brt, &sc->sc_rtlist, brt_list, nbrt) { |
| 6827 | if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) { |
| 6828 | bridge_rtnode_destroy(sc, brt); |
| 6829 | if (sc->sc_brtcnt <= sc->sc_brtmax) { |
| 6830 | return; |
| 6831 | } |
| 6832 | } |
| 6833 | } |
| 6834 | } |
| 6835 | |
| 6836 | /* |
| 6837 | * bridge_aging_timer: |
| 6838 | * |
| 6839 | * Aging periodic timer for the bridge routing table. |
| 6840 | */ |
| 6841 | static void |
| 6842 | bridge_aging_timer(struct bridge_softc *sc) |
| 6843 | { |
| 6844 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6845 | |
| 6846 | bridge_rtage(sc); |
| 6847 | if ((sc->sc_ifp->if_flags & IFF_RUNNING) && |
| 6848 | (sc->sc_flags & SCF_DETACHING) == 0) { |
| 6849 | sc->sc_aging_timer.bdc_sc = sc; |
| 6850 | sc->sc_aging_timer.bdc_func = bridge_aging_timer; |
| 6851 | sc->sc_aging_timer.bdc_ts.tv_sec = bridge_rtable_prune_period; |
| 6852 | bridge_schedule_delayed_call(call: &sc->sc_aging_timer); |
| 6853 | } |
| 6854 | } |
| 6855 | |
| 6856 | /* |
| 6857 | * bridge_rtage: |
| 6858 | * |
| 6859 | * Perform an aging cycle. |
| 6860 | */ |
| 6861 | static void |
| 6862 | bridge_rtage(struct bridge_softc *sc) |
| 6863 | { |
| 6864 | struct bridge_rtnode *brt, *nbrt; |
| 6865 | unsigned long now; |
| 6866 | |
| 6867 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6868 | |
| 6869 | now = (unsigned long) net_uptime(); |
| 6870 | |
| 6871 | LIST_FOREACH_SAFE(brt, &sc->sc_rtlist, brt_list, nbrt) { |
| 6872 | if ((brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) { |
| 6873 | if (now >= brt->brt_expire) { |
| 6874 | bridge_rtnode_destroy(sc, brt); |
| 6875 | } |
| 6876 | } |
| 6877 | } |
| 6878 | if (sc->sc_mac_nat_bif != NULL) { |
| 6879 | bridge_mac_nat_age_entries(sc, now); |
| 6880 | } |
| 6881 | } |
| 6882 | |
| 6883 | /* |
| 6884 | * bridge_rtflush: |
| 6885 | * |
| 6886 | * Remove all dynamic addresses from the bridge. |
| 6887 | */ |
| 6888 | static void |
| 6889 | bridge_rtflush(struct bridge_softc *sc, int full) |
| 6890 | { |
| 6891 | struct bridge_rtnode *brt, *nbrt; |
| 6892 | |
| 6893 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6894 | |
| 6895 | LIST_FOREACH_SAFE(brt, &sc->sc_rtlist, brt_list, nbrt) { |
| 6896 | if (full || (brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) { |
| 6897 | bridge_rtnode_destroy(sc, brt); |
| 6898 | } |
| 6899 | } |
| 6900 | } |
| 6901 | |
| 6902 | /* |
| 6903 | * bridge_rtdaddr: |
| 6904 | * |
| 6905 | * Remove an address from the table. |
| 6906 | */ |
| 6907 | static int |
| 6908 | bridge_rtdaddr(struct bridge_softc *sc, const uint8_t *addr, uint16_t vlan) |
| 6909 | { |
| 6910 | struct bridge_rtnode *brt; |
| 6911 | int found = 0; |
| 6912 | |
| 6913 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6914 | |
| 6915 | /* |
| 6916 | * If vlan is zero then we want to delete for all vlans so the lookup |
| 6917 | * may return more than one. |
| 6918 | */ |
| 6919 | while ((brt = bridge_rtnode_lookup(sc, addr, vlan)) != NULL) { |
| 6920 | bridge_rtnode_destroy(sc, brt); |
| 6921 | found = 1; |
| 6922 | } |
| 6923 | |
| 6924 | return found ? 0 : ENOENT; |
| 6925 | } |
| 6926 | |
| 6927 | /* |
| 6928 | * bridge_rtdelete: |
| 6929 | * |
| 6930 | * Delete routes to a specific member interface. |
| 6931 | */ |
| 6932 | static void |
| 6933 | bridge_rtdelete(struct bridge_softc *sc, struct ifnet *ifp, int full) |
| 6934 | { |
| 6935 | struct bridge_rtnode *brt, *nbrt; |
| 6936 | |
| 6937 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6938 | |
| 6939 | LIST_FOREACH_SAFE(brt, &sc->sc_rtlist, brt_list, nbrt) { |
| 6940 | if (brt->brt_ifp == ifp && (full || |
| 6941 | (brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC)) { |
| 6942 | bridge_rtnode_destroy(sc, brt); |
| 6943 | } |
| 6944 | } |
| 6945 | } |
| 6946 | |
| 6947 | /* |
| 6948 | * bridge_rtable_init: |
| 6949 | * |
| 6950 | * Initialize the route table for this bridge. |
| 6951 | */ |
| 6952 | static int |
| 6953 | bridge_rtable_init(struct bridge_softc *sc) |
| 6954 | { |
| 6955 | u_int32_t i; |
| 6956 | |
| 6957 | sc->sc_rthash = kalloc_type(struct _bridge_rtnode_list, |
| 6958 | BRIDGE_RTHASH_SIZE, Z_WAITOK_ZERO_NOFAIL); |
| 6959 | sc->sc_rthash_size = BRIDGE_RTHASH_SIZE; |
| 6960 | |
| 6961 | for (i = 0; i < sc->sc_rthash_size; i++) { |
| 6962 | LIST_INIT(&sc->sc_rthash[i]); |
| 6963 | } |
| 6964 | |
| 6965 | sc->sc_rthash_key = RandomULong(); |
| 6966 | |
| 6967 | LIST_INIT(&sc->sc_rtlist); |
| 6968 | |
| 6969 | return 0; |
| 6970 | } |
| 6971 | |
| 6972 | /* |
| 6973 | * bridge_rthash_delayed_resize: |
| 6974 | * |
| 6975 | * Resize the routing table hash on a delayed thread call. |
| 6976 | */ |
| 6977 | static void |
| 6978 | bridge_rthash_delayed_resize(struct bridge_softc *sc) |
| 6979 | { |
| 6980 | u_int32_t new_rthash_size = 0; |
| 6981 | u_int32_t old_rthash_size = 0; |
| 6982 | struct _bridge_rtnode_list *new_rthash = NULL; |
| 6983 | struct _bridge_rtnode_list *old_rthash = NULL; |
| 6984 | u_int32_t i; |
| 6985 | struct bridge_rtnode *brt; |
| 6986 | int error = 0; |
| 6987 | |
| 6988 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 6989 | |
| 6990 | /* |
| 6991 | * Four entries per hash bucket is our ideal load factor |
| 6992 | */ |
| 6993 | if (sc->sc_brtcnt < sc->sc_rthash_size * 4) { |
| 6994 | goto out; |
| 6995 | } |
| 6996 | |
| 6997 | /* |
| 6998 | * Doubling the number of hash buckets may be too simplistic |
| 6999 | * especially when facing a spike of new entries |
| 7000 | */ |
| 7001 | new_rthash_size = sc->sc_rthash_size * 2; |
| 7002 | |
| 7003 | sc->sc_flags |= SCF_RESIZING; |
| 7004 | BRIDGE_UNLOCK(sc); |
| 7005 | |
| 7006 | new_rthash = kalloc_type(struct _bridge_rtnode_list, new_rthash_size, |
| 7007 | Z_WAITOK | Z_ZERO); |
| 7008 | |
| 7009 | BRIDGE_LOCK(sc); |
| 7010 | sc->sc_flags &= ~SCF_RESIZING; |
| 7011 | |
| 7012 | if (new_rthash == NULL) { |
| 7013 | error = ENOMEM; |
| 7014 | goto out; |
| 7015 | } |
| 7016 | if ((sc->sc_flags & SCF_DETACHING)) { |
| 7017 | error = ENODEV; |
| 7018 | goto out; |
| 7019 | } |
| 7020 | /* |
| 7021 | * Fail safe from here on |
| 7022 | */ |
| 7023 | old_rthash = sc->sc_rthash; |
| 7024 | old_rthash_size = sc->sc_rthash_size; |
| 7025 | sc->sc_rthash = new_rthash; |
| 7026 | sc->sc_rthash_size = new_rthash_size; |
| 7027 | |
| 7028 | /* |
| 7029 | * Get a new key to force entries to be shuffled around to reduce |
| 7030 | * the likelihood they will land in the same buckets |
| 7031 | */ |
| 7032 | sc->sc_rthash_key = RandomULong(); |
| 7033 | |
| 7034 | for (i = 0; i < sc->sc_rthash_size; i++) { |
| 7035 | LIST_INIT(&sc->sc_rthash[i]); |
| 7036 | } |
| 7037 | |
| 7038 | LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) { |
| 7039 | LIST_REMOVE(brt, brt_hash); |
| 7040 | (void) bridge_rtnode_hash(sc, brt); |
| 7041 | } |
| 7042 | out: |
| 7043 | if (error == 0) { |
| 7044 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_RT_TABLE, |
| 7045 | "%s new size %u" , |
| 7046 | sc->sc_ifp->if_xname, sc->sc_rthash_size); |
| 7047 | kfree_type(struct _bridge_rtnode_list, old_rthash_size, old_rthash); |
| 7048 | } else { |
| 7049 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_RT_TABLE, |
| 7050 | "%s failed %d" , sc->sc_ifp->if_xname, error); |
| 7051 | kfree_type(struct _bridge_rtnode_list, new_rthash_size, new_rthash); |
| 7052 | } |
| 7053 | } |
| 7054 | |
| 7055 | /* |
| 7056 | * Resize the number of hash buckets based on the load factor |
| 7057 | * Currently only grow |
| 7058 | * Failing to resize the hash table is not fatal |
| 7059 | */ |
| 7060 | static void |
| 7061 | bridge_rthash_resize(struct bridge_softc *sc) |
| 7062 | { |
| 7063 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 7064 | |
| 7065 | if ((sc->sc_flags & SCF_DETACHING) || (sc->sc_flags & SCF_RESIZING)) { |
| 7066 | return; |
| 7067 | } |
| 7068 | |
| 7069 | /* |
| 7070 | * Four entries per hash bucket is our ideal load factor |
| 7071 | */ |
| 7072 | if (sc->sc_brtcnt < sc->sc_rthash_size * 4) { |
| 7073 | return; |
| 7074 | } |
| 7075 | /* |
| 7076 | * Hard limit on the size of the routing hash table |
| 7077 | */ |
| 7078 | if (sc->sc_rthash_size >= bridge_rtable_hash_size_max) { |
| 7079 | return; |
| 7080 | } |
| 7081 | |
| 7082 | sc->sc_resize_call.bdc_sc = sc; |
| 7083 | sc->sc_resize_call.bdc_func = bridge_rthash_delayed_resize; |
| 7084 | bridge_schedule_delayed_call(call: &sc->sc_resize_call); |
| 7085 | } |
| 7086 | |
| 7087 | /* |
| 7088 | * bridge_rtable_fini: |
| 7089 | * |
| 7090 | * Deconstruct the route table for this bridge. |
| 7091 | */ |
| 7092 | static void |
| 7093 | bridge_rtable_fini(struct bridge_softc *sc) |
| 7094 | { |
| 7095 | KASSERT(sc->sc_brtcnt == 0, |
| 7096 | ("%s: %d bridge routes referenced" , __func__, sc->sc_brtcnt)); |
| 7097 | kfree_type(struct _bridge_rtnode_list, sc->sc_rthash_size, |
| 7098 | sc->sc_rthash); |
| 7099 | sc->sc_rthash = NULL; |
| 7100 | sc->sc_rthash_size = 0; |
| 7101 | } |
| 7102 | |
| 7103 | /* |
| 7104 | * The following hash function is adapted from "Hash Functions" by Bob Jenkins |
| 7105 | * ("Algorithm Alley", Dr. Dobbs Journal, September 1997). |
| 7106 | */ |
| 7107 | #define mix(a, b, c) \ |
| 7108 | do { \ |
| 7109 | a -= b; a -= c; a ^= (c >> 13); \ |
| 7110 | b -= c; b -= a; b ^= (a << 8); \ |
| 7111 | c -= a; c -= b; c ^= (b >> 13); \ |
| 7112 | a -= b; a -= c; a ^= (c >> 12); \ |
| 7113 | b -= c; b -= a; b ^= (a << 16); \ |
| 7114 | c -= a; c -= b; c ^= (b >> 5); \ |
| 7115 | a -= b; a -= c; a ^= (c >> 3); \ |
| 7116 | b -= c; b -= a; b ^= (a << 10); \ |
| 7117 | c -= a; c -= b; c ^= (b >> 15); \ |
| 7118 | } while ( /*CONSTCOND*/ 0) |
| 7119 | |
| 7120 | static __inline uint32_t |
| 7121 | bridge_rthash(struct bridge_softc *sc, const uint8_t *addr) |
| 7122 | { |
| 7123 | uint32_t a = 0x9e3779b9, b = 0x9e3779b9, c = sc->sc_rthash_key; |
| 7124 | |
| 7125 | b += addr[5] << 8; |
| 7126 | b += addr[4]; |
| 7127 | a += addr[3] << 24; |
| 7128 | a += addr[2] << 16; |
| 7129 | a += addr[1] << 8; |
| 7130 | a += addr[0]; |
| 7131 | |
| 7132 | mix(a, b, c); |
| 7133 | |
| 7134 | return c & BRIDGE_RTHASH_MASK(sc); |
| 7135 | } |
| 7136 | |
| 7137 | #undef mix |
| 7138 | |
| 7139 | static int |
| 7140 | bridge_rtnode_addr_cmp(const uint8_t *a, const uint8_t *b) |
| 7141 | { |
| 7142 | int i, d; |
| 7143 | |
| 7144 | for (i = 0, d = 0; i < ETHER_ADDR_LEN && d == 0; i++) { |
| 7145 | d = ((int)a[i]) - ((int)b[i]); |
| 7146 | } |
| 7147 | |
| 7148 | return d; |
| 7149 | } |
| 7150 | |
| 7151 | /* |
| 7152 | * bridge_rtnode_lookup: |
| 7153 | * |
| 7154 | * Look up a bridge route node for the specified destination. Compare the |
| 7155 | * vlan id or if zero then just return the first match. |
| 7156 | */ |
| 7157 | static struct bridge_rtnode * |
| 7158 | bridge_rtnode_lookup(struct bridge_softc *sc, const uint8_t *addr, |
| 7159 | uint16_t vlan) |
| 7160 | { |
| 7161 | struct bridge_rtnode *brt; |
| 7162 | uint32_t hash; |
| 7163 | int dir; |
| 7164 | |
| 7165 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 7166 | |
| 7167 | hash = bridge_rthash(sc, addr); |
| 7168 | LIST_FOREACH(brt, &sc->sc_rthash[hash], brt_hash) { |
| 7169 | dir = bridge_rtnode_addr_cmp(a: addr, b: brt->brt_addr); |
| 7170 | if (dir == 0 && (brt->brt_vlan == vlan || vlan == 0)) { |
| 7171 | return brt; |
| 7172 | } |
| 7173 | if (dir > 0) { |
| 7174 | return NULL; |
| 7175 | } |
| 7176 | } |
| 7177 | |
| 7178 | return NULL; |
| 7179 | } |
| 7180 | |
| 7181 | /* |
| 7182 | * bridge_rtnode_hash: |
| 7183 | * |
| 7184 | * Insert the specified bridge node into the route hash table. |
| 7185 | * This is used when adding a new node or to rehash when resizing |
| 7186 | * the hash table |
| 7187 | */ |
| 7188 | static int |
| 7189 | bridge_rtnode_hash(struct bridge_softc *sc, struct bridge_rtnode *brt) |
| 7190 | { |
| 7191 | struct bridge_rtnode *lbrt; |
| 7192 | uint32_t hash; |
| 7193 | int dir; |
| 7194 | |
| 7195 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 7196 | |
| 7197 | hash = bridge_rthash(sc, addr: brt->brt_addr); |
| 7198 | |
| 7199 | lbrt = LIST_FIRST(&sc->sc_rthash[hash]); |
| 7200 | if (lbrt == NULL) { |
| 7201 | LIST_INSERT_HEAD(&sc->sc_rthash[hash], brt, brt_hash); |
| 7202 | goto out; |
| 7203 | } |
| 7204 | |
| 7205 | do { |
| 7206 | dir = bridge_rtnode_addr_cmp(a: brt->brt_addr, b: lbrt->brt_addr); |
| 7207 | if (dir == 0 && brt->brt_vlan == lbrt->brt_vlan) { |
| 7208 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_RT_TABLE, |
| 7209 | "%s EEXIST %02x:%02x:%02x:%02x:%02x:%02x" , |
| 7210 | sc->sc_ifp->if_xname, |
| 7211 | brt->brt_addr[0], brt->brt_addr[1], |
| 7212 | brt->brt_addr[2], brt->brt_addr[3], |
| 7213 | brt->brt_addr[4], brt->brt_addr[5]); |
| 7214 | return EEXIST; |
| 7215 | } |
| 7216 | if (dir > 0) { |
| 7217 | LIST_INSERT_BEFORE(lbrt, brt, brt_hash); |
| 7218 | goto out; |
| 7219 | } |
| 7220 | if (LIST_NEXT(lbrt, brt_hash) == NULL) { |
| 7221 | LIST_INSERT_AFTER(lbrt, brt, brt_hash); |
| 7222 | goto out; |
| 7223 | } |
| 7224 | lbrt = LIST_NEXT(lbrt, brt_hash); |
| 7225 | } while (lbrt != NULL); |
| 7226 | |
| 7227 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_RT_TABLE, |
| 7228 | "%s impossible %02x:%02x:%02x:%02x:%02x:%02x" , |
| 7229 | sc->sc_ifp->if_xname, |
| 7230 | brt->brt_addr[0], brt->brt_addr[1], brt->brt_addr[2], |
| 7231 | brt->brt_addr[3], brt->brt_addr[4], brt->brt_addr[5]); |
| 7232 | out: |
| 7233 | return 0; |
| 7234 | } |
| 7235 | |
| 7236 | /* |
| 7237 | * bridge_rtnode_insert: |
| 7238 | * |
| 7239 | * Insert the specified bridge node into the route table. We |
| 7240 | * assume the entry is not already in the table. |
| 7241 | */ |
| 7242 | static int |
| 7243 | bridge_rtnode_insert(struct bridge_softc *sc, struct bridge_rtnode *brt) |
| 7244 | { |
| 7245 | int error; |
| 7246 | |
| 7247 | error = bridge_rtnode_hash(sc, brt); |
| 7248 | if (error != 0) { |
| 7249 | return error; |
| 7250 | } |
| 7251 | |
| 7252 | LIST_INSERT_HEAD(&sc->sc_rtlist, brt, brt_list); |
| 7253 | sc->sc_brtcnt++; |
| 7254 | |
| 7255 | bridge_rthash_resize(sc); |
| 7256 | |
| 7257 | return 0; |
| 7258 | } |
| 7259 | |
| 7260 | /* |
| 7261 | * bridge_rtnode_destroy: |
| 7262 | * |
| 7263 | * Destroy a bridge rtnode. |
| 7264 | */ |
| 7265 | static void |
| 7266 | bridge_rtnode_destroy(struct bridge_softc *sc, struct bridge_rtnode *brt) |
| 7267 | { |
| 7268 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 7269 | |
| 7270 | LIST_REMOVE(brt, brt_hash); |
| 7271 | |
| 7272 | LIST_REMOVE(brt, brt_list); |
| 7273 | sc->sc_brtcnt--; |
| 7274 | brt->brt_dst->bif_addrcnt--; |
| 7275 | zfree(bridge_rtnode_pool, brt); |
| 7276 | } |
| 7277 | |
| 7278 | #if BRIDGESTP |
| 7279 | /* |
| 7280 | * bridge_rtable_expire: |
| 7281 | * |
| 7282 | * Set the expiry time for all routes on an interface. |
| 7283 | */ |
| 7284 | static void |
| 7285 | bridge_rtable_expire(struct ifnet *ifp, int age) |
| 7286 | { |
| 7287 | struct bridge_softc *sc = ifp->if_bridge; |
| 7288 | struct bridge_rtnode *brt; |
| 7289 | |
| 7290 | BRIDGE_LOCK(sc); |
| 7291 | |
| 7292 | /* |
| 7293 | * If the age is zero then flush, otherwise set all the expiry times to |
| 7294 | * age for the interface |
| 7295 | */ |
| 7296 | if (age == 0) { |
| 7297 | bridge_rtdelete(sc, ifp, IFBF_FLUSHDYN); |
| 7298 | } else { |
| 7299 | unsigned long now; |
| 7300 | |
| 7301 | now = (unsigned long) net_uptime(); |
| 7302 | |
| 7303 | LIST_FOREACH(brt, &sc->sc_rtlist, brt_list) { |
| 7304 | /* Cap the expiry time to 'age' */ |
| 7305 | if (brt->brt_ifp == ifp && |
| 7306 | brt->brt_expire > now + age && |
| 7307 | (brt->brt_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) { |
| 7308 | brt->brt_expire = now + age; |
| 7309 | } |
| 7310 | } |
| 7311 | } |
| 7312 | BRIDGE_UNLOCK(sc); |
| 7313 | } |
| 7314 | |
| 7315 | /* |
| 7316 | * bridge_state_change: |
| 7317 | * |
| 7318 | * Callback from the bridgestp code when a port changes states. |
| 7319 | */ |
| 7320 | static void |
| 7321 | bridge_state_change(struct ifnet *ifp, int state) |
| 7322 | { |
| 7323 | struct bridge_softc *sc = ifp->if_bridge; |
| 7324 | static const char *stpstates[] = { |
| 7325 | "disabled" , |
| 7326 | "listening" , |
| 7327 | "learning" , |
| 7328 | "forwarding" , |
| 7329 | "blocking" , |
| 7330 | "discarding" |
| 7331 | }; |
| 7332 | |
| 7333 | if (log_stp) { |
| 7334 | log(LOG_NOTICE, "%s: state changed to %s on %s" , |
| 7335 | sc->sc_ifp->if_xname, |
| 7336 | stpstates[state], ifp->if_xname); |
| 7337 | } |
| 7338 | } |
| 7339 | #endif /* BRIDGESTP */ |
| 7340 | |
| 7341 | /* |
| 7342 | * bridge_set_bpf_tap: |
| 7343 | * |
| 7344 | * Sets ups the BPF callbacks. |
| 7345 | */ |
| 7346 | static errno_t |
| 7347 | bridge_set_bpf_tap(ifnet_t ifp, bpf_tap_mode mode, bpf_packet_func bpf_callback) |
| 7348 | { |
| 7349 | struct bridge_softc *sc = (struct bridge_softc *)ifnet_softc(interface: ifp); |
| 7350 | |
| 7351 | /* TBD locking */ |
| 7352 | if (sc == NULL || (sc->sc_flags & SCF_DETACHING)) { |
| 7353 | return ENODEV; |
| 7354 | } |
| 7355 | switch (mode) { |
| 7356 | case BPF_TAP_DISABLE: |
| 7357 | sc->sc_bpf_input = sc->sc_bpf_output = NULL; |
| 7358 | break; |
| 7359 | |
| 7360 | case BPF_TAP_INPUT: |
| 7361 | sc->sc_bpf_input = bpf_callback; |
| 7362 | break; |
| 7363 | |
| 7364 | case BPF_TAP_OUTPUT: |
| 7365 | sc->sc_bpf_output = bpf_callback; |
| 7366 | break; |
| 7367 | |
| 7368 | case BPF_TAP_INPUT_OUTPUT: |
| 7369 | sc->sc_bpf_input = sc->sc_bpf_output = bpf_callback; |
| 7370 | break; |
| 7371 | |
| 7372 | default: |
| 7373 | break; |
| 7374 | } |
| 7375 | |
| 7376 | return 0; |
| 7377 | } |
| 7378 | |
| 7379 | /* |
| 7380 | * bridge_detach: |
| 7381 | * |
| 7382 | * Callback when interface has been detached. |
| 7383 | */ |
| 7384 | static void |
| 7385 | bridge_detach(ifnet_t ifp) |
| 7386 | { |
| 7387 | struct bridge_softc *sc = (struct bridge_softc *)ifnet_softc(interface: ifp); |
| 7388 | |
| 7389 | #if BRIDGESTP |
| 7390 | bstp_detach(&sc->sc_stp); |
| 7391 | #endif /* BRIDGESTP */ |
| 7392 | |
| 7393 | /* Tear down the routing table. */ |
| 7394 | bridge_rtable_fini(sc); |
| 7395 | |
| 7396 | lck_mtx_lock(lck: &bridge_list_mtx); |
| 7397 | LIST_REMOVE(sc, sc_list); |
| 7398 | lck_mtx_unlock(lck: &bridge_list_mtx); |
| 7399 | |
| 7400 | ifnet_release(interface: ifp); |
| 7401 | |
| 7402 | lck_mtx_destroy(lck: &sc->sc_mtx, grp: &bridge_lock_grp); |
| 7403 | kfree_type(struct bridge_softc, sc); |
| 7404 | } |
| 7405 | |
| 7406 | /* |
| 7407 | * bridge_bpf_input: |
| 7408 | * |
| 7409 | * Invoke the input BPF callback if enabled |
| 7410 | */ |
| 7411 | static errno_t |
| 7412 | bridge_bpf_input(ifnet_t ifp, struct mbuf *m, const char * func, int line) |
| 7413 | { |
| 7414 | struct bridge_softc *sc = (struct bridge_softc *)ifnet_softc(interface: ifp); |
| 7415 | bpf_packet_func input_func = sc->sc_bpf_input; |
| 7416 | |
| 7417 | if (input_func != NULL) { |
| 7418 | if (mbuf_pkthdr_rcvif(mbuf: m) != ifp) { |
| 7419 | BRIDGE_LOG(LOG_NOTICE, 0, |
| 7420 | "%s.%d: rcvif: 0x%llx != ifp 0x%llx" , func, line, |
| 7421 | (uint64_t)VM_KERNEL_ADDRPERM(mbuf_pkthdr_rcvif(m)), |
| 7422 | (uint64_t)VM_KERNEL_ADDRPERM(ifp)); |
| 7423 | } |
| 7424 | (*input_func)(ifp, m); |
| 7425 | } |
| 7426 | return 0; |
| 7427 | } |
| 7428 | |
| 7429 | /* |
| 7430 | * bridge_bpf_output: |
| 7431 | * |
| 7432 | * Invoke the output BPF callback if enabled |
| 7433 | */ |
| 7434 | static errno_t |
| 7435 | bridge_bpf_output(ifnet_t ifp, struct mbuf *m) |
| 7436 | { |
| 7437 | struct bridge_softc *sc = (struct bridge_softc *)ifnet_softc(interface: ifp); |
| 7438 | bpf_packet_func output_func = sc->sc_bpf_output; |
| 7439 | |
| 7440 | if (output_func != NULL) { |
| 7441 | (*output_func)(ifp, m); |
| 7442 | } |
| 7443 | return 0; |
| 7444 | } |
| 7445 | |
| 7446 | /* |
| 7447 | * bridge_link_event: |
| 7448 | * |
| 7449 | * Report a data link event on an interface |
| 7450 | */ |
| 7451 | static void |
| 7452 | bridge_link_event(struct ifnet *ifp, u_int32_t event_code) |
| 7453 | { |
| 7454 | struct event { |
| 7455 | u_int32_t ifnet_family; |
| 7456 | u_int32_t unit; |
| 7457 | char if_name[IFNAMSIZ]; |
| 7458 | }; |
| 7459 | _Alignas(struct kern_event_msg) char message[sizeof(struct kern_event_msg) + sizeof(struct event)] = { 0 }; |
| 7460 | struct kern_event_msg * = (struct kern_event_msg*)message; |
| 7461 | struct event *data = (struct event *)(header + 1); |
| 7462 | |
| 7463 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_LIFECYCLE, |
| 7464 | "%s event_code %u - %s" , ifp->if_xname, |
| 7465 | event_code, dlil_kev_dl_code_str(event_code)); |
| 7466 | header->total_size = sizeof(message); |
| 7467 | header->vendor_code = KEV_VENDOR_APPLE; |
| 7468 | header->kev_class = KEV_NETWORK_CLASS; |
| 7469 | header->kev_subclass = KEV_DL_SUBCLASS; |
| 7470 | header->event_code = event_code; |
| 7471 | data->ifnet_family = ifnet_family(interface: ifp); |
| 7472 | data->unit = (u_int32_t)ifnet_unit(interface: ifp); |
| 7473 | strlcpy(dst: data->if_name, src: ifnet_name(interface: ifp), IFNAMSIZ); |
| 7474 | ifnet_event(interface: ifp, event_ptr: header); |
| 7475 | } |
| 7476 | |
| 7477 | #define BRIDGE_HF_DROP(reason, func, line) { \ |
| 7478 | bridge_hostfilter_stats.reason++; \ |
| 7479 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_HOSTFILTER, \ |
| 7480 | "%s.%d" #reason, func, line); \ |
| 7481 | error = EINVAL; \ |
| 7482 | } |
| 7483 | |
| 7484 | /* |
| 7485 | * Make sure this is a DHCP or Bootp request that match the host filter |
| 7486 | */ |
| 7487 | static int |
| 7488 | bridge_dhcp_filter(struct bridge_iflist *bif, struct mbuf *m, size_t offset) |
| 7489 | { |
| 7490 | int error = EINVAL; |
| 7491 | struct dhcp dhcp; |
| 7492 | |
| 7493 | /* |
| 7494 | * Note: We use the dhcp structure because bootp structure definition |
| 7495 | * is larger and some vendors do not pad the request |
| 7496 | */ |
| 7497 | error = mbuf_copydata(mbuf: m, offset, length: sizeof(struct dhcp), out_data: &dhcp); |
| 7498 | if (error != 0) { |
| 7499 | BRIDGE_HF_DROP(brhf_dhcp_too_small, __func__, __LINE__); |
| 7500 | goto done; |
| 7501 | } |
| 7502 | if (dhcp.dp_op != BOOTREQUEST) { |
| 7503 | BRIDGE_HF_DROP(brhf_dhcp_bad_op, __func__, __LINE__); |
| 7504 | goto done; |
| 7505 | } |
| 7506 | /* |
| 7507 | * The hardware address must be an exact match |
| 7508 | */ |
| 7509 | if (dhcp.dp_htype != ARPHRD_ETHER) { |
| 7510 | BRIDGE_HF_DROP(brhf_dhcp_bad_htype, __func__, __LINE__); |
| 7511 | goto done; |
| 7512 | } |
| 7513 | if (dhcp.dp_hlen != ETHER_ADDR_LEN) { |
| 7514 | BRIDGE_HF_DROP(brhf_dhcp_bad_hlen, __func__, __LINE__); |
| 7515 | goto done; |
| 7516 | } |
| 7517 | if (bcmp(s1: dhcp.dp_chaddr, s2: bif->bif_hf_hwsrc, |
| 7518 | ETHER_ADDR_LEN) != 0) { |
| 7519 | BRIDGE_HF_DROP(brhf_dhcp_bad_chaddr, __func__, __LINE__); |
| 7520 | goto done; |
| 7521 | } |
| 7522 | /* |
| 7523 | * Client address must match the host address or be not specified |
| 7524 | */ |
| 7525 | if (dhcp.dp_ciaddr.s_addr != bif->bif_hf_ipsrc.s_addr && |
| 7526 | dhcp.dp_ciaddr.s_addr != INADDR_ANY) { |
| 7527 | BRIDGE_HF_DROP(brhf_dhcp_bad_ciaddr, __func__, __LINE__); |
| 7528 | goto done; |
| 7529 | } |
| 7530 | error = 0; |
| 7531 | done: |
| 7532 | return error; |
| 7533 | } |
| 7534 | |
| 7535 | static int |
| 7536 | bridge_host_filter(struct bridge_iflist *bif, mbuf_t *data) |
| 7537 | { |
| 7538 | int error = EINVAL; |
| 7539 | struct ether_header *eh; |
| 7540 | static struct in_addr inaddr_any = { .s_addr = INADDR_ANY }; |
| 7541 | mbuf_t m = *data; |
| 7542 | |
| 7543 | eh = mtod(m, struct ether_header *); |
| 7544 | |
| 7545 | /* |
| 7546 | * Restrict the source hardware address |
| 7547 | */ |
| 7548 | if ((bif->bif_flags & BIFF_HF_HWSRC) != 0 && |
| 7549 | bcmp(s1: eh->ether_shost, s2: bif->bif_hf_hwsrc, |
| 7550 | ETHER_ADDR_LEN) != 0) { |
| 7551 | BRIDGE_HF_DROP(brhf_bad_ether_srchw_addr, __func__, __LINE__); |
| 7552 | goto done; |
| 7553 | } |
| 7554 | |
| 7555 | /* |
| 7556 | * Restrict Ethernet protocols to ARP and IP/IPv6 |
| 7557 | */ |
| 7558 | if (eh->ether_type == htons(ETHERTYPE_ARP)) { |
| 7559 | struct ether_arp *ea; |
| 7560 | size_t minlen = sizeof(struct ether_header) + |
| 7561 | sizeof(struct ether_arp); |
| 7562 | |
| 7563 | /* |
| 7564 | * Make the Ethernet and ARP headers contiguous |
| 7565 | */ |
| 7566 | if (mbuf_pkthdr_len(mbuf: m) < minlen) { |
| 7567 | BRIDGE_HF_DROP(brhf_arp_too_small, __func__, __LINE__); |
| 7568 | goto done; |
| 7569 | } |
| 7570 | if (mbuf_len(mbuf: m) < minlen && mbuf_pullup(mbuf: data, len: minlen) != 0) { |
| 7571 | BRIDGE_HF_DROP(brhf_arp_pullup_failed, |
| 7572 | __func__, __LINE__); |
| 7573 | goto done; |
| 7574 | } |
| 7575 | m = *data; |
| 7576 | |
| 7577 | /* |
| 7578 | * Verify this is an ethernet/ip arp |
| 7579 | */ |
| 7580 | eh = mtod(m, struct ether_header *); |
| 7581 | ea = (struct ether_arp *)(eh + 1); |
| 7582 | if (ea->arp_hrd != htons(ARPHRD_ETHER)) { |
| 7583 | BRIDGE_HF_DROP(brhf_arp_bad_hw_type, |
| 7584 | __func__, __LINE__); |
| 7585 | goto done; |
| 7586 | } |
| 7587 | if (ea->arp_pro != htons(ETHERTYPE_IP)) { |
| 7588 | BRIDGE_HF_DROP(brhf_arp_bad_pro_type, |
| 7589 | __func__, __LINE__); |
| 7590 | goto done; |
| 7591 | } |
| 7592 | /* |
| 7593 | * Verify the address lengths are correct |
| 7594 | */ |
| 7595 | if (ea->arp_hln != ETHER_ADDR_LEN) { |
| 7596 | BRIDGE_HF_DROP(brhf_arp_bad_hw_len, __func__, __LINE__); |
| 7597 | goto done; |
| 7598 | } |
| 7599 | if (ea->arp_pln != sizeof(struct in_addr)) { |
| 7600 | BRIDGE_HF_DROP(brhf_arp_bad_pro_len, |
| 7601 | __func__, __LINE__); |
| 7602 | goto done; |
| 7603 | } |
| 7604 | /* |
| 7605 | * Allow only ARP request or ARP reply |
| 7606 | */ |
| 7607 | if (ea->arp_op != htons(ARPOP_REQUEST) && |
| 7608 | ea->arp_op != htons(ARPOP_REPLY)) { |
| 7609 | BRIDGE_HF_DROP(brhf_arp_bad_op, __func__, __LINE__); |
| 7610 | goto done; |
| 7611 | } |
| 7612 | if ((bif->bif_flags & BIFF_HF_HWSRC) != 0) { |
| 7613 | /* |
| 7614 | * Verify source hardware address matches |
| 7615 | */ |
| 7616 | if (bcmp(s1: ea->arp_sha, s2: bif->bif_hf_hwsrc, |
| 7617 | ETHER_ADDR_LEN) != 0) { |
| 7618 | BRIDGE_HF_DROP(brhf_arp_bad_sha, __func__, __LINE__); |
| 7619 | goto done; |
| 7620 | } |
| 7621 | } |
| 7622 | if ((bif->bif_flags & BIFF_HF_IPSRC) != 0) { |
| 7623 | /* |
| 7624 | * Verify source protocol address: |
| 7625 | * May be null for an ARP probe |
| 7626 | */ |
| 7627 | if (bcmp(s1: ea->arp_spa, s2: &bif->bif_hf_ipsrc.s_addr, |
| 7628 | n: sizeof(struct in_addr)) != 0 && |
| 7629 | bcmp(s1: ea->arp_spa, s2: &inaddr_any, |
| 7630 | n: sizeof(struct in_addr)) != 0) { |
| 7631 | BRIDGE_HF_DROP(brhf_arp_bad_spa, __func__, __LINE__); |
| 7632 | goto done; |
| 7633 | } |
| 7634 | } |
| 7635 | bridge_hostfilter_stats.brhf_arp_ok += 1; |
| 7636 | error = 0; |
| 7637 | } else if (eh->ether_type == htons(ETHERTYPE_IP)) { |
| 7638 | size_t minlen = sizeof(struct ether_header) + sizeof(struct ip); |
| 7639 | struct ip iphdr; |
| 7640 | size_t offset; |
| 7641 | |
| 7642 | /* |
| 7643 | * Make the Ethernet and IP headers contiguous |
| 7644 | */ |
| 7645 | if (mbuf_pkthdr_len(mbuf: m) < minlen) { |
| 7646 | BRIDGE_HF_DROP(brhf_ip_too_small, __func__, __LINE__); |
| 7647 | goto done; |
| 7648 | } |
| 7649 | offset = sizeof(struct ether_header); |
| 7650 | error = mbuf_copydata(mbuf: m, offset, length: sizeof(struct ip), out_data: &iphdr); |
| 7651 | if (error != 0) { |
| 7652 | BRIDGE_HF_DROP(brhf_ip_too_small, __func__, __LINE__); |
| 7653 | goto done; |
| 7654 | } |
| 7655 | if ((bif->bif_flags & BIFF_HF_IPSRC) != 0) { |
| 7656 | /* |
| 7657 | * Verify the source IP address |
| 7658 | */ |
| 7659 | if (iphdr.ip_p == IPPROTO_UDP) { |
| 7660 | struct udphdr udp; |
| 7661 | |
| 7662 | minlen += sizeof(struct udphdr); |
| 7663 | if (mbuf_pkthdr_len(mbuf: m) < minlen) { |
| 7664 | BRIDGE_HF_DROP(brhf_ip_too_small, |
| 7665 | __func__, __LINE__); |
| 7666 | goto done; |
| 7667 | } |
| 7668 | |
| 7669 | /* |
| 7670 | * Allow all zero addresses for DHCP requests |
| 7671 | */ |
| 7672 | if (iphdr.ip_src.s_addr != bif->bif_hf_ipsrc.s_addr && |
| 7673 | iphdr.ip_src.s_addr != INADDR_ANY) { |
| 7674 | BRIDGE_HF_DROP(brhf_ip_bad_srcaddr, |
| 7675 | __func__, __LINE__); |
| 7676 | goto done; |
| 7677 | } |
| 7678 | offset = sizeof(struct ether_header) + |
| 7679 | (IP_VHL_HL(iphdr.ip_vhl) << 2); |
| 7680 | error = mbuf_copydata(mbuf: m, offset, |
| 7681 | length: sizeof(struct udphdr), out_data: &udp); |
| 7682 | if (error != 0) { |
| 7683 | BRIDGE_HF_DROP(brhf_ip_too_small, |
| 7684 | __func__, __LINE__); |
| 7685 | goto done; |
| 7686 | } |
| 7687 | /* |
| 7688 | * Either it's a Bootp/DHCP packet that we like or |
| 7689 | * it's a UDP packet from the host IP as source address |
| 7690 | */ |
| 7691 | if (udp.uh_sport == htons(IPPORT_BOOTPC) && |
| 7692 | udp.uh_dport == htons(IPPORT_BOOTPS)) { |
| 7693 | minlen += sizeof(struct dhcp); |
| 7694 | if (mbuf_pkthdr_len(mbuf: m) < minlen) { |
| 7695 | BRIDGE_HF_DROP(brhf_ip_too_small, |
| 7696 | __func__, __LINE__); |
| 7697 | goto done; |
| 7698 | } |
| 7699 | offset += sizeof(struct udphdr); |
| 7700 | error = bridge_dhcp_filter(bif, m, offset); |
| 7701 | if (error != 0) { |
| 7702 | goto done; |
| 7703 | } |
| 7704 | } else if (iphdr.ip_src.s_addr == INADDR_ANY) { |
| 7705 | BRIDGE_HF_DROP(brhf_ip_bad_srcaddr, |
| 7706 | __func__, __LINE__); |
| 7707 | goto done; |
| 7708 | } |
| 7709 | } else if (iphdr.ip_src.s_addr != bif->bif_hf_ipsrc.s_addr) { |
| 7710 | assert(bif->bif_hf_ipsrc.s_addr != INADDR_ANY); |
| 7711 | BRIDGE_HF_DROP(brhf_ip_bad_srcaddr, __func__, __LINE__); |
| 7712 | goto done; |
| 7713 | } |
| 7714 | } |
| 7715 | /* |
| 7716 | * Allow only boring IP protocols |
| 7717 | */ |
| 7718 | if (iphdr.ip_p != IPPROTO_TCP && |
| 7719 | iphdr.ip_p != IPPROTO_UDP && |
| 7720 | iphdr.ip_p != IPPROTO_ICMP && |
| 7721 | iphdr.ip_p != IPPROTO_IGMP) { |
| 7722 | BRIDGE_HF_DROP(brhf_ip_bad_proto, __func__, __LINE__); |
| 7723 | goto done; |
| 7724 | } |
| 7725 | bridge_hostfilter_stats.brhf_ip_ok += 1; |
| 7726 | error = 0; |
| 7727 | } else if (eh->ether_type == htons(ETHERTYPE_IPV6)) { |
| 7728 | size_t minlen = sizeof(struct ether_header) + sizeof(struct ip6_hdr); |
| 7729 | struct ip6_hdr ip6hdr; |
| 7730 | size_t offset; |
| 7731 | |
| 7732 | /* |
| 7733 | * Make the Ethernet and IP headers contiguous |
| 7734 | */ |
| 7735 | if (mbuf_pkthdr_len(mbuf: m) < minlen) { |
| 7736 | BRIDGE_HF_DROP(brhf_ip_too_small, __func__, __LINE__); |
| 7737 | goto done; |
| 7738 | } |
| 7739 | offset = sizeof(struct ether_header); |
| 7740 | error = mbuf_copydata(mbuf: m, offset, length: sizeof(struct ip6_hdr), out_data: &ip6hdr); |
| 7741 | if (error != 0) { |
| 7742 | BRIDGE_HF_DROP(brhf_ip_too_small, __func__, __LINE__); |
| 7743 | goto done; |
| 7744 | } |
| 7745 | /* |
| 7746 | * Allow only boring IPv6 protocols |
| 7747 | */ |
| 7748 | if (ip6hdr.ip6_nxt != IPPROTO_TCP && |
| 7749 | ip6hdr.ip6_nxt != IPPROTO_UDP && |
| 7750 | ip6hdr.ip6_nxt != IPPROTO_ICMPV6) { |
| 7751 | BRIDGE_HF_DROP(brhf_ip_bad_proto, __func__, __LINE__); |
| 7752 | goto done; |
| 7753 | } |
| 7754 | bridge_hostfilter_stats.brhf_ip_ok += 1; |
| 7755 | error = 0; |
| 7756 | } else { |
| 7757 | BRIDGE_HF_DROP(brhf_bad_ether_type, __func__, __LINE__); |
| 7758 | goto done; |
| 7759 | } |
| 7760 | done: |
| 7761 | if (error != 0) { |
| 7762 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_HOSTFILTER)) { |
| 7763 | if (m) { |
| 7764 | brlog_mbuf_data(m, offset: 0, |
| 7765 | len: sizeof(struct ether_header) + |
| 7766 | sizeof(struct ip)); |
| 7767 | } |
| 7768 | } |
| 7769 | |
| 7770 | if (m != NULL) { |
| 7771 | m_freem(m); |
| 7772 | } |
| 7773 | } |
| 7774 | return error; |
| 7775 | } |
| 7776 | |
| 7777 | /* |
| 7778 | * MAC NAT |
| 7779 | */ |
| 7780 | |
| 7781 | static errno_t |
| 7782 | bridge_mac_nat_enable(struct bridge_softc *sc, struct bridge_iflist *bif) |
| 7783 | { |
| 7784 | errno_t error = 0; |
| 7785 | |
| 7786 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 7787 | |
| 7788 | if (IFNET_IS_VMNET(bif->bif_ifp)) { |
| 7789 | error = EINVAL; |
| 7790 | goto done; |
| 7791 | } |
| 7792 | if (sc->sc_mac_nat_bif != NULL) { |
| 7793 | if (sc->sc_mac_nat_bif != bif) { |
| 7794 | error = EBUSY; |
| 7795 | } |
| 7796 | goto done; |
| 7797 | } |
| 7798 | sc->sc_mac_nat_bif = bif; |
| 7799 | bif->bif_ifflags |= IFBIF_MAC_NAT; |
| 7800 | bridge_mac_nat_populate_entries(sc); |
| 7801 | |
| 7802 | done: |
| 7803 | return error; |
| 7804 | } |
| 7805 | |
| 7806 | static void |
| 7807 | bridge_mac_nat_disable(struct bridge_softc *sc) |
| 7808 | { |
| 7809 | struct bridge_iflist *mac_nat_bif = sc->sc_mac_nat_bif; |
| 7810 | |
| 7811 | assert(mac_nat_bif != NULL); |
| 7812 | bridge_mac_nat_flush_entries(sc, mac_nat_bif); |
| 7813 | mac_nat_bif->bif_ifflags &= ~IFBIF_MAC_NAT; |
| 7814 | sc->sc_mac_nat_bif = NULL; |
| 7815 | return; |
| 7816 | } |
| 7817 | |
| 7818 | static void |
| 7819 | mac_nat_entry_print2(struct mac_nat_entry *mne, |
| 7820 | char *ifname, const char *msg1, const char *msg2) |
| 7821 | { |
| 7822 | int af; |
| 7823 | char etopbuf[24]; |
| 7824 | char ntopbuf[MAX_IPv6_STR_LEN]; |
| 7825 | const char *space; |
| 7826 | |
| 7827 | af = ((mne->mne_flags & MNE_FLAGS_IPV6) != 0) ? AF_INET6 : AF_INET; |
| 7828 | ether_ntop(buf: etopbuf, len: sizeof(etopbuf), ap: mne->mne_mac); |
| 7829 | (void)inet_ntop(af, &mne->mne_u, ntopbuf, sizeof(ntopbuf)); |
| 7830 | if (msg2 == NULL) { |
| 7831 | msg2 = "" ; |
| 7832 | space = "" ; |
| 7833 | } else { |
| 7834 | space = " " ; |
| 7835 | } |
| 7836 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 7837 | "%s %s%s%s %p (%s, %s, %s)" , |
| 7838 | ifname, msg1, space, msg2, mne, mne->mne_bif->bif_ifp->if_xname, |
| 7839 | ntopbuf, etopbuf); |
| 7840 | } |
| 7841 | |
| 7842 | static void |
| 7843 | mac_nat_entry_print(struct mac_nat_entry *mne, |
| 7844 | char *ifname, const char *msg) |
| 7845 | { |
| 7846 | mac_nat_entry_print2(mne, ifname, msg1: msg, NULL); |
| 7847 | } |
| 7848 | |
| 7849 | static struct mac_nat_entry * |
| 7850 | bridge_lookup_mac_nat_entry(struct bridge_softc *sc, int af, void * ip) |
| 7851 | { |
| 7852 | struct mac_nat_entry *mne; |
| 7853 | struct mac_nat_entry *ret_mne = NULL; |
| 7854 | |
| 7855 | if (af == AF_INET) { |
| 7856 | in_addr_t s_addr = ((struct in_addr *)ip)->s_addr; |
| 7857 | |
| 7858 | LIST_FOREACH(mne, &sc->sc_mne_list, mne_list) { |
| 7859 | if (mne->mne_ip.s_addr == s_addr) { |
| 7860 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MAC_NAT)) { |
| 7861 | mac_nat_entry_print(mne, ifname: sc->sc_if_xname, |
| 7862 | msg: "found" ); |
| 7863 | } |
| 7864 | ret_mne = mne; |
| 7865 | break; |
| 7866 | } |
| 7867 | } |
| 7868 | } else { |
| 7869 | const struct in6_addr *ip6 = (const struct in6_addr *)ip; |
| 7870 | |
| 7871 | LIST_FOREACH(mne, &sc->sc_mne_list_v6, mne_list) { |
| 7872 | if (IN6_ARE_ADDR_EQUAL(&mne->mne_ip6, ip6)) { |
| 7873 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MAC_NAT)) { |
| 7874 | mac_nat_entry_print(mne, ifname: sc->sc_if_xname, |
| 7875 | msg: "found" ); |
| 7876 | } |
| 7877 | ret_mne = mne; |
| 7878 | break; |
| 7879 | } |
| 7880 | } |
| 7881 | } |
| 7882 | return ret_mne; |
| 7883 | } |
| 7884 | |
| 7885 | static void |
| 7886 | bridge_destroy_mac_nat_entry(struct bridge_softc *sc, |
| 7887 | struct mac_nat_entry *mne, const char *reason) |
| 7888 | { |
| 7889 | LIST_REMOVE(mne, mne_list); |
| 7890 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MAC_NAT)) { |
| 7891 | mac_nat_entry_print(mne, ifname: sc->sc_if_xname, msg: reason); |
| 7892 | } |
| 7893 | zfree(bridge_mne_pool, mne); |
| 7894 | sc->sc_mne_count--; |
| 7895 | } |
| 7896 | |
| 7897 | static struct mac_nat_entry * |
| 7898 | bridge_create_mac_nat_entry(struct bridge_softc *sc, |
| 7899 | struct bridge_iflist *bif, int af, const void *ip, uint8_t *eaddr) |
| 7900 | { |
| 7901 | struct mac_nat_entry_list *list; |
| 7902 | struct mac_nat_entry *mne; |
| 7903 | |
| 7904 | if (sc->sc_mne_count >= sc->sc_mne_max) { |
| 7905 | sc->sc_mne_allocation_failures++; |
| 7906 | return NULL; |
| 7907 | } |
| 7908 | mne = zalloc_noblock(kt_view: bridge_mne_pool); |
| 7909 | if (mne == NULL) { |
| 7910 | sc->sc_mne_allocation_failures++; |
| 7911 | return NULL; |
| 7912 | } |
| 7913 | sc->sc_mne_count++; |
| 7914 | bzero(s: mne, n: sizeof(*mne)); |
| 7915 | bcopy(src: eaddr, dst: mne->mne_mac, n: sizeof(mne->mne_mac)); |
| 7916 | mne->mne_bif = bif; |
| 7917 | if (af == AF_INET) { |
| 7918 | bcopy(src: ip, dst: &mne->mne_ip, n: sizeof(mne->mne_ip)); |
| 7919 | list = &sc->sc_mne_list; |
| 7920 | } else { |
| 7921 | bcopy(src: ip, dst: &mne->mne_ip6, n: sizeof(mne->mne_ip6)); |
| 7922 | mne->mne_flags |= MNE_FLAGS_IPV6; |
| 7923 | list = &sc->sc_mne_list_v6; |
| 7924 | } |
| 7925 | LIST_INSERT_HEAD(list, mne, mne_list); |
| 7926 | mne->mne_expire = (unsigned long)net_uptime() + sc->sc_brttimeout; |
| 7927 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MAC_NAT)) { |
| 7928 | mac_nat_entry_print(mne, ifname: sc->sc_if_xname, msg: "created" ); |
| 7929 | } |
| 7930 | return mne; |
| 7931 | } |
| 7932 | |
| 7933 | static struct mac_nat_entry * |
| 7934 | bridge_update_mac_nat_entry(struct bridge_softc *sc, |
| 7935 | struct bridge_iflist *bif, int af, void *ip, uint8_t *eaddr) |
| 7936 | { |
| 7937 | struct mac_nat_entry *mne; |
| 7938 | |
| 7939 | mne = bridge_lookup_mac_nat_entry(sc, af, ip); |
| 7940 | if (mne != NULL) { |
| 7941 | struct bridge_iflist *mac_nat_bif = sc->sc_mac_nat_bif; |
| 7942 | |
| 7943 | if (mne->mne_bif == mac_nat_bif) { |
| 7944 | /* the MAC NAT interface takes precedence */ |
| 7945 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MAC_NAT)) { |
| 7946 | if (mne->mne_bif != bif) { |
| 7947 | mac_nat_entry_print2(mne, |
| 7948 | ifname: sc->sc_if_xname, msg1: "reject" , |
| 7949 | msg2: bif->bif_ifp->if_xname); |
| 7950 | } |
| 7951 | } |
| 7952 | } else if (mne->mne_bif != bif) { |
| 7953 | const char *old_if = mne->mne_bif->bif_ifp->if_xname; |
| 7954 | |
| 7955 | mne->mne_bif = bif; |
| 7956 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MAC_NAT)) { |
| 7957 | mac_nat_entry_print2(mne, |
| 7958 | ifname: sc->sc_if_xname, msg1: "replaced" , |
| 7959 | msg2: old_if); |
| 7960 | } |
| 7961 | bcopy(src: eaddr, dst: mne->mne_mac, n: sizeof(mne->mne_mac)); |
| 7962 | } |
| 7963 | mne->mne_expire = (unsigned long)net_uptime() + |
| 7964 | sc->sc_brttimeout; |
| 7965 | } else { |
| 7966 | mne = bridge_create_mac_nat_entry(sc, bif, af, ip, eaddr); |
| 7967 | } |
| 7968 | return mne; |
| 7969 | } |
| 7970 | |
| 7971 | static void |
| 7972 | bridge_mac_nat_flush_entries_common(struct bridge_softc *sc, |
| 7973 | struct mac_nat_entry_list *list, struct bridge_iflist *bif) |
| 7974 | { |
| 7975 | struct mac_nat_entry *mne; |
| 7976 | struct mac_nat_entry *tmne; |
| 7977 | |
| 7978 | LIST_FOREACH_SAFE(mne, list, mne_list, tmne) { |
| 7979 | if (bif != NULL && mne->mne_bif != bif) { |
| 7980 | continue; |
| 7981 | } |
| 7982 | bridge_destroy_mac_nat_entry(sc, mne, reason: "flushed" ); |
| 7983 | } |
| 7984 | } |
| 7985 | |
| 7986 | /* |
| 7987 | * bridge_mac_nat_flush_entries: |
| 7988 | * |
| 7989 | * Flush MAC NAT entries for the specified member. Flush all entries if |
| 7990 | * the member is the one that requires MAC NAT, otherwise just flush the |
| 7991 | * ones for the specified member. |
| 7992 | */ |
| 7993 | static void |
| 7994 | bridge_mac_nat_flush_entries(struct bridge_softc *sc, struct bridge_iflist * bif) |
| 7995 | { |
| 7996 | struct bridge_iflist *flush_bif; |
| 7997 | |
| 7998 | flush_bif = (bif == sc->sc_mac_nat_bif) ? NULL : bif; |
| 7999 | bridge_mac_nat_flush_entries_common(sc, list: &sc->sc_mne_list, bif: flush_bif); |
| 8000 | bridge_mac_nat_flush_entries_common(sc, list: &sc->sc_mne_list_v6, bif: flush_bif); |
| 8001 | } |
| 8002 | |
| 8003 | static void |
| 8004 | bridge_mac_nat_populate_entries(struct bridge_softc *sc) |
| 8005 | { |
| 8006 | errno_t error; |
| 8007 | ifnet_t ifp; |
| 8008 | ifaddr_t *list; |
| 8009 | struct bridge_iflist *mac_nat_bif = sc->sc_mac_nat_bif; |
| 8010 | |
| 8011 | assert(mac_nat_bif != NULL); |
| 8012 | ifp = mac_nat_bif->bif_ifp; |
| 8013 | error = ifnet_get_address_list(interface: ifp, addresses: &list); |
| 8014 | if (error != 0) { |
| 8015 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8016 | "ifnet_get_address_list(%s) failed %d" , |
| 8017 | ifp->if_xname, error); |
| 8018 | return; |
| 8019 | } |
| 8020 | for (ifaddr_t *scan = list; *scan != NULL; scan++) { |
| 8021 | sa_family_t af; |
| 8022 | void *ip; |
| 8023 | |
| 8024 | union { |
| 8025 | struct sockaddr sa; |
| 8026 | struct sockaddr_in sin; |
| 8027 | struct sockaddr_in6 sin6; |
| 8028 | } u; |
| 8029 | af = ifaddr_address_family(ifaddr: *scan); |
| 8030 | switch (af) { |
| 8031 | case AF_INET: |
| 8032 | case AF_INET6: |
| 8033 | error = ifaddr_address(ifaddr: *scan, out_addr: &u.sa, addr_size: sizeof(u)); |
| 8034 | if (error != 0) { |
| 8035 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8036 | "ifaddr_address failed %d" , |
| 8037 | error); |
| 8038 | break; |
| 8039 | } |
| 8040 | if (af == AF_INET) { |
| 8041 | ip = (void *)&u.sin.sin_addr; |
| 8042 | } else { |
| 8043 | if (IN6_IS_ADDR_LINKLOCAL(&u.sin6.sin6_addr)) { |
| 8044 | /* remove scope ID */ |
| 8045 | u.sin6.sin6_addr.s6_addr16[1] = 0; |
| 8046 | } |
| 8047 | ip = (void *)&u.sin6.sin6_addr; |
| 8048 | } |
| 8049 | bridge_create_mac_nat_entry(sc, bif: mac_nat_bif, af, ip, |
| 8050 | eaddr: (uint8_t *)IF_LLADDR(ifp)); |
| 8051 | break; |
| 8052 | default: |
| 8053 | break; |
| 8054 | } |
| 8055 | } |
| 8056 | ifnet_free_address_list(addresses: list); |
| 8057 | return; |
| 8058 | } |
| 8059 | |
| 8060 | static void |
| 8061 | bridge_mac_nat_age_entries_common(struct bridge_softc *sc, |
| 8062 | struct mac_nat_entry_list *list, unsigned long now) |
| 8063 | { |
| 8064 | struct mac_nat_entry *mne; |
| 8065 | struct mac_nat_entry *tmne; |
| 8066 | |
| 8067 | LIST_FOREACH_SAFE(mne, list, mne_list, tmne) { |
| 8068 | if (now >= mne->mne_expire) { |
| 8069 | bridge_destroy_mac_nat_entry(sc, mne, reason: "aged out" ); |
| 8070 | } |
| 8071 | } |
| 8072 | } |
| 8073 | |
| 8074 | static void |
| 8075 | bridge_mac_nat_age_entries(struct bridge_softc *sc, unsigned long now) |
| 8076 | { |
| 8077 | if (sc->sc_mac_nat_bif == NULL) { |
| 8078 | return; |
| 8079 | } |
| 8080 | bridge_mac_nat_age_entries_common(sc, list: &sc->sc_mne_list, now); |
| 8081 | bridge_mac_nat_age_entries_common(sc, list: &sc->sc_mne_list_v6, now); |
| 8082 | } |
| 8083 | |
| 8084 | static const char * |
| 8085 | get_in_out_string(boolean_t is_output) |
| 8086 | { |
| 8087 | return is_output ? "OUT" : "IN" ; |
| 8088 | } |
| 8089 | |
| 8090 | /* |
| 8091 | * is_valid_arp_packet: |
| 8092 | * Verify that this is a valid ARP packet. |
| 8093 | * |
| 8094 | * Returns TRUE if the packet is valid, FALSE otherwise. |
| 8095 | */ |
| 8096 | static boolean_t |
| 8097 | is_valid_arp_packet(mbuf_t *data, boolean_t is_output, |
| 8098 | struct ether_header **eh_p, struct ether_arp **ea_p) |
| 8099 | { |
| 8100 | struct ether_arp *ea; |
| 8101 | struct ether_header *eh; |
| 8102 | size_t minlen = sizeof(struct ether_header) + sizeof(struct ether_arp); |
| 8103 | boolean_t is_valid = FALSE; |
| 8104 | int flags = is_output ? BR_DBGF_OUTPUT : BR_DBGF_INPUT; |
| 8105 | |
| 8106 | if (mbuf_pkthdr_len(mbuf: *data) < minlen) { |
| 8107 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8108 | "ARP %s short frame %lu < %lu" , |
| 8109 | get_in_out_string(is_output), |
| 8110 | mbuf_pkthdr_len(*data), minlen); |
| 8111 | goto done; |
| 8112 | } |
| 8113 | if (mbuf_len(mbuf: *data) < minlen && mbuf_pullup(mbuf: data, len: minlen) != 0) { |
| 8114 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8115 | "ARP %s size %lu mbuf_pullup fail" , |
| 8116 | get_in_out_string(is_output), |
| 8117 | minlen); |
| 8118 | *data = NULL; |
| 8119 | goto done; |
| 8120 | } |
| 8121 | |
| 8122 | /* validate ARP packet */ |
| 8123 | eh = mtod(*data, struct ether_header *); |
| 8124 | ea = (struct ether_arp *)(eh + 1); |
| 8125 | if (ntohs(ea->arp_hrd) != ARPHRD_ETHER) { |
| 8126 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8127 | "ARP %s htype not ethernet" , |
| 8128 | get_in_out_string(is_output)); |
| 8129 | goto done; |
| 8130 | } |
| 8131 | if (ea->arp_hln != ETHER_ADDR_LEN) { |
| 8132 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8133 | "ARP %s hlen not ethernet" , |
| 8134 | get_in_out_string(is_output)); |
| 8135 | goto done; |
| 8136 | } |
| 8137 | if (ntohs(ea->arp_pro) != ETHERTYPE_IP) { |
| 8138 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8139 | "ARP %s ptype not IP" , |
| 8140 | get_in_out_string(is_output)); |
| 8141 | goto done; |
| 8142 | } |
| 8143 | if (ea->arp_pln != sizeof(struct in_addr)) { |
| 8144 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8145 | "ARP %s plen not IP" , |
| 8146 | get_in_out_string(is_output)); |
| 8147 | goto done; |
| 8148 | } |
| 8149 | is_valid = TRUE; |
| 8150 | *ea_p = ea; |
| 8151 | *eh_p = eh; |
| 8152 | done: |
| 8153 | return is_valid; |
| 8154 | } |
| 8155 | |
| 8156 | static struct mac_nat_entry * |
| 8157 | bridge_mac_nat_arp_input(struct bridge_softc *sc, mbuf_t *data) |
| 8158 | { |
| 8159 | struct ether_arp *ea; |
| 8160 | struct ether_header *eh; |
| 8161 | struct mac_nat_entry *mne = NULL; |
| 8162 | u_short op; |
| 8163 | struct in_addr tpa; |
| 8164 | |
| 8165 | if (!is_valid_arp_packet(data, FALSE, eh_p: &eh, ea_p: &ea)) { |
| 8166 | goto done; |
| 8167 | } |
| 8168 | op = ntohs(ea->arp_op); |
| 8169 | switch (op) { |
| 8170 | case ARPOP_REQUEST: |
| 8171 | case ARPOP_REPLY: |
| 8172 | /* only care about REQUEST and REPLY */ |
| 8173 | break; |
| 8174 | default: |
| 8175 | goto done; |
| 8176 | } |
| 8177 | |
| 8178 | /* check the target IP address for a NAT entry */ |
| 8179 | bcopy(src: ea->arp_tpa, dst: &tpa, n: sizeof(tpa)); |
| 8180 | if (tpa.s_addr != 0) { |
| 8181 | mne = bridge_lookup_mac_nat_entry(sc, AF_INET, ip: &tpa); |
| 8182 | } |
| 8183 | if (mne != NULL) { |
| 8184 | if (op == ARPOP_REPLY) { |
| 8185 | /* translate the MAC address */ |
| 8186 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MAC_NAT)) { |
| 8187 | char mac_src[24]; |
| 8188 | char mac_dst[24]; |
| 8189 | |
| 8190 | ether_ntop(buf: mac_src, len: sizeof(mac_src), |
| 8191 | ap: ea->arp_tha); |
| 8192 | ether_ntop(buf: mac_dst, len: sizeof(mac_dst), |
| 8193 | ap: mne->mne_mac); |
| 8194 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8195 | "%s %s ARP %s -> %s" , |
| 8196 | sc->sc_if_xname, |
| 8197 | mne->mne_bif->bif_ifp->if_xname, |
| 8198 | mac_src, mac_dst); |
| 8199 | } |
| 8200 | bcopy(src: mne->mne_mac, dst: ea->arp_tha, n: sizeof(ea->arp_tha)); |
| 8201 | } |
| 8202 | } else { |
| 8203 | /* handle conflicting ARP (sender matches mne) */ |
| 8204 | struct in_addr spa; |
| 8205 | |
| 8206 | bcopy(src: ea->arp_spa, dst: &spa, n: sizeof(spa)); |
| 8207 | if (spa.s_addr != 0 && spa.s_addr != tpa.s_addr) { |
| 8208 | /* check the source IP for a NAT entry */ |
| 8209 | mne = bridge_lookup_mac_nat_entry(sc, AF_INET, ip: &spa); |
| 8210 | } |
| 8211 | } |
| 8212 | |
| 8213 | done: |
| 8214 | return mne; |
| 8215 | } |
| 8216 | |
| 8217 | static boolean_t |
| 8218 | bridge_mac_nat_arp_output(struct bridge_softc *sc, |
| 8219 | struct bridge_iflist *bif, mbuf_t *data, struct mac_nat_record *mnr) |
| 8220 | { |
| 8221 | struct ether_arp *ea; |
| 8222 | struct ether_header *eh; |
| 8223 | struct in_addr ip; |
| 8224 | struct mac_nat_entry *mne = NULL; |
| 8225 | u_short op; |
| 8226 | boolean_t translate = FALSE; |
| 8227 | |
| 8228 | if (!is_valid_arp_packet(data, TRUE, eh_p: &eh, ea_p: &ea)) { |
| 8229 | goto done; |
| 8230 | } |
| 8231 | op = ntohs(ea->arp_op); |
| 8232 | switch (op) { |
| 8233 | case ARPOP_REQUEST: |
| 8234 | case ARPOP_REPLY: |
| 8235 | /* only care about REQUEST and REPLY */ |
| 8236 | break; |
| 8237 | default: |
| 8238 | goto done; |
| 8239 | } |
| 8240 | |
| 8241 | bcopy(src: ea->arp_spa, dst: &ip, n: sizeof(ip)); |
| 8242 | if (ip.s_addr == 0) { |
| 8243 | goto done; |
| 8244 | } |
| 8245 | /* XXX validate IP address: no multicast/broadcast */ |
| 8246 | mne = bridge_update_mac_nat_entry(sc, bif, AF_INET, ip: &ip, eaddr: ea->arp_sha); |
| 8247 | if (mnr != NULL && mne != NULL) { |
| 8248 | /* record the offset to do the replacement */ |
| 8249 | translate = TRUE; |
| 8250 | mnr->mnr_arp_offset = (char *)ea->arp_sha - (char *)eh; |
| 8251 | } |
| 8252 | |
| 8253 | done: |
| 8254 | return translate; |
| 8255 | } |
| 8256 | |
| 8257 | #define (sizeof(struct ether_header) + \ |
| 8258 | + sizeof(struct ip)) |
| 8259 | static struct ether_header * |
| 8260 | (mbuf_t *data, boolean_t is_output) |
| 8261 | { |
| 8262 | struct ether_header *eh = NULL; |
| 8263 | int flags = is_output ? BR_DBGF_OUTPUT : BR_DBGF_INPUT; |
| 8264 | size_t minlen = ETHER_IPV4_HEADER_LEN; |
| 8265 | |
| 8266 | if (mbuf_pkthdr_len(mbuf: *data) < minlen) { |
| 8267 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8268 | "IP %s short frame %lu < %lu" , |
| 8269 | get_in_out_string(is_output), |
| 8270 | mbuf_pkthdr_len(*data), minlen); |
| 8271 | goto done; |
| 8272 | } |
| 8273 | if (mbuf_len(mbuf: *data) < minlen && mbuf_pullup(mbuf: data, len: minlen) != 0) { |
| 8274 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8275 | "IP %s size %lu mbuf_pullup fail" , |
| 8276 | get_in_out_string(is_output), |
| 8277 | minlen); |
| 8278 | *data = NULL; |
| 8279 | goto done; |
| 8280 | } |
| 8281 | eh = mtod(*data, struct ether_header *); |
| 8282 | done: |
| 8283 | return eh; |
| 8284 | } |
| 8285 | |
| 8286 | static bool |
| 8287 | is_broadcast_ip_packet(mbuf_t *data) |
| 8288 | { |
| 8289 | struct ether_header *eh; |
| 8290 | uint16_t ether_type; |
| 8291 | bool is_broadcast = FALSE; |
| 8292 | |
| 8293 | eh = mtod(*data, struct ether_header *); |
| 8294 | ether_type = ntohs(eh->ether_type); |
| 8295 | switch (ether_type) { |
| 8296 | case ETHERTYPE_IP: |
| 8297 | eh = get_ether_ip_header(data, FALSE); |
| 8298 | if (eh != NULL) { |
| 8299 | struct in_addr dst; |
| 8300 | struct ip *iphdr; |
| 8301 | |
| 8302 | iphdr = (struct ip *)(void *)(eh + 1); |
| 8303 | bcopy(src: &iphdr->ip_dst, dst: &dst, n: sizeof(dst)); |
| 8304 | is_broadcast = (dst.s_addr == INADDR_BROADCAST); |
| 8305 | } |
| 8306 | break; |
| 8307 | default: |
| 8308 | break; |
| 8309 | } |
| 8310 | return is_broadcast; |
| 8311 | } |
| 8312 | |
| 8313 | static struct mac_nat_entry * |
| 8314 | bridge_mac_nat_ip_input(struct bridge_softc *sc, mbuf_t *data) |
| 8315 | { |
| 8316 | struct in_addr dst; |
| 8317 | struct ether_header *eh; |
| 8318 | struct ip *iphdr; |
| 8319 | struct mac_nat_entry *mne = NULL; |
| 8320 | |
| 8321 | eh = get_ether_ip_header(data, FALSE); |
| 8322 | if (eh == NULL) { |
| 8323 | goto done; |
| 8324 | } |
| 8325 | iphdr = (struct ip *)(void *)(eh + 1); |
| 8326 | bcopy(src: &iphdr->ip_dst, dst: &dst, n: sizeof(dst)); |
| 8327 | /* XXX validate IP address */ |
| 8328 | if (dst.s_addr == 0) { |
| 8329 | goto done; |
| 8330 | } |
| 8331 | mne = bridge_lookup_mac_nat_entry(sc, AF_INET, ip: &dst); |
| 8332 | done: |
| 8333 | return mne; |
| 8334 | } |
| 8335 | |
| 8336 | static void |
| 8337 | bridge_mac_nat_udp_output(struct bridge_softc *sc, |
| 8338 | struct bridge_iflist *bif, mbuf_t m, |
| 8339 | uint8_t , struct mac_nat_record *mnr) |
| 8340 | { |
| 8341 | uint16_t dp_flags; |
| 8342 | errno_t error; |
| 8343 | size_t offset; |
| 8344 | struct udphdr udphdr; |
| 8345 | |
| 8346 | /* copy the UDP header */ |
| 8347 | offset = sizeof(struct ether_header) + ip_header_len; |
| 8348 | error = mbuf_copydata(mbuf: m, offset, length: sizeof(struct udphdr), out_data: &udphdr); |
| 8349 | if (error != 0) { |
| 8350 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8351 | "mbuf_copydata udphdr failed %d" , |
| 8352 | error); |
| 8353 | return; |
| 8354 | } |
| 8355 | if (ntohs(udphdr.uh_sport) != IPPORT_BOOTPC || |
| 8356 | ntohs(udphdr.uh_dport) != IPPORT_BOOTPS) { |
| 8357 | /* not a BOOTP/DHCP packet */ |
| 8358 | return; |
| 8359 | } |
| 8360 | /* check whether the broadcast bit is already set */ |
| 8361 | offset += sizeof(struct udphdr) + offsetof(struct dhcp, dp_flags); |
| 8362 | error = mbuf_copydata(mbuf: m, offset, length: sizeof(dp_flags), out_data: &dp_flags); |
| 8363 | if (error != 0) { |
| 8364 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8365 | "mbuf_copydata dp_flags failed %d" , |
| 8366 | error); |
| 8367 | return; |
| 8368 | } |
| 8369 | if ((ntohs(dp_flags) & DHCP_FLAGS_BROADCAST) != 0) { |
| 8370 | /* it's already set, nothing to do */ |
| 8371 | return; |
| 8372 | } |
| 8373 | /* broadcast bit needs to be set */ |
| 8374 | mnr->mnr_ip_dhcp_flags = dp_flags | htons(DHCP_FLAGS_BROADCAST); |
| 8375 | mnr->mnr_ip_header_len = ip_header_len; |
| 8376 | if (udphdr.uh_sum != 0) { |
| 8377 | uint16_t delta; |
| 8378 | |
| 8379 | /* adjust checksum to take modified dp_flags into account */ |
| 8380 | delta = dp_flags - mnr->mnr_ip_dhcp_flags; |
| 8381 | mnr->mnr_ip_udp_csum = udphdr.uh_sum + delta; |
| 8382 | } |
| 8383 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8384 | "%s %s DHCP dp_flags 0x%x UDP cksum 0x%x" , |
| 8385 | sc->sc_if_xname, |
| 8386 | bif->bif_ifp->if_xname, |
| 8387 | ntohs(mnr->mnr_ip_dhcp_flags), |
| 8388 | ntohs(mnr->mnr_ip_udp_csum)); |
| 8389 | return; |
| 8390 | } |
| 8391 | |
| 8392 | static boolean_t |
| 8393 | bridge_mac_nat_ip_output(struct bridge_softc *sc, |
| 8394 | struct bridge_iflist *bif, mbuf_t *data, struct mac_nat_record *mnr) |
| 8395 | { |
| 8396 | #pragma unused(mnr) |
| 8397 | struct ether_header *eh; |
| 8398 | struct in_addr ip; |
| 8399 | struct ip *iphdr; |
| 8400 | uint8_t ; |
| 8401 | struct mac_nat_entry *mne = NULL; |
| 8402 | boolean_t translate = FALSE; |
| 8403 | |
| 8404 | eh = get_ether_ip_header(data, TRUE); |
| 8405 | if (eh == NULL) { |
| 8406 | goto done; |
| 8407 | } |
| 8408 | iphdr = (struct ip *)(void *)(eh + 1); |
| 8409 | ip_header_len = IP_VHL_HL(iphdr->ip_vhl) << 2; |
| 8410 | if (ip_header_len < sizeof(ip)) { |
| 8411 | /* bogus IP header */ |
| 8412 | goto done; |
| 8413 | } |
| 8414 | bcopy(src: &iphdr->ip_src, dst: &ip, n: sizeof(ip)); |
| 8415 | /* XXX validate the source address */ |
| 8416 | if (ip.s_addr != 0) { |
| 8417 | mne = bridge_update_mac_nat_entry(sc, bif, AF_INET, ip: &ip, |
| 8418 | eaddr: eh->ether_shost); |
| 8419 | } |
| 8420 | if (mnr != NULL) { |
| 8421 | if (ip.s_addr == 0 && iphdr->ip_p == IPPROTO_UDP) { |
| 8422 | /* handle DHCP must broadcast */ |
| 8423 | bridge_mac_nat_udp_output(sc, bif, m: *data, |
| 8424 | ip_header_len, mnr); |
| 8425 | } |
| 8426 | translate = TRUE; |
| 8427 | } |
| 8428 | done: |
| 8429 | return translate; |
| 8430 | } |
| 8431 | |
| 8432 | #define (sizeof(struct ether_header) + \ |
| 8433 | + sizeof(struct ip6_hdr)) |
| 8434 | static struct ether_header * |
| 8435 | (mbuf_t *data, size_t plen, boolean_t is_output) |
| 8436 | { |
| 8437 | struct ether_header *eh = NULL; |
| 8438 | int flags = is_output ? BR_DBGF_OUTPUT : BR_DBGF_INPUT; |
| 8439 | size_t minlen = ETHER_IPV6_HEADER_LEN + plen; |
| 8440 | |
| 8441 | if (mbuf_pkthdr_len(mbuf: *data) < minlen) { |
| 8442 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8443 | "IP %s short frame %lu < %lu" , |
| 8444 | get_in_out_string(is_output), |
| 8445 | mbuf_pkthdr_len(*data), minlen); |
| 8446 | goto done; |
| 8447 | } |
| 8448 | if (mbuf_len(mbuf: *data) < minlen && mbuf_pullup(mbuf: data, len: minlen) != 0) { |
| 8449 | BRIDGE_LOG(LOG_DEBUG, flags, |
| 8450 | "IP %s size %lu mbuf_pullup fail" , |
| 8451 | get_in_out_string(is_output), |
| 8452 | minlen); |
| 8453 | *data = NULL; |
| 8454 | goto done; |
| 8455 | } |
| 8456 | eh = mtod(*data, struct ether_header *); |
| 8457 | done: |
| 8458 | return eh; |
| 8459 | } |
| 8460 | |
| 8461 | #include <netinet/icmp6.h> |
| 8462 | #include <netinet6/nd6.h> |
| 8463 | |
| 8464 | #define ETHER_ND_LLADDR_LEN (ETHER_ADDR_LEN + sizeof(struct nd_opt_hdr)) |
| 8465 | |
| 8466 | static void |
| 8467 | bridge_mac_nat_icmpv6_output(struct bridge_softc *sc, |
| 8468 | struct bridge_iflist *bif, |
| 8469 | mbuf_t *data, struct ip6_hdr *ip6h, |
| 8470 | struct in6_addr *saddrp, |
| 8471 | struct mac_nat_record *mnr) |
| 8472 | { |
| 8473 | struct ether_header *eh; |
| 8474 | struct icmp6_hdr *icmp6; |
| 8475 | uint8_t icmp6_type; |
| 8476 | uint32_t icmp6len; |
| 8477 | int lladdrlen = 0; |
| 8478 | char *lladdr = NULL; |
| 8479 | unsigned int off = sizeof(*ip6h); |
| 8480 | |
| 8481 | icmp6len = (u_int32_t)ntohs(ip6h->ip6_plen); |
| 8482 | if (icmp6len < sizeof(*icmp6)) { |
| 8483 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8484 | "short IPv6 payload length %d < %lu" , |
| 8485 | icmp6len, sizeof(*icmp6)); |
| 8486 | return; |
| 8487 | } |
| 8488 | |
| 8489 | /* pullup IP6 header + ICMPv6 header */ |
| 8490 | eh = get_ether_ipv6_header(data, plen: sizeof(*icmp6), TRUE); |
| 8491 | if (eh == NULL) { |
| 8492 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8493 | "failed to pullup icmp6 header" ); |
| 8494 | return; |
| 8495 | } |
| 8496 | ip6h = (struct ip6_hdr *)(void *)(eh + 1); |
| 8497 | icmp6 = (struct icmp6_hdr *)((caddr_t)ip6h + off); |
| 8498 | icmp6_type = icmp6->icmp6_type; |
| 8499 | switch (icmp6_type) { |
| 8500 | case ND_NEIGHBOR_SOLICIT: |
| 8501 | case ND_NEIGHBOR_ADVERT: |
| 8502 | case ND_ROUTER_ADVERT: |
| 8503 | case ND_ROUTER_SOLICIT: |
| 8504 | break; |
| 8505 | default: |
| 8506 | return; |
| 8507 | } |
| 8508 | |
| 8509 | /* pullup IP6 header + payload */ |
| 8510 | eh = get_ether_ipv6_header(data, plen: icmp6len, TRUE); |
| 8511 | if (eh == NULL) { |
| 8512 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8513 | "failed to pullup icmp6 + payload" ); |
| 8514 | return; |
| 8515 | } |
| 8516 | ip6h = (struct ip6_hdr *)(void *)(eh + 1); |
| 8517 | icmp6 = (struct icmp6_hdr *)((caddr_t)ip6h + off); |
| 8518 | switch (icmp6_type) { |
| 8519 | case ND_NEIGHBOR_SOLICIT: { |
| 8520 | struct nd_neighbor_solicit *nd_ns; |
| 8521 | union nd_opts ndopts; |
| 8522 | boolean_t is_dad_probe; |
| 8523 | struct in6_addr taddr; |
| 8524 | |
| 8525 | if (icmp6len < sizeof(*nd_ns)) { |
| 8526 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8527 | "short nd_ns %d < %lu" , |
| 8528 | icmp6len, sizeof(*nd_ns)); |
| 8529 | return; |
| 8530 | } |
| 8531 | |
| 8532 | nd_ns = (struct nd_neighbor_solicit *)(void *)icmp6; |
| 8533 | bcopy(src: &nd_ns->nd_ns_target, dst: &taddr, n: sizeof(taddr)); |
| 8534 | if (IN6_IS_ADDR_MULTICAST(&taddr) || |
| 8535 | IN6_IS_ADDR_UNSPECIFIED(&taddr)) { |
| 8536 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8537 | "invalid target ignored" ); |
| 8538 | return; |
| 8539 | } |
| 8540 | /* parse options */ |
| 8541 | nd6_option_init(nd_ns + 1, icmp6len - sizeof(*nd_ns), &ndopts); |
| 8542 | if (nd6_options(&ndopts) < 0) { |
| 8543 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8544 | "invalid ND6 NS option" ); |
| 8545 | return; |
| 8546 | } |
| 8547 | if (ndopts.nd_opts_src_lladdr != NULL) { |
| 8548 | lladdr = (char *)(ndopts.nd_opts_src_lladdr + 1); |
| 8549 | lladdrlen = ndopts.nd_opts_src_lladdr->nd_opt_len << 3; |
| 8550 | } |
| 8551 | is_dad_probe = IN6_IS_ADDR_UNSPECIFIED(saddrp); |
| 8552 | if (lladdr != NULL) { |
| 8553 | if (is_dad_probe) { |
| 8554 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8555 | "bad ND6 DAD packet" ); |
| 8556 | return; |
| 8557 | } |
| 8558 | if (lladdrlen != ETHER_ND_LLADDR_LEN) { |
| 8559 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8560 | "source lladdrlen %d != %lu" , |
| 8561 | lladdrlen, ETHER_ND_LLADDR_LEN); |
| 8562 | return; |
| 8563 | } |
| 8564 | } |
| 8565 | if (is_dad_probe) { |
| 8566 | /* node is trying use taddr, create an mne for taddr */ |
| 8567 | *saddrp = taddr; |
| 8568 | } |
| 8569 | break; |
| 8570 | } |
| 8571 | case ND_NEIGHBOR_ADVERT: { |
| 8572 | struct nd_neighbor_advert *nd_na; |
| 8573 | union nd_opts ndopts; |
| 8574 | struct in6_addr taddr; |
| 8575 | |
| 8576 | |
| 8577 | nd_na = (struct nd_neighbor_advert *)(void *)icmp6; |
| 8578 | |
| 8579 | if (icmp6len < sizeof(*nd_na)) { |
| 8580 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8581 | "short nd_na %d < %lu" , |
| 8582 | icmp6len, sizeof(*nd_na)); |
| 8583 | return; |
| 8584 | } |
| 8585 | |
| 8586 | bcopy(src: &nd_na->nd_na_target, dst: &taddr, n: sizeof(taddr)); |
| 8587 | if (IN6_IS_ADDR_MULTICAST(&taddr) || |
| 8588 | IN6_IS_ADDR_UNSPECIFIED(&taddr)) { |
| 8589 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8590 | "invalid target ignored" ); |
| 8591 | return; |
| 8592 | } |
| 8593 | /* parse options */ |
| 8594 | nd6_option_init(nd_na + 1, icmp6len - sizeof(*nd_na), &ndopts); |
| 8595 | if (nd6_options(&ndopts) < 0) { |
| 8596 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8597 | "invalid ND6 NA option" ); |
| 8598 | return; |
| 8599 | } |
| 8600 | if (ndopts.nd_opts_tgt_lladdr == NULL) { |
| 8601 | /* target linklayer, nothing to do */ |
| 8602 | return; |
| 8603 | } |
| 8604 | lladdr = (char *)(ndopts.nd_opts_tgt_lladdr + 1); |
| 8605 | lladdrlen = ndopts.nd_opts_tgt_lladdr->nd_opt_len << 3; |
| 8606 | if (lladdrlen != ETHER_ND_LLADDR_LEN) { |
| 8607 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8608 | "target lladdrlen %d != %lu" , |
| 8609 | lladdrlen, ETHER_ND_LLADDR_LEN); |
| 8610 | return; |
| 8611 | } |
| 8612 | break; |
| 8613 | } |
| 8614 | case ND_ROUTER_ADVERT: |
| 8615 | case ND_ROUTER_SOLICIT: { |
| 8616 | union nd_opts ndopts; |
| 8617 | uint32_t type_length; |
| 8618 | const char *description; |
| 8619 | |
| 8620 | if (icmp6_type == ND_ROUTER_ADVERT) { |
| 8621 | type_length = sizeof(struct nd_router_advert); |
| 8622 | description = "RA" ; |
| 8623 | } else { |
| 8624 | type_length = sizeof(struct nd_router_solicit); |
| 8625 | description = "RS" ; |
| 8626 | } |
| 8627 | if (icmp6len < type_length) { |
| 8628 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8629 | "short ND6 %s %d < %d" , |
| 8630 | description, icmp6len, type_length); |
| 8631 | return; |
| 8632 | } |
| 8633 | /* parse options */ |
| 8634 | nd6_option_init(((uint8_t *)icmp6) + type_length, |
| 8635 | icmp6len - type_length, &ndopts); |
| 8636 | if (nd6_options(&ndopts) < 0) { |
| 8637 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8638 | "invalid ND6 %s option" , description); |
| 8639 | return; |
| 8640 | } |
| 8641 | if (ndopts.nd_opts_src_lladdr != NULL) { |
| 8642 | lladdr = (char *)(ndopts.nd_opts_src_lladdr + 1); |
| 8643 | lladdrlen = ndopts.nd_opts_src_lladdr->nd_opt_len << 3; |
| 8644 | if (lladdrlen != ETHER_ND_LLADDR_LEN) { |
| 8645 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8646 | "source lladdrlen %d != %lu" , |
| 8647 | lladdrlen, ETHER_ND_LLADDR_LEN); |
| 8648 | return; |
| 8649 | } |
| 8650 | } |
| 8651 | break; |
| 8652 | } |
| 8653 | default: |
| 8654 | break; |
| 8655 | } |
| 8656 | if (lladdr != NULL) { |
| 8657 | mnr->mnr_ip6_lladdr_offset = (uint16_t) |
| 8658 | ((uintptr_t)lladdr - (uintptr_t)eh); |
| 8659 | mnr->mnr_ip6_icmp6_len = icmp6len; |
| 8660 | mnr->mnr_ip6_icmp6_type = icmp6_type; |
| 8661 | mnr->mnr_ip6_header_len = off; |
| 8662 | if (BRIDGE_DBGF_ENABLED(BR_DBGF_MAC_NAT)) { |
| 8663 | const char *str; |
| 8664 | |
| 8665 | switch (mnr->mnr_ip6_icmp6_type) { |
| 8666 | case ND_ROUTER_ADVERT: |
| 8667 | str = "ROUTER ADVERT" ; |
| 8668 | break; |
| 8669 | case ND_ROUTER_SOLICIT: |
| 8670 | str = "ROUTER SOLICIT" ; |
| 8671 | break; |
| 8672 | case ND_NEIGHBOR_ADVERT: |
| 8673 | str = "NEIGHBOR ADVERT" ; |
| 8674 | break; |
| 8675 | case ND_NEIGHBOR_SOLICIT: |
| 8676 | str = "NEIGHBOR SOLICIT" ; |
| 8677 | break; |
| 8678 | default: |
| 8679 | str = "" ; |
| 8680 | break; |
| 8681 | } |
| 8682 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_MAC_NAT, |
| 8683 | "%s %s %s ip6len %d icmp6len %d lladdr offset %d" , |
| 8684 | sc->sc_if_xname, bif->bif_ifp->if_xname, str, |
| 8685 | mnr->mnr_ip6_header_len, |
| 8686 | mnr->mnr_ip6_icmp6_len, mnr->mnr_ip6_lladdr_offset); |
| 8687 | } |
| 8688 | } |
| 8689 | } |
| 8690 | |
| 8691 | static struct mac_nat_entry * |
| 8692 | bridge_mac_nat_ipv6_input(struct bridge_softc *sc, mbuf_t *data) |
| 8693 | { |
| 8694 | struct in6_addr dst; |
| 8695 | struct ether_header *eh; |
| 8696 | struct ip6_hdr *ip6h; |
| 8697 | struct mac_nat_entry *mne = NULL; |
| 8698 | |
| 8699 | eh = get_ether_ipv6_header(data, plen: 0, FALSE); |
| 8700 | if (eh == NULL) { |
| 8701 | goto done; |
| 8702 | } |
| 8703 | ip6h = (struct ip6_hdr *)(void *)(eh + 1); |
| 8704 | bcopy(src: &ip6h->ip6_dst, dst: &dst, n: sizeof(dst)); |
| 8705 | /* XXX validate IPv6 address */ |
| 8706 | if (IN6_IS_ADDR_UNSPECIFIED(&dst)) { |
| 8707 | goto done; |
| 8708 | } |
| 8709 | mne = bridge_lookup_mac_nat_entry(sc, AF_INET6, ip: &dst); |
| 8710 | |
| 8711 | done: |
| 8712 | return mne; |
| 8713 | } |
| 8714 | |
| 8715 | static boolean_t |
| 8716 | bridge_mac_nat_ipv6_output(struct bridge_softc *sc, |
| 8717 | struct bridge_iflist *bif, mbuf_t *data, struct mac_nat_record *mnr) |
| 8718 | { |
| 8719 | struct ether_header *eh; |
| 8720 | ether_addr_t ether_shost; |
| 8721 | struct ip6_hdr *ip6h; |
| 8722 | struct in6_addr saddr; |
| 8723 | boolean_t translate; |
| 8724 | |
| 8725 | translate = (bif == sc->sc_mac_nat_bif) ? FALSE : TRUE; |
| 8726 | eh = get_ether_ipv6_header(data, plen: 0, TRUE); |
| 8727 | if (eh == NULL) { |
| 8728 | translate = FALSE; |
| 8729 | goto done; |
| 8730 | } |
| 8731 | bcopy(src: eh->ether_shost, dst: ðer_shost, n: sizeof(ether_shost)); |
| 8732 | ip6h = (struct ip6_hdr *)(void *)(eh + 1); |
| 8733 | bcopy(src: &ip6h->ip6_src, dst: &saddr, n: sizeof(saddr)); |
| 8734 | if (mnr != NULL && ip6h->ip6_nxt == IPPROTO_ICMPV6) { |
| 8735 | bridge_mac_nat_icmpv6_output(sc, bif, data, ip6h, saddrp: &saddr, mnr); |
| 8736 | } |
| 8737 | if (IN6_IS_ADDR_UNSPECIFIED(&saddr)) { |
| 8738 | goto done; |
| 8739 | } |
| 8740 | (void)bridge_update_mac_nat_entry(sc, bif, AF_INET6, ip: &saddr, |
| 8741 | eaddr: ether_shost.octet); |
| 8742 | |
| 8743 | done: |
| 8744 | return translate; |
| 8745 | } |
| 8746 | |
| 8747 | /* |
| 8748 | * bridge_mac_nat_input: |
| 8749 | * Process a packet arriving on the MAC NAT interface (sc_mac_nat_bif). |
| 8750 | * This interface is the "external" interface with respect to NAT. |
| 8751 | * The interface is only capable of receiving a single MAC address |
| 8752 | * (e.g. a Wi-Fi STA interface). |
| 8753 | * |
| 8754 | * When a packet arrives on the external interface, look up the destination |
| 8755 | * IP address in the mac_nat_entry table. If there is a match, *is_input |
| 8756 | * is set to TRUE if it's for the MAC NAT interface, otherwise *is_input |
| 8757 | * is set to FALSE and translate the MAC address if necessary. |
| 8758 | * |
| 8759 | * Returns: |
| 8760 | * The internal interface to direct the packet to, or NULL if the packet |
| 8761 | * should not be redirected. |
| 8762 | * |
| 8763 | * *data may be updated to point at a different mbuf chain, or set to NULL |
| 8764 | * if the chain was deallocated during processing. |
| 8765 | */ |
| 8766 | static ifnet_t |
| 8767 | bridge_mac_nat_input(struct bridge_softc *sc, mbuf_t *data, |
| 8768 | boolean_t *is_input) |
| 8769 | { |
| 8770 | ifnet_t dst_if = NULL; |
| 8771 | struct ether_header *eh; |
| 8772 | uint16_t ether_type; |
| 8773 | boolean_t is_unicast; |
| 8774 | mbuf_t m = *data; |
| 8775 | struct mac_nat_entry *mne = NULL; |
| 8776 | |
| 8777 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 8778 | *is_input = FALSE; |
| 8779 | assert(sc->sc_mac_nat_bif != NULL); |
| 8780 | is_unicast = ((m->m_flags & (M_BCAST | M_MCAST)) == 0); |
| 8781 | eh = mtod(m, struct ether_header *); |
| 8782 | ether_type = ntohs(eh->ether_type); |
| 8783 | switch (ether_type) { |
| 8784 | case ETHERTYPE_ARP: |
| 8785 | mne = bridge_mac_nat_arp_input(sc, data); |
| 8786 | break; |
| 8787 | case ETHERTYPE_IP: |
| 8788 | if (is_unicast) { |
| 8789 | mne = bridge_mac_nat_ip_input(sc, data); |
| 8790 | } |
| 8791 | break; |
| 8792 | case ETHERTYPE_IPV6: |
| 8793 | if (is_unicast) { |
| 8794 | mne = bridge_mac_nat_ipv6_input(sc, data); |
| 8795 | } |
| 8796 | break; |
| 8797 | default: |
| 8798 | break; |
| 8799 | } |
| 8800 | if (mne != NULL) { |
| 8801 | if (is_unicast) { |
| 8802 | if (m != *data) { |
| 8803 | /* it may have changed */ |
| 8804 | eh = mtod(*data, struct ether_header *); |
| 8805 | } |
| 8806 | bcopy(src: mne->mne_mac, dst: eh->ether_dhost, |
| 8807 | n: sizeof(eh->ether_dhost)); |
| 8808 | } |
| 8809 | dst_if = mne->mne_bif->bif_ifp; |
| 8810 | *is_input = (mne->mne_bif == sc->sc_mac_nat_bif); |
| 8811 | } |
| 8812 | return dst_if; |
| 8813 | } |
| 8814 | |
| 8815 | /* |
| 8816 | * bridge_mac_nat_output: |
| 8817 | * Process a packet destined to the MAC NAT interface (sc_mac_nat_bif) |
| 8818 | * from the interface 'bif'. |
| 8819 | * |
| 8820 | * Create a mac_nat_entry containing the source IP address and MAC address |
| 8821 | * from the packet. Populate a mac_nat_record with information detailing |
| 8822 | * how to translate the packet. Translation takes place later when |
| 8823 | * the bridge lock is no longer held. |
| 8824 | * |
| 8825 | * If 'bif' == sc_mac_nat_bif, the stack over the MAC NAT |
| 8826 | * interface is generating an output packet. No translation is required in this |
| 8827 | * case, we just record the IP address used to prevent another bif from |
| 8828 | * claiming our IP address. |
| 8829 | * |
| 8830 | * Returns: |
| 8831 | * TRUE if the packet should be translated (*mnr updated as well), |
| 8832 | * FALSE otherwise. |
| 8833 | * |
| 8834 | * *data may be updated to point at a different mbuf chain or NULL if |
| 8835 | * the chain was deallocated during processing. |
| 8836 | */ |
| 8837 | |
| 8838 | static boolean_t |
| 8839 | bridge_mac_nat_output(struct bridge_softc *sc, |
| 8840 | struct bridge_iflist *bif, mbuf_t *data, struct mac_nat_record *mnr) |
| 8841 | { |
| 8842 | struct ether_header *eh; |
| 8843 | uint16_t ether_type; |
| 8844 | boolean_t translate = FALSE; |
| 8845 | |
| 8846 | BRIDGE_LOCK_ASSERT_HELD(sc); |
| 8847 | assert(sc->sc_mac_nat_bif != NULL); |
| 8848 | |
| 8849 | eh = mtod(*data, struct ether_header *); |
| 8850 | ether_type = ntohs(eh->ether_type); |
| 8851 | if (mnr != NULL) { |
| 8852 | bzero(s: mnr, n: sizeof(*mnr)); |
| 8853 | mnr->mnr_ether_type = ether_type; |
| 8854 | } |
| 8855 | switch (ether_type) { |
| 8856 | case ETHERTYPE_ARP: |
| 8857 | translate = bridge_mac_nat_arp_output(sc, bif, data, mnr); |
| 8858 | break; |
| 8859 | case ETHERTYPE_IP: |
| 8860 | translate = bridge_mac_nat_ip_output(sc, bif, data, mnr); |
| 8861 | break; |
| 8862 | case ETHERTYPE_IPV6: |
| 8863 | translate = bridge_mac_nat_ipv6_output(sc, bif, data, mnr); |
| 8864 | break; |
| 8865 | default: |
| 8866 | break; |
| 8867 | } |
| 8868 | return translate; |
| 8869 | } |
| 8870 | |
| 8871 | static void |
| 8872 | bridge_mac_nat_arp_translate(mbuf_t *data, struct mac_nat_record *mnr, |
| 8873 | const caddr_t eaddr) |
| 8874 | { |
| 8875 | errno_t error; |
| 8876 | |
| 8877 | if (mnr->mnr_arp_offset == 0) { |
| 8878 | return; |
| 8879 | } |
| 8880 | /* replace the source hardware address */ |
| 8881 | error = mbuf_copyback(mbuf: *data, offset: mnr->mnr_arp_offset, |
| 8882 | ETHER_ADDR_LEN, data: eaddr, |
| 8883 | how: MBUF_DONTWAIT); |
| 8884 | if (error != 0) { |
| 8885 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8886 | "mbuf_copyback failed" ); |
| 8887 | m_freem(*data); |
| 8888 | *data = NULL; |
| 8889 | } |
| 8890 | return; |
| 8891 | } |
| 8892 | |
| 8893 | static void |
| 8894 | bridge_mac_nat_ip_translate(mbuf_t *data, struct mac_nat_record *mnr) |
| 8895 | { |
| 8896 | errno_t error; |
| 8897 | size_t offset; |
| 8898 | |
| 8899 | if (mnr->mnr_ip_header_len == 0) { |
| 8900 | return; |
| 8901 | } |
| 8902 | /* update the UDP checksum */ |
| 8903 | offset = sizeof(struct ether_header) + mnr->mnr_ip_header_len; |
| 8904 | error = mbuf_copyback(mbuf: *data, offset: offset + offsetof(struct udphdr, uh_sum), |
| 8905 | length: sizeof(mnr->mnr_ip_udp_csum), |
| 8906 | data: &mnr->mnr_ip_udp_csum, |
| 8907 | how: MBUF_DONTWAIT); |
| 8908 | if (error != 0) { |
| 8909 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8910 | "mbuf_copyback uh_sum failed" ); |
| 8911 | m_freem(*data); |
| 8912 | *data = NULL; |
| 8913 | } |
| 8914 | /* update the DHCP must broadcast flag */ |
| 8915 | offset += sizeof(struct udphdr); |
| 8916 | error = mbuf_copyback(mbuf: *data, offset: offset + offsetof(struct dhcp, dp_flags), |
| 8917 | length: sizeof(mnr->mnr_ip_dhcp_flags), |
| 8918 | data: &mnr->mnr_ip_dhcp_flags, |
| 8919 | how: MBUF_DONTWAIT); |
| 8920 | if (error != 0) { |
| 8921 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8922 | "mbuf_copyback dp_flags failed" ); |
| 8923 | m_freem(*data); |
| 8924 | *data = NULL; |
| 8925 | } |
| 8926 | } |
| 8927 | |
| 8928 | static void |
| 8929 | bridge_mac_nat_ipv6_translate(mbuf_t *data, struct mac_nat_record *mnr, |
| 8930 | const caddr_t eaddr) |
| 8931 | { |
| 8932 | uint16_t cksum; |
| 8933 | errno_t error; |
| 8934 | mbuf_t m = *data; |
| 8935 | |
| 8936 | if (mnr->mnr_ip6_header_len == 0) { |
| 8937 | return; |
| 8938 | } |
| 8939 | switch (mnr->mnr_ip6_icmp6_type) { |
| 8940 | case ND_ROUTER_ADVERT: |
| 8941 | case ND_ROUTER_SOLICIT: |
| 8942 | case ND_NEIGHBOR_SOLICIT: |
| 8943 | case ND_NEIGHBOR_ADVERT: |
| 8944 | if (mnr->mnr_ip6_lladdr_offset == 0) { |
| 8945 | /* nothing to do */ |
| 8946 | return; |
| 8947 | } |
| 8948 | break; |
| 8949 | default: |
| 8950 | return; |
| 8951 | } |
| 8952 | |
| 8953 | /* |
| 8954 | * replace the lladdr |
| 8955 | */ |
| 8956 | error = mbuf_copyback(mbuf: m, offset: mnr->mnr_ip6_lladdr_offset, |
| 8957 | ETHER_ADDR_LEN, data: eaddr, |
| 8958 | how: MBUF_DONTWAIT); |
| 8959 | if (error != 0) { |
| 8960 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8961 | "mbuf_copyback lladdr failed" ); |
| 8962 | m_freem(m); |
| 8963 | *data = NULL; |
| 8964 | return; |
| 8965 | } |
| 8966 | |
| 8967 | /* |
| 8968 | * recompute the icmp6 checksum |
| 8969 | */ |
| 8970 | |
| 8971 | /* skip past the ethernet header */ |
| 8972 | mbuf_setdata(mbuf: m, data: (char *)mbuf_data(mbuf: m) + ETHER_HDR_LEN, |
| 8973 | len: mbuf_len(mbuf: m) - ETHER_HDR_LEN); |
| 8974 | mbuf_pkthdr_adjustlen(mbuf: m, amount: -ETHER_HDR_LEN); |
| 8975 | |
| 8976 | #define CKSUM_OFFSET_ICMP6 offsetof(struct icmp6_hdr, icmp6_cksum) |
| 8977 | /* set the checksum to zero */ |
| 8978 | cksum = 0; |
| 8979 | error = mbuf_copyback(mbuf: m, offset: mnr->mnr_ip6_header_len + CKSUM_OFFSET_ICMP6, |
| 8980 | length: sizeof(cksum), data: &cksum, how: MBUF_DONTWAIT); |
| 8981 | if (error != 0) { |
| 8982 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8983 | "mbuf_copyback cksum=0 failed" ); |
| 8984 | m_freem(m); |
| 8985 | *data = NULL; |
| 8986 | return; |
| 8987 | } |
| 8988 | /* compute and set the new checksum */ |
| 8989 | cksum = in6_cksum(m, IPPROTO_ICMPV6, mnr->mnr_ip6_header_len, |
| 8990 | mnr->mnr_ip6_icmp6_len); |
| 8991 | error = mbuf_copyback(mbuf: m, offset: mnr->mnr_ip6_header_len + CKSUM_OFFSET_ICMP6, |
| 8992 | length: sizeof(cksum), data: &cksum, how: MBUF_DONTWAIT); |
| 8993 | if (error != 0) { |
| 8994 | BRIDGE_LOG(LOG_NOTICE, BR_DBGF_MAC_NAT, |
| 8995 | "mbuf_copyback cksum failed" ); |
| 8996 | m_freem(m); |
| 8997 | *data = NULL; |
| 8998 | return; |
| 8999 | } |
| 9000 | /* restore the ethernet header */ |
| 9001 | mbuf_setdata(mbuf: m, data: (char *)mbuf_data(mbuf: m) - ETHER_HDR_LEN, |
| 9002 | len: mbuf_len(mbuf: m) + ETHER_HDR_LEN); |
| 9003 | mbuf_pkthdr_adjustlen(mbuf: m, ETHER_HDR_LEN); |
| 9004 | return; |
| 9005 | } |
| 9006 | |
| 9007 | static void |
| 9008 | bridge_mac_nat_translate(mbuf_t *data, struct mac_nat_record *mnr, |
| 9009 | const caddr_t eaddr) |
| 9010 | { |
| 9011 | struct ether_header *eh; |
| 9012 | |
| 9013 | /* replace the source ethernet address with the single MAC */ |
| 9014 | eh = mtod(*data, struct ether_header *); |
| 9015 | bcopy(src: eaddr, dst: eh->ether_shost, n: sizeof(eh->ether_shost)); |
| 9016 | switch (mnr->mnr_ether_type) { |
| 9017 | case ETHERTYPE_ARP: |
| 9018 | bridge_mac_nat_arp_translate(data, mnr, eaddr); |
| 9019 | break; |
| 9020 | |
| 9021 | case ETHERTYPE_IP: |
| 9022 | bridge_mac_nat_ip_translate(data, mnr); |
| 9023 | break; |
| 9024 | |
| 9025 | case ETHERTYPE_IPV6: |
| 9026 | bridge_mac_nat_ipv6_translate(data, mnr, eaddr); |
| 9027 | break; |
| 9028 | |
| 9029 | default: |
| 9030 | break; |
| 9031 | } |
| 9032 | return; |
| 9033 | } |
| 9034 | |
| 9035 | /* |
| 9036 | * bridge packet filtering |
| 9037 | */ |
| 9038 | |
| 9039 | /* |
| 9040 | * Perform basic checks on header size since |
| 9041 | * pfil assumes ip_input has already processed |
| 9042 | * it for it. Cut-and-pasted from ip_input.c. |
| 9043 | * Given how simple the IPv6 version is, |
| 9044 | * does the IPv4 version really need to be |
| 9045 | * this complicated? |
| 9046 | * |
| 9047 | * XXX Should we update ipstat here, or not? |
| 9048 | * XXX Right now we update ipstat but not |
| 9049 | * XXX csum_counter. |
| 9050 | */ |
| 9051 | static int |
| 9052 | bridge_ip_checkbasic(struct mbuf **mp) |
| 9053 | { |
| 9054 | struct mbuf *m = *mp; |
| 9055 | struct ip *ip; |
| 9056 | int len, hlen; |
| 9057 | u_short sum; |
| 9058 | |
| 9059 | if (*mp == NULL) { |
| 9060 | return -1; |
| 9061 | } |
| 9062 | |
| 9063 | if (IP_HDR_ALIGNED_P(mtod(m, caddr_t)) == 0) { |
| 9064 | /* max_linkhdr is already rounded up to nearest 4-byte */ |
| 9065 | if ((m = m_copyup(m, sizeof(struct ip), |
| 9066 | max_linkhdr)) == NULL) { |
| 9067 | /* XXXJRT new stat, please */ |
| 9068 | ipstat.ips_toosmall++; |
| 9069 | goto bad; |
| 9070 | } |
| 9071 | } else if (OS_EXPECT((size_t)m->m_len < sizeof(struct ip), 0)) { |
| 9072 | if ((m = m_pullup(m, sizeof(struct ip))) == NULL) { |
| 9073 | ipstat.ips_toosmall++; |
| 9074 | goto bad; |
| 9075 | } |
| 9076 | } |
| 9077 | ip = mtod(m, struct ip *); |
| 9078 | if (ip == NULL) { |
| 9079 | goto bad; |
| 9080 | } |
| 9081 | |
| 9082 | if (IP_VHL_V(ip->ip_vhl) != IPVERSION) { |
| 9083 | ipstat.ips_badvers++; |
| 9084 | goto bad; |
| 9085 | } |
| 9086 | hlen = IP_VHL_HL(ip->ip_vhl) << 2; |
| 9087 | if (hlen < (int)sizeof(struct ip)) { /* minimum header length */ |
| 9088 | ipstat.ips_badhlen++; |
| 9089 | goto bad; |
| 9090 | } |
| 9091 | if (hlen > m->m_len) { |
| 9092 | if ((m = m_pullup(m, hlen)) == 0) { |
| 9093 | ipstat.ips_badhlen++; |
| 9094 | goto bad; |
| 9095 | } |
| 9096 | ip = mtod(m, struct ip *); |
| 9097 | if (ip == NULL) { |
| 9098 | goto bad; |
| 9099 | } |
| 9100 | } |
| 9101 | |
| 9102 | if (m->m_pkthdr.csum_flags & CSUM_IP_CHECKED) { |
| 9103 | sum = !(m->m_pkthdr.csum_flags & CSUM_IP_VALID); |
| 9104 | } else { |
| 9105 | if (hlen == sizeof(struct ip)) { |
| 9106 | sum = in_cksum_hdr(ip); |
| 9107 | } else { |
| 9108 | sum = in_cksum(m, hlen); |
| 9109 | } |
| 9110 | } |
| 9111 | if (sum) { |
| 9112 | ipstat.ips_badsum++; |
| 9113 | goto bad; |
| 9114 | } |
| 9115 | |
| 9116 | /* Retrieve the packet length. */ |
| 9117 | len = ntohs(ip->ip_len); |
| 9118 | |
| 9119 | /* |
| 9120 | * Check for additional length bogosity |
| 9121 | */ |
| 9122 | if (len < hlen) { |
| 9123 | ipstat.ips_badlen++; |
| 9124 | goto bad; |
| 9125 | } |
| 9126 | |
| 9127 | /* |
| 9128 | * Check that the amount of data in the buffers |
| 9129 | * is as at least much as the IP header would have us expect. |
| 9130 | * Drop packet if shorter than we expect. |
| 9131 | */ |
| 9132 | if (m->m_pkthdr.len < len) { |
| 9133 | ipstat.ips_tooshort++; |
| 9134 | goto bad; |
| 9135 | } |
| 9136 | |
| 9137 | /* Checks out, proceed */ |
| 9138 | *mp = m; |
| 9139 | return 0; |
| 9140 | |
| 9141 | bad: |
| 9142 | *mp = m; |
| 9143 | return -1; |
| 9144 | } |
| 9145 | |
| 9146 | /* |
| 9147 | * Same as above, but for IPv6. |
| 9148 | * Cut-and-pasted from ip6_input.c. |
| 9149 | * XXX Should we update ip6stat, or not? |
| 9150 | */ |
| 9151 | static int |
| 9152 | bridge_ip6_checkbasic(struct mbuf **mp) |
| 9153 | { |
| 9154 | struct mbuf *m = *mp; |
| 9155 | struct ip6_hdr *ip6; |
| 9156 | |
| 9157 | /* |
| 9158 | * If the IPv6 header is not aligned, slurp it up into a new |
| 9159 | * mbuf with space for link headers, in the event we forward |
| 9160 | * it. Otherwise, if it is aligned, make sure the entire base |
| 9161 | * IPv6 header is in the first mbuf of the chain. |
| 9162 | */ |
| 9163 | if (IP6_HDR_ALIGNED_P(mtod(m, caddr_t)) == 0) { |
| 9164 | struct ifnet *inifp = m->m_pkthdr.rcvif; |
| 9165 | /* max_linkhdr is already rounded up to nearest 4-byte */ |
| 9166 | if ((m = m_copyup(m, sizeof(struct ip6_hdr), |
| 9167 | max_linkhdr)) == NULL) { |
| 9168 | /* XXXJRT new stat, please */ |
| 9169 | ip6stat.ip6s_toosmall++; |
| 9170 | in6_ifstat_inc(inifp, ifs6_in_hdrerr); |
| 9171 | goto bad; |
| 9172 | } |
| 9173 | } else if (OS_EXPECT((size_t)m->m_len < sizeof(struct ip6_hdr), 0)) { |
| 9174 | struct ifnet *inifp = m->m_pkthdr.rcvif; |
| 9175 | if ((m = m_pullup(m, sizeof(struct ip6_hdr))) == NULL) { |
| 9176 | ip6stat.ip6s_toosmall++; |
| 9177 | in6_ifstat_inc(inifp, ifs6_in_hdrerr); |
| 9178 | goto bad; |
| 9179 | } |
| 9180 | } |
| 9181 | |
| 9182 | ip6 = mtod(m, struct ip6_hdr *); |
| 9183 | |
| 9184 | if ((ip6->ip6_vfc & IPV6_VERSION_MASK) != IPV6_VERSION) { |
| 9185 | ip6stat.ip6s_badvers++; |
| 9186 | in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_hdrerr); |
| 9187 | goto bad; |
| 9188 | } |
| 9189 | |
| 9190 | /* Checks out, proceed */ |
| 9191 | *mp = m; |
| 9192 | return 0; |
| 9193 | |
| 9194 | bad: |
| 9195 | *mp = m; |
| 9196 | return -1; |
| 9197 | } |
| 9198 | |
| 9199 | /* |
| 9200 | * the PF routines expect to be called from ip_input, so we |
| 9201 | * need to do and undo here some of the same processing. |
| 9202 | * |
| 9203 | * XXX : this is heavily inspired on bridge_pfil() |
| 9204 | */ |
| 9205 | static int |
| 9206 | bridge_pf(struct mbuf **mp, struct ifnet *ifp, uint32_t sc_filter_flags, |
| 9207 | int input) |
| 9208 | { |
| 9209 | /* |
| 9210 | * XXX : mpetit : heavily inspired by bridge_pfil() |
| 9211 | */ |
| 9212 | |
| 9213 | int snap, error, i, hlen; |
| 9214 | struct ether_header *eh1, eh2; |
| 9215 | struct ip *ip; |
| 9216 | struct llc llc1; |
| 9217 | u_int16_t ether_type; |
| 9218 | |
| 9219 | snap = 0; |
| 9220 | error = -1; /* Default error if not error == 0 */ |
| 9221 | |
| 9222 | if ((sc_filter_flags & IFBF_FILT_MEMBER) == 0) { |
| 9223 | return 0; /* filtering is disabled */ |
| 9224 | } |
| 9225 | i = min(a: (*mp)->m_pkthdr.len, b: max_protohdr); |
| 9226 | if ((*mp)->m_len < i) { |
| 9227 | *mp = m_pullup(*mp, i); |
| 9228 | if (*mp == NULL) { |
| 9229 | BRIDGE_LOG(LOG_NOTICE, 0, "m_pullup failed" ); |
| 9230 | return -1; |
| 9231 | } |
| 9232 | } |
| 9233 | |
| 9234 | eh1 = mtod(*mp, struct ether_header *); |
| 9235 | ether_type = ntohs(eh1->ether_type); |
| 9236 | |
| 9237 | /* |
| 9238 | * Check for SNAP/LLC. |
| 9239 | */ |
| 9240 | if (ether_type < ETHERMTU) { |
| 9241 | struct llc *llc2 = (struct llc *)(eh1 + 1); |
| 9242 | |
| 9243 | if ((*mp)->m_len >= ETHER_HDR_LEN + 8 && |
| 9244 | llc2->llc_dsap == LLC_SNAP_LSAP && |
| 9245 | llc2->llc_ssap == LLC_SNAP_LSAP && |
| 9246 | llc2->llc_control == LLC_UI) { |
| 9247 | ether_type = htons(llc2->llc_un.type_snap.ether_type); |
| 9248 | snap = 1; |
| 9249 | } |
| 9250 | } |
| 9251 | |
| 9252 | /* |
| 9253 | * If we're trying to filter bridge traffic, don't look at anything |
| 9254 | * other than IP and ARP traffic. If the filter doesn't understand |
| 9255 | * IPv6, don't allow IPv6 through the bridge either. This is lame |
| 9256 | * since if we really wanted, say, an AppleTalk filter, we are hosed, |
| 9257 | * but of course we don't have an AppleTalk filter to begin with. |
| 9258 | * (Note that since pfil doesn't understand ARP it will pass *ALL* |
| 9259 | * ARP traffic.) |
| 9260 | */ |
| 9261 | switch (ether_type) { |
| 9262 | case ETHERTYPE_ARP: |
| 9263 | case ETHERTYPE_REVARP: |
| 9264 | return 0; /* Automatically pass */ |
| 9265 | |
| 9266 | case ETHERTYPE_IP: |
| 9267 | case ETHERTYPE_IPV6: |
| 9268 | break; |
| 9269 | default: |
| 9270 | /* |
| 9271 | * Check to see if the user wants to pass non-ip |
| 9272 | * packets, these will not be checked by pf and |
| 9273 | * passed unconditionally so the default is to drop. |
| 9274 | */ |
| 9275 | if ((sc_filter_flags & IFBF_FILT_ONLYIP)) { |
| 9276 | goto bad; |
| 9277 | } |
| 9278 | break; |
| 9279 | } |
| 9280 | |
| 9281 | /* Strip off the Ethernet header and keep a copy. */ |
| 9282 | m_copydata(*mp, 0, ETHER_HDR_LEN, (caddr_t)&eh2); |
| 9283 | m_adj(*mp, ETHER_HDR_LEN); |
| 9284 | |
| 9285 | /* Strip off snap header, if present */ |
| 9286 | if (snap) { |
| 9287 | m_copydata(*mp, 0, sizeof(struct llc), (caddr_t)&llc1); |
| 9288 | m_adj(*mp, sizeof(struct llc)); |
| 9289 | } |
| 9290 | |
| 9291 | /* |
| 9292 | * Check the IP header for alignment and errors |
| 9293 | */ |
| 9294 | switch (ether_type) { |
| 9295 | case ETHERTYPE_IP: |
| 9296 | error = bridge_ip_checkbasic(mp); |
| 9297 | break; |
| 9298 | case ETHERTYPE_IPV6: |
| 9299 | error = bridge_ip6_checkbasic(mp); |
| 9300 | break; |
| 9301 | default: |
| 9302 | error = 0; |
| 9303 | break; |
| 9304 | } |
| 9305 | if (error) { |
| 9306 | goto bad; |
| 9307 | } |
| 9308 | |
| 9309 | error = 0; |
| 9310 | |
| 9311 | /* |
| 9312 | * Run the packet through pf rules |
| 9313 | */ |
| 9314 | switch (ether_type) { |
| 9315 | case ETHERTYPE_IP: |
| 9316 | /* |
| 9317 | * before calling the firewall, swap fields the same as |
| 9318 | * IP does. here we assume the header is contiguous |
| 9319 | */ |
| 9320 | ip = mtod(*mp, struct ip *); |
| 9321 | |
| 9322 | ip->ip_len = ntohs(ip->ip_len); |
| 9323 | ip->ip_off = ntohs(ip->ip_off); |
| 9324 | |
| 9325 | if (ifp != NULL) { |
| 9326 | error = pf_af_hook(ifp, 0, mp, AF_INET, input, NULL); |
| 9327 | } |
| 9328 | |
| 9329 | if (*mp == NULL || error != 0) { /* filter may consume */ |
| 9330 | break; |
| 9331 | } |
| 9332 | |
| 9333 | /* Recalculate the ip checksum and restore byte ordering */ |
| 9334 | ip = mtod(*mp, struct ip *); |
| 9335 | hlen = IP_VHL_HL(ip->ip_vhl) << 2; |
| 9336 | if (hlen < (int)sizeof(struct ip)) { |
| 9337 | goto bad; |
| 9338 | } |
| 9339 | if (hlen > (*mp)->m_len) { |
| 9340 | if ((*mp = m_pullup(*mp, hlen)) == 0) { |
| 9341 | goto bad; |
| 9342 | } |
| 9343 | ip = mtod(*mp, struct ip *); |
| 9344 | if (ip == NULL) { |
| 9345 | goto bad; |
| 9346 | } |
| 9347 | } |
| 9348 | ip->ip_len = htons(ip->ip_len); |
| 9349 | ip->ip_off = htons(ip->ip_off); |
| 9350 | ip->ip_sum = 0; |
| 9351 | if (hlen == sizeof(struct ip)) { |
| 9352 | ip->ip_sum = in_cksum_hdr(ip); |
| 9353 | } else { |
| 9354 | ip->ip_sum = in_cksum(*mp, hlen); |
| 9355 | } |
| 9356 | break; |
| 9357 | |
| 9358 | case ETHERTYPE_IPV6: |
| 9359 | if (ifp != NULL) { |
| 9360 | error = pf_af_hook(ifp, 0, mp, AF_INET6, input, NULL); |
| 9361 | } |
| 9362 | |
| 9363 | if (*mp == NULL || error != 0) { /* filter may consume */ |
| 9364 | break; |
| 9365 | } |
| 9366 | break; |
| 9367 | default: |
| 9368 | error = 0; |
| 9369 | break; |
| 9370 | } |
| 9371 | |
| 9372 | if (*mp == NULL) { |
| 9373 | return error; |
| 9374 | } |
| 9375 | if (error != 0) { |
| 9376 | goto bad; |
| 9377 | } |
| 9378 | |
| 9379 | error = -1; |
| 9380 | |
| 9381 | /* |
| 9382 | * Finally, put everything back the way it was and return |
| 9383 | */ |
| 9384 | if (snap) { |
| 9385 | M_PREPEND(*mp, sizeof(struct llc), M_DONTWAIT, 0); |
| 9386 | if (*mp == NULL) { |
| 9387 | return error; |
| 9388 | } |
| 9389 | bcopy(src: &llc1, mtod(*mp, caddr_t), n: sizeof(struct llc)); |
| 9390 | } |
| 9391 | |
| 9392 | M_PREPEND(*mp, ETHER_HDR_LEN, M_DONTWAIT, 0); |
| 9393 | if (*mp == NULL) { |
| 9394 | return error; |
| 9395 | } |
| 9396 | bcopy(src: &eh2, mtod(*mp, caddr_t), ETHER_HDR_LEN); |
| 9397 | |
| 9398 | return 0; |
| 9399 | |
| 9400 | bad: |
| 9401 | m_freem(*mp); |
| 9402 | *mp = NULL; |
| 9403 | return error; |
| 9404 | } |
| 9405 | |
| 9406 | /* |
| 9407 | * Copyright (C) 2014, Stefano Garzarella - Universita` di Pisa. |
| 9408 | * All rights reserved. |
| 9409 | * |
| 9410 | * Redistribution and use in source and binary forms, with or without |
| 9411 | * modification, are permitted provided that the following conditions |
| 9412 | * are met: |
| 9413 | * 1. Redistributions of source code must retain the above copyright |
| 9414 | * notice, this list of conditions and the following disclaimer. |
| 9415 | * 2. Redistributions in binary form must reproduce the above copyright |
| 9416 | * notice, this list of conditions and the following disclaimer in the |
| 9417 | * documentation and/or other materials provided with the distribution. |
| 9418 | * |
| 9419 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND |
| 9420 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| 9421 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| 9422 | * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE |
| 9423 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| 9424 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
| 9425 | * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
| 9426 | * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
| 9427 | * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
| 9428 | * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| 9429 | * SUCH DAMAGE. |
| 9430 | */ |
| 9431 | |
| 9432 | /* |
| 9433 | * XXX-ste: Maybe this function must be moved into kern/uipc_mbuf.c |
| 9434 | * |
| 9435 | * Create a queue of packets/segments which fit the given mss + hdr_len. |
| 9436 | * m0 points to mbuf chain to be segmented. |
| 9437 | * This function splits the payload (m0-> m_pkthdr.len - hdr_len) |
| 9438 | * into segments of length MSS bytes and then copy the first hdr_len bytes |
| 9439 | * from m0 at the top of each segment. |
| 9440 | * If hdr2_buf is not NULL (hdr2_len is the buf length), it is copied |
| 9441 | * in each segment after the first hdr_len bytes |
| 9442 | * |
| 9443 | * Return the new queue with the segments on success, NULL on failure. |
| 9444 | * (the mbuf queue is freed in this case). |
| 9445 | * nsegs contains the number of segments generated. |
| 9446 | */ |
| 9447 | |
| 9448 | static struct mbuf * |
| 9449 | m_seg(struct mbuf *m0, int hdr_len, int mss, int *nsegs, |
| 9450 | char * hdr2_buf, int hdr2_len) |
| 9451 | { |
| 9452 | int off = 0, n, firstlen; |
| 9453 | struct mbuf **mnext, *mseg; |
| 9454 | int total_len = m0->m_pkthdr.len; |
| 9455 | |
| 9456 | /* |
| 9457 | * Segmentation useless |
| 9458 | */ |
| 9459 | if (total_len <= hdr_len + mss) { |
| 9460 | return m0; |
| 9461 | } |
| 9462 | |
| 9463 | if (hdr2_buf == NULL || hdr2_len <= 0) { |
| 9464 | hdr2_buf = NULL; |
| 9465 | hdr2_len = 0; |
| 9466 | } |
| 9467 | |
| 9468 | off = hdr_len + mss; |
| 9469 | firstlen = mss; /* first segment stored in the original mbuf */ |
| 9470 | |
| 9471 | mnext = &(m0->m_nextpkt); /* pointer to next packet */ |
| 9472 | |
| 9473 | for (n = 1; off < total_len; off += mss, n++) { |
| 9474 | struct mbuf *m; |
| 9475 | /* |
| 9476 | * Copy the header from the original packet |
| 9477 | * and create a new mbuf chain |
| 9478 | */ |
| 9479 | if (MHLEN < hdr_len) { |
| 9480 | m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); |
| 9481 | } else { |
| 9482 | m = m_gethdr(M_NOWAIT, MT_DATA); |
| 9483 | } |
| 9484 | |
| 9485 | if (m == NULL) { |
| 9486 | #ifdef GSO_DEBUG |
| 9487 | D("MGETHDR error\n" ); |
| 9488 | #endif |
| 9489 | goto err; |
| 9490 | } |
| 9491 | |
| 9492 | m_copydata(m0, 0, hdr_len, mtod(m, caddr_t)); |
| 9493 | |
| 9494 | m->m_len = hdr_len; |
| 9495 | /* |
| 9496 | * if the optional header is present, copy it |
| 9497 | */ |
| 9498 | if (hdr2_buf != NULL) { |
| 9499 | m_copyback(m, hdr_len, hdr2_len, hdr2_buf); |
| 9500 | } |
| 9501 | |
| 9502 | m->m_flags |= (m0->m_flags & M_COPYFLAGS); |
| 9503 | if (off + mss >= total_len) { /* last segment */ |
| 9504 | mss = total_len - off; |
| 9505 | } |
| 9506 | /* |
| 9507 | * Copy the payload from original packet |
| 9508 | */ |
| 9509 | mseg = m_copym(m0, off, mss, M_NOWAIT); |
| 9510 | if (mseg == NULL) { |
| 9511 | m_freem(m); |
| 9512 | #ifdef GSO_DEBUG |
| 9513 | D("m_copym error\n" ); |
| 9514 | #endif |
| 9515 | goto err; |
| 9516 | } |
| 9517 | m_cat(m, mseg); |
| 9518 | |
| 9519 | m->m_pkthdr.len = hdr_len + hdr2_len + mss; |
| 9520 | m->m_pkthdr.rcvif = m0->m_pkthdr.rcvif; |
| 9521 | /* |
| 9522 | * Copy the checksum flags and data (in_cksum() need this) |
| 9523 | */ |
| 9524 | m->m_pkthdr.csum_flags = m0->m_pkthdr.csum_flags; |
| 9525 | m->m_pkthdr.csum_data = m0->m_pkthdr.csum_data; |
| 9526 | m->m_pkthdr.tso_segsz = m0->m_pkthdr.tso_segsz; |
| 9527 | |
| 9528 | *mnext = m; |
| 9529 | mnext = &(m->m_nextpkt); |
| 9530 | } |
| 9531 | |
| 9532 | /* |
| 9533 | * Update first segment. |
| 9534 | * If the optional header is present, is necessary |
| 9535 | * to insert it into the first segment. |
| 9536 | */ |
| 9537 | if (hdr2_buf == NULL) { |
| 9538 | m_adj(m0, hdr_len + firstlen - total_len); |
| 9539 | m0->m_pkthdr.len = hdr_len + firstlen; |
| 9540 | } else { |
| 9541 | mseg = m_copym(m0, hdr_len, firstlen, M_NOWAIT); |
| 9542 | if (mseg == NULL) { |
| 9543 | #ifdef GSO_DEBUG |
| 9544 | D("m_copym error\n" ); |
| 9545 | #endif |
| 9546 | goto err; |
| 9547 | } |
| 9548 | m_adj(m0, hdr_len - total_len); |
| 9549 | m_copyback(m0, hdr_len, hdr2_len, hdr2_buf); |
| 9550 | m_cat(m0, mseg); |
| 9551 | m0->m_pkthdr.len = hdr_len + hdr2_len + firstlen; |
| 9552 | } |
| 9553 | |
| 9554 | if (nsegs != NULL) { |
| 9555 | *nsegs = n; |
| 9556 | } |
| 9557 | return m0; |
| 9558 | err: |
| 9559 | while (m0 != NULL) { |
| 9560 | mseg = m0->m_nextpkt; |
| 9561 | m0->m_nextpkt = NULL; |
| 9562 | m_freem(m0); |
| 9563 | m0 = mseg; |
| 9564 | } |
| 9565 | return NULL; |
| 9566 | } |
| 9567 | |
| 9568 | /* |
| 9569 | * Wrappers of IPv4 checksum functions |
| 9570 | */ |
| 9571 | static inline void |
| 9572 | gso_ipv4_data_cksum(struct mbuf *m, struct ip *ip, int mac_hlen) |
| 9573 | { |
| 9574 | m->m_data += mac_hlen; |
| 9575 | m->m_len -= mac_hlen; |
| 9576 | m->m_pkthdr.len -= mac_hlen; |
| 9577 | #if __FreeBSD_version < 1000000 |
| 9578 | ip->ip_len = ntohs(ip->ip_len); /* needed for in_delayed_cksum() */ |
| 9579 | #endif |
| 9580 | |
| 9581 | in_delayed_cksum(m); |
| 9582 | |
| 9583 | #if __FreeBSD_version < 1000000 |
| 9584 | ip->ip_len = htons(ip->ip_len); |
| 9585 | #endif |
| 9586 | m->m_pkthdr.csum_flags &= ~CSUM_DELAY_DATA; |
| 9587 | m->m_len += mac_hlen; |
| 9588 | m->m_pkthdr.len += mac_hlen; |
| 9589 | m->m_data -= mac_hlen; |
| 9590 | } |
| 9591 | |
| 9592 | static inline void |
| 9593 | gso_ipv4_hdr_cksum(struct mbuf *m, struct ip *ip, int mac_hlen, int ip_hlen) |
| 9594 | { |
| 9595 | m->m_data += mac_hlen; |
| 9596 | |
| 9597 | ip->ip_sum = in_cksum(m, ip_hlen); |
| 9598 | |
| 9599 | m->m_pkthdr.csum_flags &= ~CSUM_IP; |
| 9600 | m->m_data -= mac_hlen; |
| 9601 | } |
| 9602 | |
| 9603 | /* |
| 9604 | * Structure that contains the state during the TCP segmentation |
| 9605 | */ |
| 9606 | struct gso_ip_tcp_state { |
| 9607 | void (*update) |
| 9608 | (struct gso_ip_tcp_state*, struct mbuf*); |
| 9609 | void (*internal) |
| 9610 | (struct gso_ip_tcp_state*, struct mbuf*); |
| 9611 | union iphdr hdr; |
| 9612 | struct tcphdr *tcp; |
| 9613 | int mac_hlen; |
| 9614 | int ip_hlen; |
| 9615 | int tcp_hlen; |
| 9616 | int hlen; |
| 9617 | int pay_len; |
| 9618 | int sw_csum; |
| 9619 | uint32_t tcp_seq; |
| 9620 | uint16_t ip_id; |
| 9621 | boolean_t is_tx; |
| 9622 | }; |
| 9623 | |
| 9624 | /* |
| 9625 | * Update the pointers to TCP and IPv4 headers |
| 9626 | */ |
| 9627 | static inline void |
| 9628 | gso_ipv4_tcp_update(struct gso_ip_tcp_state *state, struct mbuf *m) |
| 9629 | { |
| 9630 | state->hdr.ip = (struct ip *)(void *)(mtod(m, uint8_t *) + state->mac_hlen); |
| 9631 | state->tcp = (struct tcphdr *)(void *)((caddr_t)(state->hdr.ip) + state->ip_hlen); |
| 9632 | state->pay_len = m->m_pkthdr.len - state->hlen; |
| 9633 | } |
| 9634 | |
| 9635 | /* |
| 9636 | * Set properly the TCP and IPv4 headers |
| 9637 | */ |
| 9638 | static inline void |
| 9639 | gso_ipv4_tcp_internal(struct gso_ip_tcp_state *state, struct mbuf *m) |
| 9640 | { |
| 9641 | /* |
| 9642 | * Update IP header |
| 9643 | */ |
| 9644 | state->hdr.ip->ip_id = htons((state->ip_id)++); |
| 9645 | state->hdr.ip->ip_len = htons(m->m_pkthdr.len - state->mac_hlen); |
| 9646 | /* |
| 9647 | * TCP Checksum |
| 9648 | */ |
| 9649 | state->tcp->th_sum = 0; |
| 9650 | state->tcp->th_sum = in_pseudo(state->hdr.ip->ip_src.s_addr, |
| 9651 | state->hdr.ip->ip_dst.s_addr, |
| 9652 | htons(state->tcp_hlen + IPPROTO_TCP + state->pay_len)); |
| 9653 | /* |
| 9654 | * Checksum HW not supported (TCP) |
| 9655 | */ |
| 9656 | if (state->sw_csum & CSUM_DELAY_DATA) { |
| 9657 | gso_ipv4_data_cksum(m, ip: state->hdr.ip, mac_hlen: state->mac_hlen); |
| 9658 | } |
| 9659 | |
| 9660 | state->tcp_seq += state->pay_len; |
| 9661 | /* |
| 9662 | * IP Checksum |
| 9663 | */ |
| 9664 | state->hdr.ip->ip_sum = 0; |
| 9665 | /* |
| 9666 | * Checksum HW not supported (IP) |
| 9667 | */ |
| 9668 | if (state->sw_csum & CSUM_IP) { |
| 9669 | gso_ipv4_hdr_cksum(m, ip: state->hdr.ip, mac_hlen: state->mac_hlen, ip_hlen: state->ip_hlen); |
| 9670 | } |
| 9671 | } |
| 9672 | |
| 9673 | |
| 9674 | /* |
| 9675 | * Updates the pointers to TCP and IPv6 headers |
| 9676 | */ |
| 9677 | static inline void |
| 9678 | gso_ipv6_tcp_update(struct gso_ip_tcp_state *state, struct mbuf *m) |
| 9679 | { |
| 9680 | state->hdr.ip6 = (struct ip6_hdr *)(mtod(m, uint8_t *) + state->mac_hlen); |
| 9681 | state->tcp = (struct tcphdr *)(void *)((caddr_t)(state->hdr.ip6) + state->ip_hlen); |
| 9682 | state->pay_len = m->m_pkthdr.len - state->hlen; |
| 9683 | } |
| 9684 | |
| 9685 | /* |
| 9686 | * Sets properly the TCP and IPv6 headers |
| 9687 | */ |
| 9688 | static inline void |
| 9689 | gso_ipv6_tcp_internal(struct gso_ip_tcp_state *state, struct mbuf *m) |
| 9690 | { |
| 9691 | state->hdr.ip6->ip6_plen = htons(m->m_pkthdr.len - |
| 9692 | state->mac_hlen - state->ip_hlen); |
| 9693 | /* |
| 9694 | * TCP Checksum |
| 9695 | */ |
| 9696 | state->tcp->th_sum = 0; |
| 9697 | state->tcp->th_sum = in6_pseudo(&state->hdr.ip6->ip6_src, |
| 9698 | &state->hdr.ip6->ip6_dst, |
| 9699 | htonl(state->tcp_hlen + state->pay_len + IPPROTO_TCP)); |
| 9700 | /* |
| 9701 | * Checksum HW not supported (TCP) |
| 9702 | */ |
| 9703 | if (state->sw_csum & CSUM_DELAY_IPV6_DATA) { |
| 9704 | (void)in6_finalize_cksum(m, state->mac_hlen, -1, -1, state->sw_csum); |
| 9705 | m->m_pkthdr.csum_flags &= ~CSUM_DELAY_IPV6_DATA; |
| 9706 | } |
| 9707 | state->tcp_seq += state->pay_len; |
| 9708 | } |
| 9709 | |
| 9710 | /* |
| 9711 | * Init the state during the TCP segmentation |
| 9712 | */ |
| 9713 | static void |
| 9714 | gso_ip_tcp_init_state(struct gso_ip_tcp_state *state, struct ifnet *ifp, |
| 9715 | bool is_ipv4, int mac_hlen, int ip_hlen, |
| 9716 | void * ip_hdr, struct tcphdr * tcp_hdr) |
| 9717 | { |
| 9718 | #pragma unused(ifp) |
| 9719 | |
| 9720 | state->hdr.ptr = ip_hdr; |
| 9721 | state->tcp = tcp_hdr; |
| 9722 | if (is_ipv4) { |
| 9723 | state->ip_id = ntohs(state->hdr.ip->ip_id); |
| 9724 | state->update = gso_ipv4_tcp_update; |
| 9725 | state->internal = gso_ipv4_tcp_internal; |
| 9726 | state->sw_csum = CSUM_DELAY_DATA | CSUM_IP; /* XXX */ |
| 9727 | } else { |
| 9728 | state->update = gso_ipv6_tcp_update; |
| 9729 | state->internal = gso_ipv6_tcp_internal; |
| 9730 | state->sw_csum = CSUM_DELAY_IPV6_DATA; /* XXX */ |
| 9731 | } |
| 9732 | state->mac_hlen = mac_hlen; |
| 9733 | state->ip_hlen = ip_hlen; |
| 9734 | state->tcp_hlen = state->tcp->th_off << 2; |
| 9735 | state->hlen = mac_hlen + ip_hlen + state->tcp_hlen; |
| 9736 | state->tcp_seq = ntohl(state->tcp->th_seq); |
| 9737 | //state->sw_csum = m->m_pkthdr.csum_flags & ~IF_HWASSIST_CSUM_FLAGS(ifp->if_hwassist); |
| 9738 | return; |
| 9739 | } |
| 9740 | |
| 9741 | /* |
| 9742 | * GSO on TCP/IP (v4 or v6) |
| 9743 | * |
| 9744 | * If is_tx is TRUE, segmented packets are transmitted after they are |
| 9745 | * segmented. |
| 9746 | * |
| 9747 | * If is_tx is FALSE, the segmented packets are returned as a chain in *mp. |
| 9748 | */ |
| 9749 | static int |
| 9750 | gso_ip_tcp(struct ifnet *ifp, struct mbuf **mp, struct gso_ip_tcp_state *state, |
| 9751 | boolean_t is_tx) |
| 9752 | { |
| 9753 | struct mbuf *m, *m_tx; |
| 9754 | int error = 0; |
| 9755 | int mss = 0; |
| 9756 | int nsegs = 0; |
| 9757 | struct mbuf *m0 = *mp; |
| 9758 | #ifdef GSO_STATS |
| 9759 | int total_len = m0->m_pkthdr.len; |
| 9760 | #endif /* GSO_STATS */ |
| 9761 | |
| 9762 | #if 1 |
| 9763 | u_int reduce_mss; |
| 9764 | |
| 9765 | reduce_mss = is_tx ? if_bridge_tso_reduce_mss_tx |
| 9766 | : if_bridge_tso_reduce_mss_forwarding; |
| 9767 | mss = ifp->if_mtu - state->ip_hlen - state->tcp_hlen - reduce_mss; |
| 9768 | assert(mss > 0); |
| 9769 | #else |
| 9770 | if (m0->m_pkthdr.csum_flags & ifp->if_hwassist & CSUM_TSO) {/* TSO with GSO */ |
| 9771 | mss = ifp->if_hw_tsomax - state->ip_hlen - state->tcp_hlen; |
| 9772 | } else { |
| 9773 | mss = m0->m_pkthdr.tso_segsz; |
| 9774 | } |
| 9775 | #endif |
| 9776 | |
| 9777 | *mp = m0 = m_seg(m0, hdr_len: state->hlen, mss, nsegs: &nsegs, hdr2_buf: 0, hdr2_len: 0); |
| 9778 | if (m0 == NULL) { |
| 9779 | return ENOBUFS; /* XXX ok? */ |
| 9780 | } |
| 9781 | BRIDGE_LOG(LOG_DEBUG, BR_DBGF_CHECKSUM, |
| 9782 | "%s %s mss %d nsegs %d" , |
| 9783 | ifp->if_xname, |
| 9784 | is_tx ? "TX" : "RX" , |
| 9785 | mss, nsegs); |
| 9786 | /* |
| 9787 | * XXX-ste: can this happen? |
| 9788 | */ |
| 9789 | if (m0->m_nextpkt == NULL) { |
| 9790 | #ifdef GSO_DEBUG |
| 9791 | D("only 1 segment" ); |
| 9792 | #endif |
| 9793 | if (is_tx) { |
| 9794 | error = bridge_transmit(ifp, m: m0); |
| 9795 | } |
| 9796 | return error; |
| 9797 | } |
| 9798 | #ifdef GSO_STATS |
| 9799 | GSOSTAT_SET_MAX(tcp.gsos_max_mss, mss); |
| 9800 | GSOSTAT_SET_MIN(tcp.gsos_min_mss, mss); |
| 9801 | GSOSTAT_ADD(tcp.gsos_osegments, nsegs); |
| 9802 | #endif /* GSO_STATS */ |
| 9803 | |
| 9804 | /* first pkt */ |
| 9805 | m = m0; |
| 9806 | |
| 9807 | state->update(state, m); |
| 9808 | |
| 9809 | do { |
| 9810 | state->tcp->th_flags &= ~(TH_FIN | TH_PUSH); |
| 9811 | |
| 9812 | state->internal(state, m); |
| 9813 | m_tx = m; |
| 9814 | m = m->m_nextpkt; |
| 9815 | if (is_tx) { |
| 9816 | m_tx->m_nextpkt = NULL; |
| 9817 | if ((error = bridge_transmit(ifp, m: m_tx)) != 0) { |
| 9818 | /* |
| 9819 | * XXX: If a segment can not be sent, discard the following |
| 9820 | * segments and propagate the error to the upper levels. |
| 9821 | * In this way the TCP retransmits all the initial packet. |
| 9822 | */ |
| 9823 | #ifdef GSO_DEBUG |
| 9824 | D("if_transmit error\n" ); |
| 9825 | #endif |
| 9826 | goto err; |
| 9827 | } |
| 9828 | } |
| 9829 | state->update(state, m); |
| 9830 | |
| 9831 | state->tcp->th_flags &= ~TH_CWR; |
| 9832 | state->tcp->th_seq = htonl(state->tcp_seq); |
| 9833 | } while (m->m_nextpkt); |
| 9834 | |
| 9835 | /* last pkt */ |
| 9836 | state->internal(state, m); |
| 9837 | |
| 9838 | if (is_tx) { |
| 9839 | error = bridge_transmit(ifp, m); |
| 9840 | #ifdef GSO_DEBUG |
| 9841 | if (error) { |
| 9842 | D("last if_transmit error\n" ); |
| 9843 | D("error - type = %d \n" , error); |
| 9844 | } |
| 9845 | #endif |
| 9846 | } |
| 9847 | #ifdef GSO_STATS |
| 9848 | if (!error) { |
| 9849 | GSOSTAT_INC(tcp.gsos_segmented); |
| 9850 | GSOSTAT_SET_MAX(tcp.gsos_maxsegmented, total_len); |
| 9851 | GSOSTAT_SET_MIN(tcp.gsos_minsegmented, total_len); |
| 9852 | GSOSTAT_ADD(tcp.gsos_totalbyteseg, total_len); |
| 9853 | } |
| 9854 | #endif /* GSO_STATS */ |
| 9855 | return error; |
| 9856 | |
| 9857 | err: |
| 9858 | #ifdef GSO_DEBUG |
| 9859 | D("error - type = %d \n" , error); |
| 9860 | #endif |
| 9861 | while (m != NULL) { |
| 9862 | m_tx = m->m_nextpkt; |
| 9863 | m->m_nextpkt = NULL; |
| 9864 | m_freem(m); |
| 9865 | m = m_tx; |
| 9866 | } |
| 9867 | return error; |
| 9868 | } |
| 9869 | |
| 9870 | /* |
| 9871 | * GSO for TCP/IPv[46] |
| 9872 | */ |
| 9873 | static int |
| 9874 | gso_tcp(struct ifnet *ifp, struct mbuf **mp, u_int mac_hlen, bool is_ipv4, |
| 9875 | boolean_t is_tx) |
| 9876 | { |
| 9877 | int error; |
| 9878 | ip_packet_info info; |
| 9879 | uint32_t csum_flags; |
| 9880 | struct gso_ip_tcp_state state; |
| 9881 | struct bripstats stats; /* XXX ignored */ |
| 9882 | struct tcphdr *tcp; |
| 9883 | |
| 9884 | if (!is_tx && ipforwarding == 0) { |
| 9885 | /* no need to segment if the packet will not be forwarded */ |
| 9886 | return 0; |
| 9887 | } |
| 9888 | error = bridge_get_tcp_header(mp, mac_hlen, is_ipv4, info_p: &info, stats_p: &stats); |
| 9889 | if (error != 0) { |
| 9890 | if (*mp != NULL) { |
| 9891 | m_freem(*mp); |
| 9892 | *mp = NULL; |
| 9893 | } |
| 9894 | return error; |
| 9895 | } |
| 9896 | if (info.ip_proto_hdr == NULL) { |
| 9897 | /* not a TCP packet */ |
| 9898 | return 0; |
| 9899 | } |
| 9900 | tcp = (struct tcphdr *)(void *)info.ip_proto_hdr; |
| 9901 | gso_ip_tcp_init_state(state: &state, ifp, is_ipv4, mac_hlen, |
| 9902 | ip_hlen: info.ip_hlen + info.ip_opt_len, ip_hdr: info.ip_hdr.ptr, tcp_hdr: tcp); |
| 9903 | if (is_ipv4) { |
| 9904 | csum_flags = CSUM_DELAY_DATA; /* XXX */ |
| 9905 | if (!is_tx) { |
| 9906 | /* if RX to our local IP address, don't segment */ |
| 9907 | struct in_addr dst_ip; |
| 9908 | |
| 9909 | bcopy(src: &state.hdr.ip->ip_dst, dst: &dst_ip, n: sizeof(dst_ip)); |
| 9910 | if (in_addr_is_ours(ip: dst_ip)) { |
| 9911 | return 0; |
| 9912 | } |
| 9913 | } |
| 9914 | } else { |
| 9915 | csum_flags = CSUM_DELAY_IPV6_DATA; /* XXX */ |
| 9916 | if (!is_tx) { |
| 9917 | /* if RX to our local IP address, don't segment */ |
| 9918 | if (in6_addr_is_ours(ip6_p: &state.hdr.ip6->ip6_dst, |
| 9919 | ifscope: ifp->if_index)) { |
| 9920 | /* local IP address, no need to segment */ |
| 9921 | return 0; |
| 9922 | } |
| 9923 | } |
| 9924 | } |
| 9925 | (*mp)->m_pkthdr.csum_flags = csum_flags; |
| 9926 | (*mp)->m_pkthdr.csum_data = offsetof(struct tcphdr, th_sum); |
| 9927 | return gso_ip_tcp(ifp, mp, state: &state, is_tx); |
| 9928 | } |
| 9929 | |