2 * hostapd / VLAN initialization
3 * Copyright 2003, Instant802 Networks, Inc.
4 * Copyright 2005-2006, Devicescape Software, Inc.
5 * Copyright (c) 2009, Jouni Malinen <j@w1.fi>
7 * This software may be distributed under the terms of the BSD license.
8 * See README for more details.
11 #include "utils/includes.h"
13 #include <sys/ioctl.h>
14 #ifdef CONFIG_FULL_DYNAMIC_VLAN
15 #include <linux/sockios.h>
16 #include <linux/if_vlan.h>
17 #include <linux/if_bridge.h>
18 #endif /* CONFIG_FULL_DYNAMIC_VLAN */
20 #include "utils/common.h"
22 #include "ap_config.h"
23 #include "ap_drv_ops.h"
25 #include "vlan_init.h"
26 #include "vlan_util.h"
29 #ifdef CONFIG_FULL_DYNAMIC_VLAN
31 #include "drivers/priv_netlink.h"
32 #include "utils/eloop.h"
35 struct full_dynamic_vlan {
36 int s; /* socket on which to listen for new/removed interfaces. */
39 #define DVLAN_CLEAN_BR 0x1
40 #define DVLAN_CLEAN_VLAN 0x2
41 #define DVLAN_CLEAN_VLAN_PORT 0x4
43 struct dynamic_iface {
44 char ifname[IFNAMSIZ + 1];
47 struct dynamic_iface *next;
51 /* Increment ref counter for ifname and add clean flag.
52 * If not in list, add it only if some flags are given.
54 static void dyn_iface_get(struct hostapd_data *hapd, const char *ifname,
57 struct dynamic_iface *next, **dynamic_ifaces;
58 struct hapd_interfaces *interfaces;
60 interfaces = hapd->iface->interfaces;
61 dynamic_ifaces = &interfaces->vlan_priv;
63 for (next = *dynamic_ifaces; next; next = next->next) {
64 if (os_strcmp(ifname, next->ifname) == 0)
77 next = os_zalloc(sizeof(*next));
80 os_strlcpy(next->ifname, ifname, sizeof(next->ifname));
83 next->next = *dynamic_ifaces;
84 *dynamic_ifaces = next;
88 /* Decrement reference counter for given ifname.
89 * Return clean flag iff reference counter was decreased to zero, else zero
91 static int dyn_iface_put(struct hostapd_data *hapd, const char *ifname)
93 struct dynamic_iface *next, *prev = NULL, **dynamic_ifaces;
94 struct hapd_interfaces *interfaces;
97 interfaces = hapd->iface->interfaces;
98 dynamic_ifaces = &interfaces->vlan_priv;
100 for (next = *dynamic_ifaces; next; next = next->next) {
101 if (os_strcmp(ifname, next->ifname) == 0)
114 prev->next = next->next;
116 *dynamic_ifaces = next->next;
123 #endif /* CONFIG_FULL_DYNAMIC_VLAN */
126 static int ifconfig_helper(const char *if_name, int up)
131 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
132 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
133 "failed: %s", __func__, strerror(errno));
137 os_memset(&ifr, 0, sizeof(ifr));
138 os_strlcpy(ifr.ifr_name, if_name, IFNAMSIZ);
140 if (ioctl(fd, SIOCGIFFLAGS, &ifr) != 0) {
141 wpa_printf(MSG_ERROR, "VLAN: %s: ioctl(SIOCGIFFLAGS) failed "
142 "for interface %s: %s",
143 __func__, if_name, strerror(errno));
149 ifr.ifr_flags |= IFF_UP;
151 ifr.ifr_flags &= ~IFF_UP;
153 if (ioctl(fd, SIOCSIFFLAGS, &ifr) != 0) {
154 wpa_printf(MSG_ERROR, "VLAN: %s: ioctl(SIOCSIFFLAGS) failed "
155 "for interface %s (up=%d): %s",
156 __func__, if_name, up, strerror(errno));
166 static int ifconfig_up(const char *if_name)
168 wpa_printf(MSG_DEBUG, "VLAN: Set interface %s up", if_name);
169 return ifconfig_helper(if_name, 1);
173 static int vlan_if_add(struct hostapd_data *hapd, struct hostapd_vlan *vlan,
178 for (i = 0; i < NUM_WEP_KEYS; i++) {
179 if (!hapd->conf->ssid.wep.key[i])
181 wpa_printf(MSG_ERROR,
182 "VLAN: Refusing to set up VLAN iface %s with WEP",
187 if (!if_nametoindex(vlan->ifname))
188 ret = hostapd_vlan_if_add(hapd, vlan->ifname);
197 ifconfig_up(vlan->ifname); /* else wpa group will fail fatal */
200 ret = wpa_auth_ensure_group(hapd->wpa_auth, vlan->vlan_id);
205 wpa_printf(MSG_ERROR, "WPA initialization for VLAN %d failed (%d)",
207 if (wpa_auth_release_group(hapd->wpa_auth, vlan->vlan_id))
208 wpa_printf(MSG_ERROR, "WPA deinit of %s failed", vlan->ifname);
210 /* group state machine setup failed */
211 if (hostapd_vlan_if_remove(hapd, vlan->ifname))
212 wpa_printf(MSG_ERROR, "Removal of %s failed", vlan->ifname);
218 static int vlan_if_remove(struct hostapd_data *hapd, struct hostapd_vlan *vlan)
222 ret = wpa_auth_release_group(hapd->wpa_auth, vlan->vlan_id);
224 wpa_printf(MSG_ERROR,
225 "WPA deinitialization for VLAN %d failed (%d)",
228 return hostapd_vlan_if_remove(hapd, vlan->ifname);
232 #ifdef CONFIG_FULL_DYNAMIC_VLAN
234 static int ifconfig_down(const char *if_name)
236 wpa_printf(MSG_DEBUG, "VLAN: Set interface %s down", if_name);
237 return ifconfig_helper(if_name, 0);
242 * These are only available in recent linux headers (without the leading
245 #define _GET_VLAN_REALDEV_NAME_CMD 8
246 #define _GET_VLAN_VID_CMD 9
248 /* This value should be 256 ONLY. If it is something else, then hostapd
249 * might crash!, as this value has been hard-coded in 2.4.x kernel
252 #define MAX_BR_PORTS 256
254 static int br_delif(const char *br_name, const char *if_name)
258 unsigned long args[2];
261 wpa_printf(MSG_DEBUG, "VLAN: br_delif(%s, %s)", br_name, if_name);
262 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
263 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
264 "failed: %s", __func__, strerror(errno));
268 if_index = if_nametoindex(if_name);
271 wpa_printf(MSG_ERROR, "VLAN: %s: Failure determining "
272 "interface index for '%s'",
278 args[0] = BRCTL_DEL_IF;
281 os_strlcpy(ifr.ifr_name, br_name, sizeof(ifr.ifr_name));
282 ifr.ifr_data = (__caddr_t) args;
284 if (ioctl(fd, SIOCDEVPRIVATE, &ifr) < 0 && errno != EINVAL) {
285 /* No error if interface already removed. */
286 wpa_printf(MSG_ERROR, "VLAN: %s: ioctl[SIOCDEVPRIVATE,"
287 "BRCTL_DEL_IF] failed for br_name=%s if_name=%s: "
288 "%s", __func__, br_name, if_name, strerror(errno));
299 Add interface 'if_name' to the bridge 'br_name'
302 returns 1 if the interface is already part of the bridge
305 static int br_addif(const char *br_name, const char *if_name)
309 unsigned long args[2];
312 wpa_printf(MSG_DEBUG, "VLAN: br_addif(%s, %s)", br_name, if_name);
313 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
314 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
315 "failed: %s", __func__, strerror(errno));
319 if_index = if_nametoindex(if_name);
322 wpa_printf(MSG_ERROR, "VLAN: %s: Failure determining "
323 "interface index for '%s'",
329 args[0] = BRCTL_ADD_IF;
332 os_strlcpy(ifr.ifr_name, br_name, sizeof(ifr.ifr_name));
333 ifr.ifr_data = (__caddr_t) args;
335 if (ioctl(fd, SIOCDEVPRIVATE, &ifr) < 0) {
336 if (errno == EBUSY) {
337 /* The interface is already added. */
342 wpa_printf(MSG_ERROR, "VLAN: %s: ioctl[SIOCDEVPRIVATE,"
343 "BRCTL_ADD_IF] failed for br_name=%s if_name=%s: "
344 "%s", __func__, br_name, if_name, strerror(errno));
354 static int br_delbr(const char *br_name)
357 unsigned long arg[2];
359 wpa_printf(MSG_DEBUG, "VLAN: br_delbr(%s)", br_name);
360 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
361 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
362 "failed: %s", __func__, strerror(errno));
366 arg[0] = BRCTL_DEL_BRIDGE;
367 arg[1] = (unsigned long) br_name;
369 if (ioctl(fd, SIOCGIFBR, arg) < 0 && errno != ENXIO) {
370 /* No error if bridge already removed. */
371 wpa_printf(MSG_ERROR, "VLAN: %s: BRCTL_DEL_BRIDGE failed for "
372 "%s: %s", __func__, br_name, strerror(errno));
383 Add a bridge with the name 'br_name'.
386 returns 1 if the bridge already exists
389 static int br_addbr(const char *br_name)
392 unsigned long arg[4];
395 wpa_printf(MSG_DEBUG, "VLAN: br_addbr(%s)", br_name);
396 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
397 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
398 "failed: %s", __func__, strerror(errno));
402 arg[0] = BRCTL_ADD_BRIDGE;
403 arg[1] = (unsigned long) br_name;
405 if (ioctl(fd, SIOCGIFBR, arg) < 0) {
406 if (errno == EEXIST) {
407 /* The bridge is already added. */
411 wpa_printf(MSG_ERROR, "VLAN: %s: BRCTL_ADD_BRIDGE "
413 __func__, br_name, strerror(errno));
419 /* Decrease forwarding delay to avoid EAPOL timeouts. */
420 os_memset(&ifr, 0, sizeof(ifr));
421 os_strlcpy(ifr.ifr_name, br_name, IFNAMSIZ);
422 arg[0] = BRCTL_SET_BRIDGE_FORWARD_DELAY;
426 ifr.ifr_data = (char *) &arg;
427 if (ioctl(fd, SIOCDEVPRIVATE, &ifr) < 0) {
428 wpa_printf(MSG_ERROR, "VLAN: %s: "
429 "BRCTL_SET_BRIDGE_FORWARD_DELAY (1 sec) failed for "
430 "%s: %s", __func__, br_name, strerror(errno));
431 /* Continue anyway */
439 static int br_getnumports(const char *br_name)
444 unsigned long arg[4];
445 int ifindices[MAX_BR_PORTS];
448 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
449 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
450 "failed: %s", __func__, strerror(errno));
454 arg[0] = BRCTL_GET_PORT_LIST;
455 arg[1] = (unsigned long) ifindices;
456 arg[2] = MAX_BR_PORTS;
459 os_memset(ifindices, 0, sizeof(ifindices));
460 os_strlcpy(ifr.ifr_name, br_name, sizeof(ifr.ifr_name));
461 ifr.ifr_data = (__caddr_t) arg;
463 if (ioctl(fd, SIOCDEVPRIVATE, &ifr) < 0) {
464 wpa_printf(MSG_ERROR, "VLAN: %s: BRCTL_GET_PORT_LIST "
466 __func__, br_name, strerror(errno));
471 for (i = 1; i < MAX_BR_PORTS; i++) {
472 if (ifindices[i] > 0) {
482 #ifndef CONFIG_VLAN_NETLINK
484 int vlan_rem(const char *if_name)
487 struct vlan_ioctl_args if_request;
489 wpa_printf(MSG_DEBUG, "VLAN: vlan_rem(%s)", if_name);
490 if ((os_strlen(if_name) + 1) > sizeof(if_request.device1)) {
491 wpa_printf(MSG_ERROR, "VLAN: Interface name too long: '%s'",
496 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
497 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
498 "failed: %s", __func__, strerror(errno));
502 os_memset(&if_request, 0, sizeof(if_request));
504 os_strlcpy(if_request.device1, if_name, sizeof(if_request.device1));
505 if_request.cmd = DEL_VLAN_CMD;
507 if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
508 wpa_printf(MSG_ERROR, "VLAN: %s: DEL_VLAN_CMD failed for %s: "
509 "%s", __func__, if_name, strerror(errno));
520 Add a vlan interface with VLAN ID 'vid' and tagged interface
524 returns 1 if the interface already exists
527 int vlan_add(const char *if_name, int vid, const char *vlan_if_name)
530 struct vlan_ioctl_args if_request;
532 wpa_printf(MSG_DEBUG, "VLAN: vlan_add(if_name=%s, vid=%d)",
534 ifconfig_up(if_name);
536 if ((os_strlen(if_name) + 1) > sizeof(if_request.device1)) {
537 wpa_printf(MSG_ERROR, "VLAN: Interface name too long: '%s'",
542 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
543 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
544 "failed: %s", __func__, strerror(errno));
548 os_memset(&if_request, 0, sizeof(if_request));
550 /* Determine if a suitable vlan device already exists. */
552 os_snprintf(if_request.device1, sizeof(if_request.device1), "vlan%d",
555 if_request.cmd = _GET_VLAN_VID_CMD;
557 if (ioctl(fd, SIOCSIFVLAN, &if_request) == 0) {
559 if (if_request.u.VID == vid) {
560 if_request.cmd = _GET_VLAN_REALDEV_NAME_CMD;
562 if (ioctl(fd, SIOCSIFVLAN, &if_request) == 0 &&
563 os_strncmp(if_request.u.device2, if_name,
564 sizeof(if_request.u.device2)) == 0) {
566 wpa_printf(MSG_DEBUG, "VLAN: vlan_add: "
567 "if_name %s exists already",
574 /* A suitable vlan device does not already exist, add one. */
576 os_memset(&if_request, 0, sizeof(if_request));
577 os_strlcpy(if_request.device1, if_name, sizeof(if_request.device1));
578 if_request.u.VID = vid;
579 if_request.cmd = ADD_VLAN_CMD;
581 if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
582 wpa_printf(MSG_ERROR, "VLAN: %s: ADD_VLAN_CMD failed for %s: "
584 __func__, if_request.device1, strerror(errno));
594 static int vlan_set_name_type(unsigned int name_type)
597 struct vlan_ioctl_args if_request;
599 wpa_printf(MSG_DEBUG, "VLAN: vlan_set_name_type(name_type=%u)",
601 if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
602 wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) "
603 "failed: %s", __func__, strerror(errno));
607 os_memset(&if_request, 0, sizeof(if_request));
609 if_request.u.name_type = name_type;
610 if_request.cmd = SET_VLAN_NAME_TYPE_CMD;
611 if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
612 wpa_printf(MSG_ERROR, "VLAN: %s: SET_VLAN_NAME_TYPE_CMD "
613 "name_type=%u failed: %s",
614 __func__, name_type, strerror(errno));
623 #endif /* CONFIG_VLAN_NETLINK */
626 static void vlan_newlink(char *ifname, struct hostapd_data *hapd)
628 char vlan_ifname[IFNAMSIZ];
629 char br_name[IFNAMSIZ];
630 struct hostapd_vlan *vlan = hapd->conf->vlan;
631 char *tagged_interface = hapd->conf->ssid.vlan_tagged_interface;
632 int vlan_naming = hapd->conf->ssid.vlan_naming;
635 wpa_printf(MSG_DEBUG, "VLAN: vlan_newlink(%s)", ifname);
638 if (os_strcmp(ifname, vlan->ifname) == 0 && !vlan->configured) {
639 vlan->configured = 1;
641 if (hapd->conf->vlan_bridge[0]) {
642 os_snprintf(br_name, sizeof(br_name), "%s%d",
643 hapd->conf->vlan_bridge,
645 } else if (tagged_interface) {
646 os_snprintf(br_name, sizeof(br_name),
647 "br%s.%d", tagged_interface,
650 os_snprintf(br_name, sizeof(br_name),
651 "brvlan%d", vlan->vlan_id);
654 dyn_iface_get(hapd, br_name,
655 br_addbr(br_name) ? 0 : DVLAN_CLEAN_BR);
657 ifconfig_up(br_name);
659 if (tagged_interface) {
661 DYNAMIC_VLAN_NAMING_WITH_DEVICE)
662 os_snprintf(vlan_ifname,
664 "%s.%d", tagged_interface,
667 os_snprintf(vlan_ifname,
669 "vlan%d", vlan->vlan_id);
672 ifconfig_up(tagged_interface);
673 if (!vlan_add(tagged_interface, vlan->vlan_id,
675 clean |= DVLAN_CLEAN_VLAN;
677 if (!br_addif(br_name, vlan_ifname))
678 clean |= DVLAN_CLEAN_VLAN_PORT;
680 dyn_iface_get(hapd, vlan_ifname, clean);
682 ifconfig_up(vlan_ifname);
685 if (!br_addif(br_name, ifname))
686 vlan->clean |= DVLAN_CLEAN_WLAN_PORT;
697 static void vlan_dellink(char *ifname, struct hostapd_data *hapd)
699 char vlan_ifname[IFNAMSIZ];
700 char br_name[IFNAMSIZ];
701 struct hostapd_vlan *first, *prev, *vlan = hapd->conf->vlan;
702 char *tagged_interface = hapd->conf->ssid.vlan_tagged_interface;
703 int vlan_naming = hapd->conf->ssid.vlan_naming;
706 wpa_printf(MSG_DEBUG, "VLAN: vlan_dellink(%s)", ifname);
711 if (os_strcmp(ifname, vlan->ifname) == 0 &&
713 if (hapd->conf->vlan_bridge[0]) {
714 os_snprintf(br_name, sizeof(br_name), "%s%d",
715 hapd->conf->vlan_bridge,
717 } else if (tagged_interface) {
718 os_snprintf(br_name, sizeof(br_name),
719 "br%s.%d", tagged_interface,
722 os_snprintf(br_name, sizeof(br_name),
723 "brvlan%d", vlan->vlan_id);
726 if (vlan->clean & DVLAN_CLEAN_WLAN_PORT)
727 br_delif(br_name, vlan->ifname);
729 if (tagged_interface) {
731 DYNAMIC_VLAN_NAMING_WITH_DEVICE)
732 os_snprintf(vlan_ifname,
734 "%s.%d", tagged_interface,
737 os_snprintf(vlan_ifname,
739 "vlan%d", vlan->vlan_id);
741 clean = dyn_iface_put(hapd, vlan_ifname);
743 if (clean & DVLAN_CLEAN_VLAN_PORT)
744 br_delif(br_name, vlan_ifname);
746 if (clean & DVLAN_CLEAN_VLAN) {
747 ifconfig_down(vlan_ifname);
748 vlan_rem(vlan_ifname);
752 clean = dyn_iface_put(hapd, br_name);
753 if ((clean & DVLAN_CLEAN_BR) &&
754 br_getnumports(br_name) == 0) {
755 ifconfig_down(br_name);
760 if (os_strcmp(ifname, vlan->ifname) == 0) {
762 hapd->conf->vlan = vlan->next;
764 prev->next = vlan->next;
777 vlan_read_ifnames(struct nlmsghdr *h, size_t len, int del,
778 struct hostapd_data *hapd)
780 struct ifinfomsg *ifi;
781 int attrlen, nlmsg_len, rta_len;
783 char ifname[IFNAMSIZ + 1];
785 if (len < sizeof(*ifi))
790 nlmsg_len = NLMSG_ALIGN(sizeof(struct ifinfomsg));
792 attrlen = h->nlmsg_len - nlmsg_len;
796 attr = (struct rtattr *) (((char *) ifi) + nlmsg_len);
798 os_memset(ifname, 0, sizeof(ifname));
799 rta_len = RTA_ALIGN(sizeof(struct rtattr));
800 while (RTA_OK(attr, attrlen)) {
801 if (attr->rta_type == IFLA_IFNAME) {
802 int n = attr->rta_len - rta_len;
806 if ((size_t) n >= sizeof(ifname))
807 n = sizeof(ifname) - 1;
808 os_memcpy(ifname, ((char *) attr) + rta_len, n);
812 attr = RTA_NEXT(attr, attrlen);
817 if (del && if_nametoindex(ifname)) {
818 /* interface still exists, race condition ->
819 * iface has just been recreated */
823 wpa_printf(MSG_DEBUG,
824 "VLAN: RTM_%sLINK: ifi_index=%d ifname=%s ifi_family=%d ifi_flags=0x%x (%s%s%s%s)",
826 ifi->ifi_index, ifname, ifi->ifi_family, ifi->ifi_flags,
827 (ifi->ifi_flags & IFF_UP) ? "[UP]" : "",
828 (ifi->ifi_flags & IFF_RUNNING) ? "[RUNNING]" : "",
829 (ifi->ifi_flags & IFF_LOWER_UP) ? "[LOWER_UP]" : "",
830 (ifi->ifi_flags & IFF_DORMANT) ? "[DORMANT]" : "");
833 vlan_dellink(ifname, hapd);
835 vlan_newlink(ifname, hapd);
839 static void vlan_event_receive(int sock, void *eloop_ctx, void *sock_ctx)
843 struct sockaddr_nl from;
846 struct hostapd_data *hapd = eloop_ctx;
848 fromlen = sizeof(from);
849 left = recvfrom(sock, buf, sizeof(buf), MSG_DONTWAIT,
850 (struct sockaddr *) &from, &fromlen);
852 if (errno != EINTR && errno != EAGAIN)
853 wpa_printf(MSG_ERROR, "VLAN: %s: recvfrom failed: %s",
854 __func__, strerror(errno));
858 h = (struct nlmsghdr *) buf;
859 while (NLMSG_OK(h, left)) {
863 plen = len - sizeof(*h);
864 if (len > left || plen < 0) {
865 wpa_printf(MSG_DEBUG, "VLAN: Malformed netlink "
866 "message: len=%d left=%d plen=%d",
871 switch (h->nlmsg_type) {
873 vlan_read_ifnames(h, plen, 0, hapd);
876 vlan_read_ifnames(h, plen, 1, hapd);
880 h = NLMSG_NEXT(h, left);
884 wpa_printf(MSG_DEBUG, "VLAN: %s: %d extra bytes in the end of "
885 "netlink message", __func__, left);
890 static struct full_dynamic_vlan *
891 full_dynamic_vlan_init(struct hostapd_data *hapd)
893 struct sockaddr_nl local;
894 struct full_dynamic_vlan *priv;
896 priv = os_zalloc(sizeof(*priv));
900 #ifndef CONFIG_VLAN_NETLINK
901 vlan_set_name_type(hapd->conf->ssid.vlan_naming ==
902 DYNAMIC_VLAN_NAMING_WITH_DEVICE ?
903 VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD :
904 VLAN_NAME_TYPE_PLUS_VID_NO_PAD);
905 #endif /* CONFIG_VLAN_NETLINK */
907 priv->s = socket(PF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
909 wpa_printf(MSG_ERROR, "VLAN: %s: socket(PF_NETLINK,SOCK_RAW,"
910 "NETLINK_ROUTE) failed: %s",
911 __func__, strerror(errno));
916 os_memset(&local, 0, sizeof(local));
917 local.nl_family = AF_NETLINK;
918 local.nl_groups = RTMGRP_LINK;
919 if (bind(priv->s, (struct sockaddr *) &local, sizeof(local)) < 0) {
920 wpa_printf(MSG_ERROR, "VLAN: %s: bind(netlink) failed: %s",
921 __func__, strerror(errno));
927 if (eloop_register_read_sock(priv->s, vlan_event_receive, hapd, NULL))
938 static void full_dynamic_vlan_deinit(struct full_dynamic_vlan *priv)
942 eloop_unregister_read_sock(priv->s);
946 #endif /* CONFIG_FULL_DYNAMIC_VLAN */
949 static int vlan_dynamic_add(struct hostapd_data *hapd,
950 struct hostapd_vlan *vlan)
953 if (vlan->vlan_id != VLAN_ID_WILDCARD) {
954 if (vlan_if_add(hapd, vlan, 1)) {
955 wpa_printf(MSG_ERROR,
956 "VLAN: Could not add VLAN %s: %s",
957 vlan->ifname, strerror(errno));
960 #ifdef CONFIG_FULL_DYNAMIC_VLAN
961 vlan_newlink(vlan->ifname, hapd);
962 #endif /* CONFIG_FULL_DYNAMIC_VLAN */
972 static void vlan_dynamic_remove(struct hostapd_data *hapd,
973 struct hostapd_vlan *vlan)
975 struct hostapd_vlan *next;
980 if (vlan->vlan_id != VLAN_ID_WILDCARD &&
981 vlan_if_remove(hapd, vlan)) {
982 wpa_printf(MSG_ERROR, "VLAN: Could not remove VLAN "
984 vlan->ifname, strerror(errno));
986 #ifdef CONFIG_FULL_DYNAMIC_VLAN
988 vlan_dellink(vlan->ifname, hapd);
989 #endif /* CONFIG_FULL_DYNAMIC_VLAN */
996 int vlan_init(struct hostapd_data *hapd)
998 #ifdef CONFIG_FULL_DYNAMIC_VLAN
999 hapd->full_dynamic_vlan = full_dynamic_vlan_init(hapd);
1000 #endif /* CONFIG_FULL_DYNAMIC_VLAN */
1002 if (hapd->conf->ssid.dynamic_vlan != DYNAMIC_VLAN_DISABLED &&
1003 !hapd->conf->vlan) {
1004 /* dynamic vlans enabled but no (or empty) vlan_file given */
1005 struct hostapd_vlan *vlan;
1006 vlan = os_zalloc(sizeof(*vlan));
1008 wpa_printf(MSG_ERROR, "Out of memory while assigning "
1013 vlan->vlan_id = VLAN_ID_WILDCARD;
1014 os_snprintf(vlan->ifname, sizeof(vlan->ifname), "%s.#",
1016 vlan->next = hapd->conf->vlan;
1017 hapd->conf->vlan = vlan;
1020 if (vlan_dynamic_add(hapd, hapd->conf->vlan))
1027 void vlan_deinit(struct hostapd_data *hapd)
1029 vlan_dynamic_remove(hapd, hapd->conf->vlan);
1031 #ifdef CONFIG_FULL_DYNAMIC_VLAN
1032 full_dynamic_vlan_deinit(hapd->full_dynamic_vlan);
1033 hapd->full_dynamic_vlan = NULL;
1034 #endif /* CONFIG_FULL_DYNAMIC_VLAN */
1038 struct hostapd_vlan * vlan_add_dynamic(struct hostapd_data *hapd,
1039 struct hostapd_vlan *vlan,
1042 struct hostapd_vlan *n = NULL;
1045 if (vlan == NULL || vlan_id <= 0 || vlan_id > MAX_VLAN_ID ||
1046 vlan->vlan_id != VLAN_ID_WILDCARD)
1049 wpa_printf(MSG_DEBUG, "VLAN: %s(vlan_id=%d ifname=%s)",
1050 __func__, vlan_id, vlan->ifname);
1051 ifname = os_strdup(vlan->ifname);
1054 pos = os_strchr(ifname, '#');
1059 n = os_zalloc(sizeof(*n));
1063 n->vlan_id = vlan_id;
1064 n->dynamic_vlan = 1;
1066 os_snprintf(n->ifname, sizeof(n->ifname), "%s%d%s", ifname, vlan_id,
1069 n->next = hapd->conf->vlan;
1070 hapd->conf->vlan = n;
1072 /* hapd->conf->vlan needs this new VLAN here for WPA setup */
1073 if (vlan_if_add(hapd, n, 0)) {
1074 hapd->conf->vlan = n->next;
1086 int vlan_remove_dynamic(struct hostapd_data *hapd, int vlan_id)
1088 struct hostapd_vlan *vlan;
1090 if (vlan_id <= 0 || vlan_id > MAX_VLAN_ID)
1093 wpa_printf(MSG_DEBUG, "VLAN: %s(ifname=%s vlan_id=%d)",
1094 __func__, hapd->conf->iface, vlan_id);
1096 vlan = hapd->conf->vlan;
1098 if (vlan->vlan_id == vlan_id && vlan->dynamic_vlan > 0) {
1099 vlan->dynamic_vlan--;
1108 if (vlan->dynamic_vlan == 0) {
1109 vlan_if_remove(hapd, vlan);
1110 #ifdef CONFIG_FULL_DYNAMIC_VLAN
1111 vlan_dellink(vlan->ifname, hapd);
1112 #endif /* CONFIG_FULL_DYNAMIC_VLAN */