2 * Copyright 1998 Massachusetts Institute of Technology
4 * Permission to use, copy, modify, and distribute this software and
5 * its documentation for any purpose and without fee is hereby
6 * granted, provided that both the above copyright notice and this
7 * permission notice appear in all copies, that both the above
8 * copyright notice and this permission notice appear in all
9 * supporting documentation, and that the name of M.I.T. not be used
10 * in advertising or publicity pertaining to distribution of the
11 * software without specific, written prior permission. M.I.T. makes
12 * no representations about the suitability of this software for any
13 * purpose. It is provided "as is" without express or implied
16 * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS
17 * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE,
18 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
19 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT
20 * SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
21 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
22 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
23 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
24 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
25 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
26 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * $FreeBSD: src/sys/net/if_vlan.c,v 1.15.2.13 2003/02/14 22:25:58 fenner Exp $
33 * if_vlan.c - pseudo-device driver for IEEE 802.1Q virtual LANs.
34 * Might be extended some day to also handle IEEE 802.1p priority
35 * tagging. This is sort of sneaky in the implementation, since
36 * we need to pretend to be enough of an Ethernet implementation
37 * to make arp work. The way we do this is by telling everyone
38 * that we are an Ethernet, and then catch the packets that
39 * ether_output() left on our output queue queue when it calls
40 * if_start(), rewrite them for use by the real outgoing interface,
41 * and ask it to send them.
44 * Note about vlan's MP safe approach:
46 * - All configuration operation, e.g. config, unconfig and change flags,
47 * is serialized by netisr0; not by vlan's serializer
49 * - Parent interface's trunk and vlans are linked in the following
52 * +--------------+--------+--------+--------+--------+
53 * | parent ifnet |trunk[0]|trunk[1]|trunk[2]|trunk[3]|
54 * +--------------+--------+--------+--------+--------+
57 * +--------------+--------+--------+--------+--------+
58 * | vlan ifnet |entry[0]|entry[1]|entry[2]|entry[3]|
59 * +--------------+--------+--------+--------+--------+
62 * +--------------+--------+--------+--------+--------+
63 * | vlan ifnet |entry[0]|entry[1]|entry[2]|entry[3]|
64 * +--------------+--------+--------+--------+--------+
66 * - Vlan is linked/unlinked onto parent interface's trunk using following
71 * netisr0 <---------------------------------------------+
76 * V fwdmsg fwdmsg fwdmsg |
77 * ifnet0 --------> ifnet1 --------> ifnet2 --------> ifnet3
78 * (link/unlink) (link/unlink) (link/unlink) (link/unlink)
80 * - Parent interface's trunk is destroyed in the following lockless way:
82 * old_trunk = ifp->if_vlantrunks;
83 * ifp->if_vlantrunks = NULL;
84 * netmsg_service_sync();
88 * Since all of the accessing of if_vlantrunks only happens in network
89 * threads (percpu netisr and ifnet threads), after netmsg_service_sync()
90 * the network threads are promised to see only NULL if_vlantrunks; we
91 * are safe to free the "to be destroyed" parent interface's trunk
100 #include <sys/param.h>
101 #include <sys/systm.h>
102 #include <sys/kernel.h>
103 #include <sys/malloc.h>
104 #include <sys/mbuf.h>
105 #include <sys/module.h>
106 #include <sys/queue.h>
107 #include <sys/socket.h>
108 #include <sys/sockio.h>
109 #include <sys/sysctl.h>
111 #include <sys/thread2.h>
114 #include <net/ethernet.h>
116 #include <net/if_arp.h>
117 #include <net/if_dl.h>
118 #include <net/if_types.h>
119 #include <net/ifq_var.h>
120 #include <net/if_clone.h>
121 #include <net/netmsg2.h>
122 #include <net/netisr2.h>
125 #include <netinet/in.h>
126 #include <netinet/if_ether.h>
129 #include <net/vlan/if_vlan_var.h>
130 #include <net/vlan/if_vlan_ether.h>
134 struct vlan_mc_entry
{
135 struct ether_addr mc_addr
;
136 SLIST_ENTRY(vlan_mc_entry
) mc_entries
;
141 LIST_ENTRY(vlan_entry
) ifv_link
;
145 struct arpcom ifv_ac
; /* make this an interface */
146 struct ifnet
*ifv_p
; /* parent inteface of this vlan */
147 int ifv_pflags
; /* special flags we have set on parent */
150 uint16_t ifvm_proto
; /* encapsulation ethertype */
151 uint16_t ifvm_tag
; /* tag to apply on packets leaving if */
153 SLIST_HEAD(, vlan_mc_entry
) vlan_mc_listhead
;
154 LIST_ENTRY(ifvlan
) ifv_list
;
155 struct vlan_entry ifv_entries
[1];
157 #define ifv_if ifv_ac.ac_if
158 #define ifv_tag ifv_mib.ifvm_tag
161 LIST_HEAD(, vlan_entry
) vlan_list
;
165 struct netmsg_base base
;
166 struct ifvlan
*nv_ifv
;
167 struct ifnet
*nv_ifp_p
;
168 const char *nv_parent_name
;
172 #define VLANNAME "vlan"
174 SYSCTL_DECL(_net_link
);
175 SYSCTL_NODE(_net_link
, IFT_L2VLAN
, vlan
, CTLFLAG_RW
, 0, "IEEE 802.1Q VLAN");
176 SYSCTL_NODE(_net_link_vlan
, PF_LINK
, link
, CTLFLAG_RW
, 0, "for consistency");
178 static MALLOC_DEFINE(M_VLAN
, "vlan", "802.1Q Virtual LAN Interface");
179 static LIST_HEAD(, ifvlan
) ifv_list
;
181 static int vlan_clone_create(struct if_clone
*, int, caddr_t
);
182 static int vlan_clone_destroy(struct ifnet
*);
183 static void vlan_ifdetach(void *, struct ifnet
*);
185 static void vlan_init(void *);
186 static void vlan_start(struct ifnet
*, struct ifaltq_subque
*);
187 static int vlan_ioctl(struct ifnet
*, u_long
, caddr_t
, struct ucred
*);
188 static void vlan_input(struct mbuf
*);
190 static int vlan_setflags(struct ifvlan
*, struct ifnet
*, int);
191 static int vlan_setflag(struct ifvlan
*, struct ifnet
*, int, int,
192 int (*)(struct ifnet
*, int));
193 static int vlan_config_flags(struct ifvlan
*ifv
);
194 static void vlan_clrmulti(struct ifvlan
*, struct ifnet
*);
195 static int vlan_setmulti(struct ifvlan
*, struct ifnet
*);
196 static int vlan_config_multi(struct ifvlan
*);
197 static int vlan_config(struct ifvlan
*, const char *, uint16_t);
198 static int vlan_unconfig(struct ifvlan
*);
199 static void vlan_link(struct ifvlan
*, struct ifnet
*);
200 static void vlan_unlink(struct ifvlan
*, struct ifnet
*);
202 static void vlan_config_dispatch(netmsg_t
);
203 static void vlan_unconfig_dispatch(netmsg_t
);
204 static void vlan_link_dispatch(netmsg_t
);
205 static void vlan_unlink_dispatch(netmsg_t
);
206 static void vlan_multi_dispatch(netmsg_t
);
207 static void vlan_flags_dispatch(netmsg_t
);
208 static void vlan_ifdetach_dispatch(netmsg_t
);
210 /* Special flags we should propagate to parent */
213 int (*func
)(struct ifnet
*, int);
215 { IFF_PROMISC
, ifpromisc
},
216 { IFF_ALLMULTI
, if_allmulti
},
220 static eventhandler_tag vlan_ifdetach_cookie
;
221 static struct if_clone vlan_cloner
=
222 IF_CLONE_INITIALIZER("vlan", vlan_clone_create
, vlan_clone_destroy
,
226 * Handle IFF_* flags that require certain changes on the parent:
227 * if "set" is true, update parent's flags respective to our if_flags;
228 * if "set" is false, forcedly clear the flags set on parent.
231 vlan_setflags(struct ifvlan
*ifv
, struct ifnet
*ifp_p
, int set
)
235 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
237 for (i
= 0; vlan_pflags
[i
].func
!= NULL
; i
++) {
238 error
= vlan_setflag(ifv
, ifp_p
, vlan_pflags
[i
].flag
,
239 set
, vlan_pflags
[i
].func
);
246 /* Handle a reference counted flag that should be set on the parent as well */
248 vlan_setflag(struct ifvlan
*ifv
, struct ifnet
*ifp_p
, int flag
, int set
,
249 int (*func
)(struct ifnet
*, int))
251 struct ifnet
*ifp
= &ifv
->ifv_if
;
254 ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp
);
256 ifv_flag
= set
? (ifp
->if_flags
& flag
) : 0;
259 * See if recorded parent's status is different from what
260 * we want it to be. If it is, flip it. We record parent's
261 * status in ifv_pflags so that we won't clear parent's flag
262 * we haven't set. In fact, we don't clear or set parent's
263 * flags directly, but get or release references to them.
264 * That's why we can be sure that recorded flags still are
265 * in accord with actual parent's flags.
267 if (ifv_flag
!= (ifv
->ifv_pflags
& flag
)) {
268 error
= func(ifp_p
, ifv_flag
);
271 ifv
->ifv_pflags
&= ~flag
;
272 ifv
->ifv_pflags
|= ifv_flag
;
278 * Program our multicast filter. What we're actually doing is
279 * programming the multicast filter of the parent. This has the
280 * side effect of causing the parent interface to receive multicast
281 * traffic that it doesn't really want, which ends up being discarded
282 * later by the upper protocol layers. Unfortunately, there's no way
283 * to avoid this: there really is only one physical interface.
286 vlan_setmulti(struct ifvlan
*ifv
, struct ifnet
*ifp_p
)
288 struct ifmultiaddr
*ifma
;
289 struct vlan_mc_entry
*mc
= NULL
;
290 struct sockaddr_dl sdl
;
291 struct ifnet
*ifp
= &ifv
->ifv_if
;
293 ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp
);
296 * First, remove any existing filter entries.
298 vlan_clrmulti(ifv
, ifp_p
);
301 * Save the filter entries to be added to parent.
303 * TODO: need ifnet_serialize_main
305 ifnet_serialize_all(ifp
);
306 TAILQ_FOREACH(ifma
, &ifp
->if_multiaddrs
, ifma_link
) {
307 if (ifma
->ifma_addr
->sa_family
!= AF_LINK
)
311 mc
= kmalloc(sizeof(struct vlan_mc_entry
), M_VLAN
, M_WAITOK
);
312 bcopy(LLADDR((struct sockaddr_dl
*)ifma
->ifma_addr
),
313 &mc
->mc_addr
, ETHER_ADDR_LEN
);
314 SLIST_INSERT_HEAD(&ifv
->vlan_mc_listhead
, mc
, mc_entries
);
316 ifnet_deserialize_all(ifp
);
319 * Now program new ones.
321 bzero(&sdl
, sizeof(sdl
));
322 sdl
.sdl_len
= sizeof(sdl
);
323 sdl
.sdl_family
= AF_LINK
;
324 sdl
.sdl_index
= ifp_p
->if_index
;
325 sdl
.sdl_type
= IFT_ETHER
;
326 sdl
.sdl_alen
= ETHER_ADDR_LEN
;
329 * Program the parent multicast filter
331 SLIST_FOREACH(mc
, &ifv
->vlan_mc_listhead
, mc_entries
) {
334 bcopy(&mc
->mc_addr
, LLADDR(&sdl
), ETHER_ADDR_LEN
);
335 error
= if_addmulti(ifp_p
, (struct sockaddr
*)&sdl
, NULL
);
337 /* XXX probably should keep going */
345 vlan_clrmulti(struct ifvlan
*ifv
, struct ifnet
*ifp_p
)
347 struct vlan_mc_entry
*mc
;
348 struct sockaddr_dl sdl
;
350 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
352 bzero(&sdl
, sizeof(sdl
));
353 sdl
.sdl_len
= sizeof(sdl
);
354 sdl
.sdl_family
= AF_LINK
;
355 sdl
.sdl_index
= ifp_p
->if_index
;
356 sdl
.sdl_type
= IFT_ETHER
;
357 sdl
.sdl_alen
= ETHER_ADDR_LEN
;
359 while ((mc
= SLIST_FIRST(&ifv
->vlan_mc_listhead
)) != NULL
) {
360 bcopy(&mc
->mc_addr
, LLADDR(&sdl
), ETHER_ADDR_LEN
);
361 if_delmulti(ifp_p
, (struct sockaddr
*)&sdl
); /* ignore error */
363 SLIST_REMOVE_HEAD(&ifv
->vlan_mc_listhead
, mc_entries
);
369 vlan_modevent(module_t mod
, int type
, void *data
)
373 LIST_INIT(&ifv_list
);
374 vlan_input_p
= vlan_input
;
375 vlan_ifdetach_cookie
=
376 EVENTHANDLER_REGISTER(ifnet_detach_event
,
378 EVENTHANDLER_PRI_ANY
);
379 if_clone_attach(&vlan_cloner
);
383 if_clone_detach(&vlan_cloner
);
387 * Make sure that all protocol threads see vlan_input_p change.
389 netmsg_service_sync();
391 EVENTHANDLER_DEREGISTER(ifnet_detach_event
,
392 vlan_ifdetach_cookie
);
393 while (!LIST_EMPTY(&ifv_list
))
394 vlan_clone_destroy(&LIST_FIRST(&ifv_list
)->ifv_if
);
400 static moduledata_t vlan_mod
= {
406 DECLARE_MODULE(if_vlan
, vlan_mod
, SI_SUB_PSEUDO
, SI_ORDER_ANY
);
409 vlan_ifdetach_dispatch(netmsg_t msg
)
411 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
412 struct ifnet
*ifp_p
= vmsg
->nv_ifp_p
;
413 struct vlan_trunk
*vlantrunks
, *trunk
;
414 struct vlan_entry
*ifve
;
416 vlantrunks
= ifp_p
->if_vlantrunks
;
417 if (vlantrunks
== NULL
)
419 trunk
= &vlantrunks
[mycpuid
];
421 while (ifp_p
->if_vlantrunks
&&
422 (ifve
= LIST_FIRST(&trunk
->vlan_list
)) != NULL
)
423 vlan_unconfig(ifve
->ifv
);
425 lwkt_replymsg(&vmsg
->base
.lmsg
, 0);
429 vlan_ifdetach(void *arg __unused
, struct ifnet
*ifp
)
431 struct netmsg_vlan vmsg
;
433 ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp
);
435 bzero(&vmsg
, sizeof(vmsg
));
437 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
438 0, vlan_ifdetach_dispatch
);
441 lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);
445 vlan_clone_create(struct if_clone
*ifc
, int unit
, caddr_t param __unused
)
451 vlan_size
= sizeof(struct ifvlan
)
452 + ((ncpus
- 1) * sizeof(struct vlan_entry
));
453 ifv
= kmalloc(vlan_size
, M_VLAN
, M_WAITOK
| M_ZERO
);
454 SLIST_INIT(&ifv
->vlan_mc_listhead
);
455 for (i
= 0; i
< ncpus
; ++i
)
456 ifv
->ifv_entries
[i
].ifv
= ifv
;
458 crit_enter(); /* XXX not MP safe */
459 LIST_INSERT_HEAD(&ifv_list
, ifv
, ifv_list
);
464 if_initname(ifp
, "vlan", unit
);
465 /* NB: flags are not set here */
466 ifp
->if_linkmib
= &ifv
->ifv_mib
;
467 ifp
->if_linkmiblen
= sizeof ifv
->ifv_mib
;
468 /* NB: mtu is not set here */
470 ifp
->if_init
= vlan_init
;
471 ifp
->if_start
= vlan_start
;
472 ifp
->if_ioctl
= vlan_ioctl
;
473 ifq_set_maxlen(&ifp
->if_snd
, ifqmaxlen
);
474 ifq_set_ready(&ifp
->if_snd
);
475 ether_ifattach(ifp
, ifv
->ifv_ac
.ac_enaddr
, NULL
);
476 /* Now undo some of the damage... */
477 ifp
->if_data
.ifi_type
= IFT_L2VLAN
;
478 ifp
->if_data
.ifi_hdrlen
= EVL_ENCAPLEN
;
484 vlan_clone_destroy(struct ifnet
*ifp
)
486 struct ifvlan
*ifv
= ifp
->if_softc
;
488 crit_enter(); /* XXX not MP safe */
489 LIST_REMOVE(ifv
, ifv_list
);
503 struct ifvlan
*ifv
= xsc
;
504 struct ifnet
*ifp
= &ifv
->ifv_if
;
506 ASSERT_IFNET_SERIALIZED_ALL(ifp
);
508 if (ifv
->ifv_p
!= NULL
)
509 ifp
->if_flags
|= IFF_RUNNING
;
513 vlan_start(struct ifnet
*ifp
, struct ifaltq_subque
*ifsq
)
515 struct ifvlan
*ifv
= ifp
->if_softc
;
516 struct ifnet
*ifp_p
= ifv
->ifv_p
;
520 ASSERT_ALTQ_SQ_DEFAULT(ifp
, ifsq
);
521 ASSERT_ALTQ_SQ_SERIALIZED_HW(ifsq
);
528 if ((ifp
->if_flags
& IFF_RUNNING
) == 0)
531 p_port
= netisr_cpuport(
532 ifsq_get_cpuid(ifq_get_subq_default(&ifp_p
->if_snd
)));
534 struct netmsg_packet
*nmp
;
536 m
= ifsq_dequeue(ifsq
);
542 * Do not run parent's if_start() if the parent is not up,
543 * or parent's driver will cause a system crash.
545 if ((ifp_p
->if_flags
& (IFF_UP
| IFF_RUNNING
)) !=
546 (IFF_UP
| IFF_RUNNING
)) {
548 IFNET_STAT_INC(ifp
, collisions
, 1);
553 * We need some way to tell the interface where the packet
554 * came from so that it knows how to find the VLAN tag to
555 * use, so we set the ether_vlantag in the mbuf packet header
556 * to our vlan tag. We also set the M_VLANTAG flag in the
557 * mbuf to let the parent driver know that the ether_vlantag
560 m
->m_pkthdr
.ether_vlantag
= ifv
->ifv_tag
;
561 m
->m_flags
|= M_VLANTAG
;
563 nmp
= &m
->m_hdr
.mh_netmsg
;
565 netmsg_init(&nmp
->base
, NULL
, &netisr_apanic_rport
,
566 0, vlan_start_dispatch
);
568 nmp
->base
.lmsg
.u
.ms_resultp
= ifp_p
;
570 lwkt_sendmsg(p_port
, &nmp
->base
.lmsg
);
571 IFNET_STAT_INC(ifp
, opackets
, 1);
576 vlan_input(struct mbuf
*m
)
578 struct ifvlan
*ifv
= NULL
;
580 struct vlan_trunk
*vlantrunks
;
581 struct vlan_entry
*entry
;
583 rcvif
= m
->m_pkthdr
.rcvif
;
584 KKASSERT(m
->m_flags
& M_VLANTAG
);
586 vlantrunks
= rcvif
->if_vlantrunks
;
587 if (vlantrunks
== NULL
) {
588 IFNET_STAT_INC(rcvif
, noproto
, 1);
593 crit_enter(); /* XXX Necessary? */
594 LIST_FOREACH(entry
, &vlantrunks
[mycpuid
].vlan_list
, ifv_link
) {
595 if (entry
->ifv
->ifv_tag
==
596 EVL_VLANOFTAG(m
->m_pkthdr
.ether_vlantag
)) {
604 * Packet is discarded if:
605 * - no corresponding vlan(4) interface
606 * - vlan(4) interface has not been completely set up yet,
607 * or is being destroyed (ifv->ifv_p != rcvif)
609 if (ifv
== NULL
|| ifv
->ifv_p
!= rcvif
) {
610 IFNET_STAT_INC(rcvif
, noproto
, 1);
616 * Clear M_VLANTAG, before the packet is handed to
619 m
->m_flags
&= ~M_VLANTAG
;
621 ether_reinput_oncpu(&ifv
->ifv_if
, m
, REINPUT_RUNBPF
);
625 vlan_link_dispatch(netmsg_t msg
)
627 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
628 struct ifvlan
*ifv
= vmsg
->nv_ifv
;
629 struct ifnet
*ifp_p
= vmsg
->nv_ifp_p
;
630 struct vlan_entry
*entry
;
631 struct vlan_trunk
*vlantrunks
, *trunk
;
634 vlantrunks
= ifp_p
->if_vlantrunks
;
635 KASSERT(vlantrunks
!= NULL
,
636 ("vlan trunk has not been initialized yet"));
638 entry
= &ifv
->ifv_entries
[cpu
];
639 trunk
= &vlantrunks
[cpu
];
642 LIST_INSERT_HEAD(&trunk
->vlan_list
, entry
, ifv_link
);
645 ifnet_forwardmsg(&vmsg
->base
.lmsg
, cpu
+ 1);
649 vlan_link(struct ifvlan
*ifv
, struct ifnet
*ifp_p
)
651 struct netmsg_vlan vmsg
;
653 /* Assert in netisr0 */
654 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
656 if (ifp_p
->if_vlantrunks
== NULL
) {
657 struct vlan_trunk
*vlantrunks
;
660 vlantrunks
= kmalloc(sizeof(*vlantrunks
) * ncpus
, M_VLAN
,
662 for (i
= 0; i
< ncpus
; ++i
)
663 LIST_INIT(&vlantrunks
[i
].vlan_list
);
665 ifp_p
->if_vlantrunks
= vlantrunks
;
668 bzero(&vmsg
, sizeof(vmsg
));
670 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
671 0, vlan_link_dispatch
);
673 vmsg
.nv_ifp_p
= ifp_p
;
675 ifnet_domsg(&vmsg
.base
.lmsg
, 0);
679 vlan_config_dispatch(netmsg_t msg
)
681 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
683 struct ifnet
*ifp_p
, *ifp
;
684 struct sockaddr_dl
*sdl1
, *sdl2
;
687 /* Assert in netisr0 */
689 ifp_p
= ifunit_netisr(vmsg
->nv_parent_name
);
695 if (ifp_p
->if_data
.ifi_type
!= IFT_ETHER
) {
696 error
= EPROTONOSUPPORT
;
708 /* Link vlan into parent's vlantrunk */
709 vlan_link(ifv
, ifp_p
);
711 ifnet_serialize_all(ifp
);
713 ifv
->ifv_tag
= vmsg
->nv_vlantag
;
714 if (ifp_p
->if_capenable
& IFCAP_VLAN_MTU
)
715 ifp
->if_mtu
= ifp_p
->if_mtu
;
717 ifp
->if_mtu
= ifp_p
->if_data
.ifi_mtu
- EVL_ENCAPLEN
;
720 * Copy only a selected subset of flags from the parent.
721 * Other flags are none of our business.
723 #define VLAN_INHERIT_FLAGS (IFF_BROADCAST | IFF_MULTICAST | \
724 IFF_SIMPLEX | IFF_POINTOPOINT)
726 ifp
->if_flags
&= ~VLAN_INHERIT_FLAGS
;
727 ifp
->if_flags
|= (ifp_p
->if_flags
& VLAN_INHERIT_FLAGS
);
729 #undef VLAN_INHERIT_FLAGS
732 * Set up our ``Ethernet address'' to reflect the underlying
733 * physical interface's.
735 sdl1
= IF_LLSOCKADDR(ifp
);
736 sdl2
= IF_LLSOCKADDR(ifp_p
);
737 sdl1
->sdl_type
= IFT_ETHER
;
738 sdl1
->sdl_alen
= ETHER_ADDR_LEN
;
739 bcopy(LLADDR(sdl2
), LLADDR(sdl1
), ETHER_ADDR_LEN
);
740 bcopy(LLADDR(sdl2
), ifv
->ifv_ac
.ac_enaddr
, ETHER_ADDR_LEN
);
743 * Release vlan's serializer before reprogramming parent's
744 * multicast filter to avoid possible dead lock.
746 ifnet_deserialize_all(ifp
);
749 * Configure multicast addresses that may already be
750 * joined on the vlan device.
752 vlan_setmulti(ifv
, ifp_p
);
755 * Set flags on the parent, if necessary.
757 vlan_setflags(ifv
, ifp_p
, 1);
760 * Connect to parent after everything have been set up,
761 * so input/output could know that vlan is ready to go
766 lwkt_replymsg(&vmsg
->base
.lmsg
, error
);
770 vlan_config(struct ifvlan
*ifv
, const char *parent_name
, uint16_t vlantag
)
772 struct netmsg_vlan vmsg
;
774 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
776 bzero(&vmsg
, sizeof(vmsg
));
778 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
779 0, vlan_config_dispatch
);
781 vmsg
.nv_parent_name
= parent_name
;
782 vmsg
.nv_vlantag
= vlantag
;
784 return lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);
788 vlan_unlink_dispatch(netmsg_t msg
)
790 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
791 struct ifvlan
*ifv
= vmsg
->nv_ifv
;
792 struct vlan_entry
*entry
;
795 KASSERT(vmsg
->nv_ifp_p
->if_vlantrunks
!= NULL
,
796 ("vlan trunk has not been initialized yet"));
797 entry
= &ifv
->ifv_entries
[cpu
];
800 LIST_REMOVE(entry
, ifv_link
);
803 ifnet_forwardmsg(&vmsg
->base
.lmsg
, cpu
+ 1);
807 vlan_unlink(struct ifvlan
*ifv
, struct ifnet
*ifp_p
)
809 struct vlan_trunk
*vlantrunks
= ifp_p
->if_vlantrunks
;
810 struct netmsg_vlan vmsg
;
812 /* Assert in netisr0 */
813 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
815 KASSERT(ifp_p
->if_vlantrunks
!= NULL
,
816 ("vlan trunk has not been initialized yet"));
818 bzero(&vmsg
, sizeof(vmsg
));
820 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
821 0, vlan_unlink_dispatch
);
823 vmsg
.nv_ifp_p
= ifp_p
;
825 ifnet_domsg(&vmsg
.base
.lmsg
, 0);
828 if (LIST_EMPTY(&vlantrunks
[mycpuid
].vlan_list
)) {
829 ifp_p
->if_vlantrunks
= NULL
;
832 * Make sure that all protocol threads see if_vlantrunks change.
834 netmsg_service_sync();
835 kfree(vlantrunks
, M_VLAN
);
841 vlan_unconfig_dispatch(netmsg_t msg
)
843 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
844 struct sockaddr_dl
*sdl
;
846 struct ifnet
*ifp_p
, *ifp
;
849 /* Assert in netisr0 */
854 if (ifp
->if_flags
& IFF_UP
)
857 ifnet_serialize_all(ifp
);
859 ifp
->if_flags
&= ~IFF_RUNNING
;
862 * Save parent ifnet pointer and disconnect from parent.
864 * This is done early in this function, so input/output could
865 * know that we are disconnecting.
871 * Release vlan's serializer before reprogramming parent's
872 * multicast filter to avoid possible dead lock.
874 ifnet_deserialize_all(ifp
);
878 * Since the interface is being unconfigured, we need to
879 * empty the list of multicast groups that we may have joined
880 * while we were alive from the parent's list.
882 vlan_clrmulti(ifv
, ifp_p
);
884 /* Clear parent's flags which was set by us. */
885 vlan_setflags(ifv
, ifp_p
, 0);
888 ifnet_serialize_all(ifp
);
890 ifp
->if_mtu
= ETHERMTU
;
892 /* Clear our MAC address. */
893 sdl
= IF_LLSOCKADDR(ifp
);
894 sdl
->sdl_type
= IFT_ETHER
;
895 sdl
->sdl_alen
= ETHER_ADDR_LEN
;
896 bzero(LLADDR(sdl
), ETHER_ADDR_LEN
);
897 bzero(ifv
->ifv_ac
.ac_enaddr
, ETHER_ADDR_LEN
);
899 ifnet_deserialize_all(ifp
);
901 /* Unlink vlan from parent's vlantrunk */
902 if (ifp_p
!= NULL
&& ifp_p
->if_vlantrunks
!= NULL
)
903 vlan_unlink(ifv
, ifp_p
);
906 lwkt_replymsg(&vmsg
->base
.lmsg
, error
);
910 vlan_unconfig(struct ifvlan
*ifv
)
912 struct netmsg_vlan vmsg
;
914 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
916 bzero(&vmsg
, sizeof(vmsg
));
918 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
919 0, vlan_unconfig_dispatch
);
922 return lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);
926 vlan_ioctl(struct ifnet
*ifp
, u_long cmd
, caddr_t data
, struct ucred
*cr
)
928 struct ifvlan
*ifv
= ifp
->if_softc
;
929 struct ifreq
*ifr
= (struct ifreq
*)data
;
934 ASSERT_IFNET_SERIALIZED_ALL(ifp
);
941 * Release vlan interface's serializer to void
942 * possible dead lock.
944 ifnet_deserialize_all(ifp
);
946 ifnet_serialize_all(ifp_p
);
947 error
= ifp_p
->if_ioctl(ifp_p
, SIOCGIFMEDIA
, data
, cr
);
948 ifnet_deserialize_all(ifp_p
);
950 ifnet_serialize_all(ifp
);
952 if (ifv
->ifv_p
== NULL
|| ifv
->ifv_p
!= ifp_p
) {
954 * We are disconnected from the original
955 * parent interface or the parent interface
956 * is changed, after vlan interface's
957 * serializer is released.
962 /* Limit the result to the parent's current config. */
964 struct ifmediareq
*ifmr
;
966 ifmr
= (struct ifmediareq
*) data
;
967 if (ifmr
->ifm_count
>= 1 && ifmr
->ifm_ulist
) {
969 error
= copyout(&ifmr
->ifm_current
,
984 error
= copyin(ifr
->ifr_data
, &vlr
, sizeof vlr
);
988 ifnet_deserialize_all(ifp
);
989 if (vlr
.vlr_parent
[0] == '\0')
990 error
= vlan_unconfig(ifv
);
992 error
= vlan_config(ifv
, vlr
.vlr_parent
, vlr
.vlr_tag
);
993 ifnet_serialize_all(ifp
);
997 bzero(&vlr
, sizeof(vlr
));
999 strlcpy(vlr
.vlr_parent
, ifv
->ifv_p
->if_xname
,
1000 sizeof(vlr
.vlr_parent
));
1001 vlr
.vlr_tag
= ifv
->ifv_tag
;
1003 error
= copyout(&vlr
, ifr
->ifr_data
, sizeof vlr
);
1007 if (ifp
->if_flags
& IFF_UP
)
1010 ifp
->if_flags
&= ~IFF_RUNNING
;
1013 * We should propagate selected flags to the parent,
1014 * e.g., promiscuous mode.
1016 ifnet_deserialize_all(ifp
);
1017 error
= vlan_config_flags(ifv
);
1018 ifnet_serialize_all(ifp
);
1023 ifnet_deserialize_all(ifp
);
1024 error
= vlan_config_multi(ifv
);
1025 ifnet_serialize_all(ifp
);
1029 error
= ether_ioctl(ifp
, cmd
, data
);
1036 vlan_multi_dispatch(netmsg_t msg
)
1038 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
1039 struct ifvlan
*ifv
= vmsg
->nv_ifv
;
1043 * If we don't have a parent, just remember the membership for
1046 if (ifv
->ifv_p
!= NULL
)
1047 error
= vlan_setmulti(ifv
, ifv
->ifv_p
);
1048 lwkt_replymsg(&vmsg
->base
.lmsg
, error
);
1052 vlan_config_multi(struct ifvlan
*ifv
)
1054 struct netmsg_vlan vmsg
;
1056 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
1058 bzero(&vmsg
, sizeof(vmsg
));
1060 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
1061 0, vlan_multi_dispatch
);
1064 return lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);
1068 vlan_flags_dispatch(netmsg_t msg
)
1070 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
1071 struct ifvlan
*ifv
= vmsg
->nv_ifv
;
1075 * If we don't have a parent, just remember the flags for
1078 if (ifv
->ifv_p
!= NULL
)
1079 error
= vlan_setflags(ifv
, ifv
->ifv_p
, 1);
1080 lwkt_replymsg(&vmsg
->base
.lmsg
, error
);
1084 vlan_config_flags(struct ifvlan
*ifv
)
1086 struct netmsg_vlan vmsg
;
1088 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
1090 bzero(&vmsg
, sizeof(vmsg
));
1092 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
1093 0, vlan_flags_dispatch
);
1096 return lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);