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 <----------------------------------------------+
77 * : fwdmsg fwdmsg fwdmsg |
78 * :-----------> netisr1 --------> netisr2 --------> netisr3
79 * (link/unlink) (link/unlink) (link/unlink)
81 * - Parent interface's trunk is destroyed in the following lockless way:
83 * old_trunk = ifp->if_vlantrunks;
84 * ifp->if_vlantrunks = NULL;
85 * netmsg_service_sync();
89 * Since all of the accessing of if_vlantrunks only happens in network
90 * threads (percpu netisr and ifnet threads), after netmsg_service_sync()
91 * the network threads are promised to see only NULL if_vlantrunks; we
92 * are safe to free the "to be destroyed" parent interface's trunk
101 #include <sys/param.h>
102 #include <sys/systm.h>
103 #include <sys/kernel.h>
104 #include <sys/malloc.h>
105 #include <sys/mbuf.h>
106 #include <sys/module.h>
107 #include <sys/queue.h>
108 #include <sys/socket.h>
109 #include <sys/sockio.h>
110 #include <sys/sysctl.h>
112 #include <sys/thread2.h>
115 #include <net/ethernet.h>
117 #include <net/if_arp.h>
118 #include <net/if_dl.h>
119 #include <net/if_types.h>
120 #include <net/ifq_var.h>
121 #include <net/if_clone.h>
122 #include <net/netmsg2.h>
123 #include <net/netisr2.h>
126 #include <netinet/in.h>
127 #include <netinet/if_ether.h>
130 #include <net/vlan/if_vlan_var.h>
131 #include <net/vlan/if_vlan_ether.h>
135 struct vlan_mc_entry
{
136 struct ether_addr mc_addr
;
137 SLIST_ENTRY(vlan_mc_entry
) mc_entries
;
142 LIST_ENTRY(vlan_entry
) ifv_link
;
146 struct arpcom ifv_ac
; /* make this an interface */
147 struct ifnet
*ifv_p
; /* parent inteface of this vlan */
148 int ifv_pflags
; /* special flags we have set on parent */
151 uint16_t ifvm_proto
; /* encapsulation ethertype */
152 uint16_t ifvm_tag
; /* tag to apply on packets leaving if */
154 SLIST_HEAD(, vlan_mc_entry
) vlan_mc_listhead
;
155 LIST_ENTRY(ifvlan
) ifv_list
;
156 struct vlan_entry ifv_entries
[1];
158 #define ifv_if ifv_ac.ac_if
159 #define ifv_tag ifv_mib.ifvm_tag
162 LIST_HEAD(, vlan_entry
) vlan_list
;
166 struct netmsg_base base
;
167 struct ifvlan
*nv_ifv
;
168 struct ifnet
*nv_ifp_p
;
169 const char *nv_parent_name
;
173 #define VLANNAME "vlan"
175 SYSCTL_DECL(_net_link
);
176 SYSCTL_NODE(_net_link
, IFT_L2VLAN
, vlan
, CTLFLAG_RW
, 0, "IEEE 802.1Q VLAN");
177 SYSCTL_NODE(_net_link_vlan
, PF_LINK
, link
, CTLFLAG_RW
, 0, "for consistency");
179 static MALLOC_DEFINE(M_VLAN
, "vlan", "802.1Q Virtual LAN Interface");
180 static LIST_HEAD(, ifvlan
) ifv_list
;
182 static int vlan_clone_create(struct if_clone
*, int, caddr_t
);
183 static int vlan_clone_destroy(struct ifnet
*);
184 static void vlan_ifdetach(void *, struct ifnet
*);
186 static void vlan_init(void *);
187 static void vlan_start(struct ifnet
*, struct ifaltq_subque
*);
188 static int vlan_ioctl(struct ifnet
*, u_long
, caddr_t
, struct ucred
*);
189 static void vlan_input(struct mbuf
*);
191 static int vlan_setflags(struct ifvlan
*, struct ifnet
*, int);
192 static int vlan_setflag(struct ifvlan
*, struct ifnet
*, int, int,
193 int (*)(struct ifnet
*, int));
194 static int vlan_config_flags(struct ifvlan
*ifv
);
195 static void vlan_clrmulti(struct ifvlan
*, struct ifnet
*);
196 static int vlan_setmulti(struct ifvlan
*, struct ifnet
*);
197 static int vlan_config_multi(struct ifvlan
*);
198 static int vlan_config(struct ifvlan
*, const char *, uint16_t);
199 static int vlan_unconfig(struct ifvlan
*);
200 static void vlan_link(struct ifvlan
*, struct ifnet
*);
201 static void vlan_unlink(struct ifvlan
*, struct ifnet
*);
203 static void vlan_config_dispatch(netmsg_t
);
204 static void vlan_unconfig_dispatch(netmsg_t
);
205 static void vlan_link_dispatch(netmsg_t
);
206 static void vlan_unlink_dispatch(netmsg_t
);
207 static void vlan_multi_dispatch(netmsg_t
);
208 static void vlan_flags_dispatch(netmsg_t
);
209 static void vlan_ifdetach_dispatch(netmsg_t
);
211 /* Special flags we should propagate to parent */
214 int (*func
)(struct ifnet
*, int);
216 { IFF_PROMISC
, ifpromisc
},
217 { IFF_ALLMULTI
, if_allmulti
},
221 static eventhandler_tag vlan_ifdetach_cookie
;
222 static struct if_clone vlan_cloner
=
223 IF_CLONE_INITIALIZER("vlan", vlan_clone_create
, vlan_clone_destroy
,
227 * Handle IFF_* flags that require certain changes on the parent:
228 * if "set" is true, update parent's flags respective to our if_flags;
229 * if "set" is false, forcedly clear the flags set on parent.
232 vlan_setflags(struct ifvlan
*ifv
, struct ifnet
*ifp_p
, int set
)
236 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
238 for (i
= 0; vlan_pflags
[i
].func
!= NULL
; i
++) {
239 error
= vlan_setflag(ifv
, ifp_p
, vlan_pflags
[i
].flag
,
240 set
, vlan_pflags
[i
].func
);
247 /* Handle a reference counted flag that should be set on the parent as well */
249 vlan_setflag(struct ifvlan
*ifv
, struct ifnet
*ifp_p
, int flag
, int set
,
250 int (*func
)(struct ifnet
*, int))
252 struct ifnet
*ifp
= &ifv
->ifv_if
;
255 ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp
);
257 ifv_flag
= set
? (ifp
->if_flags
& flag
) : 0;
260 * See if recorded parent's status is different from what
261 * we want it to be. If it is, flip it. We record parent's
262 * status in ifv_pflags so that we won't clear parent's flag
263 * we haven't set. In fact, we don't clear or set parent's
264 * flags directly, but get or release references to them.
265 * That's why we can be sure that recorded flags still are
266 * in accord with actual parent's flags.
268 if (ifv_flag
!= (ifv
->ifv_pflags
& flag
)) {
269 error
= func(ifp_p
, ifv_flag
);
272 ifv
->ifv_pflags
&= ~flag
;
273 ifv
->ifv_pflags
|= ifv_flag
;
279 * Program our multicast filter. What we're actually doing is
280 * programming the multicast filter of the parent. This has the
281 * side effect of causing the parent interface to receive multicast
282 * traffic that it doesn't really want, which ends up being discarded
283 * later by the upper protocol layers. Unfortunately, there's no way
284 * to avoid this: there really is only one physical interface.
287 vlan_setmulti(struct ifvlan
*ifv
, struct ifnet
*ifp_p
)
289 struct ifmultiaddr
*ifma
;
290 struct vlan_mc_entry
*mc
= NULL
;
291 struct sockaddr_dl sdl
;
292 struct ifnet
*ifp
= &ifv
->ifv_if
;
294 ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp
);
297 * First, remove any existing filter entries.
299 vlan_clrmulti(ifv
, ifp_p
);
302 * Save the filter entries to be added to parent.
304 * TODO: need ifnet_serialize_main
306 ifnet_serialize_all(ifp
);
307 TAILQ_FOREACH(ifma
, &ifp
->if_multiaddrs
, ifma_link
) {
308 if (ifma
->ifma_addr
->sa_family
!= AF_LINK
)
312 mc
= kmalloc(sizeof(struct vlan_mc_entry
), M_VLAN
, M_WAITOK
);
313 bcopy(LLADDR((struct sockaddr_dl
*)ifma
->ifma_addr
),
314 &mc
->mc_addr
, ETHER_ADDR_LEN
);
315 SLIST_INSERT_HEAD(&ifv
->vlan_mc_listhead
, mc
, mc_entries
);
317 ifnet_deserialize_all(ifp
);
320 * Now program new ones.
322 bzero(&sdl
, sizeof(sdl
));
323 sdl
.sdl_len
= sizeof(sdl
);
324 sdl
.sdl_family
= AF_LINK
;
325 sdl
.sdl_index
= ifp_p
->if_index
;
326 sdl
.sdl_type
= IFT_ETHER
;
327 sdl
.sdl_alen
= ETHER_ADDR_LEN
;
330 * Program the parent multicast filter
332 SLIST_FOREACH(mc
, &ifv
->vlan_mc_listhead
, mc_entries
) {
335 bcopy(&mc
->mc_addr
, LLADDR(&sdl
), ETHER_ADDR_LEN
);
336 error
= if_addmulti(ifp_p
, (struct sockaddr
*)&sdl
, NULL
);
338 /* XXX probably should keep going */
346 vlan_clrmulti(struct ifvlan
*ifv
, struct ifnet
*ifp_p
)
348 struct vlan_mc_entry
*mc
;
349 struct sockaddr_dl sdl
;
351 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
353 bzero(&sdl
, sizeof(sdl
));
354 sdl
.sdl_len
= sizeof(sdl
);
355 sdl
.sdl_family
= AF_LINK
;
356 sdl
.sdl_index
= ifp_p
->if_index
;
357 sdl
.sdl_type
= IFT_ETHER
;
358 sdl
.sdl_alen
= ETHER_ADDR_LEN
;
360 while ((mc
= SLIST_FIRST(&ifv
->vlan_mc_listhead
)) != NULL
) {
361 bcopy(&mc
->mc_addr
, LLADDR(&sdl
), ETHER_ADDR_LEN
);
362 if_delmulti(ifp_p
, (struct sockaddr
*)&sdl
); /* ignore error */
364 SLIST_REMOVE_HEAD(&ifv
->vlan_mc_listhead
, mc_entries
);
370 vlan_modevent(module_t mod
, int type
, void *data
)
374 LIST_INIT(&ifv_list
);
375 vlan_input_p
= vlan_input
;
376 vlan_ifdetach_cookie
=
377 EVENTHANDLER_REGISTER(ifnet_detach_event
,
379 EVENTHANDLER_PRI_ANY
);
380 if_clone_attach(&vlan_cloner
);
384 if_clone_detach(&vlan_cloner
);
388 * Make sure that all protocol threads see vlan_input_p change.
390 netmsg_service_sync();
392 EVENTHANDLER_DEREGISTER(ifnet_detach_event
,
393 vlan_ifdetach_cookie
);
394 while (!LIST_EMPTY(&ifv_list
))
395 vlan_clone_destroy(&LIST_FIRST(&ifv_list
)->ifv_if
);
401 static moduledata_t vlan_mod
= {
407 DECLARE_MODULE(if_vlan
, vlan_mod
, SI_SUB_PSEUDO
, SI_ORDER_ANY
);
410 vlan_ifdetach_dispatch(netmsg_t msg
)
412 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
413 struct ifnet
*ifp_p
= vmsg
->nv_ifp_p
;
414 struct vlan_trunk
*vlantrunks
, *trunk
;
415 struct vlan_entry
*ifve
;
417 vlantrunks
= ifp_p
->if_vlantrunks
;
418 if (vlantrunks
== NULL
)
420 trunk
= &vlantrunks
[mycpuid
];
422 while (ifp_p
->if_vlantrunks
&&
423 (ifve
= LIST_FIRST(&trunk
->vlan_list
)) != NULL
)
424 vlan_unconfig(ifve
->ifv
);
426 lwkt_replymsg(&vmsg
->base
.lmsg
, 0);
430 vlan_ifdetach(void *arg __unused
, struct ifnet
*ifp
)
432 struct netmsg_vlan vmsg
;
434 ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp
);
436 bzero(&vmsg
, sizeof(vmsg
));
438 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
439 0, vlan_ifdetach_dispatch
);
442 lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);
446 vlan_clone_create(struct if_clone
*ifc
, int unit
, caddr_t param __unused
)
452 vlan_size
= sizeof(struct ifvlan
)
453 + ((ncpus
- 1) * sizeof(struct vlan_entry
));
454 ifv
= kmalloc(vlan_size
, M_VLAN
, M_WAITOK
| M_ZERO
);
455 SLIST_INIT(&ifv
->vlan_mc_listhead
);
456 for (i
= 0; i
< ncpus
; ++i
)
457 ifv
->ifv_entries
[i
].ifv
= ifv
;
459 crit_enter(); /* XXX not MP safe */
460 LIST_INSERT_HEAD(&ifv_list
, ifv
, ifv_list
);
465 if_initname(ifp
, "vlan", unit
);
466 /* NB: flags are not set here */
467 ifp
->if_linkmib
= &ifv
->ifv_mib
;
468 ifp
->if_linkmiblen
= sizeof ifv
->ifv_mib
;
469 /* NB: mtu is not set here */
471 ifp
->if_init
= vlan_init
;
472 ifp
->if_start
= vlan_start
;
473 ifp
->if_ioctl
= vlan_ioctl
;
474 ifq_set_maxlen(&ifp
->if_snd
, ifqmaxlen
);
475 ifq_set_ready(&ifp
->if_snd
);
476 ether_ifattach(ifp
, ifv
->ifv_ac
.ac_enaddr
, NULL
);
477 /* Now undo some of the damage... */
478 ifp
->if_data
.ifi_type
= IFT_L2VLAN
;
479 ifp
->if_data
.ifi_hdrlen
= EVL_ENCAPLEN
;
485 vlan_clone_destroy(struct ifnet
*ifp
)
487 struct ifvlan
*ifv
= ifp
->if_softc
;
489 crit_enter(); /* XXX not MP safe */
490 LIST_REMOVE(ifv
, ifv_list
);
504 struct ifvlan
*ifv
= xsc
;
505 struct ifnet
*ifp
= &ifv
->ifv_if
;
507 ASSERT_IFNET_SERIALIZED_ALL(ifp
);
509 if (ifv
->ifv_p
!= NULL
)
510 ifp
->if_flags
|= IFF_RUNNING
;
514 vlan_start(struct ifnet
*ifp
, struct ifaltq_subque
*ifsq
)
516 struct ifvlan
*ifv
= ifp
->if_softc
;
517 struct ifnet
*ifp_p
= ifv
->ifv_p
;
521 ASSERT_ALTQ_SQ_DEFAULT(ifp
, ifsq
);
522 ASSERT_ALTQ_SQ_SERIALIZED_HW(ifsq
);
529 if ((ifp
->if_flags
& IFF_RUNNING
) == 0)
532 p_port
= netisr_cpuport(
533 ifsq_get_cpuid(ifq_get_subq_default(&ifp_p
->if_snd
)));
535 struct netmsg_packet
*nmp
;
537 m
= ifsq_dequeue(ifsq
);
543 * Do not run parent's if_start() if the parent is not up,
544 * or parent's driver will cause a system crash.
546 if ((ifp_p
->if_flags
& (IFF_UP
| IFF_RUNNING
)) !=
547 (IFF_UP
| IFF_RUNNING
)) {
549 IFNET_STAT_INC(ifp
, collisions
, 1);
554 * We need some way to tell the interface where the packet
555 * came from so that it knows how to find the VLAN tag to
556 * use, so we set the ether_vlantag in the mbuf packet header
557 * to our vlan tag. We also set the M_VLANTAG flag in the
558 * mbuf to let the parent driver know that the ether_vlantag
561 m
->m_pkthdr
.ether_vlantag
= ifv
->ifv_tag
;
562 m
->m_flags
|= M_VLANTAG
;
564 nmp
= &m
->m_hdr
.mh_netmsg
;
566 netmsg_init(&nmp
->base
, NULL
, &netisr_apanic_rport
,
567 0, vlan_start_dispatch
);
569 nmp
->base
.lmsg
.u
.ms_resultp
= ifp_p
;
571 lwkt_sendmsg(p_port
, &nmp
->base
.lmsg
);
572 IFNET_STAT_INC(ifp
, opackets
, 1);
577 vlan_input(struct mbuf
*m
)
579 struct ifvlan
*ifv
= NULL
;
581 struct vlan_trunk
*vlantrunks
;
582 struct vlan_entry
*entry
;
584 rcvif
= m
->m_pkthdr
.rcvif
;
585 KKASSERT(m
->m_flags
& M_VLANTAG
);
587 vlantrunks
= rcvif
->if_vlantrunks
;
588 if (vlantrunks
== NULL
) {
589 IFNET_STAT_INC(rcvif
, noproto
, 1);
594 crit_enter(); /* XXX Necessary? */
595 LIST_FOREACH(entry
, &vlantrunks
[mycpuid
].vlan_list
, ifv_link
) {
596 if (entry
->ifv
->ifv_tag
==
597 EVL_VLANOFTAG(m
->m_pkthdr
.ether_vlantag
)) {
605 * Packet is discarded if:
606 * - no corresponding vlan(4) interface
607 * - vlan(4) interface has not been completely set up yet,
608 * or is being destroyed (ifv->ifv_p != rcvif)
610 if (ifv
== NULL
|| ifv
->ifv_p
!= rcvif
) {
611 IFNET_STAT_INC(rcvif
, noproto
, 1);
617 * Clear M_VLANTAG, before the packet is handed to
620 m
->m_flags
&= ~M_VLANTAG
;
622 ether_reinput_oncpu(&ifv
->ifv_if
, m
, REINPUT_RUNBPF
);
626 vlan_link_dispatch(netmsg_t msg
)
628 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
629 struct ifvlan
*ifv
= vmsg
->nv_ifv
;
630 struct ifnet
*ifp_p
= vmsg
->nv_ifp_p
;
631 struct vlan_entry
*entry
;
632 struct vlan_trunk
*vlantrunks
, *trunk
;
635 vlantrunks
= ifp_p
->if_vlantrunks
;
636 KASSERT(vlantrunks
!= NULL
,
637 ("vlan trunk has not been initialized yet"));
639 entry
= &ifv
->ifv_entries
[cpu
];
640 trunk
= &vlantrunks
[cpu
];
643 LIST_INSERT_HEAD(&trunk
->vlan_list
, entry
, ifv_link
);
646 netisr_forwardmsg(&vmsg
->base
, cpu
+ 1);
650 vlan_link(struct ifvlan
*ifv
, struct ifnet
*ifp_p
)
652 struct netmsg_vlan vmsg
;
654 /* Assert in netisr0 */
655 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
657 if (ifp_p
->if_vlantrunks
== NULL
) {
658 struct vlan_trunk
*vlantrunks
;
661 vlantrunks
= kmalloc(sizeof(*vlantrunks
) * ncpus
, M_VLAN
,
663 for (i
= 0; i
< ncpus
; ++i
)
664 LIST_INIT(&vlantrunks
[i
].vlan_list
);
666 ifp_p
->if_vlantrunks
= vlantrunks
;
669 bzero(&vmsg
, sizeof(vmsg
));
671 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
672 0, vlan_link_dispatch
);
674 vmsg
.nv_ifp_p
= ifp_p
;
676 netisr_domsg(&vmsg
.base
, 0);
680 vlan_config_dispatch(netmsg_t msg
)
682 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
684 struct ifnet
*ifp_p
, *ifp
;
685 struct sockaddr_dl
*sdl1
, *sdl2
;
688 /* Assert in netisr0 */
690 ifp_p
= ifunit_netisr(vmsg
->nv_parent_name
);
696 if (ifp_p
->if_data
.ifi_type
!= IFT_ETHER
) {
697 error
= EPROTONOSUPPORT
;
709 /* Link vlan into parent's vlantrunk */
710 vlan_link(ifv
, ifp_p
);
712 ifnet_serialize_all(ifp
);
714 ifv
->ifv_tag
= vmsg
->nv_vlantag
;
715 if (ifp_p
->if_capenable
& IFCAP_VLAN_MTU
)
716 ifp
->if_mtu
= ifp_p
->if_mtu
;
718 ifp
->if_mtu
= ifp_p
->if_data
.ifi_mtu
- EVL_ENCAPLEN
;
721 * Copy only a selected subset of flags from the parent.
722 * Other flags are none of our business.
724 #define VLAN_INHERIT_FLAGS (IFF_BROADCAST | IFF_MULTICAST | \
725 IFF_SIMPLEX | IFF_POINTOPOINT)
727 ifp
->if_flags
&= ~VLAN_INHERIT_FLAGS
;
728 ifp
->if_flags
|= (ifp_p
->if_flags
& VLAN_INHERIT_FLAGS
);
730 #undef VLAN_INHERIT_FLAGS
733 * Set up our ``Ethernet address'' to reflect the underlying
734 * physical interface's.
736 sdl1
= IF_LLSOCKADDR(ifp
);
737 sdl2
= IF_LLSOCKADDR(ifp_p
);
738 sdl1
->sdl_type
= IFT_ETHER
;
739 sdl1
->sdl_alen
= ETHER_ADDR_LEN
;
740 bcopy(LLADDR(sdl2
), LLADDR(sdl1
), ETHER_ADDR_LEN
);
741 bcopy(LLADDR(sdl2
), ifv
->ifv_ac
.ac_enaddr
, ETHER_ADDR_LEN
);
744 * Release vlan's serializer before reprogramming parent's
745 * multicast filter to avoid possible dead lock.
747 ifnet_deserialize_all(ifp
);
750 * Configure multicast addresses that may already be
751 * joined on the vlan device.
753 vlan_setmulti(ifv
, ifp_p
);
756 * Set flags on the parent, if necessary.
758 vlan_setflags(ifv
, ifp_p
, 1);
761 * Connect to parent after everything have been set up,
762 * so input/output could know that vlan is ready to go
767 lwkt_replymsg(&vmsg
->base
.lmsg
, error
);
771 vlan_config(struct ifvlan
*ifv
, const char *parent_name
, uint16_t vlantag
)
773 struct netmsg_vlan vmsg
;
775 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
777 bzero(&vmsg
, sizeof(vmsg
));
779 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
780 0, vlan_config_dispatch
);
782 vmsg
.nv_parent_name
= parent_name
;
783 vmsg
.nv_vlantag
= vlantag
;
785 return lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);
789 vlan_unlink_dispatch(netmsg_t msg
)
791 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
792 struct ifvlan
*ifv
= vmsg
->nv_ifv
;
793 struct vlan_entry
*entry
;
796 KASSERT(vmsg
->nv_ifp_p
->if_vlantrunks
!= NULL
,
797 ("vlan trunk has not been initialized yet"));
798 entry
= &ifv
->ifv_entries
[cpu
];
801 LIST_REMOVE(entry
, ifv_link
);
804 netisr_forwardmsg(&vmsg
->base
, cpu
+ 1);
808 vlan_unlink(struct ifvlan
*ifv
, struct ifnet
*ifp_p
)
810 struct vlan_trunk
*vlantrunks
= ifp_p
->if_vlantrunks
;
811 struct netmsg_vlan vmsg
;
813 /* Assert in netisr0 */
814 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
816 KASSERT(ifp_p
->if_vlantrunks
!= NULL
,
817 ("vlan trunk has not been initialized yet"));
819 bzero(&vmsg
, sizeof(vmsg
));
821 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
822 0, vlan_unlink_dispatch
);
824 vmsg
.nv_ifp_p
= ifp_p
;
826 netisr_domsg(&vmsg
.base
, 0);
829 if (LIST_EMPTY(&vlantrunks
[mycpuid
].vlan_list
)) {
830 ifp_p
->if_vlantrunks
= NULL
;
833 * Make sure that all protocol threads see if_vlantrunks change.
835 netmsg_service_sync();
836 kfree(vlantrunks
, M_VLAN
);
842 vlan_unconfig_dispatch(netmsg_t msg
)
844 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
845 struct sockaddr_dl
*sdl
;
847 struct ifnet
*ifp_p
, *ifp
;
850 /* Assert in netisr0 */
855 if (ifp
->if_flags
& IFF_UP
)
858 ifnet_serialize_all(ifp
);
860 ifp
->if_flags
&= ~IFF_RUNNING
;
863 * Save parent ifnet pointer and disconnect from parent.
865 * This is done early in this function, so input/output could
866 * know that we are disconnecting.
872 * Release vlan's serializer before reprogramming parent's
873 * multicast filter to avoid possible dead lock.
875 ifnet_deserialize_all(ifp
);
879 * Since the interface is being unconfigured, we need to
880 * empty the list of multicast groups that we may have joined
881 * while we were alive from the parent's list.
883 vlan_clrmulti(ifv
, ifp_p
);
885 /* Clear parent's flags which was set by us. */
886 vlan_setflags(ifv
, ifp_p
, 0);
889 ifnet_serialize_all(ifp
);
891 ifp
->if_mtu
= ETHERMTU
;
893 /* Clear our MAC address. */
894 sdl
= IF_LLSOCKADDR(ifp
);
895 sdl
->sdl_type
= IFT_ETHER
;
896 sdl
->sdl_alen
= ETHER_ADDR_LEN
;
897 bzero(LLADDR(sdl
), ETHER_ADDR_LEN
);
898 bzero(ifv
->ifv_ac
.ac_enaddr
, ETHER_ADDR_LEN
);
900 ifnet_deserialize_all(ifp
);
902 /* Unlink vlan from parent's vlantrunk */
903 if (ifp_p
!= NULL
&& ifp_p
->if_vlantrunks
!= NULL
)
904 vlan_unlink(ifv
, ifp_p
);
907 lwkt_replymsg(&vmsg
->base
.lmsg
, error
);
911 vlan_unconfig(struct ifvlan
*ifv
)
913 struct netmsg_vlan vmsg
;
915 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
917 bzero(&vmsg
, sizeof(vmsg
));
919 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
920 0, vlan_unconfig_dispatch
);
923 return lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);
927 vlan_ioctl(struct ifnet
*ifp
, u_long cmd
, caddr_t data
, struct ucred
*cr
)
929 struct ifvlan
*ifv
= ifp
->if_softc
;
930 struct ifreq
*ifr
= (struct ifreq
*)data
;
935 ASSERT_IFNET_SERIALIZED_ALL(ifp
);
942 * Release vlan interface's serializer to void
943 * possible dead lock.
945 ifnet_deserialize_all(ifp
);
947 ifnet_serialize_all(ifp_p
);
948 error
= ifp_p
->if_ioctl(ifp_p
, SIOCGIFMEDIA
, data
, cr
);
949 ifnet_deserialize_all(ifp_p
);
951 ifnet_serialize_all(ifp
);
953 if (ifv
->ifv_p
== NULL
|| ifv
->ifv_p
!= ifp_p
) {
955 * We are disconnected from the original
956 * parent interface or the parent interface
957 * is changed, after vlan interface's
958 * serializer is released.
963 /* Limit the result to the parent's current config. */
965 struct ifmediareq
*ifmr
;
967 ifmr
= (struct ifmediareq
*) data
;
968 if (ifmr
->ifm_count
>= 1 && ifmr
->ifm_ulist
) {
970 error
= copyout(&ifmr
->ifm_current
,
985 error
= copyin(ifr
->ifr_data
, &vlr
, sizeof vlr
);
989 ifnet_deserialize_all(ifp
);
990 if (vlr
.vlr_parent
[0] == '\0')
991 error
= vlan_unconfig(ifv
);
993 error
= vlan_config(ifv
, vlr
.vlr_parent
, vlr
.vlr_tag
);
994 ifnet_serialize_all(ifp
);
998 bzero(&vlr
, sizeof(vlr
));
1000 strlcpy(vlr
.vlr_parent
, ifv
->ifv_p
->if_xname
,
1001 sizeof(vlr
.vlr_parent
));
1002 vlr
.vlr_tag
= ifv
->ifv_tag
;
1004 error
= copyout(&vlr
, ifr
->ifr_data
, sizeof vlr
);
1008 if (ifp
->if_flags
& IFF_UP
)
1011 ifp
->if_flags
&= ~IFF_RUNNING
;
1014 * We should propagate selected flags to the parent,
1015 * e.g., promiscuous mode.
1017 ifnet_deserialize_all(ifp
);
1018 error
= vlan_config_flags(ifv
);
1019 ifnet_serialize_all(ifp
);
1024 ifnet_deserialize_all(ifp
);
1025 error
= vlan_config_multi(ifv
);
1026 ifnet_serialize_all(ifp
);
1030 error
= ether_ioctl(ifp
, cmd
, data
);
1037 vlan_multi_dispatch(netmsg_t msg
)
1039 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
1040 struct ifvlan
*ifv
= vmsg
->nv_ifv
;
1044 * If we don't have a parent, just remember the membership for
1047 if (ifv
->ifv_p
!= NULL
)
1048 error
= vlan_setmulti(ifv
, ifv
->ifv_p
);
1049 lwkt_replymsg(&vmsg
->base
.lmsg
, error
);
1053 vlan_config_multi(struct ifvlan
*ifv
)
1055 struct netmsg_vlan vmsg
;
1057 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
1059 bzero(&vmsg
, sizeof(vmsg
));
1061 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
1062 0, vlan_multi_dispatch
);
1065 return lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);
1069 vlan_flags_dispatch(netmsg_t msg
)
1071 struct netmsg_vlan
*vmsg
= (struct netmsg_vlan
*)msg
;
1072 struct ifvlan
*ifv
= vmsg
->nv_ifv
;
1076 * If we don't have a parent, just remember the flags for
1079 if (ifv
->ifv_p
!= NULL
)
1080 error
= vlan_setflags(ifv
, ifv
->ifv_p
, 1);
1081 lwkt_replymsg(&vmsg
->base
.lmsg
, error
);
1085 vlan_config_flags(struct ifvlan
*ifv
)
1087 struct netmsg_vlan vmsg
;
1089 ASSERT_IFNET_NOT_SERIALIZED_ALL(&ifv
->ifv_if
);
1091 bzero(&vmsg
, sizeof(vmsg
));
1093 netmsg_init(&vmsg
.base
, NULL
, &curthread
->td_msgport
,
1094 0, vlan_flags_dispatch
);
1097 return lwkt_domsg(netisr_cpuport(0), &vmsg
.base
.lmsg
, 0);