1c398230bSWarner Losh /*- 22cc2df49SGarrett Wollman * Copyright 1998 Massachusetts Institute of Technology 32cc2df49SGarrett Wollman * 42cc2df49SGarrett Wollman * Permission to use, copy, modify, and distribute this software and 52cc2df49SGarrett Wollman * its documentation for any purpose and without fee is hereby 62cc2df49SGarrett Wollman * granted, provided that both the above copyright notice and this 72cc2df49SGarrett Wollman * permission notice appear in all copies, that both the above 82cc2df49SGarrett Wollman * copyright notice and this permission notice appear in all 92cc2df49SGarrett Wollman * supporting documentation, and that the name of M.I.T. not be used 102cc2df49SGarrett Wollman * in advertising or publicity pertaining to distribution of the 112cc2df49SGarrett Wollman * software without specific, written prior permission. M.I.T. makes 122cc2df49SGarrett Wollman * no representations about the suitability of this software for any 132cc2df49SGarrett Wollman * purpose. It is provided "as is" without express or implied 142cc2df49SGarrett Wollman * warranty. 152cc2df49SGarrett Wollman * 162cc2df49SGarrett Wollman * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS 172cc2df49SGarrett Wollman * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE, 182cc2df49SGarrett Wollman * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 192cc2df49SGarrett Wollman * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT 202cc2df49SGarrett Wollman * SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 212cc2df49SGarrett Wollman * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 222cc2df49SGarrett Wollman * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 232cc2df49SGarrett Wollman * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 242cc2df49SGarrett Wollman * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 252cc2df49SGarrett Wollman * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 262cc2df49SGarrett Wollman * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 272cc2df49SGarrett Wollman * SUCH DAMAGE. 282cc2df49SGarrett Wollman * 29c3aac50fSPeter Wemm * $FreeBSD$ 302cc2df49SGarrett Wollman */ 312cc2df49SGarrett Wollman 322cc2df49SGarrett Wollman /* 332cc2df49SGarrett Wollman * if_vlan.c - pseudo-device driver for IEEE 802.1Q virtual LANs. 342cc2df49SGarrett Wollman * Might be extended some day to also handle IEEE 802.1p priority 352cc2df49SGarrett Wollman * tagging. This is sort of sneaky in the implementation, since 362cc2df49SGarrett Wollman * we need to pretend to be enough of an Ethernet implementation 372cc2df49SGarrett Wollman * to make arp work. The way we do this is by telling everyone 382cc2df49SGarrett Wollman * that we are an Ethernet, and then catch the packets that 3946a32e61SPhilippe Charnier * ether_output() left on our output queue when it calls 402cc2df49SGarrett Wollman * if_start(), rewrite them for use by the real outgoing interface, 412cc2df49SGarrett Wollman * and ask it to send them. 422cc2df49SGarrett Wollman */ 432cc2df49SGarrett Wollman 442cc2df49SGarrett Wollman #include "opt_inet.h" 4575ee267cSGleb Smirnoff #include "opt_vlan.h" 462cc2df49SGarrett Wollman 472cc2df49SGarrett Wollman #include <sys/param.h> 482cc2df49SGarrett Wollman #include <sys/kernel.h> 4975ee267cSGleb Smirnoff #include <sys/lock.h> 50f731f104SBill Paul #include <sys/malloc.h> 512cc2df49SGarrett Wollman #include <sys/mbuf.h> 522b120974SPeter Wemm #include <sys/module.h> 5375ee267cSGleb Smirnoff #include <sys/rwlock.h> 54f731f104SBill Paul #include <sys/queue.h> 552cc2df49SGarrett Wollman #include <sys/socket.h> 562cc2df49SGarrett Wollman #include <sys/sockio.h> 572cc2df49SGarrett Wollman #include <sys/sysctl.h> 582cc2df49SGarrett Wollman #include <sys/systm.h> 592cc2df49SGarrett Wollman 602cc2df49SGarrett Wollman #include <net/bpf.h> 612cc2df49SGarrett Wollman #include <net/ethernet.h> 622cc2df49SGarrett Wollman #include <net/if.h> 63f889d2efSBrooks Davis #include <net/if_clone.h> 642cc2df49SGarrett Wollman #include <net/if_arp.h> 652cc2df49SGarrett Wollman #include <net/if_dl.h> 662cc2df49SGarrett Wollman #include <net/if_types.h> 672cc2df49SGarrett Wollman #include <net/if_vlan_var.h> 682cc2df49SGarrett Wollman 692cc2df49SGarrett Wollman #ifdef INET 702cc2df49SGarrett Wollman #include <netinet/in.h> 712cc2df49SGarrett Wollman #include <netinet/if_ether.h> 722cc2df49SGarrett Wollman #endif 732cc2df49SGarrett Wollman 749d4fe4b2SBrooks Davis #define VLANNAME "vlan" 7575ee267cSGleb Smirnoff #define VLAN_DEF_HWIDTH 4 7664a17d2eSYaroslav Tykhiy #define VLAN_IFFLAGS (IFF_BROADCAST | IFF_MULTICAST) 7775ee267cSGleb Smirnoff 7875ee267cSGleb Smirnoff LIST_HEAD(ifvlanhead, ifvlan); 7975ee267cSGleb Smirnoff 8075ee267cSGleb Smirnoff struct ifvlantrunk { 8175ee267cSGleb Smirnoff struct ifnet *parent; /* parent interface of this trunk */ 8275ee267cSGleb Smirnoff struct rwlock rw; 8375ee267cSGleb Smirnoff #ifdef VLAN_ARRAY 845cb8c31aSYaroslav Tykhiy #define VLAN_ARRAY_SIZE (EVL_VLID_MASK + 1) 855cb8c31aSYaroslav Tykhiy struct ifvlan *vlans[VLAN_ARRAY_SIZE]; /* static table */ 8675ee267cSGleb Smirnoff #else 8775ee267cSGleb Smirnoff struct ifvlanhead *hash; /* dynamic hash-list table */ 8875ee267cSGleb Smirnoff uint16_t hmask; 8975ee267cSGleb Smirnoff uint16_t hwidth; 9075ee267cSGleb Smirnoff #endif 9175ee267cSGleb Smirnoff int refcnt; 9275ee267cSGleb Smirnoff LIST_ENTRY(ifvlantrunk) trunk_entry; 9375ee267cSGleb Smirnoff }; 9475ee267cSGleb Smirnoff static LIST_HEAD(, ifvlantrunk) trunk_list; 959d4fe4b2SBrooks Davis 96a3814acfSSam Leffler struct vlan_mc_entry { 97a3814acfSSam Leffler struct ether_addr mc_addr; 98a3814acfSSam Leffler SLIST_ENTRY(vlan_mc_entry) mc_entries; 99a3814acfSSam Leffler }; 100a3814acfSSam Leffler 101a3814acfSSam Leffler struct ifvlan { 10275ee267cSGleb Smirnoff struct ifvlantrunk *ifv_trunk; 103fc74a9f9SBrooks Davis struct ifnet *ifv_ifp; 10475ee267cSGleb Smirnoff #define TRUNK(ifv) ((ifv)->ifv_trunk) 10575ee267cSGleb Smirnoff #define PARENT(ifv) ((ifv)->ifv_trunk->parent) 1061cf236fbSYaroslav Tykhiy int ifv_pflags; /* special flags we have set on parent */ 107a3814acfSSam Leffler struct ifv_linkmib { 108a3814acfSSam Leffler int ifvm_encaplen; /* encapsulation length */ 109a3814acfSSam Leffler int ifvm_mtufudge; /* MTU fudged by this much */ 110a3814acfSSam Leffler int ifvm_mintu; /* min transmission unit */ 11175ee267cSGleb Smirnoff uint16_t ifvm_tag; /* tag to apply on packets leaving if */ 112a3814acfSSam Leffler } ifv_mib; 113114c608cSYaroslav Tykhiy SLIST_HEAD(, vlan_mc_entry) vlan_mc_listhead; 114a3814acfSSam Leffler LIST_ENTRY(ifvlan) ifv_list; 115a3814acfSSam Leffler }; 116a3814acfSSam Leffler #define ifv_tag ifv_mib.ifvm_tag 117a3814acfSSam Leffler #define ifv_encaplen ifv_mib.ifvm_encaplen 118a3814acfSSam Leffler #define ifv_mtufudge ifv_mib.ifvm_mtufudge 119a3814acfSSam Leffler #define ifv_mintu ifv_mib.ifvm_mintu 120a3814acfSSam Leffler 12175ee267cSGleb Smirnoff /* Special flags we should propagate to parent. */ 1221cf236fbSYaroslav Tykhiy static struct { 1231cf236fbSYaroslav Tykhiy int flag; 1241cf236fbSYaroslav Tykhiy int (*func)(struct ifnet *, int); 1251cf236fbSYaroslav Tykhiy } vlan_pflags[] = { 1261cf236fbSYaroslav Tykhiy {IFF_PROMISC, ifpromisc}, 1271cf236fbSYaroslav Tykhiy {IFF_ALLMULTI, if_allmulti}, 1281cf236fbSYaroslav Tykhiy {0, NULL} 1291cf236fbSYaroslav Tykhiy }; 130a3814acfSSam Leffler 1314a408dcbSBill Paul SYSCTL_DECL(_net_link); 132d2a75853SBill Fenner SYSCTL_NODE(_net_link, IFT_L2VLAN, vlan, CTLFLAG_RW, 0, "IEEE 802.1Q VLAN"); 1332cc2df49SGarrett Wollman SYSCTL_NODE(_net_link_vlan, PF_LINK, link, CTLFLAG_RW, 0, "for consistency"); 1342cc2df49SGarrett Wollman 1355e17543aSBrooks Davis static MALLOC_DEFINE(M_VLAN, VLANNAME, "802.1Q Virtual LAN Interface"); 1362cc2df49SGarrett Wollman 1375cb8c31aSYaroslav Tykhiy static eventhandler_tag ifdetach_tag; 1385cb8c31aSYaroslav Tykhiy 1394faedfe8SSam Leffler /* 14075ee267cSGleb Smirnoff * We have a global mutex, that is used to serialize configuration 14175ee267cSGleb Smirnoff * changes and isn't used in normal packet delivery. 14275ee267cSGleb Smirnoff * 14375ee267cSGleb Smirnoff * We also have a per-trunk rwlock, that is locked shared on packet 14475ee267cSGleb Smirnoff * processing and exclusive when configuration is changed. 14575ee267cSGleb Smirnoff * 14675ee267cSGleb Smirnoff * The VLAN_ARRAY substitutes the dynamic hash with a static array 14775ee267cSGleb Smirnoff * with 4096 entries. In theory this can give a boots in processing, 14875ee267cSGleb Smirnoff * however on practice it does not. Probably this is because array 14975ee267cSGleb Smirnoff * is too big to fit into CPU cache. 1504faedfe8SSam Leffler */ 1514faedfe8SSam Leffler static struct mtx ifv_mtx; 15275ee267cSGleb Smirnoff #define VLAN_LOCK_INIT() mtx_init(&ifv_mtx, "vlan_global", NULL, MTX_DEF) 1534faedfe8SSam Leffler #define VLAN_LOCK_DESTROY() mtx_destroy(&ifv_mtx) 1544faedfe8SSam Leffler #define VLAN_LOCK_ASSERT() mtx_assert(&ifv_mtx, MA_OWNED) 1554faedfe8SSam Leffler #define VLAN_LOCK() mtx_lock(&ifv_mtx) 1564faedfe8SSam Leffler #define VLAN_UNLOCK() mtx_unlock(&ifv_mtx) 15775ee267cSGleb Smirnoff #define TRUNK_LOCK_INIT(trunk) rw_init(&(trunk)->rw, VLANNAME) 15875ee267cSGleb Smirnoff #define TRUNK_LOCK_DESTROY(trunk) rw_destroy(&(trunk)->rw) 15975ee267cSGleb Smirnoff #define TRUNK_LOCK(trunk) rw_wlock(&(trunk)->rw) 16075ee267cSGleb Smirnoff #define TRUNK_UNLOCK(trunk) rw_wunlock(&(trunk)->rw) 16175ee267cSGleb Smirnoff #define TRUNK_LOCK_ASSERT(trunk) rw_assert(&(trunk)->rw, RA_WLOCKED) 16275ee267cSGleb Smirnoff #define TRUNK_RLOCK(trunk) rw_rlock(&(trunk)->rw) 16375ee267cSGleb Smirnoff #define TRUNK_RUNLOCK(trunk) rw_runlock(&(trunk)->rw) 16475ee267cSGleb Smirnoff #define TRUNK_LOCK_RASSERT(trunk) rw_assert(&(trunk)->rw, RA_RLOCKED) 16575ee267cSGleb Smirnoff 16675ee267cSGleb Smirnoff #ifndef VLAN_ARRAY 16775ee267cSGleb Smirnoff static void vlan_inithash(struct ifvlantrunk *trunk); 16875ee267cSGleb Smirnoff static void vlan_freehash(struct ifvlantrunk *trunk); 16975ee267cSGleb Smirnoff static int vlan_inshash(struct ifvlantrunk *trunk, struct ifvlan *ifv); 17075ee267cSGleb Smirnoff static int vlan_remhash(struct ifvlantrunk *trunk, struct ifvlan *ifv); 17175ee267cSGleb Smirnoff static void vlan_growhash(struct ifvlantrunk *trunk, int howmuch); 17275ee267cSGleb Smirnoff static __inline struct ifvlan * vlan_gethash(struct ifvlantrunk *trunk, 17375ee267cSGleb Smirnoff uint16_t tag); 17475ee267cSGleb Smirnoff #endif 17575ee267cSGleb Smirnoff static void trunk_destroy(struct ifvlantrunk *trunk); 1764faedfe8SSam Leffler 1772cc2df49SGarrett Wollman static void vlan_start(struct ifnet *ifp); 178114c608cSYaroslav Tykhiy static void vlan_init(void *foo); 179a3814acfSSam Leffler static void vlan_input(struct ifnet *ifp, struct mbuf *m); 180cfe8b629SGarrett Wollman static int vlan_ioctl(struct ifnet *ifp, u_long cmd, caddr_t addr); 1811cf236fbSYaroslav Tykhiy static int vlan_setflag(struct ifnet *ifp, int flag, int status, 1821cf236fbSYaroslav Tykhiy int (*func)(struct ifnet *, int)); 1831cf236fbSYaroslav Tykhiy static int vlan_setflags(struct ifnet *ifp, int status); 184f731f104SBill Paul static int vlan_setmulti(struct ifnet *ifp); 185f731f104SBill Paul static int vlan_unconfig(struct ifnet *ifp); 1865cb8c31aSYaroslav Tykhiy static int vlan_unconfig_locked(struct ifnet *ifp); 18775ee267cSGleb Smirnoff static int vlan_config(struct ifvlan *ifv, struct ifnet *p, uint16_t tag); 188127d7b2dSAndre Oppermann static void vlan_link_state(struct ifnet *ifp, int link); 18975ee267cSGleb Smirnoff static void vlan_capabilities(struct ifvlan *ifv); 19075ee267cSGleb Smirnoff static void vlan_trunk_capabilities(struct ifnet *ifp); 191f731f104SBill Paul 192f889d2efSBrooks Davis static struct ifnet *vlan_clone_match_ethertag(struct if_clone *, 193f889d2efSBrooks Davis const char *, int *); 194f889d2efSBrooks Davis static int vlan_clone_match(struct if_clone *, const char *); 1956b7330e2SSam Leffler static int vlan_clone_create(struct if_clone *, char *, size_t, caddr_t); 196f889d2efSBrooks Davis static int vlan_clone_destroy(struct if_clone *, struct ifnet *); 197f889d2efSBrooks Davis 1985cb8c31aSYaroslav Tykhiy static void vlan_ifdetach(void *arg, struct ifnet *ifp); 1995cb8c31aSYaroslav Tykhiy 200c6e6ca3eSYaroslav Tykhiy static struct if_clone vlan_cloner = IFC_CLONE_INITIALIZER(VLANNAME, NULL, 201c6e6ca3eSYaroslav Tykhiy IF_MAXUNIT, NULL, vlan_clone_match, vlan_clone_create, vlan_clone_destroy); 2029d4fe4b2SBrooks Davis 20375ee267cSGleb Smirnoff #ifndef VLAN_ARRAY 20475ee267cSGleb Smirnoff #define HASH(n, m) ((((n) >> 8) ^ ((n) >> 4) ^ (n)) & (m)) 205114c608cSYaroslav Tykhiy 20675ee267cSGleb Smirnoff static void 20775ee267cSGleb Smirnoff vlan_inithash(struct ifvlantrunk *trunk) 20875ee267cSGleb Smirnoff { 20975ee267cSGleb Smirnoff int i, n; 21075ee267cSGleb Smirnoff 21175ee267cSGleb Smirnoff /* 21275ee267cSGleb Smirnoff * The trunk must not be locked here since we call malloc(M_WAITOK). 21375ee267cSGleb Smirnoff * It is OK in case this function is called before the trunk struct 21475ee267cSGleb Smirnoff * gets hooked up and becomes visible from other threads. 21575ee267cSGleb Smirnoff */ 21675ee267cSGleb Smirnoff 21775ee267cSGleb Smirnoff KASSERT(trunk->hwidth == 0 && trunk->hash == NULL, 21875ee267cSGleb Smirnoff ("%s: hash already initialized", __func__)); 21975ee267cSGleb Smirnoff 22075ee267cSGleb Smirnoff trunk->hwidth = VLAN_DEF_HWIDTH; 22175ee267cSGleb Smirnoff n = 1 << trunk->hwidth; 22275ee267cSGleb Smirnoff trunk->hmask = n - 1; 22375ee267cSGleb Smirnoff trunk->hash = malloc(sizeof(struct ifvlanhead) * n, M_VLAN, M_WAITOK); 22475ee267cSGleb Smirnoff for (i = 0; i < n; i++) 22575ee267cSGleb Smirnoff LIST_INIT(&trunk->hash[i]); 22675ee267cSGleb Smirnoff } 22775ee267cSGleb Smirnoff 22875ee267cSGleb Smirnoff static void 22975ee267cSGleb Smirnoff vlan_freehash(struct ifvlantrunk *trunk) 23075ee267cSGleb Smirnoff { 23175ee267cSGleb Smirnoff #ifdef INVARIANTS 23275ee267cSGleb Smirnoff int i; 23375ee267cSGleb Smirnoff 23475ee267cSGleb Smirnoff KASSERT(trunk->hwidth > 0, ("%s: hwidth not positive", __func__)); 23575ee267cSGleb Smirnoff for (i = 0; i < (1 << trunk->hwidth); i++) 23675ee267cSGleb Smirnoff KASSERT(LIST_EMPTY(&trunk->hash[i]), 23775ee267cSGleb Smirnoff ("%s: hash table not empty", __func__)); 23875ee267cSGleb Smirnoff #endif 23975ee267cSGleb Smirnoff free(trunk->hash, M_VLAN); 24075ee267cSGleb Smirnoff trunk->hash = NULL; 24175ee267cSGleb Smirnoff trunk->hwidth = trunk->hmask = 0; 24275ee267cSGleb Smirnoff } 24375ee267cSGleb Smirnoff 24475ee267cSGleb Smirnoff static int 24575ee267cSGleb Smirnoff vlan_inshash(struct ifvlantrunk *trunk, struct ifvlan *ifv) 24675ee267cSGleb Smirnoff { 24775ee267cSGleb Smirnoff int i, b; 24875ee267cSGleb Smirnoff struct ifvlan *ifv2; 24975ee267cSGleb Smirnoff 25075ee267cSGleb Smirnoff TRUNK_LOCK_ASSERT(trunk); 25175ee267cSGleb Smirnoff KASSERT(trunk->hwidth > 0, ("%s: hwidth not positive", __func__)); 25275ee267cSGleb Smirnoff 25375ee267cSGleb Smirnoff b = 1 << trunk->hwidth; 25475ee267cSGleb Smirnoff i = HASH(ifv->ifv_tag, trunk->hmask); 25575ee267cSGleb Smirnoff LIST_FOREACH(ifv2, &trunk->hash[i], ifv_list) 25675ee267cSGleb Smirnoff if (ifv->ifv_tag == ifv2->ifv_tag) 25775ee267cSGleb Smirnoff return (EEXIST); 25875ee267cSGleb Smirnoff 25975ee267cSGleb Smirnoff /* 26075ee267cSGleb Smirnoff * Grow the hash when the number of vlans exceeds half of the number of 26175ee267cSGleb Smirnoff * hash buckets squared. This will make the average linked-list length 26275ee267cSGleb Smirnoff * buckets/2. 26375ee267cSGleb Smirnoff */ 26475ee267cSGleb Smirnoff if (trunk->refcnt > (b * b) / 2) { 26575ee267cSGleb Smirnoff vlan_growhash(trunk, 1); 26675ee267cSGleb Smirnoff i = HASH(ifv->ifv_tag, trunk->hmask); 26775ee267cSGleb Smirnoff } 26875ee267cSGleb Smirnoff LIST_INSERT_HEAD(&trunk->hash[i], ifv, ifv_list); 26975ee267cSGleb Smirnoff trunk->refcnt++; 27075ee267cSGleb Smirnoff 27175ee267cSGleb Smirnoff return (0); 27275ee267cSGleb Smirnoff } 27375ee267cSGleb Smirnoff 27475ee267cSGleb Smirnoff static int 27575ee267cSGleb Smirnoff vlan_remhash(struct ifvlantrunk *trunk, struct ifvlan *ifv) 27675ee267cSGleb Smirnoff { 27775ee267cSGleb Smirnoff int i, b; 27875ee267cSGleb Smirnoff struct ifvlan *ifv2; 27975ee267cSGleb Smirnoff 28075ee267cSGleb Smirnoff TRUNK_LOCK_ASSERT(trunk); 28175ee267cSGleb Smirnoff KASSERT(trunk->hwidth > 0, ("%s: hwidth not positive", __func__)); 28275ee267cSGleb Smirnoff 28375ee267cSGleb Smirnoff b = 1 << trunk->hwidth; 28475ee267cSGleb Smirnoff i = HASH(ifv->ifv_tag, trunk->hmask); 28575ee267cSGleb Smirnoff LIST_FOREACH(ifv2, &trunk->hash[i], ifv_list) 28675ee267cSGleb Smirnoff if (ifv2 == ifv) { 28775ee267cSGleb Smirnoff trunk->refcnt--; 28875ee267cSGleb Smirnoff LIST_REMOVE(ifv2, ifv_list); 28975ee267cSGleb Smirnoff if (trunk->refcnt < (b * b) / 2) 29075ee267cSGleb Smirnoff vlan_growhash(trunk, -1); 29175ee267cSGleb Smirnoff return (0); 29275ee267cSGleb Smirnoff } 29375ee267cSGleb Smirnoff 29475ee267cSGleb Smirnoff panic("%s: vlan not found\n", __func__); 29575ee267cSGleb Smirnoff return (ENOENT); /*NOTREACHED*/ 29675ee267cSGleb Smirnoff } 29775ee267cSGleb Smirnoff 29875ee267cSGleb Smirnoff /* 29975ee267cSGleb Smirnoff * Grow the hash larger or smaller if memory permits. 30075ee267cSGleb Smirnoff */ 30175ee267cSGleb Smirnoff static void 30275ee267cSGleb Smirnoff vlan_growhash(struct ifvlantrunk *trunk, int howmuch) 30375ee267cSGleb Smirnoff { 30475ee267cSGleb Smirnoff 30575ee267cSGleb Smirnoff struct ifvlan *ifv; 30675ee267cSGleb Smirnoff struct ifvlanhead *hash2; 30775ee267cSGleb Smirnoff int hwidth2, i, j, n, n2; 30875ee267cSGleb Smirnoff 30975ee267cSGleb Smirnoff TRUNK_LOCK_ASSERT(trunk); 31075ee267cSGleb Smirnoff KASSERT(trunk->hwidth > 0, ("%s: hwidth not positive", __func__)); 31175ee267cSGleb Smirnoff 31275ee267cSGleb Smirnoff if (howmuch == 0) { 31375ee267cSGleb Smirnoff /* Harmless yet obvious coding error */ 31475ee267cSGleb Smirnoff printf("%s: howmuch is 0\n", __func__); 31575ee267cSGleb Smirnoff return; 31675ee267cSGleb Smirnoff } 31775ee267cSGleb Smirnoff 31875ee267cSGleb Smirnoff hwidth2 = trunk->hwidth + howmuch; 31975ee267cSGleb Smirnoff n = 1 << trunk->hwidth; 32075ee267cSGleb Smirnoff n2 = 1 << hwidth2; 32175ee267cSGleb Smirnoff /* Do not shrink the table below the default */ 32275ee267cSGleb Smirnoff if (hwidth2 < VLAN_DEF_HWIDTH) 32375ee267cSGleb Smirnoff return; 32475ee267cSGleb Smirnoff 32575ee267cSGleb Smirnoff /* M_NOWAIT because we're called with trunk mutex held */ 32675ee267cSGleb Smirnoff hash2 = malloc(sizeof(struct ifvlanhead) * n2, M_VLAN, M_NOWAIT); 32775ee267cSGleb Smirnoff if (hash2 == NULL) { 32875ee267cSGleb Smirnoff printf("%s: out of memory -- hash size not changed\n", 32975ee267cSGleb Smirnoff __func__); 33075ee267cSGleb Smirnoff return; /* We can live with the old hash table */ 33175ee267cSGleb Smirnoff } 33275ee267cSGleb Smirnoff for (j = 0; j < n2; j++) 33375ee267cSGleb Smirnoff LIST_INIT(&hash2[j]); 33475ee267cSGleb Smirnoff for (i = 0; i < n; i++) 33575ee267cSGleb Smirnoff while (!LIST_EMPTY(&trunk->hash[i])) { 33675ee267cSGleb Smirnoff ifv = LIST_FIRST(&trunk->hash[i]); 33775ee267cSGleb Smirnoff LIST_REMOVE(ifv, ifv_list); 33875ee267cSGleb Smirnoff j = HASH(ifv->ifv_tag, n2 - 1); 33975ee267cSGleb Smirnoff LIST_INSERT_HEAD(&hash2[j], ifv, ifv_list); 34075ee267cSGleb Smirnoff } 34175ee267cSGleb Smirnoff free(trunk->hash, M_VLAN); 34275ee267cSGleb Smirnoff trunk->hash = hash2; 34375ee267cSGleb Smirnoff trunk->hwidth = hwidth2; 34475ee267cSGleb Smirnoff trunk->hmask = n2 - 1; 34575ee267cSGleb Smirnoff } 34675ee267cSGleb Smirnoff 34775ee267cSGleb Smirnoff static __inline struct ifvlan * 34875ee267cSGleb Smirnoff vlan_gethash(struct ifvlantrunk *trunk, uint16_t tag) 34975ee267cSGleb Smirnoff { 35075ee267cSGleb Smirnoff struct ifvlan *ifv; 35175ee267cSGleb Smirnoff 35275ee267cSGleb Smirnoff TRUNK_LOCK_RASSERT(trunk); 35375ee267cSGleb Smirnoff 35475ee267cSGleb Smirnoff LIST_FOREACH(ifv, &trunk->hash[HASH(tag, trunk->hmask)], ifv_list) 35575ee267cSGleb Smirnoff if (ifv->ifv_tag == tag) 35675ee267cSGleb Smirnoff return (ifv); 35775ee267cSGleb Smirnoff return (NULL); 35875ee267cSGleb Smirnoff } 35975ee267cSGleb Smirnoff 36075ee267cSGleb Smirnoff #if 0 36175ee267cSGleb Smirnoff /* Debugging code to view the hashtables. */ 36275ee267cSGleb Smirnoff static void 36375ee267cSGleb Smirnoff vlan_dumphash(struct ifvlantrunk *trunk) 36475ee267cSGleb Smirnoff { 36575ee267cSGleb Smirnoff int i; 36675ee267cSGleb Smirnoff struct ifvlan *ifv; 36775ee267cSGleb Smirnoff 36875ee267cSGleb Smirnoff for (i = 0; i < (1 << trunk->hwidth); i++) { 36975ee267cSGleb Smirnoff printf("%d: ", i); 37075ee267cSGleb Smirnoff LIST_FOREACH(ifv, &trunk->hash[i], ifv_list) 37175ee267cSGleb Smirnoff printf("%s ", ifv->ifv_ifp->if_xname); 37275ee267cSGleb Smirnoff printf("\n"); 37375ee267cSGleb Smirnoff } 37475ee267cSGleb Smirnoff } 37575ee267cSGleb Smirnoff #endif /* 0 */ 37675ee267cSGleb Smirnoff #endif /* !VLAN_ARRAY */ 37775ee267cSGleb Smirnoff 37875ee267cSGleb Smirnoff static void 37975ee267cSGleb Smirnoff trunk_destroy(struct ifvlantrunk *trunk) 38075ee267cSGleb Smirnoff { 38175ee267cSGleb Smirnoff VLAN_LOCK_ASSERT(); 38275ee267cSGleb Smirnoff 38375ee267cSGleb Smirnoff TRUNK_LOCK(trunk); 38475ee267cSGleb Smirnoff #ifndef VLAN_ARRAY 38575ee267cSGleb Smirnoff vlan_freehash(trunk); 38675ee267cSGleb Smirnoff #endif 38775ee267cSGleb Smirnoff trunk->parent->if_vlantrunk = NULL; 38833499e2aSYaroslav Tykhiy LIST_REMOVE(trunk, trunk_entry); 38933499e2aSYaroslav Tykhiy TRUNK_UNLOCK(trunk); 39033499e2aSYaroslav Tykhiy TRUNK_LOCK_DESTROY(trunk); 39175ee267cSGleb Smirnoff free(trunk, M_VLAN); 39275ee267cSGleb Smirnoff } 39375ee267cSGleb Smirnoff 394f731f104SBill Paul /* 395f731f104SBill Paul * Program our multicast filter. What we're actually doing is 396f731f104SBill Paul * programming the multicast filter of the parent. This has the 397f731f104SBill Paul * side effect of causing the parent interface to receive multicast 398f731f104SBill Paul * traffic that it doesn't really want, which ends up being discarded 399f731f104SBill Paul * later by the upper protocol layers. Unfortunately, there's no way 400f731f104SBill Paul * to avoid this: there really is only one physical interface. 40129c2dfbeSBruce M Simpson * 40229c2dfbeSBruce M Simpson * XXX: There is a possible race here if more than one thread is 40329c2dfbeSBruce M Simpson * modifying the multicast state of the vlan interface at the same time. 404f731f104SBill Paul */ 4052b120974SPeter Wemm static int 4062b120974SPeter Wemm vlan_setmulti(struct ifnet *ifp) 407f731f104SBill Paul { 408f731f104SBill Paul struct ifnet *ifp_p; 409f731f104SBill Paul struct ifmultiaddr *ifma, *rifma = NULL; 410f731f104SBill Paul struct ifvlan *sc; 411f731f104SBill Paul struct vlan_mc_entry *mc = NULL; 412f731f104SBill Paul struct sockaddr_dl sdl; 413f731f104SBill Paul int error; 414f731f104SBill Paul 41529c2dfbeSBruce M Simpson /*VLAN_LOCK_ASSERT();*/ 41629c2dfbeSBruce M Simpson 417f731f104SBill Paul /* Find the parent. */ 418f731f104SBill Paul sc = ifp->if_softc; 41975ee267cSGleb Smirnoff ifp_p = PARENT(sc); 4201b2a4f7aSBill Fenner 42115a66c21SBruce M Simpson bzero((char *)&sdl, sizeof(sdl)); 42215a66c21SBruce M Simpson sdl.sdl_len = sizeof(sdl); 423f731f104SBill Paul sdl.sdl_family = AF_LINK; 42426e30963SBill Fenner sdl.sdl_index = ifp_p->if_index; 42526e30963SBill Fenner sdl.sdl_type = IFT_ETHER; 42624993214SYaroslav Tykhiy sdl.sdl_alen = ETHER_ADDR_LEN; 427f731f104SBill Paul 428f731f104SBill Paul /* First, remove any existing filter entries. */ 42922f29826SPoul-Henning Kamp while (SLIST_FIRST(&sc->vlan_mc_listhead) != NULL) { 43022f29826SPoul-Henning Kamp mc = SLIST_FIRST(&sc->vlan_mc_listhead); 431f731f104SBill Paul bcopy((char *)&mc->mc_addr, LLADDR(&sdl), ETHER_ADDR_LEN); 432f731f104SBill Paul error = if_delmulti(ifp_p, (struct sockaddr *)&sdl); 433f731f104SBill Paul if (error) 434f731f104SBill Paul return (error); 435f731f104SBill Paul SLIST_REMOVE_HEAD(&sc->vlan_mc_listhead, mc_entries); 4369d4fe4b2SBrooks Davis free(mc, M_VLAN); 437f731f104SBill Paul } 438f731f104SBill Paul 439f731f104SBill Paul /* Now program new ones. */ 4406817526dSPoul-Henning Kamp TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 441f731f104SBill Paul if (ifma->ifma_addr->sa_family != AF_LINK) 442f731f104SBill Paul continue; 44329c2dfbeSBruce M Simpson mc = malloc(sizeof(struct vlan_mc_entry), M_VLAN, M_NOWAIT); 44429c2dfbeSBruce M Simpson if (mc == NULL) 44529c2dfbeSBruce M Simpson return (ENOMEM); 446f731f104SBill Paul bcopy(LLADDR((struct sockaddr_dl *)ifma->ifma_addr), 447f731f104SBill Paul (char *)&mc->mc_addr, ETHER_ADDR_LEN); 448f731f104SBill Paul SLIST_INSERT_HEAD(&sc->vlan_mc_listhead, mc, mc_entries); 44926e30963SBill Fenner bcopy(LLADDR((struct sockaddr_dl *)ifma->ifma_addr), 45026e30963SBill Fenner LLADDR(&sdl), ETHER_ADDR_LEN); 451f731f104SBill Paul error = if_addmulti(ifp_p, (struct sockaddr *)&sdl, &rifma); 452f731f104SBill Paul if (error) 453f731f104SBill Paul return (error); 454f731f104SBill Paul } 455f731f104SBill Paul 456f731f104SBill Paul return (0); 457f731f104SBill Paul } 4582cc2df49SGarrett Wollman 459a3814acfSSam Leffler /* 4605cb8c31aSYaroslav Tykhiy * A handler for network interface departure events. 4615cb8c31aSYaroslav Tykhiy * Track departure of trunks here so that we don't access invalid 4625cb8c31aSYaroslav Tykhiy * pointers or whatever if a trunk is ripped from under us, e.g., 4635cb8c31aSYaroslav Tykhiy * by ejecting its hot-plug card. 4645cb8c31aSYaroslav Tykhiy */ 4655cb8c31aSYaroslav Tykhiy static void 4665cb8c31aSYaroslav Tykhiy vlan_ifdetach(void *arg __unused, struct ifnet *ifp) 4675cb8c31aSYaroslav Tykhiy { 4685cb8c31aSYaroslav Tykhiy struct ifvlan *ifv; 4695cb8c31aSYaroslav Tykhiy int i; 4705cb8c31aSYaroslav Tykhiy 4715cb8c31aSYaroslav Tykhiy /* 4725cb8c31aSYaroslav Tykhiy * Check if it's a trunk interface first of all 4735cb8c31aSYaroslav Tykhiy * to avoid needless locking. 4745cb8c31aSYaroslav Tykhiy */ 4755cb8c31aSYaroslav Tykhiy if (ifp->if_vlantrunk == NULL) 4765cb8c31aSYaroslav Tykhiy return; 4775cb8c31aSYaroslav Tykhiy 4785cb8c31aSYaroslav Tykhiy VLAN_LOCK(); 4795cb8c31aSYaroslav Tykhiy /* 4805cb8c31aSYaroslav Tykhiy * OK, it's a trunk. Loop over and detach all vlan's on it. 4815cb8c31aSYaroslav Tykhiy * Check trunk pointer after each vlan_unconfig() as it will 4825cb8c31aSYaroslav Tykhiy * free it and set to NULL after the last vlan was detached. 4835cb8c31aSYaroslav Tykhiy */ 4845cb8c31aSYaroslav Tykhiy #ifdef VLAN_ARRAY 4855cb8c31aSYaroslav Tykhiy for (i = 0; i < VLAN_ARRAY_SIZE; i++) 4865cb8c31aSYaroslav Tykhiy if ((ifv = ifp->if_vlantrunk->vlans[i])) { 4875cb8c31aSYaroslav Tykhiy vlan_unconfig_locked(ifv->ifv_ifp); 4885cb8c31aSYaroslav Tykhiy if (ifp->if_vlantrunk == NULL) 4895cb8c31aSYaroslav Tykhiy break; 4905cb8c31aSYaroslav Tykhiy } 4915cb8c31aSYaroslav Tykhiy #else /* VLAN_ARRAY */ 4925cb8c31aSYaroslav Tykhiy restart: 4935cb8c31aSYaroslav Tykhiy for (i = 0; i < (1 << ifp->if_vlantrunk->hwidth); i++) 4945cb8c31aSYaroslav Tykhiy if ((ifv = LIST_FIRST(&ifp->if_vlantrunk->hash[i]))) { 4955cb8c31aSYaroslav Tykhiy vlan_unconfig_locked(ifv->ifv_ifp); 4965cb8c31aSYaroslav Tykhiy if (ifp->if_vlantrunk) 4975cb8c31aSYaroslav Tykhiy goto restart; /* trunk->hwidth can change */ 4985cb8c31aSYaroslav Tykhiy else 4995cb8c31aSYaroslav Tykhiy break; 5005cb8c31aSYaroslav Tykhiy } 5015cb8c31aSYaroslav Tykhiy #endif /* VLAN_ARRAY */ 5025cb8c31aSYaroslav Tykhiy /* Trunk should have been destroyed in vlan_unconfig(). */ 5035cb8c31aSYaroslav Tykhiy KASSERT(ifp->if_vlantrunk == NULL, ("%s: purge failed", __func__)); 5045cb8c31aSYaroslav Tykhiy VLAN_UNLOCK(); 5055cb8c31aSYaroslav Tykhiy } 5065cb8c31aSYaroslav Tykhiy 5075cb8c31aSYaroslav Tykhiy /* 508a3814acfSSam Leffler * VLAN support can be loaded as a module. The only place in the 509a3814acfSSam Leffler * system that's intimately aware of this is ether_input. We hook 510a3814acfSSam Leffler * into this code through vlan_input_p which is defined there and 511a3814acfSSam Leffler * set here. Noone else in the system should be aware of this so 512a3814acfSSam Leffler * we use an explicit reference here. 513a3814acfSSam Leffler */ 514a3814acfSSam Leffler extern void (*vlan_input_p)(struct ifnet *, struct mbuf *); 515a3814acfSSam Leffler 516984be3efSGleb Smirnoff /* For if_link_state_change() eyes only... */ 517127d7b2dSAndre Oppermann extern void (*vlan_link_state_p)(struct ifnet *, int); 518127d7b2dSAndre Oppermann 5192b120974SPeter Wemm static int 5202b120974SPeter Wemm vlan_modevent(module_t mod, int type, void *data) 5212b120974SPeter Wemm { 5229d4fe4b2SBrooks Davis 5232b120974SPeter Wemm switch (type) { 5242b120974SPeter Wemm case MOD_LOAD: 5255cb8c31aSYaroslav Tykhiy ifdetach_tag = EVENTHANDLER_REGISTER(ifnet_departure_event, 5265cb8c31aSYaroslav Tykhiy vlan_ifdetach, NULL, EVENTHANDLER_PRI_ANY); 5275cb8c31aSYaroslav Tykhiy if (ifdetach_tag == NULL) 5285cb8c31aSYaroslav Tykhiy return (ENOMEM); 52975ee267cSGleb Smirnoff LIST_INIT(&trunk_list); 5304faedfe8SSam Leffler VLAN_LOCK_INIT(); 5319d4fe4b2SBrooks Davis vlan_input_p = vlan_input; 532127d7b2dSAndre Oppermann vlan_link_state_p = vlan_link_state; 53375ee267cSGleb Smirnoff vlan_trunk_cap_p = vlan_trunk_capabilities; 5349d4fe4b2SBrooks Davis if_clone_attach(&vlan_cloner); 5352b120974SPeter Wemm break; 5362b120974SPeter Wemm case MOD_UNLOAD: 53775ee267cSGleb Smirnoff { 53875ee267cSGleb Smirnoff struct ifvlantrunk *trunk, *trunk1; 53975ee267cSGleb Smirnoff 5409d4fe4b2SBrooks Davis if_clone_detach(&vlan_cloner); 5415cb8c31aSYaroslav Tykhiy EVENTHANDLER_DEREGISTER(ifnet_departure_event, ifdetach_tag); 5429d4fe4b2SBrooks Davis vlan_input_p = NULL; 543127d7b2dSAndre Oppermann vlan_link_state_p = NULL; 54475ee267cSGleb Smirnoff vlan_trunk_cap_p = NULL; 54575ee267cSGleb Smirnoff VLAN_LOCK(); 54675ee267cSGleb Smirnoff LIST_FOREACH_SAFE(trunk, &trunk_list, trunk_entry, trunk1) 54775ee267cSGleb Smirnoff trunk_destroy(trunk); 54875ee267cSGleb Smirnoff VLAN_UNLOCK(); 5494faedfe8SSam Leffler VLAN_LOCK_DESTROY(); 5509d4fe4b2SBrooks Davis break; 55175ee267cSGleb Smirnoff } 5523e019deaSPoul-Henning Kamp default: 5533e019deaSPoul-Henning Kamp return (EOPNOTSUPP); 5542b120974SPeter Wemm } 55515a66c21SBruce M Simpson return (0); 5562b120974SPeter Wemm } 5572b120974SPeter Wemm 5582b120974SPeter Wemm static moduledata_t vlan_mod = { 5592b120974SPeter Wemm "if_vlan", 5602b120974SPeter Wemm vlan_modevent, 5612b120974SPeter Wemm 0 5622b120974SPeter Wemm }; 5632b120974SPeter Wemm 5642b120974SPeter Wemm DECLARE_MODULE(if_vlan, vlan_mod, SI_SUB_PSEUDO, SI_ORDER_ANY); 56511edc477SEd Maste MODULE_VERSION(if_vlan, 3); 566d35bcd3bSRuslan Ermilov MODULE_DEPEND(if_vlan, miibus, 1, 1, 1); 5672cc2df49SGarrett Wollman 568f889d2efSBrooks Davis static struct ifnet * 569f889d2efSBrooks Davis vlan_clone_match_ethertag(struct if_clone *ifc, const char *name, int *tag) 5709d4fe4b2SBrooks Davis { 571f889d2efSBrooks Davis const char *cp; 572f889d2efSBrooks Davis struct ifnet *ifp; 57315a66c21SBruce M Simpson int t = 0; 574f889d2efSBrooks Davis 575f889d2efSBrooks Davis /* Check for <etherif>.<vlan> style interface names. */ 576f889d2efSBrooks Davis IFNET_RLOCK(); 577f889d2efSBrooks Davis TAILQ_FOREACH(ifp, &ifnet, if_link) { 578f889d2efSBrooks Davis if (ifp->if_type != IFT_ETHER) 579f889d2efSBrooks Davis continue; 580f889d2efSBrooks Davis if (strncmp(ifp->if_xname, name, strlen(ifp->if_xname)) != 0) 581f889d2efSBrooks Davis continue; 582f889d2efSBrooks Davis cp = name + strlen(ifp->if_xname); 583f889d2efSBrooks Davis if (*cp != '.') 584f889d2efSBrooks Davis continue; 585f889d2efSBrooks Davis for(; *cp != '\0'; cp++) { 586f889d2efSBrooks Davis if (*cp < '0' || *cp > '9') 587f889d2efSBrooks Davis continue; 588f889d2efSBrooks Davis t = (t * 10) + (*cp - '0'); 589f889d2efSBrooks Davis } 590f889d2efSBrooks Davis if (tag != NULL) 591f889d2efSBrooks Davis *tag = t; 592f889d2efSBrooks Davis break; 593f889d2efSBrooks Davis } 594f889d2efSBrooks Davis IFNET_RUNLOCK(); 595f889d2efSBrooks Davis 59615a66c21SBruce M Simpson return (ifp); 597f889d2efSBrooks Davis } 598f889d2efSBrooks Davis 599f889d2efSBrooks Davis static int 600f889d2efSBrooks Davis vlan_clone_match(struct if_clone *ifc, const char *name) 601f889d2efSBrooks Davis { 602f889d2efSBrooks Davis const char *cp; 603f889d2efSBrooks Davis 604f889d2efSBrooks Davis if (vlan_clone_match_ethertag(ifc, name, NULL) != NULL) 605f889d2efSBrooks Davis return (1); 606f889d2efSBrooks Davis 607f889d2efSBrooks Davis if (strncmp(VLANNAME, name, strlen(VLANNAME)) != 0) 608f889d2efSBrooks Davis return (0); 609f889d2efSBrooks Davis for (cp = name + 4; *cp != '\0'; cp++) { 610f889d2efSBrooks Davis if (*cp < '0' || *cp > '9') 611f889d2efSBrooks Davis return (0); 612f889d2efSBrooks Davis } 613f889d2efSBrooks Davis 614f889d2efSBrooks Davis return (1); 615f889d2efSBrooks Davis } 616f889d2efSBrooks Davis 617f889d2efSBrooks Davis static int 6186b7330e2SSam Leffler vlan_clone_create(struct if_clone *ifc, char *name, size_t len, caddr_t params) 619f889d2efSBrooks Davis { 620f889d2efSBrooks Davis char *dp; 621f889d2efSBrooks Davis int wildcard; 622f889d2efSBrooks Davis int unit; 623f889d2efSBrooks Davis int error; 624f889d2efSBrooks Davis int tag; 625f889d2efSBrooks Davis int ethertag; 6269d4fe4b2SBrooks Davis struct ifvlan *ifv; 6279d4fe4b2SBrooks Davis struct ifnet *ifp; 628f889d2efSBrooks Davis struct ifnet *p; 6296b7330e2SSam Leffler struct vlanreq vlr; 630114c608cSYaroslav Tykhiy static const u_char eaddr[6]; /* 00:00:00:00:00:00 */ 631f889d2efSBrooks Davis 6326b7330e2SSam Leffler /* 6336b7330e2SSam Leffler * There are 3 (ugh) ways to specify the cloned device: 6346b7330e2SSam Leffler * o pass a parameter block with the clone request. 6356b7330e2SSam Leffler * o specify parameters in the text of the clone device name 6366b7330e2SSam Leffler * o specify no parameters and get an unattached device that 6376b7330e2SSam Leffler * must be configured separately. 6386b7330e2SSam Leffler * The first technique is preferred; the latter two are 6396b7330e2SSam Leffler * supported for backwards compatibilty. 6406b7330e2SSam Leffler */ 6416b7330e2SSam Leffler if (params) { 6426b7330e2SSam Leffler error = copyin(params, &vlr, sizeof(vlr)); 6436b7330e2SSam Leffler if (error) 6446b7330e2SSam Leffler return error; 6456b7330e2SSam Leffler p = ifunit(vlr.vlr_parent); 6466b7330e2SSam Leffler if (p == NULL) 6476b7330e2SSam Leffler return ENXIO; 6486b7330e2SSam Leffler /* 6496b7330e2SSam Leffler * Don't let the caller set up a VLAN tag with 6506b7330e2SSam Leffler * anything except VLID bits. 6516b7330e2SSam Leffler */ 6526b7330e2SSam Leffler if (vlr.vlr_tag & ~EVL_VLID_MASK) 6536b7330e2SSam Leffler return (EINVAL); 6546b7330e2SSam Leffler error = ifc_name2unit(name, &unit); 6556b7330e2SSam Leffler if (error != 0) 6566b7330e2SSam Leffler return (error); 6576b7330e2SSam Leffler 6586b7330e2SSam Leffler ethertag = 1; 6596b7330e2SSam Leffler tag = vlr.vlr_tag; 6606b7330e2SSam Leffler wildcard = (unit < 0); 6616b7330e2SSam Leffler } else if ((p = vlan_clone_match_ethertag(ifc, name, &tag)) != NULL) { 662f889d2efSBrooks Davis ethertag = 1; 663f889d2efSBrooks Davis unit = -1; 664f889d2efSBrooks Davis wildcard = 0; 665f889d2efSBrooks Davis 666f889d2efSBrooks Davis /* 667f889d2efSBrooks Davis * Don't let the caller set up a VLAN tag with 668f889d2efSBrooks Davis * anything except VLID bits. 669f889d2efSBrooks Davis */ 67015a66c21SBruce M Simpson if (tag & ~EVL_VLID_MASK) 671f889d2efSBrooks Davis return (EINVAL); 672f889d2efSBrooks Davis } else { 673f889d2efSBrooks Davis ethertag = 0; 674f889d2efSBrooks Davis 675f889d2efSBrooks Davis error = ifc_name2unit(name, &unit); 676f889d2efSBrooks Davis if (error != 0) 677f889d2efSBrooks Davis return (error); 678f889d2efSBrooks Davis 679f889d2efSBrooks Davis wildcard = (unit < 0); 680f889d2efSBrooks Davis } 681f889d2efSBrooks Davis 682f889d2efSBrooks Davis error = ifc_alloc_unit(ifc, &unit); 683f889d2efSBrooks Davis if (error != 0) 684f889d2efSBrooks Davis return (error); 685f889d2efSBrooks Davis 686f889d2efSBrooks Davis /* In the wildcard case, we need to update the name. */ 687f889d2efSBrooks Davis if (wildcard) { 688f889d2efSBrooks Davis for (dp = name; *dp != '\0'; dp++); 689f889d2efSBrooks Davis if (snprintf(dp, len - (dp-name), "%d", unit) > 690f889d2efSBrooks Davis len - (dp-name) - 1) { 691f889d2efSBrooks Davis panic("%s: interface name too long", __func__); 692f889d2efSBrooks Davis } 693f889d2efSBrooks Davis } 6949d4fe4b2SBrooks Davis 695a163d034SWarner Losh ifv = malloc(sizeof(struct ifvlan), M_VLAN, M_WAITOK | M_ZERO); 696fc74a9f9SBrooks Davis ifp = ifv->ifv_ifp = if_alloc(IFT_ETHER); 697fc74a9f9SBrooks Davis if (ifp == NULL) { 698fc74a9f9SBrooks Davis ifc_free_unit(ifc, unit); 699fc74a9f9SBrooks Davis free(ifv, M_VLAN); 700fc74a9f9SBrooks Davis return (ENOSPC); 701fc74a9f9SBrooks Davis } 7029d4fe4b2SBrooks Davis SLIST_INIT(&ifv->vlan_mc_listhead); 7039d4fe4b2SBrooks Davis 7049d4fe4b2SBrooks Davis ifp->if_softc = ifv; 705f889d2efSBrooks Davis /* 706cab574d8SYaroslav Tykhiy * Set the name manually rather than using if_initname because 707f889d2efSBrooks Davis * we don't conform to the default naming convention for interfaces. 708f889d2efSBrooks Davis */ 709f889d2efSBrooks Davis strlcpy(ifp->if_xname, name, IFNAMSIZ); 710f889d2efSBrooks Davis ifp->if_dname = ifc->ifc_name; 711f889d2efSBrooks Davis ifp->if_dunit = unit; 7129d4fe4b2SBrooks Davis /* NB: flags are not set here */ 7139d4fe4b2SBrooks Davis ifp->if_linkmib = &ifv->ifv_mib; 71415a66c21SBruce M Simpson ifp->if_linkmiblen = sizeof(ifv->ifv_mib); 7159d4fe4b2SBrooks Davis /* NB: mtu is not set here */ 7169d4fe4b2SBrooks Davis 717114c608cSYaroslav Tykhiy ifp->if_init = vlan_init; 7189d4fe4b2SBrooks Davis ifp->if_start = vlan_start; 7199d4fe4b2SBrooks Davis ifp->if_ioctl = vlan_ioctl; 7209d4fe4b2SBrooks Davis ifp->if_snd.ifq_maxlen = ifqmaxlen; 72164a17d2eSYaroslav Tykhiy ifp->if_flags = VLAN_IFFLAGS; 722fc74a9f9SBrooks Davis ether_ifattach(ifp, eaddr); 7239d4fe4b2SBrooks Davis /* Now undo some of the damage... */ 724211f625aSBill Fenner ifp->if_baudrate = 0; 725a3814acfSSam Leffler ifp->if_type = IFT_L2VLAN; 726a3814acfSSam Leffler ifp->if_hdrlen = ETHER_VLAN_ENCAP_LEN; 7279d4fe4b2SBrooks Davis 728f889d2efSBrooks Davis if (ethertag) { 72975ee267cSGleb Smirnoff error = vlan_config(ifv, p, tag); 730f889d2efSBrooks Davis if (error != 0) { 731f889d2efSBrooks Davis /* 732f889d2efSBrooks Davis * Since we've partialy failed, we need to back 733f889d2efSBrooks Davis * out all the way, otherwise userland could get 734f889d2efSBrooks Davis * confused. Thus, we destroy the interface. 735f889d2efSBrooks Davis */ 736f889d2efSBrooks Davis ether_ifdetach(ifp); 737249f4297SYaroslav Tykhiy vlan_unconfig(ifp); 738fc74a9f9SBrooks Davis if_free_type(ifp, IFT_ETHER); 739f889d2efSBrooks Davis free(ifv, M_VLAN); 740f889d2efSBrooks Davis 741f889d2efSBrooks Davis return (error); 742f889d2efSBrooks Davis } 74313f4c340SRobert Watson ifp->if_drv_flags |= IFF_DRV_RUNNING; 744f889d2efSBrooks Davis 7451cf236fbSYaroslav Tykhiy /* Update flags on the parent, if necessary. */ 7461cf236fbSYaroslav Tykhiy vlan_setflags(ifp, 1); 747f889d2efSBrooks Davis } 748f889d2efSBrooks Davis 7499d4fe4b2SBrooks Davis return (0); 7509d4fe4b2SBrooks Davis } 7519d4fe4b2SBrooks Davis 752f889d2efSBrooks Davis static int 753f889d2efSBrooks Davis vlan_clone_destroy(struct if_clone *ifc, struct ifnet *ifp) 7549d4fe4b2SBrooks Davis { 7559d4fe4b2SBrooks Davis struct ifvlan *ifv = ifp->if_softc; 756114c608cSYaroslav Tykhiy int unit = ifp->if_dunit; 757b4e9f837SBrooks Davis 758249f4297SYaroslav Tykhiy ether_ifdetach(ifp); /* first, remove it from system-wide lists */ 759249f4297SYaroslav Tykhiy vlan_unconfig(ifp); /* now it can be unconfigured and freed */ 760f3447eb4SBrooks Davis if_free_type(ifp, IFT_ETHER); 7619d4fe4b2SBrooks Davis free(ifv, M_VLAN); 762b4e9f837SBrooks Davis ifc_free_unit(ifc, unit); 763b4e9f837SBrooks Davis 764f889d2efSBrooks Davis return (0); 7659d4fe4b2SBrooks Davis } 7669d4fe4b2SBrooks Davis 76715a66c21SBruce M Simpson /* 76815a66c21SBruce M Simpson * The ifp->if_init entry point for vlan(4) is a no-op. 76915a66c21SBruce M Simpson */ 7702cc2df49SGarrett Wollman static void 771114c608cSYaroslav Tykhiy vlan_init(void *foo __unused) 7722cc2df49SGarrett Wollman { 7732cc2df49SGarrett Wollman } 7742cc2df49SGarrett Wollman 7756d3a3ab7SGleb Smirnoff /* 7766d3a3ab7SGleb Smirnoff * The if_start method for vlan(4) interface. It doesn't 7776d3a3ab7SGleb Smirnoff * raises the IFF_DRV_OACTIVE flag, since it is called 7786d3a3ab7SGleb Smirnoff * only from IFQ_HANDOFF() macro in ether_output_frame(). 7796d3a3ab7SGleb Smirnoff * If the interface queue is full, and vlan_start() is 7806d3a3ab7SGleb Smirnoff * not called, the queue would never get emptied and 7816d3a3ab7SGleb Smirnoff * interface would stall forever. 7826d3a3ab7SGleb Smirnoff */ 7832cc2df49SGarrett Wollman static void 7842cc2df49SGarrett Wollman vlan_start(struct ifnet *ifp) 7852cc2df49SGarrett Wollman { 7862cc2df49SGarrett Wollman struct ifvlan *ifv; 7872cc2df49SGarrett Wollman struct ifnet *p; 7885326b23cSMatthew N. Dodd struct mbuf *m; 789affc907dSMax Laier int error; 7902cc2df49SGarrett Wollman 7912cc2df49SGarrett Wollman ifv = ifp->if_softc; 79275ee267cSGleb Smirnoff p = PARENT(ifv); 7932cc2df49SGarrett Wollman 7942cc2df49SGarrett Wollman for (;;) { 7952cc2df49SGarrett Wollman IF_DEQUEUE(&ifp->if_snd, m); 7962cc2df49SGarrett Wollman if (m == 0) 7972cc2df49SGarrett Wollman break; 798a3814acfSSam Leffler BPF_MTAP(ifp, m); 7992cc2df49SGarrett Wollman 800f731f104SBill Paul /* 80124993214SYaroslav Tykhiy * Do not run parent's if_start() if the parent is not up, 80224993214SYaroslav Tykhiy * or parent's driver will cause a system crash. 80324993214SYaroslav Tykhiy */ 80413f4c340SRobert Watson if (!((p->if_flags & IFF_UP) && 80513f4c340SRobert Watson (p->if_drv_flags & IFF_DRV_RUNNING))) { 80624993214SYaroslav Tykhiy m_freem(m); 807a3814acfSSam Leffler ifp->if_collisions++; 80824993214SYaroslav Tykhiy continue; 80924993214SYaroslav Tykhiy } 81024993214SYaroslav Tykhiy 81124993214SYaroslav Tykhiy /* 812a3814acfSSam Leffler * If underlying interface can do VLAN tag insertion itself, 813a3814acfSSam Leffler * just pass the packet along. However, we need some way to 814a3814acfSSam Leffler * tell the interface where the packet came from so that it 815a3814acfSSam Leffler * knows how to find the VLAN tag to use, so we attach a 816a3814acfSSam Leffler * packet tag that holds it. 817f731f104SBill Paul */ 818b08347a0SYaroslav Tykhiy if (p->if_capenable & IFCAP_VLAN_HWTAGGING) { 81975ee267cSGleb Smirnoff struct m_tag *mtag = (struct m_tag *) 82075ee267cSGleb Smirnoff uma_zalloc(zone_mtag_vlan, M_NOWAIT); 821a3814acfSSam Leffler if (mtag == NULL) { 822a3814acfSSam Leffler ifp->if_oerrors++; 823a3814acfSSam Leffler m_freem(m); 824a3814acfSSam Leffler continue; 825a3814acfSSam Leffler } 826eefbcf0eSYaroslav Tykhiy VLAN_TAG_VALUE(mtag) = ifv->ifv_tag; 827a3814acfSSam Leffler m_tag_prepend(m, mtag); 828ba26134bSGleb Smirnoff m->m_flags |= M_VLANTAG; 829f731f104SBill Paul } else { 83075ee267cSGleb Smirnoff struct ether_vlan_header *evl; 83175ee267cSGleb Smirnoff 832a163d034SWarner Losh M_PREPEND(m, ifv->ifv_encaplen, M_DONTWAIT); 8334af90a4dSMatthew N. Dodd if (m == NULL) { 8346cbd3e99SYaroslav Tykhiy if_printf(ifp, 8356cbd3e99SYaroslav Tykhiy "unable to prepend VLAN header\n"); 83626f9b263SRuslan Ermilov ifp->if_oerrors++; 8372cc2df49SGarrett Wollman continue; 8384af90a4dSMatthew N. Dodd } 8392cc2df49SGarrett Wollman /* M_PREPEND takes care of m_len, m_pkthdr.len for us */ 8402cc2df49SGarrett Wollman 841a3814acfSSam Leffler if (m->m_len < sizeof(*evl)) { 842a3814acfSSam Leffler m = m_pullup(m, sizeof(*evl)); 8435326b23cSMatthew N. Dodd if (m == NULL) { 844a3814acfSSam Leffler if_printf(ifp, 8456cbd3e99SYaroslav Tykhiy "cannot pullup VLAN header\n"); 84626f9b263SRuslan Ermilov ifp->if_oerrors++; 8474af90a4dSMatthew N. Dodd continue; 8484af90a4dSMatthew N. Dodd } 849a3814acfSSam Leffler } 8504af90a4dSMatthew N. Dodd 8512cc2df49SGarrett Wollman /* 8522cc2df49SGarrett Wollman * Transform the Ethernet header into an Ethernet header 8532cc2df49SGarrett Wollman * with 802.1Q encapsulation. 8542cc2df49SGarrett Wollman */ 855a3814acfSSam Leffler bcopy(mtod(m, char *) + ifv->ifv_encaplen, 856797f247bSMatthew N. Dodd mtod(m, char *), ETHER_HDR_LEN); 8572cc2df49SGarrett Wollman evl = mtod(m, struct ether_vlan_header *); 8582cc2df49SGarrett Wollman evl->evl_proto = evl->evl_encap_proto; 8599d4fe4b2SBrooks Davis evl->evl_encap_proto = htons(ETHERTYPE_VLAN); 8602cc2df49SGarrett Wollman evl->evl_tag = htons(ifv->ifv_tag); 861f731f104SBill Paul #ifdef DEBUG 86283908c65SRuslan Ermilov printf("%s: %*D\n", __func__, (int)sizeof(*evl), 86383908c65SRuslan Ermilov (unsigned char *)evl, ":"); 864f731f104SBill Paul #endif 865f731f104SBill Paul } 8662cc2df49SGarrett Wollman 8672cc2df49SGarrett Wollman /* 8682cc2df49SGarrett Wollman * Send it, precisely as ether_output() would have. 8692cc2df49SGarrett Wollman * We are already running at splimp. 8702cc2df49SGarrett Wollman */ 871affc907dSMax Laier IFQ_HANDOFF(p, m, error); 872affc907dSMax Laier if (!error) 873f731f104SBill Paul ifp->if_opackets++; 874df5e1987SJonathan Lemon else 875df5e1987SJonathan Lemon ifp->if_oerrors++; 8762cc2df49SGarrett Wollman } 877f731f104SBill Paul } 878f731f104SBill Paul 879a3814acfSSam Leffler static void 880a3814acfSSam Leffler vlan_input(struct ifnet *ifp, struct mbuf *m) 881f731f104SBill Paul { 88275ee267cSGleb Smirnoff struct ifvlantrunk *trunk = ifp->if_vlantrunk; 883f731f104SBill Paul struct ifvlan *ifv; 884a3814acfSSam Leffler struct m_tag *mtag; 88575ee267cSGleb Smirnoff uint16_t tag; 88675ee267cSGleb Smirnoff 88775ee267cSGleb Smirnoff KASSERT(trunk != NULL, ("%s: no trunk", __func__)); 888a3814acfSSam Leffler 889f4ec4126SYaroslav Tykhiy if (m->m_flags & M_VLANTAG) { 890a3814acfSSam Leffler /* 89114e98256SYaroslav Tykhiy * Packet is tagged, but m contains a normal 892a3814acfSSam Leffler * Ethernet frame; the tag is stored out-of-band. 893a3814acfSSam Leffler */ 894f4ec4126SYaroslav Tykhiy mtag = m_tag_locate(m, MTAG_VLAN, MTAG_VLAN_TAG, NULL); 895f4ec4126SYaroslav Tykhiy KASSERT(mtag != NULL, 896f4ec4126SYaroslav Tykhiy ("%s: M_VLANTAG without m_tag", __func__)); 89726f9b263SRuslan Ermilov tag = EVL_VLANOFTAG(VLAN_TAG_VALUE(mtag)); 898a3814acfSSam Leffler m_tag_delete(m, mtag); 8996ee20ab5SRuslan Ermilov m->m_flags &= ~M_VLANTAG; 900a3814acfSSam Leffler } else { 90175ee267cSGleb Smirnoff struct ether_vlan_header *evl; 90275ee267cSGleb Smirnoff 90314e98256SYaroslav Tykhiy /* 90414e98256SYaroslav Tykhiy * Packet is tagged in-band as specified by 802.1q. 90514e98256SYaroslav Tykhiy */ 906f4ec4126SYaroslav Tykhiy mtag = NULL; 907a3814acfSSam Leffler switch (ifp->if_type) { 908a3814acfSSam Leffler case IFT_ETHER: 909a3814acfSSam Leffler if (m->m_len < sizeof(*evl) && 910a3814acfSSam Leffler (m = m_pullup(m, sizeof(*evl))) == NULL) { 911a3814acfSSam Leffler if_printf(ifp, "cannot pullup VLAN header\n"); 912a3814acfSSam Leffler return; 913a3814acfSSam Leffler } 914a3814acfSSam Leffler evl = mtod(m, struct ether_vlan_header *); 915a3814acfSSam Leffler KASSERT(ntohs(evl->evl_encap_proto) == ETHERTYPE_VLAN, 916ffdd61c3SYaroslav Tykhiy ("%s: bad encapsulation protocol (%u)", 917ffdd61c3SYaroslav Tykhiy __func__, ntohs(evl->evl_encap_proto))); 918a3814acfSSam Leffler 919fb88a3e0SBill Paul tag = EVL_VLANOFTAG(ntohs(evl->evl_tag)); 920db8b5973SYaroslav Tykhiy 921db8b5973SYaroslav Tykhiy /* 922db8b5973SYaroslav Tykhiy * Restore the original ethertype. We'll remove 923db8b5973SYaroslav Tykhiy * the encapsulation after we've found the vlan 924db8b5973SYaroslav Tykhiy * interface corresponding to the tag. 925db8b5973SYaroslav Tykhiy */ 926db8b5973SYaroslav Tykhiy evl->evl_encap_proto = evl->evl_proto; 927a3814acfSSam Leffler break; 928a3814acfSSam Leffler default: 929db8b5973SYaroslav Tykhiy tag = (uint16_t) -1; 930db8b5973SYaroslav Tykhiy #ifdef INVARIANTS 931db8b5973SYaroslav Tykhiy panic("%s: unsupported if_type (%u)", 932db8b5973SYaroslav Tykhiy __func__, ifp->if_type); 933a3814acfSSam Leffler #endif 934db8b5973SYaroslav Tykhiy break; 935a3814acfSSam Leffler } 9367a46ec8fSBrooks Davis } 9377a46ec8fSBrooks Davis 93815ed2fa1SYaroslav Tykhiy TRUNK_RLOCK(trunk); 93975ee267cSGleb Smirnoff #ifdef VLAN_ARRAY 94075ee267cSGleb Smirnoff ifv = trunk->vlans[tag]; 94175ee267cSGleb Smirnoff #else 94275ee267cSGleb Smirnoff ifv = vlan_gethash(trunk, tag); 94315ed2fa1SYaroslav Tykhiy #endif 94475ee267cSGleb Smirnoff if (ifv == NULL || (ifv->ifv_ifp->if_flags & IFF_UP) == 0) { 94575ee267cSGleb Smirnoff TRUNK_RUNLOCK(trunk); 94675ee267cSGleb Smirnoff m_freem(m); 94775ee267cSGleb Smirnoff ifp->if_noproto++; 94875ee267cSGleb Smirnoff return; 94975ee267cSGleb Smirnoff } 95075ee267cSGleb Smirnoff TRUNK_RUNLOCK(trunk); 951f731f104SBill Paul 952a3814acfSSam Leffler if (mtag == NULL) { 953f731f104SBill Paul /* 954a3814acfSSam Leffler * Packet had an in-line encapsulation header; 955db8b5973SYaroslav Tykhiy * remove it. The original header has already 956db8b5973SYaroslav Tykhiy * been fixed up above. 957f731f104SBill Paul */ 958a3814acfSSam Leffler bcopy(mtod(m, caddr_t), 959a3814acfSSam Leffler mtod(m, caddr_t) + ETHER_VLAN_ENCAP_LEN, 960db8b5973SYaroslav Tykhiy ETHER_HDR_LEN); 961a3814acfSSam Leffler m_adj(m, ETHER_VLAN_ENCAP_LEN); 962a3814acfSSam Leffler } 963a3814acfSSam Leffler 964fc74a9f9SBrooks Davis m->m_pkthdr.rcvif = ifv->ifv_ifp; 965fc74a9f9SBrooks Davis ifv->ifv_ifp->if_ipackets++; 9662cc2df49SGarrett Wollman 967a3814acfSSam Leffler /* Pass it back through the parent's input routine. */ 968fc74a9f9SBrooks Davis (*ifp->if_input)(ifv->ifv_ifp, m); 9692cc2df49SGarrett Wollman } 9702cc2df49SGarrett Wollman 9712cc2df49SGarrett Wollman static int 97275ee267cSGleb Smirnoff vlan_config(struct ifvlan *ifv, struct ifnet *p, uint16_t tag) 9732cc2df49SGarrett Wollman { 97475ee267cSGleb Smirnoff struct ifvlantrunk *trunk; 9751cf236fbSYaroslav Tykhiy struct ifnet *ifp; 97675ee267cSGleb Smirnoff int error = 0; 9772cc2df49SGarrett Wollman 97875ee267cSGleb Smirnoff /* VID numbers 0x0 and 0xFFF are reserved */ 97975ee267cSGleb Smirnoff if (tag == 0 || tag == 0xFFF) 98075ee267cSGleb Smirnoff return (EINVAL); 9811cf236fbSYaroslav Tykhiy if (p->if_type != IFT_ETHER) 98215a66c21SBruce M Simpson return (EPROTONOSUPPORT); 98364a17d2eSYaroslav Tykhiy if ((p->if_flags & VLAN_IFFLAGS) != VLAN_IFFLAGS) 98464a17d2eSYaroslav Tykhiy return (EPROTONOSUPPORT); 98575ee267cSGleb Smirnoff if (ifv->ifv_trunk) 98615a66c21SBruce M Simpson return (EBUSY); 9872cc2df49SGarrett Wollman 98875ee267cSGleb Smirnoff if (p->if_vlantrunk == NULL) { 98975ee267cSGleb Smirnoff trunk = malloc(sizeof(struct ifvlantrunk), 99075ee267cSGleb Smirnoff M_VLAN, M_WAITOK | M_ZERO); 99175ee267cSGleb Smirnoff #ifndef VLAN_ARRAY 99275ee267cSGleb Smirnoff vlan_inithash(trunk); 99375ee267cSGleb Smirnoff #endif 99405a2398fSGleb Smirnoff VLAN_LOCK(); 99505a2398fSGleb Smirnoff if (p->if_vlantrunk != NULL) { 99605a2398fSGleb Smirnoff /* A race that that is very unlikely to be hit. */ 99705a2398fSGleb Smirnoff #ifndef VLAN_ARRAY 99805a2398fSGleb Smirnoff vlan_freehash(trunk); 99905a2398fSGleb Smirnoff #endif 100005a2398fSGleb Smirnoff free(trunk, M_VLAN); 100105a2398fSGleb Smirnoff goto exists; 100205a2398fSGleb Smirnoff } 100375ee267cSGleb Smirnoff TRUNK_LOCK_INIT(trunk); 100475ee267cSGleb Smirnoff LIST_INSERT_HEAD(&trunk_list, trunk, trunk_entry); 100575ee267cSGleb Smirnoff TRUNK_LOCK(trunk); 100675ee267cSGleb Smirnoff p->if_vlantrunk = trunk; 100775ee267cSGleb Smirnoff trunk->parent = p; 100875ee267cSGleb Smirnoff } else { 100975ee267cSGleb Smirnoff VLAN_LOCK(); 101075ee267cSGleb Smirnoff exists: 101175ee267cSGleb Smirnoff trunk = p->if_vlantrunk; 101275ee267cSGleb Smirnoff TRUNK_LOCK(trunk); 101375ee267cSGleb Smirnoff } 101475ee267cSGleb Smirnoff 101515ed2fa1SYaroslav Tykhiy ifv->ifv_tag = tag; /* must set this before vlan_inshash() */ 101675ee267cSGleb Smirnoff #ifdef VLAN_ARRAY 101715ed2fa1SYaroslav Tykhiy if (trunk->vlans[tag] != NULL) { 101875ee267cSGleb Smirnoff error = EEXIST; 101915ed2fa1SYaroslav Tykhiy goto done; 102015ed2fa1SYaroslav Tykhiy } 102115ed2fa1SYaroslav Tykhiy trunk->vlans[tag] = ifv; 102215ed2fa1SYaroslav Tykhiy trunk->refcnt++; 102375ee267cSGleb Smirnoff #else 102475ee267cSGleb Smirnoff error = vlan_inshash(trunk, ifv); 102575ee267cSGleb Smirnoff if (error) 102675ee267cSGleb Smirnoff goto done; 102715ed2fa1SYaroslav Tykhiy #endif 1028a3814acfSSam Leffler ifv->ifv_encaplen = ETHER_VLAN_ENCAP_LEN; 1029a3814acfSSam Leffler ifv->ifv_mintu = ETHERMIN; 10301cf236fbSYaroslav Tykhiy ifv->ifv_pflags = 0; 1031a3814acfSSam Leffler 1032a3814acfSSam Leffler /* 1033a3814acfSSam Leffler * If the parent supports the VLAN_MTU capability, 1034a3814acfSSam Leffler * i.e. can Tx/Rx larger than ETHER_MAX_LEN frames, 1035656acce4SYaroslav Tykhiy * use it. 1036a3814acfSSam Leffler */ 1037656acce4SYaroslav Tykhiy if (p->if_capenable & IFCAP_VLAN_MTU) { 1038656acce4SYaroslav Tykhiy /* 1039656acce4SYaroslav Tykhiy * No need to fudge the MTU since the parent can 1040656acce4SYaroslav Tykhiy * handle extended frames. 1041656acce4SYaroslav Tykhiy */ 1042a3814acfSSam Leffler ifv->ifv_mtufudge = 0; 1043656acce4SYaroslav Tykhiy } else { 1044a3814acfSSam Leffler /* 1045a3814acfSSam Leffler * Fudge the MTU by the encapsulation size. This 1046a3814acfSSam Leffler * makes us incompatible with strictly compliant 1047a3814acfSSam Leffler * 802.1Q implementations, but allows us to use 1048a3814acfSSam Leffler * the feature with other NetBSD implementations, 1049a3814acfSSam Leffler * which might still be useful. 1050a3814acfSSam Leffler */ 1051a3814acfSSam Leffler ifv->ifv_mtufudge = ifv->ifv_encaplen; 1052a3814acfSSam Leffler } 1053a3814acfSSam Leffler 105475ee267cSGleb Smirnoff ifv->ifv_trunk = trunk; 10551cf236fbSYaroslav Tykhiy ifp = ifv->ifv_ifp; 10561cf236fbSYaroslav Tykhiy ifp->if_mtu = p->if_mtu - ifv->ifv_mtufudge; 105775ee267cSGleb Smirnoff ifp->if_baudrate = p->if_baudrate; 10582cc2df49SGarrett Wollman /* 105924993214SYaroslav Tykhiy * Copy only a selected subset of flags from the parent. 106024993214SYaroslav Tykhiy * Other flags are none of our business. 10612cc2df49SGarrett Wollman */ 106264a17d2eSYaroslav Tykhiy #define VLAN_COPY_FLAGS (IFF_SIMPLEX) 10631cf236fbSYaroslav Tykhiy ifp->if_flags &= ~VLAN_COPY_FLAGS; 10641cf236fbSYaroslav Tykhiy ifp->if_flags |= p->if_flags & VLAN_COPY_FLAGS; 10651cf236fbSYaroslav Tykhiy #undef VLAN_COPY_FLAGS 10661cf236fbSYaroslav Tykhiy 10671cf236fbSYaroslav Tykhiy ifp->if_link_state = p->if_link_state; 10682cc2df49SGarrett Wollman 106975ee267cSGleb Smirnoff vlan_capabilities(ifv); 1070a3814acfSSam Leffler 1071a3814acfSSam Leffler /* 10722cc2df49SGarrett Wollman * Set up our ``Ethernet address'' to reflect the underlying 10732cc2df49SGarrett Wollman * physical interface's. 10742cc2df49SGarrett Wollman */ 1075d09ed26fSRuslan Ermilov bcopy(IF_LLADDR(p), IF_LLADDR(ifp), ETHER_ADDR_LEN); 10761b2a4f7aSBill Fenner 10771b2a4f7aSBill Fenner /* 10781b2a4f7aSBill Fenner * Configure multicast addresses that may already be 10791b2a4f7aSBill Fenner * joined on the vlan device. 10801b2a4f7aSBill Fenner */ 10811cf236fbSYaroslav Tykhiy (void)vlan_setmulti(ifp); /* XXX: VLAN lock held */ 108275ee267cSGleb Smirnoff done: 108375ee267cSGleb Smirnoff TRUNK_UNLOCK(trunk); 108475ee267cSGleb Smirnoff VLAN_UNLOCK(); 108575ee267cSGleb Smirnoff 108675ee267cSGleb Smirnoff return (error); 10872cc2df49SGarrett Wollman } 10882cc2df49SGarrett Wollman 10892cc2df49SGarrett Wollman static int 1090f731f104SBill Paul vlan_unconfig(struct ifnet *ifp) 1091f731f104SBill Paul { 10925cb8c31aSYaroslav Tykhiy int ret; 10935cb8c31aSYaroslav Tykhiy 10945cb8c31aSYaroslav Tykhiy VLAN_LOCK(); 10955cb8c31aSYaroslav Tykhiy ret = vlan_unconfig_locked(ifp); 10965cb8c31aSYaroslav Tykhiy VLAN_UNLOCK(); 10975cb8c31aSYaroslav Tykhiy return (ret); 10985cb8c31aSYaroslav Tykhiy } 10995cb8c31aSYaroslav Tykhiy 11005cb8c31aSYaroslav Tykhiy static int 11015cb8c31aSYaroslav Tykhiy vlan_unconfig_locked(struct ifnet *ifp) 11025cb8c31aSYaroslav Tykhiy { 110375ee267cSGleb Smirnoff struct ifvlantrunk *trunk; 1104f731f104SBill Paul struct vlan_mc_entry *mc; 1105f731f104SBill Paul struct ifvlan *ifv; 1106f731f104SBill Paul int error; 1107f731f104SBill Paul 11085cb8c31aSYaroslav Tykhiy VLAN_LOCK_ASSERT(); 11094faedfe8SSam Leffler 1110f731f104SBill Paul ifv = ifp->if_softc; 111175ee267cSGleb Smirnoff trunk = ifv->ifv_trunk; 1112f731f104SBill Paul 111375ee267cSGleb Smirnoff if (trunk) { 11141b2a4f7aSBill Fenner struct sockaddr_dl sdl; 111575ee267cSGleb Smirnoff struct ifnet *p = trunk->parent; 111675ee267cSGleb Smirnoff 111775ee267cSGleb Smirnoff TRUNK_LOCK(trunk); 11181b2a4f7aSBill Fenner 1119f731f104SBill Paul /* 1120f731f104SBill Paul * Since the interface is being unconfigured, we need to 1121f731f104SBill Paul * empty the list of multicast groups that we may have joined 11221b2a4f7aSBill Fenner * while we were alive from the parent's list. 1123f731f104SBill Paul */ 112415a66c21SBruce M Simpson bzero((char *)&sdl, sizeof(sdl)); 112515a66c21SBruce M Simpson sdl.sdl_len = sizeof(sdl); 1126f731f104SBill Paul sdl.sdl_family = AF_LINK; 11271b2a4f7aSBill Fenner sdl.sdl_index = p->if_index; 11281b2a4f7aSBill Fenner sdl.sdl_type = IFT_ETHER; 11291b2a4f7aSBill Fenner sdl.sdl_alen = ETHER_ADDR_LEN; 11301b2a4f7aSBill Fenner 11311b2a4f7aSBill Fenner while(SLIST_FIRST(&ifv->vlan_mc_listhead) != NULL) { 113222f29826SPoul-Henning Kamp mc = SLIST_FIRST(&ifv->vlan_mc_listhead); 113315a66c21SBruce M Simpson bcopy((char *)&mc->mc_addr, LLADDR(&sdl), 113415a66c21SBruce M Simpson ETHER_ADDR_LEN); 1135f731f104SBill Paul error = if_delmulti(p, (struct sockaddr *)&sdl); 1136f731f104SBill Paul if (error) 1137f731f104SBill Paul return (error); 1138f731f104SBill Paul SLIST_REMOVE_HEAD(&ifv->vlan_mc_listhead, mc_entries); 11399d4fe4b2SBrooks Davis free(mc, M_VLAN); 1140f731f104SBill Paul } 1141a3814acfSSam Leffler 11421cf236fbSYaroslav Tykhiy vlan_setflags(ifp, 0); /* clear special flags on parent */ 114315ed2fa1SYaroslav Tykhiy #ifdef VLAN_ARRAY 114415ed2fa1SYaroslav Tykhiy trunk->vlans[ifv->ifv_tag] = NULL; 114515ed2fa1SYaroslav Tykhiy trunk->refcnt--; 114615ed2fa1SYaroslav Tykhiy #else 114775ee267cSGleb Smirnoff vlan_remhash(trunk, ifv); 114875ee267cSGleb Smirnoff #endif 114975ee267cSGleb Smirnoff ifv->ifv_trunk = NULL; 115075ee267cSGleb Smirnoff 115175ee267cSGleb Smirnoff /* 115275ee267cSGleb Smirnoff * Check if we were the last. 115375ee267cSGleb Smirnoff */ 115475ee267cSGleb Smirnoff if (trunk->refcnt == 0) { 115515ed2fa1SYaroslav Tykhiy trunk->parent->if_vlantrunk = NULL; 115675ee267cSGleb Smirnoff /* 115775ee267cSGleb Smirnoff * XXXGL: If some ithread has already entered 115875ee267cSGleb Smirnoff * vlan_input() and is now blocked on the trunk 115975ee267cSGleb Smirnoff * lock, then it should preempt us right after 116075ee267cSGleb Smirnoff * unlock and finish its work. Then we will acquire 116175ee267cSGleb Smirnoff * lock again in trunk_destroy(). 116275ee267cSGleb Smirnoff * XXX: not true in case of VLAN_ARRAY 116375ee267cSGleb Smirnoff */ 116475ee267cSGleb Smirnoff TRUNK_UNLOCK(trunk); 116575ee267cSGleb Smirnoff trunk_destroy(trunk); 116675ee267cSGleb Smirnoff } else 116775ee267cSGleb Smirnoff TRUNK_UNLOCK(trunk); 11681b2a4f7aSBill Fenner } 1169f731f104SBill Paul 1170f731f104SBill Paul /* Disconnect from parent. */ 11711cf236fbSYaroslav Tykhiy if (ifv->ifv_pflags) 11721cf236fbSYaroslav Tykhiy if_printf(ifp, "%s: ifv_pflags unclean\n", __func__); 11735cb8c31aSYaroslav Tykhiy ifp->if_mtu = ETHERMTU; 11745cb8c31aSYaroslav Tykhiy ifp->if_link_state = LINK_STATE_UNKNOWN; 11755cb8c31aSYaroslav Tykhiy ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 1176f731f104SBill Paul 117715a66c21SBruce M Simpson return (0); 1178f731f104SBill Paul } 1179f731f104SBill Paul 11801cf236fbSYaroslav Tykhiy /* Handle a reference counted flag that should be set on the parent as well */ 1181f731f104SBill Paul static int 11821cf236fbSYaroslav Tykhiy vlan_setflag(struct ifnet *ifp, int flag, int status, 11831cf236fbSYaroslav Tykhiy int (*func)(struct ifnet *, int)) 1184a3814acfSSam Leffler { 11851cf236fbSYaroslav Tykhiy struct ifvlan *ifv; 11861cf236fbSYaroslav Tykhiy int error; 1187a3814acfSSam Leffler 11881cf236fbSYaroslav Tykhiy /* XXX VLAN_LOCK_ASSERT(); */ 1189a3814acfSSam Leffler 11901cf236fbSYaroslav Tykhiy ifv = ifp->if_softc; 11911cf236fbSYaroslav Tykhiy status = status ? (ifp->if_flags & flag) : 0; 11921cf236fbSYaroslav Tykhiy /* Now "status" contains the flag value or 0 */ 11931cf236fbSYaroslav Tykhiy 11941cf236fbSYaroslav Tykhiy /* 11951cf236fbSYaroslav Tykhiy * See if recorded parent's status is different from what 11961cf236fbSYaroslav Tykhiy * we want it to be. If it is, flip it. We record parent's 11971cf236fbSYaroslav Tykhiy * status in ifv_pflags so that we won't clear parent's flag 11981cf236fbSYaroslav Tykhiy * we haven't set. In fact, we don't clear or set parent's 11991cf236fbSYaroslav Tykhiy * flags directly, but get or release references to them. 12001cf236fbSYaroslav Tykhiy * That's why we can be sure that recorded flags still are 12011cf236fbSYaroslav Tykhiy * in accord with actual parent's flags. 12021cf236fbSYaroslav Tykhiy */ 12031cf236fbSYaroslav Tykhiy if (status != (ifv->ifv_pflags & flag)) { 120475ee267cSGleb Smirnoff error = (*func)(PARENT(ifv), status); 12051cf236fbSYaroslav Tykhiy if (error) 1206a3814acfSSam Leffler return (error); 12071cf236fbSYaroslav Tykhiy ifv->ifv_pflags &= ~flag; 12081cf236fbSYaroslav Tykhiy ifv->ifv_pflags |= status; 12091cf236fbSYaroslav Tykhiy } 12101cf236fbSYaroslav Tykhiy return (0); 12111cf236fbSYaroslav Tykhiy } 12121cf236fbSYaroslav Tykhiy 12131cf236fbSYaroslav Tykhiy /* 12141cf236fbSYaroslav Tykhiy * Handle IFF_* flags that require certain changes on the parent: 12151cf236fbSYaroslav Tykhiy * if "status" is true, update parent's flags respective to our if_flags; 12161cf236fbSYaroslav Tykhiy * if "status" is false, forcedly clear the flags set on parent. 12171cf236fbSYaroslav Tykhiy */ 12181cf236fbSYaroslav Tykhiy static int 12191cf236fbSYaroslav Tykhiy vlan_setflags(struct ifnet *ifp, int status) 12201cf236fbSYaroslav Tykhiy { 12211cf236fbSYaroslav Tykhiy int error, i; 12221cf236fbSYaroslav Tykhiy 12231cf236fbSYaroslav Tykhiy for (i = 0; vlan_pflags[i].flag; i++) { 12241cf236fbSYaroslav Tykhiy error = vlan_setflag(ifp, vlan_pflags[i].flag, 12251cf236fbSYaroslav Tykhiy status, vlan_pflags[i].func); 12261cf236fbSYaroslav Tykhiy if (error) 12271cf236fbSYaroslav Tykhiy return (error); 12281cf236fbSYaroslav Tykhiy } 12291cf236fbSYaroslav Tykhiy return (0); 1230a3814acfSSam Leffler } 1231a3814acfSSam Leffler 1232127d7b2dSAndre Oppermann /* Inform all vlans that their parent has changed link state */ 1233127d7b2dSAndre Oppermann static void 1234127d7b2dSAndre Oppermann vlan_link_state(struct ifnet *ifp, int link) 1235127d7b2dSAndre Oppermann { 123675ee267cSGleb Smirnoff struct ifvlantrunk *trunk = ifp->if_vlantrunk; 1237127d7b2dSAndre Oppermann struct ifvlan *ifv; 123875ee267cSGleb Smirnoff int i; 1239127d7b2dSAndre Oppermann 124075ee267cSGleb Smirnoff TRUNK_LOCK(trunk); 124175ee267cSGleb Smirnoff #ifdef VLAN_ARRAY 124215ed2fa1SYaroslav Tykhiy for (i = 0; i < VLAN_ARRAY_SIZE; i++) 124375ee267cSGleb Smirnoff if (trunk->vlans[i] != NULL) { 124475ee267cSGleb Smirnoff ifv = trunk->vlans[i]; 124575ee267cSGleb Smirnoff #else 124675ee267cSGleb Smirnoff for (i = 0; i < (1 << trunk->hwidth); i++) { 124775ee267cSGleb Smirnoff LIST_FOREACH(ifv, &trunk->hash[i], ifv_list) 124875ee267cSGleb Smirnoff #endif 1249fc74a9f9SBrooks Davis if_link_state_change(ifv->ifv_ifp, 125075ee267cSGleb Smirnoff trunk->parent->if_link_state); 1251127d7b2dSAndre Oppermann } 125275ee267cSGleb Smirnoff TRUNK_UNLOCK(trunk); 125375ee267cSGleb Smirnoff } 125475ee267cSGleb Smirnoff 125575ee267cSGleb Smirnoff static void 125675ee267cSGleb Smirnoff vlan_capabilities(struct ifvlan *ifv) 125775ee267cSGleb Smirnoff { 125875ee267cSGleb Smirnoff struct ifnet *p = PARENT(ifv); 125975ee267cSGleb Smirnoff struct ifnet *ifp = ifv->ifv_ifp; 126075ee267cSGleb Smirnoff 126175ee267cSGleb Smirnoff TRUNK_LOCK_ASSERT(TRUNK(ifv)); 126275ee267cSGleb Smirnoff 126375ee267cSGleb Smirnoff /* 126475ee267cSGleb Smirnoff * If the parent interface can do checksum offloading 126575ee267cSGleb Smirnoff * on VLANs, then propagate its hardware-assisted 126675ee267cSGleb Smirnoff * checksumming flags. Also assert that checksum 126775ee267cSGleb Smirnoff * offloading requires hardware VLAN tagging. 126875ee267cSGleb Smirnoff */ 126975ee267cSGleb Smirnoff if (p->if_capabilities & IFCAP_VLAN_HWCSUM) 127075ee267cSGleb Smirnoff ifp->if_capabilities = p->if_capabilities & IFCAP_HWCSUM; 127175ee267cSGleb Smirnoff 127275ee267cSGleb Smirnoff if (p->if_capenable & IFCAP_VLAN_HWCSUM && 127375ee267cSGleb Smirnoff p->if_capenable & IFCAP_VLAN_HWTAGGING) { 127475ee267cSGleb Smirnoff ifp->if_capenable = p->if_capenable & IFCAP_HWCSUM; 127575ee267cSGleb Smirnoff ifp->if_hwassist = p->if_hwassist; 127675ee267cSGleb Smirnoff } else { 127775ee267cSGleb Smirnoff ifp->if_capenable = 0; 127875ee267cSGleb Smirnoff ifp->if_hwassist = 0; 127975ee267cSGleb Smirnoff } 128075ee267cSGleb Smirnoff } 128175ee267cSGleb Smirnoff 128275ee267cSGleb Smirnoff static void 128375ee267cSGleb Smirnoff vlan_trunk_capabilities(struct ifnet *ifp) 128475ee267cSGleb Smirnoff { 128575ee267cSGleb Smirnoff struct ifvlantrunk *trunk = ifp->if_vlantrunk; 128675ee267cSGleb Smirnoff struct ifvlan *ifv; 128775ee267cSGleb Smirnoff int i; 128875ee267cSGleb Smirnoff 128975ee267cSGleb Smirnoff TRUNK_LOCK(trunk); 129075ee267cSGleb Smirnoff #ifdef VLAN_ARRAY 129115ed2fa1SYaroslav Tykhiy for (i = 0; i < VLAN_ARRAY_SIZE; i++) 129275ee267cSGleb Smirnoff if (trunk->vlans[i] != NULL) { 129375ee267cSGleb Smirnoff ifv = trunk->vlans[i]; 129475ee267cSGleb Smirnoff #else 129575ee267cSGleb Smirnoff for (i = 0; i < (1 << trunk->hwidth); i++) { 129675ee267cSGleb Smirnoff LIST_FOREACH(ifv, &trunk->hash[i], ifv_list) 129775ee267cSGleb Smirnoff #endif 129875ee267cSGleb Smirnoff vlan_capabilities(ifv); 129975ee267cSGleb Smirnoff } 130075ee267cSGleb Smirnoff TRUNK_UNLOCK(trunk); 1301127d7b2dSAndre Oppermann } 1302127d7b2dSAndre Oppermann 1303a3814acfSSam Leffler static int 1304cfe8b629SGarrett Wollman vlan_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 13052cc2df49SGarrett Wollman { 13062cc2df49SGarrett Wollman struct ifaddr *ifa; 13072cc2df49SGarrett Wollman struct ifnet *p; 13082cc2df49SGarrett Wollman struct ifreq *ifr; 13092cc2df49SGarrett Wollman struct ifvlan *ifv; 13102cc2df49SGarrett Wollman struct vlanreq vlr; 13112cc2df49SGarrett Wollman int error = 0; 13122cc2df49SGarrett Wollman 13132cc2df49SGarrett Wollman ifr = (struct ifreq *)data; 13142cc2df49SGarrett Wollman ifa = (struct ifaddr *)data; 13152cc2df49SGarrett Wollman ifv = ifp->if_softc; 13162cc2df49SGarrett Wollman 13172cc2df49SGarrett Wollman switch (cmd) { 13182cc2df49SGarrett Wollman case SIOCSIFADDR: 13192cc2df49SGarrett Wollman ifp->if_flags |= IFF_UP; 13202cc2df49SGarrett Wollman 13212cc2df49SGarrett Wollman switch (ifa->ifa_addr->sa_family) { 13222cc2df49SGarrett Wollman #ifdef INET 13232cc2df49SGarrett Wollman case AF_INET: 1324fc74a9f9SBrooks Davis arp_ifinit(ifv->ifv_ifp, ifa); 13252cc2df49SGarrett Wollman break; 13262cc2df49SGarrett Wollman #endif 13272cc2df49SGarrett Wollman default: 13282cc2df49SGarrett Wollman break; 13292cc2df49SGarrett Wollman } 13302cc2df49SGarrett Wollman break; 13312cc2df49SGarrett Wollman 13322cc2df49SGarrett Wollman case SIOCGIFADDR: 13332cc2df49SGarrett Wollman { 13342cc2df49SGarrett Wollman struct sockaddr *sa; 13352cc2df49SGarrett Wollman 13362cc2df49SGarrett Wollman sa = (struct sockaddr *) &ifr->ifr_data; 13374a0d6638SRuslan Ermilov bcopy(IF_LLADDR(ifp), (caddr_t)sa->sa_data, 133815a66c21SBruce M Simpson ETHER_ADDR_LEN); 13392cc2df49SGarrett Wollman } 13402cc2df49SGarrett Wollman break; 13412cc2df49SGarrett Wollman 1342b3cca108SBill Fenner case SIOCGIFMEDIA: 13434faedfe8SSam Leffler VLAN_LOCK(); 134475ee267cSGleb Smirnoff if (TRUNK(ifv) != NULL) { 134575ee267cSGleb Smirnoff error = (*PARENT(ifv)->if_ioctl)(PARENT(ifv), 13464faedfe8SSam Leffler SIOCGIFMEDIA, data); 13474faedfe8SSam Leffler VLAN_UNLOCK(); 1348b3cca108SBill Fenner /* Limit the result to the parent's current config. */ 1349b3cca108SBill Fenner if (error == 0) { 1350b3cca108SBill Fenner struct ifmediareq *ifmr; 1351b3cca108SBill Fenner 1352b3cca108SBill Fenner ifmr = (struct ifmediareq *)data; 1353b3cca108SBill Fenner if (ifmr->ifm_count >= 1 && ifmr->ifm_ulist) { 1354b3cca108SBill Fenner ifmr->ifm_count = 1; 1355b3cca108SBill Fenner error = copyout(&ifmr->ifm_current, 1356b3cca108SBill Fenner ifmr->ifm_ulist, 1357b3cca108SBill Fenner sizeof(int)); 1358b3cca108SBill Fenner } 1359b3cca108SBill Fenner } 13604faedfe8SSam Leffler } else { 13614faedfe8SSam Leffler VLAN_UNLOCK(); 1362b3cca108SBill Fenner error = EINVAL; 13634faedfe8SSam Leffler } 1364b3cca108SBill Fenner break; 1365b3cca108SBill Fenner 1366b3cca108SBill Fenner case SIOCSIFMEDIA: 1367b3cca108SBill Fenner error = EINVAL; 1368b3cca108SBill Fenner break; 1369b3cca108SBill Fenner 13702cc2df49SGarrett Wollman case SIOCSIFMTU: 13712cc2df49SGarrett Wollman /* 13722cc2df49SGarrett Wollman * Set the interface MTU. 13732cc2df49SGarrett Wollman */ 13744faedfe8SSam Leffler VLAN_LOCK(); 137575ee267cSGleb Smirnoff if (TRUNK(ifv) != NULL) { 1376a3814acfSSam Leffler if (ifr->ifr_mtu > 137775ee267cSGleb Smirnoff (PARENT(ifv)->if_mtu - ifv->ifv_mtufudge) || 1378a3814acfSSam Leffler ifr->ifr_mtu < 1379a3814acfSSam Leffler (ifv->ifv_mintu - ifv->ifv_mtufudge)) 13802cc2df49SGarrett Wollman error = EINVAL; 1381a3814acfSSam Leffler else 13822cc2df49SGarrett Wollman ifp->if_mtu = ifr->ifr_mtu; 1383a3814acfSSam Leffler } else 1384a3814acfSSam Leffler error = EINVAL; 13854faedfe8SSam Leffler VLAN_UNLOCK(); 13862cc2df49SGarrett Wollman break; 13872cc2df49SGarrett Wollman 13882cc2df49SGarrett Wollman case SIOCSETVLAN: 138915a66c21SBruce M Simpson error = copyin(ifr->ifr_data, &vlr, sizeof(vlr)); 13902cc2df49SGarrett Wollman if (error) 13912cc2df49SGarrett Wollman break; 13922cc2df49SGarrett Wollman if (vlr.vlr_parent[0] == '\0') { 1393f731f104SBill Paul vlan_unconfig(ifp); 13942cc2df49SGarrett Wollman break; 13952cc2df49SGarrett Wollman } 13962cc2df49SGarrett Wollman p = ifunit(vlr.vlr_parent); 13972cc2df49SGarrett Wollman if (p == 0) { 13982cc2df49SGarrett Wollman error = ENOENT; 13992cc2df49SGarrett Wollman break; 14002cc2df49SGarrett Wollman } 1401fb88a3e0SBill Paul /* 1402fb88a3e0SBill Paul * Don't let the caller set up a VLAN tag with 1403fb88a3e0SBill Paul * anything except VLID bits. 1404fb88a3e0SBill Paul */ 1405fb88a3e0SBill Paul if (vlr.vlr_tag & ~EVL_VLID_MASK) { 1406fb88a3e0SBill Paul error = EINVAL; 1407fb88a3e0SBill Paul break; 1408fb88a3e0SBill Paul } 140975ee267cSGleb Smirnoff error = vlan_config(ifv, p, vlr.vlr_tag); 141075ee267cSGleb Smirnoff if (error) 14112cc2df49SGarrett Wollman break; 141213f4c340SRobert Watson ifp->if_drv_flags |= IFF_DRV_RUNNING; 1413a3814acfSSam Leffler 14141cf236fbSYaroslav Tykhiy /* Update flags on the parent, if necessary. */ 14151cf236fbSYaroslav Tykhiy vlan_setflags(ifp, 1); 14162cc2df49SGarrett Wollman break; 14172cc2df49SGarrett Wollman 14182cc2df49SGarrett Wollman case SIOCGETVLAN: 141915a66c21SBruce M Simpson bzero(&vlr, sizeof(vlr)); 14204faedfe8SSam Leffler VLAN_LOCK(); 142175ee267cSGleb Smirnoff if (TRUNK(ifv) != NULL) { 142275ee267cSGleb Smirnoff strlcpy(vlr.vlr_parent, PARENT(ifv)->if_xname, 14239bf40edeSBrooks Davis sizeof(vlr.vlr_parent)); 14242cc2df49SGarrett Wollman vlr.vlr_tag = ifv->ifv_tag; 14252cc2df49SGarrett Wollman } 14264faedfe8SSam Leffler VLAN_UNLOCK(); 142715a66c21SBruce M Simpson error = copyout(&vlr, ifr->ifr_data, sizeof(vlr)); 14282cc2df49SGarrett Wollman break; 14292cc2df49SGarrett Wollman 14302cc2df49SGarrett Wollman case SIOCSIFFLAGS: 14312cc2df49SGarrett Wollman /* 14321cf236fbSYaroslav Tykhiy * We should propagate selected flags to the parent, 14331cf236fbSYaroslav Tykhiy * e.g., promiscuous mode. 14342cc2df49SGarrett Wollman */ 143575ee267cSGleb Smirnoff if (TRUNK(ifv) != NULL) 14361cf236fbSYaroslav Tykhiy error = vlan_setflags(ifp, 1); 14372cc2df49SGarrett Wollman break; 1438a3814acfSSam Leffler 1439f731f104SBill Paul case SIOCADDMULTI: 1440f731f104SBill Paul case SIOCDELMULTI: 144175ee267cSGleb Smirnoff /* 144275ee267cSGleb Smirnoff * If we don't have a parent, just remember the membership for 144375ee267cSGleb Smirnoff * when we do. 144475ee267cSGleb Smirnoff */ 144575ee267cSGleb Smirnoff if (TRUNK(ifv) != NULL) 1446f731f104SBill Paul error = vlan_setmulti(ifp); 1447f731f104SBill Paul break; 144875ee267cSGleb Smirnoff 14492cc2df49SGarrett Wollman default: 14502cc2df49SGarrett Wollman error = EINVAL; 14512cc2df49SGarrett Wollman } 145215a66c21SBruce M Simpson 145315a66c21SBruce M Simpson return (error); 14542cc2df49SGarrett Wollman } 1455