18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hostapd / VLAN initialization 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright 2003, Instant802 Networks, Inc. 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright 2005-2006, Devicescape Software, Inc. 58d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2009, Jouni Malinen <j@w1.fi> 68d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This program is free software; you can redistribute it and/or modify 88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * it under the terms of the GNU General Public License version 2 as 98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * published by the Free Software Foundation. 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Alternatively, this software may be distributed under the terms of BSD 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * license. 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * See README and COPYING for more details. 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/includes.h" 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/common.h" 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "hostapd.h" 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "ap_config.h" 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "ap_drv_ops.h" 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "vlan_init.h" 2461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "vlan_util.h" 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_FULL_DYNAMIC_VLAN 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <net/if.h> 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <sys/ioctl.h> 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <linux/sockios.h> 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <linux/if_vlan.h> 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <linux/if_bridge.h> 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "drivers/priv_netlink.h" 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/eloop.h" 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct full_dynamic_vlan { 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int s; /* socket on which to listen for new/removed interfaces. */ 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int ifconfig_helper(const char *if_name, int up) 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&ifr, 0, sizeof(ifr)); 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, if_name, IFNAMSIZ); 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCGIFFLAGS, &ifr) != 0) { 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: ioctl(SIOCGIFFLAGS) failed " 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "for interface %s: %s", 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, if_name, strerror(errno)); 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (up) 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifr.ifr_flags |= IFF_UP; 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifr.ifr_flags &= ~IFF_UP; 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCSIFFLAGS, &ifr) != 0) { 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: ioctl(SIOCSIFFLAGS) failed " 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "for interface %s (up=%d): %s", 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, if_name, up, strerror(errno)); 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int ifconfig_up(const char *if_name) 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: Set interface %s up", if_name); 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ifconfig_helper(if_name, 1); 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int ifconfig_down(const char *if_name) 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: Set interface %s down", if_name); 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ifconfig_helper(if_name, 0); 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * These are only available in recent linux headers (without the leading 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * underscore). 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define _GET_VLAN_REALDEV_NAME_CMD 8 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define _GET_VLAN_VID_CMD 9 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* This value should be 256 ONLY. If it is something else, then hostapd 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * might crash!, as this value has been hard-coded in 2.4.x kernel 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * bridging code. 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define MAX_BR_PORTS 256 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int br_delif(const char *br_name, const char *if_name) 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned long args[2]; 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int if_index; 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: br_delif(%s, %s)", br_name, if_name); 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_index = if_nametoindex(if_name); 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (if_index == 0) { 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: Failure determining " 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "interface index for '%s'", 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, if_name); 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt args[0] = BRCTL_DEL_IF; 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt args[1] = if_index; 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, br_name, sizeof(ifr.ifr_name)); 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifr.ifr_data = (__caddr_t) args; 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCDEVPRIVATE, &ifr) < 0 && errno != EINVAL) { 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* No error if interface already removed. */ 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: ioctl[SIOCDEVPRIVATE," 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "BRCTL_DEL_IF] failed for br_name=%s if_name=%s: " 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s", __func__, br_name, if_name, strerror(errno)); 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt Add interface 'if_name' to the bridge 'br_name' 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns -1 on error 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns 1 if the interface is already part of the bridge 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns 0 otherwise 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt*/ 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int br_addif(const char *br_name, const char *if_name) 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned long args[2]; 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int if_index; 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: br_addif(%s, %s)", br_name, if_name); 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_index = if_nametoindex(if_name); 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (if_index == 0) { 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: Failure determining " 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "interface index for '%s'", 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, if_name); 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt args[0] = BRCTL_ADD_IF; 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt args[1] = if_index; 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, br_name, sizeof(ifr.ifr_name)); 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifr.ifr_data = (__caddr_t) args; 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCDEVPRIVATE, &ifr) < 0) { 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (errno == EBUSY) { 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* The interface is already added. */ 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 1; 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: ioctl[SIOCDEVPRIVATE," 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "BRCTL_ADD_IF] failed for br_name=%s if_name=%s: " 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s", __func__, br_name, if_name, strerror(errno)); 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int br_delbr(const char *br_name) 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned long arg[2]; 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: br_delbr(%s)", br_name); 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[0] = BRCTL_DEL_BRIDGE; 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[1] = (unsigned long) br_name; 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCGIFBR, arg) < 0 && errno != ENXIO) { 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* No error if bridge already removed. */ 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: BRCTL_DEL_BRIDGE failed for " 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s: %s", __func__, br_name, strerror(errno)); 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt Add a bridge with the name 'br_name'. 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns -1 on error 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns 1 if the bridge already exists 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns 0 otherwise 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt*/ 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int br_addbr(const char *br_name) 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned long arg[4]; 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: br_addbr(%s)", br_name); 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[0] = BRCTL_ADD_BRIDGE; 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[1] = (unsigned long) br_name; 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCGIFBR, arg) < 0) { 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (errno == EEXIST) { 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* The bridge is already added. */ 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 1; 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: BRCTL_ADD_BRIDGE " 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed for %s: %s", 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, br_name, strerror(errno)); 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Decrease forwarding delay to avoid EAPOL timeouts. */ 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&ifr, 0, sizeof(ifr)); 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, br_name, IFNAMSIZ); 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[0] = BRCTL_SET_BRIDGE_FORWARD_DELAY; 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[1] = 1; 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[2] = 0; 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[3] = 0; 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifr.ifr_data = (char *) &arg; 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCDEVPRIVATE, &ifr) < 0) { 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: " 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "BRCTL_SET_BRIDGE_FORWARD_DELAY (1 sec) failed for " 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s: %s", __func__, br_name, strerror(errno)); 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Continue anyway */ 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int br_getnumports(const char *br_name) 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int port_cnt = 0; 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned long arg[4]; 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ifindices[MAX_BR_PORTS]; 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[0] = BRCTL_GET_PORT_LIST; 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[1] = (unsigned long) ifindices; 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[2] = MAX_BR_PORTS; 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg[3] = 0; 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(ifindices, 0, sizeof(ifindices)); 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, br_name, sizeof(ifr.ifr_name)); 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifr.ifr_data = (__caddr_t) arg; 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCDEVPRIVATE, &ifr) < 0) { 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: BRCTL_GET_PORT_LIST " 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed for %s: %s", 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, br_name, strerror(errno)); 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 1; i < MAX_BR_PORTS; i++) { 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ifindices[i] > 0) { 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt port_cnt++; 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return port_cnt; 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 33961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifndef CONFIG_VLAN_NETLINK 34061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 34161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtint vlan_rem(const char *if_name) 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct vlan_ioctl_args if_request; 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: vlan_rem(%s)", if_name); 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((os_strlen(if_name) + 1) > sizeof(if_request.device1)) { 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: Interface name too long: '%s'", 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_name); 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&if_request, 0, sizeof(if_request)); 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(if_request.device1, if_name, sizeof(if_request.device1)); 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_request.cmd = DEL_VLAN_CMD; 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) { 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: DEL_VLAN_CMD failed for %s: " 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s", __func__, if_name, strerror(errno)); 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt Add a vlan interface with VLAN ID 'vid' and tagged interface 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 'if_name'. 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns -1 on error 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns 1 if the interface already exists 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt returns 0 otherwise 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt*/ 38461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtint vlan_add(const char *if_name, int vid, const char *vlan_if_name) 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct vlan_ioctl_args if_request; 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: vlan_add(if_name=%s, vid=%d)", 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_name, vid); 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifconfig_up(if_name); 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((os_strlen(if_name) + 1) > sizeof(if_request.device1)) { 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: Interface name too long: '%s'", 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_name); 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&if_request, 0, sizeof(if_request)); 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Determine if a suitable vlan device already exists. */ 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(if_request.device1, sizeof(if_request.device1), "vlan%d", 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vid); 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_request.cmd = _GET_VLAN_VID_CMD; 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCSIFVLAN, &if_request) == 0) { 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (if_request.u.VID == vid) { 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_request.cmd = _GET_VLAN_REALDEV_NAME_CMD; 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCSIFVLAN, &if_request) == 0 && 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strncmp(if_request.u.device2, if_name, 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(if_request.u.device2)) == 0) { 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: vlan_add: " 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "if_name %s exists already", 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_request.device1); 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 1; 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* A suitable vlan device does not already exist, add one. */ 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&if_request, 0, sizeof(if_request)); 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(if_request.device1, if_name, sizeof(if_request.device1)); 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_request.u.VID = vid; 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_request.cmd = ADD_VLAN_CMD; 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) { 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: ADD_VLAN_CMD failed for %s: " 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s", 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, if_request.device1, strerror(errno)); 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int vlan_set_name_type(unsigned int name_type) 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int fd; 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct vlan_ioctl_args if_request; 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: vlan_set_name_type(name_type=%u)", 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt name_type); 4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) { 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(AF_INET,SOCK_STREAM) " 4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "failed: %s", __func__, strerror(errno)); 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&if_request, 0, sizeof(if_request)); 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_request.u.name_type = name_type; 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_request.cmd = SET_VLAN_NAME_TYPE_CMD; 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) { 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: SET_VLAN_NAME_TYPE_CMD " 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "name_type=%u failed: %s", 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, name_type, strerror(errno)); 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(fd); 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 48061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_VLAN_NETLINK */ 48161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void vlan_newlink(char *ifname, struct hostapd_data *hapd) 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char vlan_ifname[IFNAMSIZ]; 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char br_name[IFNAMSIZ]; 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_vlan *vlan = hapd->conf->vlan; 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *tagged_interface = hapd->conf->ssid.vlan_tagged_interface; 48961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int vlan_naming = hapd->conf->ssid.vlan_naming; 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: vlan_newlink(%s)", ifname); 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (vlan) { 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strcmp(ifname, vlan->ifname) == 0) { 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(br_name, sizeof(br_name), "brvlan%d", 4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->vlan_id); 4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!br_addbr(br_name)) 5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->clean |= DVLAN_CLEAN_BR; 5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifconfig_up(br_name); 5038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tagged_interface) { 50561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (vlan_naming == 50661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt DYNAMIC_VLAN_NAMING_WITH_DEVICE) 50761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_snprintf(vlan_ifname, 50861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(vlan_ifname), 50961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s.%d", tagged_interface, 51061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt vlan->vlan_id); 51161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt else 51261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_snprintf(vlan_ifname, 51361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(vlan_ifname), 51461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "vlan%d", vlan->vlan_id); 51561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 51661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ifconfig_up(tagged_interface); 51761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (!vlan_add(tagged_interface, vlan->vlan_id, 51861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt vlan_ifname)) 5198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->clean |= DVLAN_CLEAN_VLAN; 5208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!br_addif(br_name, vlan_ifname)) 5228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->clean |= DVLAN_CLEAN_VLAN_PORT; 5238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifconfig_up(vlan_ifname); 5258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!br_addif(br_name, ifname)) 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->clean |= DVLAN_CLEAN_WLAN_PORT; 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifconfig_up(ifname); 5318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan = vlan->next; 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void vlan_dellink(char *ifname, struct hostapd_data *hapd) 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char vlan_ifname[IFNAMSIZ]; 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char br_name[IFNAMSIZ]; 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_vlan *first, *prev, *vlan = hapd->conf->vlan; 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *tagged_interface = hapd->conf->ssid.vlan_tagged_interface; 54561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int vlan_naming = hapd->conf->ssid.vlan_naming; 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: vlan_dellink(%s)", ifname); 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt first = prev = vlan; 5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (vlan) { 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strcmp(ifname, vlan->ifname) == 0) { 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(br_name, sizeof(br_name), "brvlan%d", 5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->vlan_id); 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan->clean & DVLAN_CLEAN_WLAN_PORT) 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt br_delif(br_name, vlan->ifname); 5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tagged_interface) { 56061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (vlan_naming == 56161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt DYNAMIC_VLAN_NAMING_WITH_DEVICE) 56261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_snprintf(vlan_ifname, 56361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(vlan_ifname), 56461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s.%d", tagged_interface, 56561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt vlan->vlan_id); 56661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt else 56761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_snprintf(vlan_ifname, 56861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(vlan_ifname), 56961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "vlan%d", vlan->vlan_id); 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan->clean & DVLAN_CLEAN_VLAN_PORT) 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt br_delif(br_name, vlan_ifname); 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifconfig_down(vlan_ifname); 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan->clean & DVLAN_CLEAN_VLAN) 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan_rem(vlan_ifname); 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((vlan->clean & DVLAN_CLEAN_BR) && 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt br_getnumports(br_name) == 0) { 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifconfig_down(br_name); 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt br_delbr(br_name); 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan == first) { 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hapd->conf->vlan = vlan->next; 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt prev->next = vlan->next; 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(vlan); 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt prev = vlan; 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan = vlan->next; 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvlan_read_ifnames(struct nlmsghdr *h, size_t len, int del, 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd) 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifinfomsg *ifi; 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int attrlen, nlmsg_len, rta_len; 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct rtattr *attr; 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < sizeof(*ifi)) 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifi = NLMSG_DATA(h); 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt nlmsg_len = NLMSG_ALIGN(sizeof(struct ifinfomsg)); 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attrlen = h->nlmsg_len - nlmsg_len; 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attrlen < 0) 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = (struct rtattr *) (((char *) ifi) + nlmsg_len); 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rta_len = RTA_ALIGN(sizeof(struct rtattr)); 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (RTA_OK(attr, attrlen)) { 6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char ifname[IFNAMSIZ + 1]; 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->rta_type == IFLA_IFNAME) { 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int n = attr->rta_len - rta_len; 6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (n < 0) 6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 6288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(ifname, 0, sizeof(ifname)); 6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((size_t) n > sizeof(ifname)) 6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt n = sizeof(ifname); 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ifname, ((char *) attr) + rta_len, n); 6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (del) 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan_dellink(ifname, hapd); 6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan_newlink(ifname, hapd); 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = RTA_NEXT(attr, attrlen); 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void vlan_event_receive(int sock, void *eloop_ctx, void *sock_ctx) 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char buf[8192]; 6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int left; 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_nl from; 6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen; 6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct nlmsghdr *h; 6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd = eloop_ctx; 6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fromlen = sizeof(from); 6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt left = recvfrom(sock, buf, sizeof(buf), MSG_DONTWAIT, 6578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &from, &fromlen); 6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (left < 0) { 6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (errno != EINTR && errno != EAGAIN) 6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: recvfrom failed: %s", 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, strerror(errno)); 6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt h = (struct nlmsghdr *) buf; 6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (left >= (int) sizeof(*h)) { 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int len, plen; 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = h->nlmsg_len; 6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt plen = len - sizeof(*h); 6718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len > left || plen < 0) { 6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: Malformed netlink " 6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "message: len=%d left=%d plen=%d", 6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len, left, plen); 6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 6768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (h->nlmsg_type) { 6798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case RTM_NEWLINK: 6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan_read_ifnames(h, plen, 0, hapd); 6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case RTM_DELLINK: 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan_read_ifnames(h, plen, 1, hapd); 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = NLMSG_ALIGN(len); 6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt left -= len; 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt h = (struct nlmsghdr *) ((char *) h + len); 6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (left > 0) { 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: %s: %d extra bytes in the end of " 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "netlink message", __func__, left); 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct full_dynamic_vlan * 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtfull_dynamic_vlan_init(struct hostapd_data *hapd) 7018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_nl local; 7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct full_dynamic_vlan *priv; 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt priv = os_zalloc(sizeof(*priv)); 7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (priv == NULL) 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 70961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifndef CONFIG_VLAN_NETLINK 71061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt vlan_set_name_type(hapd->conf->ssid.vlan_naming == 71161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt DYNAMIC_VLAN_NAMING_WITH_DEVICE ? 71261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD : 71361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt VLAN_NAME_TYPE_PLUS_VID_NO_PAD); 71461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_VLAN_NETLINK */ 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt priv->s = socket(PF_NETLINK, SOCK_RAW, NETLINK_ROUTE); 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (priv->s < 0) { 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: socket(PF_NETLINK,SOCK_RAW," 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "NETLINK_ROUTE) failed: %s", 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, strerror(errno)); 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(priv); 7228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&local, 0, sizeof(local)); 7268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt local.nl_family = AF_NETLINK; 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt local.nl_groups = RTMGRP_LINK; 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bind(priv->s, (struct sockaddr *) &local, sizeof(local)) < 0) { 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: %s: bind(netlink) failed: %s", 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, strerror(errno)); 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(priv->s); 7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(priv); 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (eloop_register_read_sock(priv->s, vlan_event_receive, hapd, NULL)) 7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt { 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(priv->s); 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(priv); 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return priv; 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void full_dynamic_vlan_deinit(struct full_dynamic_vlan *priv) 7488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (priv == NULL) 7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 7518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_unregister_read_sock(priv->s); 7528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(priv->s); 7538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(priv); 7548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_FULL_DYNAMIC_VLAN */ 7568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint vlan_setup_encryption_dyn(struct hostapd_data *hapd, 7598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_ssid *mssid, const char *dyn_vlan) 7608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 7628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dyn_vlan == NULL) 7648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 7658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Static WEP keys are set here; IEEE 802.1X and WPA uses their own 7678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * functions for setting up dynamic broadcast keys. */ 7688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < 4; i++) { 7698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (mssid->wep.key[i] && 7708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_drv_set_key(dyn_vlan, hapd, WPA_ALG_WEP, NULL, i, 7718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt i == mssid->wep.idx, NULL, 0, 7728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mssid->wep.key[i], mssid->wep.len[i])) 7738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt { 7748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: Could not set WEP " 7758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "encryption for dynamic VLAN"); 7768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 7778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 7818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int vlan_dynamic_add(struct hostapd_data *hapd, 7858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_vlan *vlan) 7868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (vlan) { 7888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan->vlan_id != VLAN_ID_WILDCARD) { 7898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hostapd_vlan_if_add(hapd, vlan->ifname)) { 7908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (errno != EEXIST) { 7918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: Could " 7928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "not add VLAN %s: %s", 7938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->ifname, 7948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt strerror(errno)); 7958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 7968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_FULL_DYNAMIC_VLAN 7998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifconfig_up(vlan->ifname); 8008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_FULL_DYNAMIC_VLAN */ 8018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan = vlan->next; 8048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 8078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void vlan_dynamic_remove(struct hostapd_data *hapd, 8118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_vlan *vlan) 8128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_vlan *next; 8148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (vlan) { 8168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt next = vlan->next; 8178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan->vlan_id != VLAN_ID_WILDCARD && 8198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_vlan_if_remove(hapd, vlan->ifname)) { 8208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "VLAN: Could not remove VLAN " 8218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "iface: %s: %s", 8228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->ifname, strerror(errno)); 8238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_FULL_DYNAMIC_VLAN 8258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan->clean) 8268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan_dellink(vlan->ifname, hapd); 8278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_FULL_DYNAMIC_VLAN */ 8288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan = next; 8308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint vlan_init(struct hostapd_data *hapd) 8358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_FULL_DYNAMIC_VLAN 8378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hapd->full_dynamic_vlan = full_dynamic_vlan_init(hapd); 8388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_FULL_DYNAMIC_VLAN */ 8398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan_dynamic_add(hapd, hapd->conf->vlan)) 8418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 8428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 8448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid vlan_deinit(struct hostapd_data *hapd) 8488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan_dynamic_remove(hapd, hapd->conf->vlan); 8508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_FULL_DYNAMIC_VLAN 8528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt full_dynamic_vlan_deinit(hapd->full_dynamic_vlan); 8538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_FULL_DYNAMIC_VLAN */ 8548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct hostapd_vlan * vlan_add_dynamic(struct hostapd_data *hapd, 8588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_vlan *vlan, 8598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int vlan_id) 8608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_vlan *n; 8628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *ifname, *pos; 8638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan == NULL || vlan_id <= 0 || vlan_id > MAX_VLAN_ID || 8658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->vlan_id != VLAN_ID_WILDCARD) 8668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 8678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: %s(vlan_id=%d ifname=%s)", 8698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, vlan_id, vlan->ifname); 8708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifname = os_strdup(vlan->ifname); 8718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ifname == NULL) 8728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 8738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = os_strchr(ifname, '#'); 8748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL) { 8758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ifname); 8768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 8778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = '\0'; 8798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt n = os_zalloc(sizeof(*n)); 8818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (n == NULL) { 8828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ifname); 8838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 8848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt n->vlan_id = vlan_id; 8878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt n->dynamic_vlan = 1; 8888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(n->ifname, sizeof(n->ifname), "%s%d%s", ifname, vlan_id, 8908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos); 8918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ifname); 8928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hostapd_vlan_if_add(hapd, n->ifname)) { 8948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(n); 8958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 8968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt n->next = hapd->conf->vlan; 8998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hapd->conf->vlan = n; 9008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_FULL_DYNAMIC_VLAN 9028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ifconfig_up(n->ifname); 9038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_FULL_DYNAMIC_VLAN */ 9048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return n; 9068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint vlan_remove_dynamic(struct hostapd_data *hapd, int vlan_id) 9108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_vlan *vlan; 9128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan_id <= 0 || vlan_id > MAX_VLAN_ID) 9148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 1; 9158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "VLAN: %s(vlan_id=%d)", __func__, vlan_id); 9178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan = hapd->conf->vlan; 9198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (vlan) { 9208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan->vlan_id == vlan_id && vlan->dynamic_vlan > 0) { 9218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan->dynamic_vlan--; 9228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 9238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt vlan = vlan->next; 9258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan == NULL) 9288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 1; 9298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (vlan->dynamic_vlan == 0) 9318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_vlan_if_remove(hapd, vlan->ifname); 9328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 9348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 935