sys/net/if_vlan.c

   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