version 1.1.2.1, 2010/10/27 15:23:49
|
version 1.4, 2014/02/05 15:44:06
|
Line 1
|
Line 1
|
|
/************************************************************************* |
|
* (C) 2010 AITNET - Sofia/Bulgaria - <office@aitbg.com> |
|
* by Michael Pounov <misho@aitbg.com> |
|
* |
|
* $Author$ |
|
* $Id$ |
|
* |
|
************************************************************************* |
|
The ELWIX and AITNET software is distributed under the following |
|
terms: |
|
|
|
All of the documentation and software included in the ELWIX and AITNET |
|
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
|
|
|
Copyright 2004 - 2014 |
|
by Michael Pounov <misho@elwix.org>. All rights reserved. |
|
|
|
Redistribution and use in source and binary forms, with or without |
|
modification, are permitted provided that the following conditions |
|
are met: |
|
1. Redistributions of source code must retain the above copyright |
|
notice, this list of conditions and the following disclaimer. |
|
2. Redistributions in binary form must reproduce the above copyright |
|
notice, this list of conditions and the following disclaimer in the |
|
documentation and/or other materials provided with the distribution. |
|
3. All advertising materials mentioning features or use of this software |
|
must display the following acknowledgement: |
|
This product includes software developed by Michael Pounov <misho@elwix.org> |
|
ELWIX - Embedded LightWeight unIX and its contributors. |
|
4. Neither the name of AITNET nor the names of its contributors |
|
may be used to endorse or promote products derived from this software |
|
without specific prior written permission. |
|
|
|
THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND |
|
ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
|
ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE |
|
FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
|
DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
|
OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
|
HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
|
LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
|
OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
|
SUCH DAMAGE. |
|
*/ |
#include "global.h" |
#include "global.h" |
#include "dwds.h" |
#include "dwds.h" |
|
|
|
|
|
static inline int |
|
wifi_getParent(const char *csVAP, char *psParent, size_t plen) |
|
{ |
|
char szOID[STRSIZ] = { 0 }; |
|
|
|
FTRACE(5); |
|
|
|
assert(csVAP); |
|
assert(psParent); |
|
|
|
memset(psParent, 0, plen); |
|
snprintf(szOID, STRSIZ, "net.wlan.%s.%%parent", csVAP + 4); |
|
if (sysctlbyname(szOID, psParent, &plen, NULL, 0) == -1) { |
|
// syslog(LOG_ERR, "Error:: can`t get parent #%d - %s\n", errno, strerror(errno)); |
|
return -1; |
|
} else |
|
psParent[plen] = 0; |
|
|
|
return 0; |
|
} |
|
|
|
inline int |
|
wifi_chkIface(const char *csVAP, char **ppsIF, int nIF) |
|
{ |
|
char szParent[IFNAMSIZ]; |
|
register int i; |
|
|
|
FTRACE(5); |
|
|
|
assert(csVAP); |
|
|
|
if (wifi_getParent(csVAP, szParent, IFNAMSIZ) == -1) |
|
return 0; |
|
|
|
for (i = 0; i < nIF; i++) |
|
if (!strcasecmp(ppsIF[i], "any") || !strcmp(ppsIF[i], szParent)) |
|
return 1; /* OK, vap is child */ |
|
|
|
VERB(2) syslog(LOG_ERR, "Error:: Interface %s parent %s not being monitored", csVAP, szParent); |
|
return 0; |
|
} |
|
|
|
static inline int |
|
wifi_isWDS(int fd, const char *csVAP) |
|
{ |
|
struct ifmediareq ifmr; |
|
|
|
FTRACE(5); |
|
|
|
assert(csVAP); |
|
|
|
memset(&ifmr, 0, sizeof ifmr); |
|
strlcpy(ifmr.ifm_name, csVAP, sizeof ifmr.ifm_name); |
|
if (ioctl(fd, SIOCGIFMEDIA, &ifmr) == -1) { |
|
syslog(LOG_ERR, "Error:: can`t get media for %s #%d - %s\n", csVAP, |
|
errno, strerror(errno)); |
|
return -1; |
|
} |
|
|
|
return (ifmr.ifm_current & IFM_IEEE80211_WDS) != 0; |
|
} |
|
|
|
static inline int |
|
wifi_getBSSID(int fd, const char *csVAP, uint8_t *psBSSID, int len) |
|
{ |
|
struct ieee80211req ireq; |
|
|
|
FTRACE(5); |
|
|
|
assert(csVAP); |
|
assert(psBSSID); |
|
|
|
memset(&ireq, 0, sizeof ireq); |
|
strlcpy(ireq.i_name, csVAP, sizeof ireq.i_name); |
|
ireq.i_type = IEEE80211_IOC_BSSID; |
|
ireq.i_data = psBSSID; |
|
ireq.i_len = len; |
|
if (ioctl(fd, SIOCG80211, &ireq) == -1) { |
|
syslog(LOG_ERR, "Error:: can`t get BSSID for %s #%d - %s\n", csVAP, |
|
errno, strerror(errno)); |
|
return -1; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
struct dwds_if * |
|
wifi_buildWDS(int fd, char **ppsIF, int nIF) |
|
{ |
|
struct dwds_if *p, *wds = NULL; |
|
char szVAP[IFNAMSIZ]; |
|
struct ether_addr bssid; |
|
register int i; |
|
|
|
FTRACE(5); |
|
|
|
for (i = 0; i < 128; i++) { |
|
memset(szVAP, 0, IFNAMSIZ); |
|
snprintf(szVAP, IFNAMSIZ, "wlan%d", i); |
|
if (wifi_chkIface(szVAP, ppsIF, nIF) && !wifi_isWDS(fd, szVAP)) { |
|
p = malloc(sizeof(struct dwds_if)); |
|
if (!p) { |
|
syslog(LOG_ERR, "Error:: can`t allocate memory #%d - %s\n", |
|
errno, strerror(errno)); |
|
i = -1; |
|
break; |
|
} |
|
strlcpy(p->if_name, szVAP, IFNAMSIZ); |
|
if (wifi_getBSSID(fd, szVAP, p->if_bssid, IEEE80211_ADDR_LEN) == -1) { |
|
syslog(LOG_ERR, "Error:: can`t get BSSID #%d - %s\n", |
|
errno, strerror(errno)); |
|
i = -1; |
|
break; |
|
} |
|
p->if_next = wds; |
|
wds = p; |
|
|
|
memcpy(&bssid, p->if_bssid, ETHER_ADDR_LEN); |
|
syslog(LOG_INFO, "BSSID:%s discover WDS vap %s\n", ether_ntoa(&bssid), szVAP); |
|
} |
|
} |
|
|
|
if (i == -1) |
|
while ((p = wds)) { |
|
wds = wds->if_next; |
|
free(p); |
|
} |
|
|
|
return wds; |
|
} |
|
|
|
inline int |
|
wifi_destroyWDS(const char *csIface, struct dwds_if **wds) |
|
{ |
|
struct dwds_if *p, **pp; |
|
|
|
FTRACE(5); |
|
|
|
assert(csIface); |
|
assert(wds); |
|
|
|
for (pp = wds; (p = *pp); pp = &p->if_next) |
|
if (!strncmp(p->if_name, csIface, IFNAMSIZ)) |
|
break; |
|
if (p) { |
|
*pp = p->if_next; |
|
free(p); |
|
return 0; |
|
} |
|
|
|
return 1; |
|
} |
|
|
|
static int |
|
wifi_vapDestroy(const char *csVAP) |
|
{ |
|
struct ieee80211req ifr; |
|
int s; |
|
|
|
FTRACE(5); |
|
|
|
assert(csVAP); |
|
|
|
s = socket(PF_INET, SOCK_DGRAM, 0); |
|
if (s == -1) { |
|
syslog(LOG_ERR, "Error:: destroy socket(vap) %m\n"); |
|
return -1; |
|
} |
|
|
|
memset(&ifr, 0, sizeof ifr); |
|
strlcpy(ifr.i_name, csVAP, IFNAMSIZ); |
|
if (ioctl(s, SIOCIFDESTROY, &ifr) == -1) { |
|
syslog(LOG_ERR, "Error:: destroy ioctl(vap) %m\n"); |
|
close(s); |
|
return -1; |
|
} else |
|
close(s); |
|
|
|
return 0; |
|
} |
|
|
|
inline int |
|
wifi_leaveWDS(struct ether_addr bssid, struct dwds_if **wds, char *psVAP, int vapLen) |
|
{ |
|
struct dwds_if *p, **pp; |
|
|
|
FTRACE(5); |
|
|
|
assert(wds); |
|
assert(psVAP); |
|
|
|
for (pp = wds; (p = *pp); pp = &p->if_next) |
|
if (!memcmp(p->if_bssid, &bssid, IEEE80211_ADDR_LEN)) |
|
break; |
|
if (p) { |
|
*pp = p->if_next; |
|
strlcpy(psVAP, p->if_name, vapLen); |
|
if (wifi_vapDestroy(p->if_name) != -1) |
|
VERB(1) syslog(LOG_INFO, "BSSID:%s WDS VAP %s destroyed\n", |
|
ether_ntoa(&bssid), p->if_name); |
|
free(p); |
|
return 0; |
|
} |
|
|
|
return 1; |
|
} |
|
|
|
static int |
|
wifi_vapCreate(const char *csIface, struct dwds_if *p) |
|
{ |
|
struct ieee80211_clone_params cp; |
|
struct ifreq ifr; |
|
struct ether_addr bssid; |
|
int s; |
|
|
|
FTRACE(5); |
|
|
|
assert(csIface); |
|
assert(p); |
|
|
|
s = socket(PF_INET, SOCK_DGRAM, 0); |
|
if (s == -1) { |
|
syslog(LOG_ERR, "Error:: create socket(vap) %m\n"); |
|
return -1; |
|
} |
|
|
|
memset(&cp, 0, sizeof cp); |
|
strlcpy(cp.icp_parent, csIface, IFNAMSIZ); |
|
cp.icp_opmode = IEEE80211_M_WDS; |
|
memcpy(cp.icp_bssid, p->if_bssid, IEEE80211_ADDR_LEN); |
|
|
|
memset(&ifr, 0, sizeof ifr); |
|
strlcpy(ifr.ifr_name, "wlan", IFNAMSIZ); |
|
ifr.ifr_data = (void *) &cp; |
|
|
|
if (ioctl(s, SIOCIFCREATE2, &ifr) == -1) { |
|
memcpy(&bssid, cp.icp_bssid, IEEE80211_ADDR_LEN); |
|
syslog(LOG_ERR, "Error:: create ioctl(vap) mode %u flags 0x%x parent %s bssid %s %m\n", |
|
cp.icp_opmode, cp.icp_flags, cp.icp_parent, ether_ntoa(&bssid)); |
|
close(s); |
|
return -1; |
|
} else { |
|
strlcpy(p->if_name, ifr.ifr_name, IFNAMSIZ); |
|
close(s); |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
inline int |
|
wifi_createWDS(const char *csIface, struct ether_addr bssid, struct dwds_if **wds) |
|
{ |
|
struct dwds_if *p; |
|
char szParent[IFNAMSIZ]; |
|
|
|
FTRACE(5); |
|
|
|
assert(csIface); |
|
assert(wds); |
|
|
|
for (p = *wds; p; p = p->if_next) |
|
if (!memcmp(p->if_bssid, &bssid, IEEE80211_ADDR_LEN)) { |
|
VERB(1) syslog(LOG_INFO, "BSSID:%s WDS VAP already created (%s)\n", |
|
ether_ntoa(&bssid), csIface); |
|
return 1; |
|
} |
|
if (wifi_getParent(csIface, szParent, IFNAMSIZ) == -1) { |
|
syslog(LOG_ERR, "Error:: %s no pointer to parent interface\n", csIface); |
|
return -1; |
|
} |
|
|
|
p = malloc(sizeof(struct dwds_if)); |
|
if (!p) { |
|
syslog(LOG_ERR, "Error:: malloc failed: %m\n"); |
|
return -1; |
|
} else |
|
memcpy(p->if_bssid, &bssid, IEEE80211_ADDR_LEN); |
|
if (wifi_vapCreate(szParent, p) == -1) { |
|
free(p); |
|
return -1; |
|
} else { |
|
p->if_next = *wds; |
|
*wds = p; |
|
VERB(1) syslog(LOG_INFO, "BSSID:%s create WDS VAP %s\n", ether_ntoa(&bssid), p->if_name); |
|
} |
|
|
|
return 0; |
|
} |