1 /*- 2 * Copyright 1998 Massachusetts Institute of Technology 3 * Copyright 2012 ADARA Networks, Inc. 4 * Copyright 2017 Dell EMC Isilon 5 * 6 * Portions of this software were developed by Robert N. M. Watson under 7 * contract to ADARA Networks, Inc. 8 * 9 * Permission to use, copy, modify, and distribute this software and 10 * its documentation for any purpose and without fee is hereby 11 * granted, provided that both the above copyright notice and this 12 * permission notice appear in all copies, that both the above 13 * copyright notice and this permission notice appear in all 14 * supporting documentation, and that the name of M.I.T. not be used 15 * in advertising or publicity pertaining to distribution of the 16 * software without specific, written prior permission. M.I.T. makes 17 * no representations about the suitability of this software for any 18 * purpose. It is provided "as is" without express or implied 19 * warranty. 20 * 21 * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS 22 * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE, 23 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 24 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT 25 * SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 26 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 27 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 28 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 29 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 30 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 31 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32 * SUCH DAMAGE. 33 */ 34 35 /* 36 * if_vlan.c - pseudo-device driver for IEEE 802.1Q virtual LANs. 37 * This is sort of sneaky in the implementation, since 38 * we need to pretend to be enough of an Ethernet implementation 39 * to make arp work. The way we do this is by telling everyone 40 * that we are an Ethernet, and then catch the packets that 41 * ether_output() sends to us via if_transmit(), rewrite them for 42 * use by the real outgoing interface, and ask it to send them. 43 */ 44 45 #include <sys/cdefs.h> 46 __FBSDID("$FreeBSD$"); 47 48 #include "opt_inet.h" 49 #include "opt_vlan.h" 50 #include "opt_ratelimit.h" 51 52 #include <sys/param.h> 53 #include <sys/eventhandler.h> 54 #include <sys/kernel.h> 55 #include <sys/lock.h> 56 #include <sys/malloc.h> 57 #include <sys/mbuf.h> 58 #include <sys/module.h> 59 #include <sys/rmlock.h> 60 #include <sys/priv.h> 61 #include <sys/queue.h> 62 #include <sys/socket.h> 63 #include <sys/sockio.h> 64 #include <sys/sysctl.h> 65 #include <sys/systm.h> 66 #include <sys/sx.h> 67 #include <sys/taskqueue.h> 68 69 #include <net/bpf.h> 70 #include <net/ethernet.h> 71 #include <net/if.h> 72 #include <net/if_var.h> 73 #include <net/if_clone.h> 74 #include <net/if_dl.h> 75 #include <net/if_types.h> 76 #include <net/if_vlan_var.h> 77 #include <net/vnet.h> 78 79 #ifdef INET 80 #include <netinet/in.h> 81 #include <netinet/if_ether.h> 82 #endif 83 84 #define VLAN_DEF_HWIDTH 4 85 #define VLAN_IFFLAGS (IFF_BROADCAST | IFF_MULTICAST) 86 87 #define UP_AND_RUNNING(ifp) \ 88 ((ifp)->if_flags & IFF_UP && (ifp)->if_drv_flags & IFF_DRV_RUNNING) 89 90 CK_SLIST_HEAD(ifvlanhead, ifvlan); 91 92 struct ifvlantrunk { 93 struct ifnet *parent; /* parent interface of this trunk */ 94 struct mtx lock; 95 #ifdef VLAN_ARRAY 96 #define VLAN_ARRAY_SIZE (EVL_VLID_MASK + 1) 97 struct ifvlan *vlans[VLAN_ARRAY_SIZE]; /* static table */ 98 #else 99 struct ifvlanhead *hash; /* dynamic hash-list table */ 100 uint16_t hmask; 101 uint16_t hwidth; 102 #endif 103 int refcnt; 104 }; 105 106 /* 107 * This macro provides a facility to iterate over every vlan on a trunk with 108 * the assumption that none will be added/removed during iteration. 109 */ 110 #ifdef VLAN_ARRAY 111 #define VLAN_FOREACH(_ifv, _trunk) \ 112 size_t _i; \ 113 for (_i = 0; _i < VLAN_ARRAY_SIZE; _i++) \ 114 if (((_ifv) = (_trunk)->vlans[_i]) != NULL) 115 #else /* VLAN_ARRAY */ 116 #define VLAN_FOREACH(_ifv, _trunk) \ 117 struct ifvlan *_next; \ 118 size_t _i; \ 119 for (_i = 0; _i < (1 << (_trunk)->hwidth); _i++) \ 120 CK_SLIST_FOREACH_SAFE((_ifv), &(_trunk)->hash[_i], ifv_list, _next) 121 #endif /* VLAN_ARRAY */ 122 123 /* 124 * This macro provides a facility to iterate over every vlan on a trunk while 125 * also modifying the number of vlans on the trunk. The iteration continues 126 * until some condition is met or there are no more vlans on the trunk. 127 */ 128 #ifdef VLAN_ARRAY 129 /* The VLAN_ARRAY case is simple -- just a for loop using the condition. */ 130 #define VLAN_FOREACH_UNTIL_SAFE(_ifv, _trunk, _cond) \ 131 size_t _i; \ 132 for (_i = 0; !(_cond) && _i < VLAN_ARRAY_SIZE; _i++) \ 133 if (((_ifv) = (_trunk)->vlans[_i])) 134 #else /* VLAN_ARRAY */ 135 /* 136 * The hash table case is more complicated. We allow for the hash table to be 137 * modified (i.e. vlans removed) while we are iterating over it. To allow for 138 * this we must restart the iteration every time we "touch" something during 139 * the iteration, since removal will resize the hash table and invalidate our 140 * current position. If acting on the touched element causes the trunk to be 141 * emptied, then iteration also stops. 142 */ 143 #define VLAN_FOREACH_UNTIL_SAFE(_ifv, _trunk, _cond) \ 144 size_t _i; \ 145 bool _touch = false; \ 146 for (_i = 0; \ 147 !(_cond) && _i < (1 << (_trunk)->hwidth); \ 148 _i = (_touch && ((_trunk) != NULL) ? 0 : _i + 1), _touch = false) \ 149 if (((_ifv) = CK_SLIST_FIRST(&(_trunk)->hash[_i])) != NULL && \ 150 (_touch = true)) 151 #endif /* VLAN_ARRAY */ 152 153 struct vlan_mc_entry { 154 struct sockaddr_dl mc_addr; 155 CK_SLIST_ENTRY(vlan_mc_entry) mc_entries; 156 struct epoch_context mc_epoch_ctx; 157 }; 158 159 struct ifvlan { 160 struct ifvlantrunk *ifv_trunk; 161 struct ifnet *ifv_ifp; 162 #define TRUNK(ifv) ((ifv)->ifv_trunk) 163 #define PARENT(ifv) ((ifv)->ifv_trunk->parent) 164 void *ifv_cookie; 165 int ifv_pflags; /* special flags we have set on parent */ 166 int ifv_capenable; 167 struct ifv_linkmib { 168 int ifvm_encaplen; /* encapsulation length */ 169 int ifvm_mtufudge; /* MTU fudged by this much */ 170 int ifvm_mintu; /* min transmission unit */ 171 uint16_t ifvm_proto; /* encapsulation ethertype */ 172 uint16_t ifvm_tag; /* tag to apply on packets leaving if */ 173 uint16_t ifvm_vid; /* VLAN ID */ 174 uint8_t ifvm_pcp; /* Priority Code Point (PCP). */ 175 } ifv_mib; 176 struct task lladdr_task; 177 CK_SLIST_HEAD(, vlan_mc_entry) vlan_mc_listhead; 178 #ifndef VLAN_ARRAY 179 CK_SLIST_ENTRY(ifvlan) ifv_list; 180 #endif 181 }; 182 #define ifv_proto ifv_mib.ifvm_proto 183 #define ifv_tag ifv_mib.ifvm_tag 184 #define ifv_vid ifv_mib.ifvm_vid 185 #define ifv_pcp ifv_mib.ifvm_pcp 186 #define ifv_encaplen ifv_mib.ifvm_encaplen 187 #define ifv_mtufudge ifv_mib.ifvm_mtufudge 188 #define ifv_mintu ifv_mib.ifvm_mintu 189 190 /* Special flags we should propagate to parent. */ 191 static struct { 192 int flag; 193 int (*func)(struct ifnet *, int); 194 } vlan_pflags[] = { 195 {IFF_PROMISC, ifpromisc}, 196 {IFF_ALLMULTI, if_allmulti}, 197 {0, NULL} 198 }; 199 200 extern int vlan_mtag_pcp; 201 202 static const char vlanname[] = "vlan"; 203 static MALLOC_DEFINE(M_VLAN, vlanname, "802.1Q Virtual LAN Interface"); 204 205 static eventhandler_tag ifdetach_tag; 206 static eventhandler_tag iflladdr_tag; 207 208 /* 209 * if_vlan uses two module-level synchronizations primitives to allow concurrent 210 * modification of vlan interfaces and (mostly) allow for vlans to be destroyed 211 * while they are being used for tx/rx. To accomplish this in a way that has 212 * acceptable performance and cooperation with other parts of the network stack 213 * there is a non-sleepable epoch(9) and an sx(9). 214 * 215 * The performance-sensitive paths that warrant using the epoch(9) are 216 * vlan_transmit and vlan_input. Both have to check for the vlan interface's 217 * existence using if_vlantrunk, and being in the network tx/rx paths the use 218 * of an epoch(9) gives a measureable improvement in performance. 219 * 220 * The reason for having an sx(9) is mostly because there are still areas that 221 * must be sleepable and also have safe concurrent access to a vlan interface. 222 * Since the sx(9) exists, it is used by default in most paths unless sleeping 223 * is not permitted, or if it is not clear whether sleeping is permitted. 224 * 225 */ 226 #define _VLAN_SX_ID ifv_sx 227 228 static struct sx _VLAN_SX_ID; 229 230 #define VLAN_LOCKING_INIT() \ 231 sx_init(&_VLAN_SX_ID, "vlan_sx") 232 233 #define VLAN_LOCKING_DESTROY() \ 234 sx_destroy(&_VLAN_SX_ID) 235 236 #define VLAN_RLOCK() NET_EPOCH_ENTER(); 237 #define VLAN_RUNLOCK() NET_EPOCH_EXIT(); 238 #define VLAN_RLOCK_ASSERT() MPASS(in_epoch(net_epoch_preempt)) 239 240 #define VLAN_SLOCK() sx_slock(&_VLAN_SX_ID) 241 #define VLAN_SUNLOCK() sx_sunlock(&_VLAN_SX_ID) 242 #define VLAN_XLOCK() sx_xlock(&_VLAN_SX_ID) 243 #define VLAN_XUNLOCK() sx_xunlock(&_VLAN_SX_ID) 244 #define VLAN_SLOCK_ASSERT() sx_assert(&_VLAN_SX_ID, SA_SLOCKED) 245 #define VLAN_XLOCK_ASSERT() sx_assert(&_VLAN_SX_ID, SA_XLOCKED) 246 #define VLAN_SXLOCK_ASSERT() sx_assert(&_VLAN_SX_ID, SA_LOCKED) 247 248 249 /* 250 * We also have a per-trunk mutex that should be acquired when changing 251 * its state. 252 */ 253 #define TRUNK_LOCK_INIT(trunk) mtx_init(&(trunk)->lock, vlanname, NULL, MTX_DEF) 254 #define TRUNK_LOCK_DESTROY(trunk) mtx_destroy(&(trunk)->lock) 255 #define TRUNK_RLOCK(trunk) NET_EPOCH_ENTER() 256 #define TRUNK_WLOCK(trunk) mtx_lock(&(trunk)->lock) 257 #define TRUNK_RUNLOCK(trunk) NET_EPOCH_EXIT(); 258 #define TRUNK_WUNLOCK(trunk) mtx_unlock(&(trunk)->lock) 259 #define TRUNK_RLOCK_ASSERT(trunk) MPASS(in_epoch(net_epoch_preempt)) 260 #define TRUNK_LOCK_ASSERT(trunk) MPASS(in_epoch(net_epoch_preempt) || mtx_owned(&(trunk)->lock)) 261 #define TRUNK_WLOCK_ASSERT(trunk) mtx_assert(&(trunk)->lock, MA_OWNED); 262 263 /* 264 * The VLAN_ARRAY substitutes the dynamic hash with a static array 265 * with 4096 entries. In theory this can give a boost in processing, 266 * however in practice it does not. Probably this is because the array 267 * is too big to fit into CPU cache. 268 */ 269 #ifndef VLAN_ARRAY 270 static void vlan_inithash(struct ifvlantrunk *trunk); 271 static void vlan_freehash(struct ifvlantrunk *trunk); 272 static int vlan_inshash(struct ifvlantrunk *trunk, struct ifvlan *ifv); 273 static int vlan_remhash(struct ifvlantrunk *trunk, struct ifvlan *ifv); 274 static void vlan_growhash(struct ifvlantrunk *trunk, int howmuch); 275 static __inline struct ifvlan * vlan_gethash(struct ifvlantrunk *trunk, 276 uint16_t vid); 277 #endif 278 static void trunk_destroy(struct ifvlantrunk *trunk); 279 280 static void vlan_init(void *foo); 281 static void vlan_input(struct ifnet *ifp, struct mbuf *m); 282 static int vlan_ioctl(struct ifnet *ifp, u_long cmd, caddr_t addr); 283 #ifdef RATELIMIT 284 static int vlan_snd_tag_alloc(struct ifnet *, 285 union if_snd_tag_alloc_params *, struct m_snd_tag **); 286 #endif 287 static void vlan_qflush(struct ifnet *ifp); 288 static int vlan_setflag(struct ifnet *ifp, int flag, int status, 289 int (*func)(struct ifnet *, int)); 290 static int vlan_setflags(struct ifnet *ifp, int status); 291 static int vlan_setmulti(struct ifnet *ifp); 292 static int vlan_transmit(struct ifnet *ifp, struct mbuf *m); 293 static void vlan_unconfig(struct ifnet *ifp); 294 static void vlan_unconfig_locked(struct ifnet *ifp, int departing); 295 static int vlan_config(struct ifvlan *ifv, struct ifnet *p, uint16_t tag); 296 static void vlan_link_state(struct ifnet *ifp); 297 static void vlan_capabilities(struct ifvlan *ifv); 298 static void vlan_trunk_capabilities(struct ifnet *ifp); 299 300 static struct ifnet *vlan_clone_match_ethervid(const char *, int *); 301 static int vlan_clone_match(struct if_clone *, const char *); 302 static int vlan_clone_create(struct if_clone *, char *, size_t, caddr_t); 303 static int vlan_clone_destroy(struct if_clone *, struct ifnet *); 304 305 static void vlan_ifdetach(void *arg, struct ifnet *ifp); 306 static void vlan_iflladdr(void *arg, struct ifnet *ifp); 307 308 static void vlan_lladdr_fn(void *arg, int pending); 309 310 static struct if_clone *vlan_cloner; 311 312 #ifdef VIMAGE 313 VNET_DEFINE_STATIC(struct if_clone *, vlan_cloner); 314 #define V_vlan_cloner VNET(vlan_cloner) 315 #endif 316 317 #ifndef VLAN_ARRAY 318 #define HASH(n, m) ((((n) >> 8) ^ ((n) >> 4) ^ (n)) & (m)) 319 320 static void 321 vlan_mc_free(struct epoch_context *ctx) 322 { 323 struct vlan_mc_entry *mc = __containerof(ctx, struct vlan_mc_entry, mc_epoch_ctx); 324 free(mc, M_VLAN); 325 } 326 327 static void 328 vlan_inithash(struct ifvlantrunk *trunk) 329 { 330 int i, n; 331 332 /* 333 * The trunk must not be locked here since we call malloc(M_WAITOK). 334 * It is OK in case this function is called before the trunk struct 335 * gets hooked up and becomes visible from other threads. 336 */ 337 338 KASSERT(trunk->hwidth == 0 && trunk->hash == NULL, 339 ("%s: hash already initialized", __func__)); 340 341 trunk->hwidth = VLAN_DEF_HWIDTH; 342 n = 1 << trunk->hwidth; 343 trunk->hmask = n - 1; 344 trunk->hash = malloc(sizeof(struct ifvlanhead) * n, M_VLAN, M_WAITOK); 345 for (i = 0; i < n; i++) 346 CK_SLIST_INIT(&trunk->hash[i]); 347 } 348 349 static void 350 vlan_freehash(struct ifvlantrunk *trunk) 351 { 352 #ifdef INVARIANTS 353 int i; 354 355 KASSERT(trunk->hwidth > 0, ("%s: hwidth not positive", __func__)); 356 for (i = 0; i < (1 << trunk->hwidth); i++) 357 KASSERT(CK_SLIST_EMPTY(&trunk->hash[i]), 358 ("%s: hash table not empty", __func__)); 359 #endif 360 free(trunk->hash, M_VLAN); 361 trunk->hash = NULL; 362 trunk->hwidth = trunk->hmask = 0; 363 } 364 365 static int 366 vlan_inshash(struct ifvlantrunk *trunk, struct ifvlan *ifv) 367 { 368 int i, b; 369 struct ifvlan *ifv2; 370 371 VLAN_XLOCK_ASSERT(); 372 KASSERT(trunk->hwidth > 0, ("%s: hwidth not positive", __func__)); 373 374 b = 1 << trunk->hwidth; 375 i = HASH(ifv->ifv_vid, trunk->hmask); 376 CK_SLIST_FOREACH(ifv2, &trunk->hash[i], ifv_list) 377 if (ifv->ifv_vid == ifv2->ifv_vid) 378 return (EEXIST); 379 380 /* 381 * Grow the hash when the number of vlans exceeds half of the number of 382 * hash buckets squared. This will make the average linked-list length 383 * buckets/2. 384 */ 385 if (trunk->refcnt > (b * b) / 2) { 386 vlan_growhash(trunk, 1); 387 i = HASH(ifv->ifv_vid, trunk->hmask); 388 } 389 CK_SLIST_INSERT_HEAD(&trunk->hash[i], ifv, ifv_list); 390 trunk->refcnt++; 391 392 return (0); 393 } 394 395 static int 396 vlan_remhash(struct ifvlantrunk *trunk, struct ifvlan *ifv) 397 { 398 int i, b; 399 struct ifvlan *ifv2; 400 401 VLAN_XLOCK_ASSERT(); 402 KASSERT(trunk->hwidth > 0, ("%s: hwidth not positive", __func__)); 403 404 b = 1 << trunk->hwidth; 405 i = HASH(ifv->ifv_vid, trunk->hmask); 406 CK_SLIST_FOREACH(ifv2, &trunk->hash[i], ifv_list) 407 if (ifv2 == ifv) { 408 trunk->refcnt--; 409 CK_SLIST_REMOVE(&trunk->hash[i], ifv2, ifvlan, ifv_list); 410 if (trunk->refcnt < (b * b) / 2) 411 vlan_growhash(trunk, -1); 412 return (0); 413 } 414 415 panic("%s: vlan not found\n", __func__); 416 return (ENOENT); /*NOTREACHED*/ 417 } 418 419 /* 420 * Grow the hash larger or smaller if memory permits. 421 */ 422 static void 423 vlan_growhash(struct ifvlantrunk *trunk, int howmuch) 424 { 425 struct ifvlan *ifv; 426 struct ifvlanhead *hash2; 427 int hwidth2, i, j, n, n2; 428 429 VLAN_XLOCK_ASSERT(); 430 KASSERT(trunk->hwidth > 0, ("%s: hwidth not positive", __func__)); 431 432 if (howmuch == 0) { 433 /* Harmless yet obvious coding error */ 434 printf("%s: howmuch is 0\n", __func__); 435 return; 436 } 437 438 hwidth2 = trunk->hwidth + howmuch; 439 n = 1 << trunk->hwidth; 440 n2 = 1 << hwidth2; 441 /* Do not shrink the table below the default */ 442 if (hwidth2 < VLAN_DEF_HWIDTH) 443 return; 444 445 hash2 = malloc(sizeof(struct ifvlanhead) * n2, M_VLAN, M_WAITOK); 446 if (hash2 == NULL) { 447 printf("%s: out of memory -- hash size not changed\n", 448 __func__); 449 return; /* We can live with the old hash table */ 450 } 451 for (j = 0; j < n2; j++) 452 CK_SLIST_INIT(&hash2[j]); 453 for (i = 0; i < n; i++) 454 while ((ifv = CK_SLIST_FIRST(&trunk->hash[i])) != NULL) { 455 CK_SLIST_REMOVE(&trunk->hash[i], ifv, ifvlan, ifv_list); 456 j = HASH(ifv->ifv_vid, n2 - 1); 457 CK_SLIST_INSERT_HEAD(&hash2[j], ifv, ifv_list); 458 } 459 NET_EPOCH_WAIT(); 460 free(trunk->hash, M_VLAN); 461 trunk->hash = hash2; 462 trunk->hwidth = hwidth2; 463 trunk->hmask = n2 - 1; 464 465 if (bootverbose) 466 if_printf(trunk->parent, 467 "VLAN hash table resized from %d to %d buckets\n", n, n2); 468 } 469 470 static __inline struct ifvlan * 471 vlan_gethash(struct ifvlantrunk *trunk, uint16_t vid) 472 { 473 struct ifvlan *ifv; 474 475 TRUNK_RLOCK_ASSERT(trunk); 476 477 CK_SLIST_FOREACH(ifv, &trunk->hash[HASH(vid, trunk->hmask)], ifv_list) 478 if (ifv->ifv_vid == vid) 479 return (ifv); 480 return (NULL); 481 } 482 483 #if 0 484 /* Debugging code to view the hashtables. */ 485 static void 486 vlan_dumphash(struct ifvlantrunk *trunk) 487 { 488 int i; 489 struct ifvlan *ifv; 490 491 for (i = 0; i < (1 << trunk->hwidth); i++) { 492 printf("%d: ", i); 493 CK_SLIST_FOREACH(ifv, &trunk->hash[i], ifv_list) 494 printf("%s ", ifv->ifv_ifp->if_xname); 495 printf("\n"); 496 } 497 } 498 #endif /* 0 */ 499 #else 500 501 static __inline struct ifvlan * 502 vlan_gethash(struct ifvlantrunk *trunk, uint16_t vid) 503 { 504 505 return trunk->vlans[vid]; 506 } 507 508 static __inline int 509 vlan_inshash(struct ifvlantrunk *trunk, struct ifvlan *ifv) 510 { 511 512 if (trunk->vlans[ifv->ifv_vid] != NULL) 513 return EEXIST; 514 trunk->vlans[ifv->ifv_vid] = ifv; 515 trunk->refcnt++; 516 517 return (0); 518 } 519 520 static __inline int 521 vlan_remhash(struct ifvlantrunk *trunk, struct ifvlan *ifv) 522 { 523 524 trunk->vlans[ifv->ifv_vid] = NULL; 525 trunk->refcnt--; 526 527 return (0); 528 } 529 530 static __inline void 531 vlan_freehash(struct ifvlantrunk *trunk) 532 { 533 } 534 535 static __inline void 536 vlan_inithash(struct ifvlantrunk *trunk) 537 { 538 } 539 540 #endif /* !VLAN_ARRAY */ 541 542 static void 543 trunk_destroy(struct ifvlantrunk *trunk) 544 { 545 VLAN_XLOCK_ASSERT(); 546 547 vlan_freehash(trunk); 548 trunk->parent->if_vlantrunk = NULL; 549 TRUNK_LOCK_DESTROY(trunk); 550 if_rele(trunk->parent); 551 free(trunk, M_VLAN); 552 } 553 554 /* 555 * Program our multicast filter. What we're actually doing is 556 * programming the multicast filter of the parent. This has the 557 * side effect of causing the parent interface to receive multicast 558 * traffic that it doesn't really want, which ends up being discarded 559 * later by the upper protocol layers. Unfortunately, there's no way 560 * to avoid this: there really is only one physical interface. 561 */ 562 static int 563 vlan_setmulti(struct ifnet *ifp) 564 { 565 struct ifnet *ifp_p; 566 struct ifmultiaddr *ifma; 567 struct ifvlan *sc; 568 struct vlan_mc_entry *mc; 569 int error; 570 571 VLAN_XLOCK_ASSERT(); 572 573 /* Find the parent. */ 574 sc = ifp->if_softc; 575 ifp_p = PARENT(sc); 576 577 CURVNET_SET_QUIET(ifp_p->if_vnet); 578 579 /* First, remove any existing filter entries. */ 580 while ((mc = CK_SLIST_FIRST(&sc->vlan_mc_listhead)) != NULL) { 581 CK_SLIST_REMOVE_HEAD(&sc->vlan_mc_listhead, mc_entries); 582 (void)if_delmulti(ifp_p, (struct sockaddr *)&mc->mc_addr); 583 epoch_call(net_epoch_preempt, &mc->mc_epoch_ctx, vlan_mc_free); 584 } 585 586 /* Now program new ones. */ 587 IF_ADDR_WLOCK(ifp); 588 CK_STAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 589 if (ifma->ifma_addr->sa_family != AF_LINK) 590 continue; 591 mc = malloc(sizeof(struct vlan_mc_entry), M_VLAN, M_NOWAIT); 592 if (mc == NULL) { 593 IF_ADDR_WUNLOCK(ifp); 594 return (ENOMEM); 595 } 596 bcopy(ifma->ifma_addr, &mc->mc_addr, ifma->ifma_addr->sa_len); 597 mc->mc_addr.sdl_index = ifp_p->if_index; 598 CK_SLIST_INSERT_HEAD(&sc->vlan_mc_listhead, mc, mc_entries); 599 } 600 IF_ADDR_WUNLOCK(ifp); 601 CK_SLIST_FOREACH (mc, &sc->vlan_mc_listhead, mc_entries) { 602 error = if_addmulti(ifp_p, (struct sockaddr *)&mc->mc_addr, 603 NULL); 604 if (error) 605 return (error); 606 } 607 608 CURVNET_RESTORE(); 609 return (0); 610 } 611 612 /* 613 * A handler for parent interface link layer address changes. 614 * If the parent interface link layer address is changed we 615 * should also change it on all children vlans. 616 */ 617 static void 618 vlan_iflladdr(void *arg __unused, struct ifnet *ifp) 619 { 620 struct ifvlan *ifv; 621 struct ifnet *ifv_ifp; 622 struct ifvlantrunk *trunk; 623 struct sockaddr_dl *sdl; 624 625 /* Need the rmlock since this is run on taskqueue_swi. */ 626 VLAN_RLOCK(); 627 trunk = ifp->if_vlantrunk; 628 if (trunk == NULL) { 629 VLAN_RUNLOCK(); 630 return; 631 } 632 633 /* 634 * OK, it's a trunk. Loop over and change all vlan's lladdrs on it. 635 * We need an exclusive lock here to prevent concurrent SIOCSIFLLADDR 636 * ioctl calls on the parent garbling the lladdr of the child vlan. 637 */ 638 TRUNK_WLOCK(trunk); 639 VLAN_FOREACH(ifv, trunk) { 640 /* 641 * Copy new new lladdr into the ifv_ifp, enqueue a task 642 * to actually call if_setlladdr. if_setlladdr needs to 643 * be deferred to a taskqueue because it will call into 644 * the if_vlan ioctl path and try to acquire the global 645 * lock. 646 */ 647 ifv_ifp = ifv->ifv_ifp; 648 bcopy(IF_LLADDR(ifp), IF_LLADDR(ifv_ifp), 649 ifp->if_addrlen); 650 sdl = (struct sockaddr_dl *)ifv_ifp->if_addr->ifa_addr; 651 sdl->sdl_alen = ifp->if_addrlen; 652 taskqueue_enqueue(taskqueue_thread, &ifv->lladdr_task); 653 } 654 TRUNK_WUNLOCK(trunk); 655 VLAN_RUNLOCK(); 656 } 657 658 /* 659 * A handler for network interface departure events. 660 * Track departure of trunks here so that we don't access invalid 661 * pointers or whatever if a trunk is ripped from under us, e.g., 662 * by ejecting its hot-plug card. However, if an ifnet is simply 663 * being renamed, then there's no need to tear down the state. 664 */ 665 static void 666 vlan_ifdetach(void *arg __unused, struct ifnet *ifp) 667 { 668 struct ifvlan *ifv; 669 struct ifvlantrunk *trunk; 670 671 /* If the ifnet is just being renamed, don't do anything. */ 672 if (ifp->if_flags & IFF_RENAMING) 673 return; 674 VLAN_XLOCK(); 675 trunk = ifp->if_vlantrunk; 676 if (trunk == NULL) { 677 VLAN_XUNLOCK(); 678 return; 679 } 680 681 /* 682 * OK, it's a trunk. Loop over and detach all vlan's on it. 683 * Check trunk pointer after each vlan_unconfig() as it will 684 * free it and set to NULL after the last vlan was detached. 685 */ 686 VLAN_FOREACH_UNTIL_SAFE(ifv, ifp->if_vlantrunk, 687 ifp->if_vlantrunk == NULL) 688 vlan_unconfig_locked(ifv->ifv_ifp, 1); 689 690 /* Trunk should have been destroyed in vlan_unconfig(). */ 691 KASSERT(ifp->if_vlantrunk == NULL, ("%s: purge failed", __func__)); 692 VLAN_XUNLOCK(); 693 } 694 695 /* 696 * Return the trunk device for a virtual interface. 697 */ 698 static struct ifnet * 699 vlan_trunkdev(struct ifnet *ifp) 700 { 701 struct ifvlan *ifv; 702 703 if (ifp->if_type != IFT_L2VLAN) 704 return (NULL); 705 706 VLAN_RLOCK(); 707 ifv = ifp->if_softc; 708 ifp = NULL; 709 if (ifv->ifv_trunk) 710 ifp = PARENT(ifv); 711 VLAN_RUNLOCK(); 712 return (ifp); 713 } 714 715 /* 716 * Return the 12-bit VLAN VID for this interface, for use by external 717 * components such as Infiniband. 718 * 719 * XXXRW: Note that the function name here is historical; it should be named 720 * vlan_vid(). 721 */ 722 static int 723 vlan_tag(struct ifnet *ifp, uint16_t *vidp) 724 { 725 struct ifvlan *ifv; 726 727 if (ifp->if_type != IFT_L2VLAN) 728 return (EINVAL); 729 ifv = ifp->if_softc; 730 *vidp = ifv->ifv_vid; 731 return (0); 732 } 733 734 static int 735 vlan_pcp(struct ifnet *ifp, uint16_t *pcpp) 736 { 737 struct ifvlan *ifv; 738 739 if (ifp->if_type != IFT_L2VLAN) 740 return (EINVAL); 741 ifv = ifp->if_softc; 742 *pcpp = ifv->ifv_pcp; 743 return (0); 744 } 745 746 /* 747 * Return a driver specific cookie for this interface. Synchronization 748 * with setcookie must be provided by the driver. 749 */ 750 static void * 751 vlan_cookie(struct ifnet *ifp) 752 { 753 struct ifvlan *ifv; 754 755 if (ifp->if_type != IFT_L2VLAN) 756 return (NULL); 757 ifv = ifp->if_softc; 758 return (ifv->ifv_cookie); 759 } 760 761 /* 762 * Store a cookie in our softc that drivers can use to store driver 763 * private per-instance data in. 764 */ 765 static int 766 vlan_setcookie(struct ifnet *ifp, void *cookie) 767 { 768 struct ifvlan *ifv; 769 770 if (ifp->if_type != IFT_L2VLAN) 771 return (EINVAL); 772 ifv = ifp->if_softc; 773 ifv->ifv_cookie = cookie; 774 return (0); 775 } 776 777 /* 778 * Return the vlan device present at the specific VID. 779 */ 780 static struct ifnet * 781 vlan_devat(struct ifnet *ifp, uint16_t vid) 782 { 783 struct ifvlantrunk *trunk; 784 struct ifvlan *ifv; 785 786 VLAN_RLOCK(); 787 trunk = ifp->if_vlantrunk; 788 if (trunk == NULL) { 789 VLAN_RUNLOCK(); 790 return (NULL); 791 } 792 ifp = NULL; 793 ifv = vlan_gethash(trunk, vid); 794 if (ifv) 795 ifp = ifv->ifv_ifp; 796 VLAN_RUNLOCK(); 797 return (ifp); 798 } 799 800 /* 801 * Recalculate the cached VLAN tag exposed via the MIB. 802 */ 803 static void 804 vlan_tag_recalculate(struct ifvlan *ifv) 805 { 806 807 ifv->ifv_tag = EVL_MAKETAG(ifv->ifv_vid, ifv->ifv_pcp, 0); 808 } 809 810 /* 811 * VLAN support can be loaded as a module. The only place in the 812 * system that's intimately aware of this is ether_input. We hook 813 * into this code through vlan_input_p which is defined there and 814 * set here. No one else in the system should be aware of this so 815 * we use an explicit reference here. 816 */ 817 extern void (*vlan_input_p)(struct ifnet *, struct mbuf *); 818 819 /* For if_link_state_change() eyes only... */ 820 extern void (*vlan_link_state_p)(struct ifnet *); 821 822 static int 823 vlan_modevent(module_t mod, int type, void *data) 824 { 825 826 switch (type) { 827 case MOD_LOAD: 828 ifdetach_tag = EVENTHANDLER_REGISTER(ifnet_departure_event, 829 vlan_ifdetach, NULL, EVENTHANDLER_PRI_ANY); 830 if (ifdetach_tag == NULL) 831 return (ENOMEM); 832 iflladdr_tag = EVENTHANDLER_REGISTER(iflladdr_event, 833 vlan_iflladdr, NULL, EVENTHANDLER_PRI_ANY); 834 if (iflladdr_tag == NULL) 835 return (ENOMEM); 836 VLAN_LOCKING_INIT(); 837 vlan_input_p = vlan_input; 838 vlan_link_state_p = vlan_link_state; 839 vlan_trunk_cap_p = vlan_trunk_capabilities; 840 vlan_trunkdev_p = vlan_trunkdev; 841 vlan_cookie_p = vlan_cookie; 842 vlan_setcookie_p = vlan_setcookie; 843 vlan_tag_p = vlan_tag; 844 vlan_pcp_p = vlan_pcp; 845 vlan_devat_p = vlan_devat; 846 #ifndef VIMAGE 847 vlan_cloner = if_clone_advanced(vlanname, 0, vlan_clone_match, 848 vlan_clone_create, vlan_clone_destroy); 849 #endif 850 if (bootverbose) 851 printf("vlan: initialized, using " 852 #ifdef VLAN_ARRAY 853 "full-size arrays" 854 #else 855 "hash tables with chaining" 856 #endif 857 858 "\n"); 859 break; 860 case MOD_UNLOAD: 861 #ifndef VIMAGE 862 if_clone_detach(vlan_cloner); 863 #endif 864 EVENTHANDLER_DEREGISTER(ifnet_departure_event, ifdetach_tag); 865 EVENTHANDLER_DEREGISTER(iflladdr_event, iflladdr_tag); 866 vlan_input_p = NULL; 867 vlan_link_state_p = NULL; 868 vlan_trunk_cap_p = NULL; 869 vlan_trunkdev_p = NULL; 870 vlan_tag_p = NULL; 871 vlan_cookie_p = NULL; 872 vlan_setcookie_p = NULL; 873 vlan_devat_p = NULL; 874 VLAN_LOCKING_DESTROY(); 875 if (bootverbose) 876 printf("vlan: unloaded\n"); 877 break; 878 default: 879 return (EOPNOTSUPP); 880 } 881 return (0); 882 } 883 884 static moduledata_t vlan_mod = { 885 "if_vlan", 886 vlan_modevent, 887 0 888 }; 889 890 DECLARE_MODULE(if_vlan, vlan_mod, SI_SUB_PSEUDO, SI_ORDER_ANY); 891 MODULE_VERSION(if_vlan, 3); 892 893 #ifdef VIMAGE 894 static void 895 vnet_vlan_init(const void *unused __unused) 896 { 897 898 vlan_cloner = if_clone_advanced(vlanname, 0, vlan_clone_match, 899 vlan_clone_create, vlan_clone_destroy); 900 V_vlan_cloner = vlan_cloner; 901 } 902 VNET_SYSINIT(vnet_vlan_init, SI_SUB_PROTO_IFATTACHDOMAIN, SI_ORDER_ANY, 903 vnet_vlan_init, NULL); 904 905 static void 906 vnet_vlan_uninit(const void *unused __unused) 907 { 908 909 if_clone_detach(V_vlan_cloner); 910 } 911 VNET_SYSUNINIT(vnet_vlan_uninit, SI_SUB_INIT_IF, SI_ORDER_FIRST, 912 vnet_vlan_uninit, NULL); 913 #endif 914 915 /* 916 * Check for <etherif>.<vlan> style interface names. 917 */ 918 static struct ifnet * 919 vlan_clone_match_ethervid(const char *name, int *vidp) 920 { 921 char ifname[IFNAMSIZ]; 922 char *cp; 923 struct ifnet *ifp; 924 int vid; 925 926 strlcpy(ifname, name, IFNAMSIZ); 927 if ((cp = strchr(ifname, '.')) == NULL) 928 return (NULL); 929 *cp = '\0'; 930 if ((ifp = ifunit_ref(ifname)) == NULL) 931 return (NULL); 932 /* Parse VID. */ 933 if (*++cp == '\0') { 934 if_rele(ifp); 935 return (NULL); 936 } 937 vid = 0; 938 for(; *cp >= '0' && *cp <= '9'; cp++) 939 vid = (vid * 10) + (*cp - '0'); 940 if (*cp != '\0') { 941 if_rele(ifp); 942 return (NULL); 943 } 944 if (vidp != NULL) 945 *vidp = vid; 946 947 return (ifp); 948 } 949 950 static int 951 vlan_clone_match(struct if_clone *ifc, const char *name) 952 { 953 const char *cp; 954 955 if (vlan_clone_match_ethervid(name, NULL) != NULL) 956 return (1); 957 958 if (strncmp(vlanname, name, strlen(vlanname)) != 0) 959 return (0); 960 for (cp = name + 4; *cp != '\0'; cp++) { 961 if (*cp < '0' || *cp > '9') 962 return (0); 963 } 964 965 return (1); 966 } 967 968 static int 969 vlan_clone_create(struct if_clone *ifc, char *name, size_t len, caddr_t params) 970 { 971 char *dp; 972 int wildcard; 973 int unit; 974 int error; 975 int vid; 976 struct ifvlan *ifv; 977 struct ifnet *ifp; 978 struct ifnet *p; 979 struct ifaddr *ifa; 980 struct sockaddr_dl *sdl; 981 struct vlanreq vlr; 982 static const u_char eaddr[ETHER_ADDR_LEN]; /* 00:00:00:00:00:00 */ 983 984 /* 985 * There are 3 (ugh) ways to specify the cloned device: 986 * o pass a parameter block with the clone request. 987 * o specify parameters in the text of the clone device name 988 * o specify no parameters and get an unattached device that 989 * must be configured separately. 990 * The first technique is preferred; the latter two are 991 * supported for backwards compatibility. 992 * 993 * XXXRW: Note historic use of the word "tag" here. New ioctls may be 994 * called for. 995 */ 996 if (params) { 997 error = copyin(params, &vlr, sizeof(vlr)); 998 if (error) 999 return error; 1000 p = ifunit_ref(vlr.vlr_parent); 1001 if (p == NULL) 1002 return (ENXIO); 1003 error = ifc_name2unit(name, &unit); 1004 if (error != 0) { 1005 if_rele(p); 1006 return (error); 1007 } 1008 vid = vlr.vlr_tag; 1009 wildcard = (unit < 0); 1010 } else if ((p = vlan_clone_match_ethervid(name, &vid)) != NULL) { 1011 unit = -1; 1012 wildcard = 0; 1013 } else { 1014 p = NULL; 1015 error = ifc_name2unit(name, &unit); 1016 if (error != 0) 1017 return (error); 1018 1019 wildcard = (unit < 0); 1020 } 1021 1022 error = ifc_alloc_unit(ifc, &unit); 1023 if (error != 0) { 1024 if (p != NULL) 1025 if_rele(p); 1026 return (error); 1027 } 1028 1029 /* In the wildcard case, we need to update the name. */ 1030 if (wildcard) { 1031 for (dp = name; *dp != '\0'; dp++); 1032 if (snprintf(dp, len - (dp-name), "%d", unit) > 1033 len - (dp-name) - 1) { 1034 panic("%s: interface name too long", __func__); 1035 } 1036 } 1037 1038 ifv = malloc(sizeof(struct ifvlan), M_VLAN, M_WAITOK | M_ZERO); 1039 ifp = ifv->ifv_ifp = if_alloc(IFT_ETHER); 1040 if (ifp == NULL) { 1041 ifc_free_unit(ifc, unit); 1042 free(ifv, M_VLAN); 1043 if (p != NULL) 1044 if_rele(p); 1045 return (ENOSPC); 1046 } 1047 CK_SLIST_INIT(&ifv->vlan_mc_listhead); 1048 ifp->if_softc = ifv; 1049 /* 1050 * Set the name manually rather than using if_initname because 1051 * we don't conform to the default naming convention for interfaces. 1052 */ 1053 strlcpy(ifp->if_xname, name, IFNAMSIZ); 1054 ifp->if_dname = vlanname; 1055 ifp->if_dunit = unit; 1056 /* NB: flags are not set here */ 1057 ifp->if_linkmib = &ifv->ifv_mib; 1058 ifp->if_linkmiblen = sizeof(ifv->ifv_mib); 1059 /* NB: mtu is not set here */ 1060 1061 ifp->if_init = vlan_init; 1062 ifp->if_transmit = vlan_transmit; 1063 ifp->if_qflush = vlan_qflush; 1064 ifp->if_ioctl = vlan_ioctl; 1065 #ifdef RATELIMIT 1066 ifp->if_snd_tag_alloc = vlan_snd_tag_alloc; 1067 #endif 1068 ifp->if_flags = VLAN_IFFLAGS; 1069 ether_ifattach(ifp, eaddr); 1070 /* Now undo some of the damage... */ 1071 ifp->if_baudrate = 0; 1072 ifp->if_type = IFT_L2VLAN; 1073 ifp->if_hdrlen = ETHER_VLAN_ENCAP_LEN; 1074 ifa = ifp->if_addr; 1075 sdl = (struct sockaddr_dl *)ifa->ifa_addr; 1076 sdl->sdl_type = IFT_L2VLAN; 1077 1078 if (p != NULL) { 1079 error = vlan_config(ifv, p, vid); 1080 if_rele(p); 1081 if (error != 0) { 1082 /* 1083 * Since we've partially failed, we need to back 1084 * out all the way, otherwise userland could get 1085 * confused. Thus, we destroy the interface. 1086 */ 1087 ether_ifdetach(ifp); 1088 vlan_unconfig(ifp); 1089 if_free(ifp); 1090 ifc_free_unit(ifc, unit); 1091 free(ifv, M_VLAN); 1092 1093 return (error); 1094 } 1095 } 1096 1097 return (0); 1098 } 1099 1100 static int 1101 vlan_clone_destroy(struct if_clone *ifc, struct ifnet *ifp) 1102 { 1103 struct ifvlan *ifv = ifp->if_softc; 1104 int unit = ifp->if_dunit; 1105 1106 ether_ifdetach(ifp); /* first, remove it from system-wide lists */ 1107 vlan_unconfig(ifp); /* now it can be unconfigured and freed */ 1108 /* 1109 * We should have the only reference to the ifv now, so we can now 1110 * drain any remaining lladdr task before freeing the ifnet and the 1111 * ifvlan. 1112 */ 1113 taskqueue_drain(taskqueue_thread, &ifv->lladdr_task); 1114 NET_EPOCH_WAIT(); 1115 if_free(ifp); 1116 free(ifv, M_VLAN); 1117 ifc_free_unit(ifc, unit); 1118 1119 return (0); 1120 } 1121 1122 /* 1123 * The ifp->if_init entry point for vlan(4) is a no-op. 1124 */ 1125 static void 1126 vlan_init(void *foo __unused) 1127 { 1128 } 1129 1130 /* 1131 * The if_transmit method for vlan(4) interface. 1132 */ 1133 static int 1134 vlan_transmit(struct ifnet *ifp, struct mbuf *m) 1135 { 1136 struct ifvlan *ifv; 1137 struct ifnet *p; 1138 int error, len, mcast; 1139 1140 VLAN_RLOCK(); 1141 ifv = ifp->if_softc; 1142 if (TRUNK(ifv) == NULL) { 1143 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 1144 VLAN_RUNLOCK(); 1145 m_freem(m); 1146 return (ENETDOWN); 1147 } 1148 p = PARENT(ifv); 1149 len = m->m_pkthdr.len; 1150 mcast = (m->m_flags & (M_MCAST | M_BCAST)) ? 1 : 0; 1151 1152 BPF_MTAP(ifp, m); 1153 1154 /* 1155 * Do not run parent's if_transmit() if the parent is not up, 1156 * or parent's driver will cause a system crash. 1157 */ 1158 if (!UP_AND_RUNNING(p)) { 1159 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 1160 VLAN_RUNLOCK(); 1161 m_freem(m); 1162 return (ENETDOWN); 1163 } 1164 1165 if (!ether_8021q_frame(&m, ifp, p, ifv->ifv_vid, ifv->ifv_pcp)) { 1166 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 1167 VLAN_RUNLOCK(); 1168 return (0); 1169 } 1170 1171 /* 1172 * Send it, precisely as ether_output() would have. 1173 */ 1174 error = (p->if_transmit)(p, m); 1175 if (error == 0) { 1176 if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); 1177 if_inc_counter(ifp, IFCOUNTER_OBYTES, len); 1178 if_inc_counter(ifp, IFCOUNTER_OMCASTS, mcast); 1179 } else 1180 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 1181 VLAN_RUNLOCK(); 1182 return (error); 1183 } 1184 1185 /* 1186 * The ifp->if_qflush entry point for vlan(4) is a no-op. 1187 */ 1188 static void 1189 vlan_qflush(struct ifnet *ifp __unused) 1190 { 1191 } 1192 1193 static void 1194 vlan_input(struct ifnet *ifp, struct mbuf *m) 1195 { 1196 struct ifvlantrunk *trunk; 1197 struct ifvlan *ifv; 1198 struct m_tag *mtag; 1199 uint16_t vid, tag; 1200 1201 VLAN_RLOCK(); 1202 trunk = ifp->if_vlantrunk; 1203 if (trunk == NULL) { 1204 VLAN_RUNLOCK(); 1205 m_freem(m); 1206 return; 1207 } 1208 1209 if (m->m_flags & M_VLANTAG) { 1210 /* 1211 * Packet is tagged, but m contains a normal 1212 * Ethernet frame; the tag is stored out-of-band. 1213 */ 1214 tag = m->m_pkthdr.ether_vtag; 1215 m->m_flags &= ~M_VLANTAG; 1216 } else { 1217 struct ether_vlan_header *evl; 1218 1219 /* 1220 * Packet is tagged in-band as specified by 802.1q. 1221 */ 1222 switch (ifp->if_type) { 1223 case IFT_ETHER: 1224 if (m->m_len < sizeof(*evl) && 1225 (m = m_pullup(m, sizeof(*evl))) == NULL) { 1226 if_printf(ifp, "cannot pullup VLAN header\n"); 1227 VLAN_RUNLOCK(); 1228 return; 1229 } 1230 evl = mtod(m, struct ether_vlan_header *); 1231 tag = ntohs(evl->evl_tag); 1232 1233 /* 1234 * Remove the 802.1q header by copying the Ethernet 1235 * addresses over it and adjusting the beginning of 1236 * the data in the mbuf. The encapsulated Ethernet 1237 * type field is already in place. 1238 */ 1239 bcopy((char *)evl, (char *)evl + ETHER_VLAN_ENCAP_LEN, 1240 ETHER_HDR_LEN - ETHER_TYPE_LEN); 1241 m_adj(m, ETHER_VLAN_ENCAP_LEN); 1242 break; 1243 1244 default: 1245 #ifdef INVARIANTS 1246 panic("%s: %s has unsupported if_type %u", 1247 __func__, ifp->if_xname, ifp->if_type); 1248 #endif 1249 if_inc_counter(ifp, IFCOUNTER_NOPROTO, 1); 1250 VLAN_RUNLOCK(); 1251 m_freem(m); 1252 return; 1253 } 1254 } 1255 1256 vid = EVL_VLANOFTAG(tag); 1257 1258 ifv = vlan_gethash(trunk, vid); 1259 if (ifv == NULL || !UP_AND_RUNNING(ifv->ifv_ifp)) { 1260 VLAN_RUNLOCK(); 1261 if_inc_counter(ifp, IFCOUNTER_NOPROTO, 1); 1262 m_freem(m); 1263 return; 1264 } 1265 1266 if (vlan_mtag_pcp) { 1267 /* 1268 * While uncommon, it is possible that we will find a 802.1q 1269 * packet encapsulated inside another packet that also had an 1270 * 802.1q header. For example, ethernet tunneled over IPSEC 1271 * arriving over ethernet. In that case, we replace the 1272 * existing 802.1q PCP m_tag value. 1273 */ 1274 mtag = m_tag_locate(m, MTAG_8021Q, MTAG_8021Q_PCP_IN, NULL); 1275 if (mtag == NULL) { 1276 mtag = m_tag_alloc(MTAG_8021Q, MTAG_8021Q_PCP_IN, 1277 sizeof(uint8_t), M_NOWAIT); 1278 if (mtag == NULL) { 1279 if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 1280 VLAN_RUNLOCK(); 1281 m_freem(m); 1282 return; 1283 } 1284 m_tag_prepend(m, mtag); 1285 } 1286 *(uint8_t *)(mtag + 1) = EVL_PRIOFTAG(tag); 1287 } 1288 1289 m->m_pkthdr.rcvif = ifv->ifv_ifp; 1290 if_inc_counter(ifv->ifv_ifp, IFCOUNTER_IPACKETS, 1); 1291 VLAN_RUNLOCK(); 1292 1293 /* Pass it back through the parent's input routine. */ 1294 (*ifv->ifv_ifp->if_input)(ifv->ifv_ifp, m); 1295 } 1296 1297 static void 1298 vlan_lladdr_fn(void *arg, int pending __unused) 1299 { 1300 struct ifvlan *ifv; 1301 struct ifnet *ifp; 1302 1303 ifv = (struct ifvlan *)arg; 1304 ifp = ifv->ifv_ifp; 1305 1306 CURVNET_SET(ifp->if_vnet); 1307 1308 /* The ifv_ifp already has the lladdr copied in. */ 1309 if_setlladdr(ifp, IF_LLADDR(ifp), ifp->if_addrlen); 1310 1311 CURVNET_RESTORE(); 1312 } 1313 1314 static int 1315 vlan_config(struct ifvlan *ifv, struct ifnet *p, uint16_t vid) 1316 { 1317 struct ifvlantrunk *trunk; 1318 struct ifnet *ifp; 1319 int error = 0; 1320 1321 /* 1322 * We can handle non-ethernet hardware types as long as 1323 * they handle the tagging and headers themselves. 1324 */ 1325 if (p->if_type != IFT_ETHER && 1326 (p->if_capenable & IFCAP_VLAN_HWTAGGING) == 0) 1327 return (EPROTONOSUPPORT); 1328 if ((p->if_flags & VLAN_IFFLAGS) != VLAN_IFFLAGS) 1329 return (EPROTONOSUPPORT); 1330 /* 1331 * Don't let the caller set up a VLAN VID with 1332 * anything except VLID bits. 1333 * VID numbers 0x0 and 0xFFF are reserved. 1334 */ 1335 if (vid == 0 || vid == 0xFFF || (vid & ~EVL_VLID_MASK)) 1336 return (EINVAL); 1337 if (ifv->ifv_trunk) 1338 return (EBUSY); 1339 1340 VLAN_XLOCK(); 1341 if (p->if_vlantrunk == NULL) { 1342 trunk = malloc(sizeof(struct ifvlantrunk), 1343 M_VLAN, M_WAITOK | M_ZERO); 1344 vlan_inithash(trunk); 1345 TRUNK_LOCK_INIT(trunk); 1346 TRUNK_WLOCK(trunk); 1347 p->if_vlantrunk = trunk; 1348 trunk->parent = p; 1349 if_ref(trunk->parent); 1350 TRUNK_WUNLOCK(trunk); 1351 } else { 1352 trunk = p->if_vlantrunk; 1353 } 1354 1355 ifv->ifv_vid = vid; /* must set this before vlan_inshash() */ 1356 ifv->ifv_pcp = 0; /* Default: best effort delivery. */ 1357 vlan_tag_recalculate(ifv); 1358 error = vlan_inshash(trunk, ifv); 1359 if (error) 1360 goto done; 1361 ifv->ifv_proto = ETHERTYPE_VLAN; 1362 ifv->ifv_encaplen = ETHER_VLAN_ENCAP_LEN; 1363 ifv->ifv_mintu = ETHERMIN; 1364 ifv->ifv_pflags = 0; 1365 ifv->ifv_capenable = -1; 1366 1367 /* 1368 * If the parent supports the VLAN_MTU capability, 1369 * i.e. can Tx/Rx larger than ETHER_MAX_LEN frames, 1370 * use it. 1371 */ 1372 if (p->if_capenable & IFCAP_VLAN_MTU) { 1373 /* 1374 * No need to fudge the MTU since the parent can 1375 * handle extended frames. 1376 */ 1377 ifv->ifv_mtufudge = 0; 1378 } else { 1379 /* 1380 * Fudge the MTU by the encapsulation size. This 1381 * makes us incompatible with strictly compliant 1382 * 802.1Q implementations, but allows us to use 1383 * the feature with other NetBSD implementations, 1384 * which might still be useful. 1385 */ 1386 ifv->ifv_mtufudge = ifv->ifv_encaplen; 1387 } 1388 1389 ifv->ifv_trunk = trunk; 1390 ifp = ifv->ifv_ifp; 1391 /* 1392 * Initialize fields from our parent. This duplicates some 1393 * work with ether_ifattach() but allows for non-ethernet 1394 * interfaces to also work. 1395 */ 1396 ifp->if_mtu = p->if_mtu - ifv->ifv_mtufudge; 1397 ifp->if_baudrate = p->if_baudrate; 1398 ifp->if_output = p->if_output; 1399 ifp->if_input = p->if_input; 1400 ifp->if_resolvemulti = p->if_resolvemulti; 1401 ifp->if_addrlen = p->if_addrlen; 1402 ifp->if_broadcastaddr = p->if_broadcastaddr; 1403 ifp->if_pcp = ifv->ifv_pcp; 1404 1405 /* 1406 * Copy only a selected subset of flags from the parent. 1407 * Other flags are none of our business. 1408 */ 1409 #define VLAN_COPY_FLAGS (IFF_SIMPLEX) 1410 ifp->if_flags &= ~VLAN_COPY_FLAGS; 1411 ifp->if_flags |= p->if_flags & VLAN_COPY_FLAGS; 1412 #undef VLAN_COPY_FLAGS 1413 1414 ifp->if_link_state = p->if_link_state; 1415 1416 TRUNK_RLOCK(TRUNK(ifv)); 1417 vlan_capabilities(ifv); 1418 TRUNK_RUNLOCK(TRUNK(ifv)); 1419 1420 /* 1421 * Set up our interface address to reflect the underlying 1422 * physical interface's. 1423 */ 1424 bcopy(IF_LLADDR(p), IF_LLADDR(ifp), p->if_addrlen); 1425 ((struct sockaddr_dl *)ifp->if_addr->ifa_addr)->sdl_alen = 1426 p->if_addrlen; 1427 1428 TASK_INIT(&ifv->lladdr_task, 0, vlan_lladdr_fn, ifv); 1429 1430 /* We are ready for operation now. */ 1431 ifp->if_drv_flags |= IFF_DRV_RUNNING; 1432 1433 /* Update flags on the parent, if necessary. */ 1434 vlan_setflags(ifp, 1); 1435 1436 /* 1437 * Configure multicast addresses that may already be 1438 * joined on the vlan device. 1439 */ 1440 (void)vlan_setmulti(ifp); 1441 1442 done: 1443 if (error == 0) 1444 EVENTHANDLER_INVOKE(vlan_config, p, ifv->ifv_vid); 1445 VLAN_XUNLOCK(); 1446 1447 return (error); 1448 } 1449 1450 static void 1451 vlan_unconfig(struct ifnet *ifp) 1452 { 1453 1454 VLAN_XLOCK(); 1455 vlan_unconfig_locked(ifp, 0); 1456 VLAN_XUNLOCK(); 1457 } 1458 1459 static void 1460 vlan_unconfig_locked(struct ifnet *ifp, int departing) 1461 { 1462 struct ifvlantrunk *trunk; 1463 struct vlan_mc_entry *mc; 1464 struct ifvlan *ifv; 1465 struct ifnet *parent; 1466 int error; 1467 1468 VLAN_XLOCK_ASSERT(); 1469 1470 ifv = ifp->if_softc; 1471 trunk = ifv->ifv_trunk; 1472 parent = NULL; 1473 1474 if (trunk != NULL) { 1475 parent = trunk->parent; 1476 1477 /* 1478 * Since the interface is being unconfigured, we need to 1479 * empty the list of multicast groups that we may have joined 1480 * while we were alive from the parent's list. 1481 */ 1482 while ((mc = CK_SLIST_FIRST(&ifv->vlan_mc_listhead)) != NULL) { 1483 /* 1484 * If the parent interface is being detached, 1485 * all its multicast addresses have already 1486 * been removed. Warn about errors if 1487 * if_delmulti() does fail, but don't abort as 1488 * all callers expect vlan destruction to 1489 * succeed. 1490 */ 1491 if (!departing) { 1492 error = if_delmulti(parent, 1493 (struct sockaddr *)&mc->mc_addr); 1494 if (error) 1495 if_printf(ifp, 1496 "Failed to delete multicast address from parent: %d\n", 1497 error); 1498 } 1499 CK_SLIST_REMOVE_HEAD(&ifv->vlan_mc_listhead, mc_entries); 1500 epoch_call(net_epoch_preempt, &mc->mc_epoch_ctx, vlan_mc_free); 1501 } 1502 1503 vlan_setflags(ifp, 0); /* clear special flags on parent */ 1504 1505 vlan_remhash(trunk, ifv); 1506 ifv->ifv_trunk = NULL; 1507 1508 /* 1509 * Check if we were the last. 1510 */ 1511 if (trunk->refcnt == 0) { 1512 parent->if_vlantrunk = NULL; 1513 NET_EPOCH_WAIT(); 1514 trunk_destroy(trunk); 1515 } 1516 } 1517 1518 /* Disconnect from parent. */ 1519 if (ifv->ifv_pflags) 1520 if_printf(ifp, "%s: ifv_pflags unclean\n", __func__); 1521 ifp->if_mtu = ETHERMTU; 1522 ifp->if_link_state = LINK_STATE_UNKNOWN; 1523 ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 1524 1525 /* 1526 * Only dispatch an event if vlan was 1527 * attached, otherwise there is nothing 1528 * to cleanup anyway. 1529 */ 1530 if (parent != NULL) 1531 EVENTHANDLER_INVOKE(vlan_unconfig, parent, ifv->ifv_vid); 1532 } 1533 1534 /* Handle a reference counted flag that should be set on the parent as well */ 1535 static int 1536 vlan_setflag(struct ifnet *ifp, int flag, int status, 1537 int (*func)(struct ifnet *, int)) 1538 { 1539 struct ifvlan *ifv; 1540 int error; 1541 1542 VLAN_SXLOCK_ASSERT(); 1543 1544 ifv = ifp->if_softc; 1545 status = status ? (ifp->if_flags & flag) : 0; 1546 /* Now "status" contains the flag value or 0 */ 1547 1548 /* 1549 * See if recorded parent's status is different from what 1550 * we want it to be. If it is, flip it. We record parent's 1551 * status in ifv_pflags so that we won't clear parent's flag 1552 * we haven't set. In fact, we don't clear or set parent's 1553 * flags directly, but get or release references to them. 1554 * That's why we can be sure that recorded flags still are 1555 * in accord with actual parent's flags. 1556 */ 1557 if (status != (ifv->ifv_pflags & flag)) { 1558 error = (*func)(PARENT(ifv), status); 1559 if (error) 1560 return (error); 1561 ifv->ifv_pflags &= ~flag; 1562 ifv->ifv_pflags |= status; 1563 } 1564 return (0); 1565 } 1566 1567 /* 1568 * Handle IFF_* flags that require certain changes on the parent: 1569 * if "status" is true, update parent's flags respective to our if_flags; 1570 * if "status" is false, forcedly clear the flags set on parent. 1571 */ 1572 static int 1573 vlan_setflags(struct ifnet *ifp, int status) 1574 { 1575 int error, i; 1576 1577 for (i = 0; vlan_pflags[i].flag; i++) { 1578 error = vlan_setflag(ifp, vlan_pflags[i].flag, 1579 status, vlan_pflags[i].func); 1580 if (error) 1581 return (error); 1582 } 1583 return (0); 1584 } 1585 1586 /* Inform all vlans that their parent has changed link state */ 1587 static void 1588 vlan_link_state(struct ifnet *ifp) 1589 { 1590 struct ifvlantrunk *trunk; 1591 struct ifvlan *ifv; 1592 1593 /* Called from a taskqueue_swi task, so we cannot sleep. */ 1594 VLAN_RLOCK(); 1595 trunk = ifp->if_vlantrunk; 1596 if (trunk == NULL) { 1597 VLAN_RUNLOCK(); 1598 return; 1599 } 1600 1601 TRUNK_WLOCK(trunk); 1602 VLAN_FOREACH(ifv, trunk) { 1603 ifv->ifv_ifp->if_baudrate = trunk->parent->if_baudrate; 1604 if_link_state_change(ifv->ifv_ifp, 1605 trunk->parent->if_link_state); 1606 } 1607 TRUNK_WUNLOCK(trunk); 1608 VLAN_RUNLOCK(); 1609 } 1610 1611 static void 1612 vlan_capabilities(struct ifvlan *ifv) 1613 { 1614 struct ifnet *p; 1615 struct ifnet *ifp; 1616 struct ifnet_hw_tsomax hw_tsomax; 1617 int cap = 0, ena = 0, mena; 1618 u_long hwa = 0; 1619 1620 VLAN_SXLOCK_ASSERT(); 1621 TRUNK_RLOCK_ASSERT(TRUNK(ifv)); 1622 p = PARENT(ifv); 1623 ifp = ifv->ifv_ifp; 1624 1625 /* Mask parent interface enabled capabilities disabled by user. */ 1626 mena = p->if_capenable & ifv->ifv_capenable; 1627 1628 /* 1629 * If the parent interface can do checksum offloading 1630 * on VLANs, then propagate its hardware-assisted 1631 * checksumming flags. Also assert that checksum 1632 * offloading requires hardware VLAN tagging. 1633 */ 1634 if (p->if_capabilities & IFCAP_VLAN_HWCSUM) 1635 cap |= p->if_capabilities & (IFCAP_HWCSUM | IFCAP_HWCSUM_IPV6); 1636 if (p->if_capenable & IFCAP_VLAN_HWCSUM && 1637 p->if_capenable & IFCAP_VLAN_HWTAGGING) { 1638 ena |= mena & (IFCAP_HWCSUM | IFCAP_HWCSUM_IPV6); 1639 if (ena & IFCAP_TXCSUM) 1640 hwa |= p->if_hwassist & (CSUM_IP | CSUM_TCP | 1641 CSUM_UDP | CSUM_SCTP); 1642 if (ena & IFCAP_TXCSUM_IPV6) 1643 hwa |= p->if_hwassist & (CSUM_TCP_IPV6 | 1644 CSUM_UDP_IPV6 | CSUM_SCTP_IPV6); 1645 } 1646 1647 /* 1648 * If the parent interface can do TSO on VLANs then 1649 * propagate the hardware-assisted flag. TSO on VLANs 1650 * does not necessarily require hardware VLAN tagging. 1651 */ 1652 memset(&hw_tsomax, 0, sizeof(hw_tsomax)); 1653 if_hw_tsomax_common(p, &hw_tsomax); 1654 if_hw_tsomax_update(ifp, &hw_tsomax); 1655 if (p->if_capabilities & IFCAP_VLAN_HWTSO) 1656 cap |= p->if_capabilities & IFCAP_TSO; 1657 if (p->if_capenable & IFCAP_VLAN_HWTSO) { 1658 ena |= mena & IFCAP_TSO; 1659 if (ena & IFCAP_TSO) 1660 hwa |= p->if_hwassist & CSUM_TSO; 1661 } 1662 1663 /* 1664 * If the parent interface can do LRO and checksum offloading on 1665 * VLANs, then guess it may do LRO on VLANs. False positive here 1666 * cost nothing, while false negative may lead to some confusions. 1667 */ 1668 if (p->if_capabilities & IFCAP_VLAN_HWCSUM) 1669 cap |= p->if_capabilities & IFCAP_LRO; 1670 if (p->if_capenable & IFCAP_VLAN_HWCSUM) 1671 ena |= p->if_capenable & IFCAP_LRO; 1672 1673 /* 1674 * If the parent interface can offload TCP connections over VLANs then 1675 * propagate its TOE capability to the VLAN interface. 1676 * 1677 * All TOE drivers in the tree today can deal with VLANs. If this 1678 * changes then IFCAP_VLAN_TOE should be promoted to a full capability 1679 * with its own bit. 1680 */ 1681 #define IFCAP_VLAN_TOE IFCAP_TOE 1682 if (p->if_capabilities & IFCAP_VLAN_TOE) 1683 cap |= p->if_capabilities & IFCAP_TOE; 1684 if (p->if_capenable & IFCAP_VLAN_TOE) { 1685 TOEDEV(ifp) = TOEDEV(p); 1686 ena |= mena & IFCAP_TOE; 1687 } 1688 1689 /* 1690 * If the parent interface supports dynamic link state, so does the 1691 * VLAN interface. 1692 */ 1693 cap |= (p->if_capabilities & IFCAP_LINKSTATE); 1694 ena |= (mena & IFCAP_LINKSTATE); 1695 1696 #ifdef RATELIMIT 1697 /* 1698 * If the parent interface supports ratelimiting, so does the 1699 * VLAN interface. 1700 */ 1701 cap |= (p->if_capabilities & IFCAP_TXRTLMT); 1702 ena |= (mena & IFCAP_TXRTLMT); 1703 #endif 1704 1705 ifp->if_capabilities = cap; 1706 ifp->if_capenable = ena; 1707 ifp->if_hwassist = hwa; 1708 } 1709 1710 static void 1711 vlan_trunk_capabilities(struct ifnet *ifp) 1712 { 1713 struct ifvlantrunk *trunk; 1714 struct ifvlan *ifv; 1715 1716 VLAN_SLOCK(); 1717 trunk = ifp->if_vlantrunk; 1718 if (trunk == NULL) { 1719 VLAN_SUNLOCK(); 1720 return; 1721 } 1722 TRUNK_RLOCK(trunk); 1723 VLAN_FOREACH(ifv, trunk) { 1724 vlan_capabilities(ifv); 1725 } 1726 TRUNK_RUNLOCK(trunk); 1727 VLAN_SUNLOCK(); 1728 } 1729 1730 static int 1731 vlan_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 1732 { 1733 struct ifnet *p; 1734 struct ifreq *ifr; 1735 struct ifaddr *ifa; 1736 struct ifvlan *ifv; 1737 struct ifvlantrunk *trunk; 1738 struct vlanreq vlr; 1739 int error = 0; 1740 1741 ifr = (struct ifreq *)data; 1742 ifa = (struct ifaddr *) data; 1743 ifv = ifp->if_softc; 1744 1745 switch (cmd) { 1746 case SIOCSIFADDR: 1747 ifp->if_flags |= IFF_UP; 1748 #ifdef INET 1749 if (ifa->ifa_addr->sa_family == AF_INET) 1750 arp_ifinit(ifp, ifa); 1751 #endif 1752 break; 1753 case SIOCGIFADDR: 1754 bcopy(IF_LLADDR(ifp), &ifr->ifr_addr.sa_data[0], 1755 ifp->if_addrlen); 1756 break; 1757 case SIOCGIFMEDIA: 1758 VLAN_SLOCK(); 1759 if (TRUNK(ifv) != NULL) { 1760 p = PARENT(ifv); 1761 if_ref(p); 1762 error = (*p->if_ioctl)(p, SIOCGIFMEDIA, data); 1763 if_rele(p); 1764 /* Limit the result to the parent's current config. */ 1765 if (error == 0) { 1766 struct ifmediareq *ifmr; 1767 1768 ifmr = (struct ifmediareq *)data; 1769 if (ifmr->ifm_count >= 1 && ifmr->ifm_ulist) { 1770 ifmr->ifm_count = 1; 1771 error = copyout(&ifmr->ifm_current, 1772 ifmr->ifm_ulist, 1773 sizeof(int)); 1774 } 1775 } 1776 } else { 1777 error = EINVAL; 1778 } 1779 VLAN_SUNLOCK(); 1780 break; 1781 1782 case SIOCSIFMEDIA: 1783 error = EINVAL; 1784 break; 1785 1786 case SIOCSIFMTU: 1787 /* 1788 * Set the interface MTU. 1789 */ 1790 VLAN_SLOCK(); 1791 trunk = TRUNK(ifv); 1792 if (trunk != NULL) { 1793 TRUNK_WLOCK(trunk); 1794 if (ifr->ifr_mtu > 1795 (PARENT(ifv)->if_mtu - ifv->ifv_mtufudge) || 1796 ifr->ifr_mtu < 1797 (ifv->ifv_mintu - ifv->ifv_mtufudge)) 1798 error = EINVAL; 1799 else 1800 ifp->if_mtu = ifr->ifr_mtu; 1801 TRUNK_WUNLOCK(trunk); 1802 } else 1803 error = EINVAL; 1804 VLAN_SUNLOCK(); 1805 break; 1806 1807 case SIOCSETVLAN: 1808 #ifdef VIMAGE 1809 /* 1810 * XXXRW/XXXBZ: The goal in these checks is to allow a VLAN 1811 * interface to be delegated to a jail without allowing the 1812 * jail to change what underlying interface/VID it is 1813 * associated with. We are not entirely convinced that this 1814 * is the right way to accomplish that policy goal. 1815 */ 1816 if (ifp->if_vnet != ifp->if_home_vnet) { 1817 error = EPERM; 1818 break; 1819 } 1820 #endif 1821 error = copyin(ifr_data_get_ptr(ifr), &vlr, sizeof(vlr)); 1822 if (error) 1823 break; 1824 if (vlr.vlr_parent[0] == '\0') { 1825 vlan_unconfig(ifp); 1826 break; 1827 } 1828 p = ifunit_ref(vlr.vlr_parent); 1829 if (p == NULL) { 1830 error = ENOENT; 1831 break; 1832 } 1833 error = vlan_config(ifv, p, vlr.vlr_tag); 1834 if_rele(p); 1835 break; 1836 1837 case SIOCGETVLAN: 1838 #ifdef VIMAGE 1839 if (ifp->if_vnet != ifp->if_home_vnet) { 1840 error = EPERM; 1841 break; 1842 } 1843 #endif 1844 bzero(&vlr, sizeof(vlr)); 1845 VLAN_SLOCK(); 1846 if (TRUNK(ifv) != NULL) { 1847 strlcpy(vlr.vlr_parent, PARENT(ifv)->if_xname, 1848 sizeof(vlr.vlr_parent)); 1849 vlr.vlr_tag = ifv->ifv_vid; 1850 } 1851 VLAN_SUNLOCK(); 1852 error = copyout(&vlr, ifr_data_get_ptr(ifr), sizeof(vlr)); 1853 break; 1854 1855 case SIOCSIFFLAGS: 1856 /* 1857 * We should propagate selected flags to the parent, 1858 * e.g., promiscuous mode. 1859 */ 1860 VLAN_XLOCK(); 1861 if (TRUNK(ifv) != NULL) 1862 error = vlan_setflags(ifp, 1); 1863 VLAN_XUNLOCK(); 1864 break; 1865 1866 case SIOCADDMULTI: 1867 case SIOCDELMULTI: 1868 /* 1869 * If we don't have a parent, just remember the membership for 1870 * when we do. 1871 * 1872 * XXX We need the rmlock here to avoid sleeping while 1873 * holding in6_multi_mtx. 1874 */ 1875 VLAN_XLOCK(); 1876 trunk = TRUNK(ifv); 1877 if (trunk != NULL) 1878 error = vlan_setmulti(ifp); 1879 VLAN_XUNLOCK(); 1880 1881 break; 1882 case SIOCGVLANPCP: 1883 #ifdef VIMAGE 1884 if (ifp->if_vnet != ifp->if_home_vnet) { 1885 error = EPERM; 1886 break; 1887 } 1888 #endif 1889 ifr->ifr_vlan_pcp = ifv->ifv_pcp; 1890 break; 1891 1892 case SIOCSVLANPCP: 1893 #ifdef VIMAGE 1894 if (ifp->if_vnet != ifp->if_home_vnet) { 1895 error = EPERM; 1896 break; 1897 } 1898 #endif 1899 error = priv_check(curthread, PRIV_NET_SETVLANPCP); 1900 if (error) 1901 break; 1902 if (ifr->ifr_vlan_pcp > 7) { 1903 error = EINVAL; 1904 break; 1905 } 1906 ifv->ifv_pcp = ifr->ifr_vlan_pcp; 1907 ifp->if_pcp = ifv->ifv_pcp; 1908 vlan_tag_recalculate(ifv); 1909 /* broadcast event about PCP change */ 1910 EVENTHANDLER_INVOKE(ifnet_event, ifp, IFNET_EVENT_PCP); 1911 break; 1912 1913 case SIOCSIFCAP: 1914 VLAN_SLOCK(); 1915 ifv->ifv_capenable = ifr->ifr_reqcap; 1916 trunk = TRUNK(ifv); 1917 if (trunk != NULL) { 1918 TRUNK_RLOCK(trunk); 1919 vlan_capabilities(ifv); 1920 TRUNK_RUNLOCK(trunk); 1921 } 1922 VLAN_SUNLOCK(); 1923 break; 1924 1925 default: 1926 error = EINVAL; 1927 break; 1928 } 1929 1930 return (error); 1931 } 1932 1933 #ifdef RATELIMIT 1934 static int 1935 vlan_snd_tag_alloc(struct ifnet *ifp, 1936 union if_snd_tag_alloc_params *params, 1937 struct m_snd_tag **ppmt) 1938 { 1939 1940 /* get trunk device */ 1941 ifp = vlan_trunkdev(ifp); 1942 if (ifp == NULL || (ifp->if_capenable & IFCAP_TXRTLMT) == 0) 1943 return (EOPNOTSUPP); 1944 /* forward allocation request */ 1945 return (ifp->if_snd_tag_alloc(ifp, params, ppmt)); 1946 } 1947 #endif 1948