--- embedtools/src/dwds.c 2010/10/27 15:23:49 1.1.2.4 +++ embedtools/src/dwds.c 2011/06/13 20:23:35 1.2.2.1 @@ -1,3 +1,48 @@ +/************************************************************************* + * (C) 2010 AITNET - Sofia/Bulgaria - + * by Michael Pounov + * + * $Author: misho $ + * $Id: dwds.c,v 1.2.2.1 2011/06/13 20:23:35 misho Exp $ + * + ************************************************************************* +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 + +Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011 + by Michael Pounov . 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 +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 "dwds.h" @@ -5,7 +50,6 @@ sl_config cfg; int Verbose, Kill, nif; char **ifs, szConfig[MAXPATHLEN] = DWDS_CONFIG; -struct dwds_if *wds; extern char compiled[], compiledby[], compilehost[]; @@ -14,7 +58,7 @@ Usage() { printf( "-= dWDS =- WiFi dynamic WDS service managment for VAP\n" "=== %s === %s@%s ===\n\n" - " Syntax: dwds [options] [interface [...]]\n" + " Syntax: dwds [options] [interface [ath0, ...]]\n" "\n" "\t-v\t\tVerbose ...\n" "\t-f\t\tForeground, not demonize process ...\n" @@ -54,8 +98,131 @@ sigHandler(int sig) } static int -RtMsg(struct rt_msghdr *msg, size_t len) +RtMsg(struct dwds_if **wds, struct rt_msghdr *msg, size_t len) { + struct if_announcemsghdr *ifan; + const u_char *v; + struct ether_addr bssid; + char szStr[STRSIZ] = { 0 }, szCmd[MAXPATHLEN] = { 0 }, szIdent[STRSIZ] = { 0 }, + szName[IFNAMSIZ] = { 0 }; + int f, stat; + + assert(wds); + assert(msg); + + if (msg->rtm_version != RTM_VERSION) { + syslog(LOG_ERR, "Error:: routing message version %d not understood!\n", msg->rtm_version); + return -1; + } + + switch (msg->rtm_type) { + case RTM_IFANNOUNCE: + ifan = (struct if_announcemsghdr*) msg; + switch (ifan->ifan_what) { + case IFAN_ARRIVAL: + VERB(1) syslog(LOG_INFO, "RTM_IFANNOUNCE: if# %d, what: arrival\n", + ifan->ifan_index); + break; + case IFAN_DEPARTURE: + VERB(1) syslog(LOG_INFO, "RTM_IFANNOUNCE: if# %d, what: departure\n", + ifan->ifan_index); + wifi_destroyWDS(ifan->ifan_name, wds); + break; + } + break; + case RTM_IEEE80211: +#define V(type) ((struct type *)(&ifan[1])) + ifan = (struct if_announcemsghdr*) msg; + switch (ifan->ifan_what) { + case RTM_IEEE80211_DISASSOC: + v = cfg_GetAttribute(&cfg, CFG("dwds"), CFG("discover_on_join")); + if (!v || !strtol((char*) v, NULL, 0)) + break; + /* fall thru ... */ + case RTM_IEEE80211_LEAVE: + if (!wifi_chkIface(ifan->ifan_name, ifs, nif)) + break; + memcpy(&bssid, V(ieee80211_leave_event)->iev_addr, ETHER_ADDR_LEN); + VERB(1) syslog(LOG_INFO, "BSSID:%s Station leave\n", ether_ntoa(&bssid)); + if (!wifi_leaveWDS(bssid, wds, szName, IFNAMSIZ)) { + cfg_LoadAttribute(&cfg, CFG("dwds"), CFG("name"), + CFG(szIdent), STRSIZ, DWDS_NAME); + /* delete state file ... */ + v = cfg_GetAttribute(&cfg, CFG("dwds"), CFG("state_dir")); + if (v) { + memset(szCmd, 0, STRSIZ); + snprintf(szCmd, MAXPATHLEN, "%s/%s-%s-%s", (char*) v, + szName, ether_ntoa(&bssid), szIdent); + unlink(szCmd); + VERB(2) syslog(LOG_DEBUG, "Debug:: delete session name %s\n", szCmd); + } + + /* Launch script ... */ + cfg_LoadAttribute(&cfg, CFG("dwds"), CFG("disassoc_event"), + CFG(szStr), STRSIZ, NULL); + if (*szStr) { + cfg_LoadAttribute(&cfg, CFG("dwds"), CFG("name"), + CFG(szIdent), STRSIZ, DWDS_NAME); + memset(szCmd, 0, MAXPATHLEN); + snprintf(szCmd, MAXPATHLEN, "%s %s %s %s", szStr, + szName, ether_ntoa(&bssid), szIdent); + VERB(3) syslog(LOG_DEBUG, "Debug:: Command line: %s\n", szCmd); + + if ((stat = system(szCmd))) + syslog(LOG_ERR, "VAP down script %s exited " + "with status %d\n", szStr, stat); + } + } + break; + + case RTM_IEEE80211_JOIN: + case RTM_IEEE80211_REJOIN: + case RTM_IEEE80211_ASSOC: + case RTM_IEEE80211_REASSOC: + v = cfg_GetAttribute(&cfg, CFG("dwds"), CFG("discover_on_join")); + if (!v || !strtol((char*) v, NULL, 0)) + break; + /* fall thru ... */ + case RTM_IEEE80211_WDS: + memcpy(&bssid, V(ieee80211_leave_event)->iev_addr, ETHER_ADDR_LEN); + VERB(1) syslog(LOG_INFO, "BSSID:%s WDS discovery\n", ether_ntoa(&bssid)); + if (!wifi_chkIface(ifan->ifan_name, ifs, nif)) + break; + if (!wifi_createWDS(ifan->ifan_name, bssid, wds)) { + cfg_LoadAttribute(&cfg, CFG("dwds"), CFG("name"), + CFG(szIdent), STRSIZ, DWDS_NAME); + /* create state file ... */ + v = cfg_GetAttribute(&cfg, CFG("dwds"), CFG("state_dir")); + if (v) { + memset(szCmd, 0, MAXPATHLEN); + snprintf(szCmd, MAXPATHLEN, "%s/%s-%s-%s", (char*) v, + (*wds)->if_name, ether_ntoa(&bssid), szIdent); + f = open(szCmd, O_WRONLY | O_CREAT, 0644); + if (f != -1) + close(f); + VERB(2) syslog(LOG_DEBUG, "Debug:: create session name %s\n", szCmd); + } + + /* Launch script ... */ + cfg_LoadAttribute(&cfg, CFG("dwds"), CFG("assoc_event"), + CFG(szStr), STRSIZ, NULL); + if (*szStr) { + memset(szCmd, 0, MAXPATHLEN); + snprintf(szCmd, MAXPATHLEN, "%s %s %s %s", szStr, + (*wds)->if_name, ether_ntoa(&bssid), szIdent); + VERB(3) syslog(LOG_DEBUG, "Debug:: Command line: %s\n", szCmd); + + if ((stat = system(szCmd))) + syslog(LOG_ERR, "VAP up script %s exited " + "with status %d\n", szStr, stat); + } + } + break; + } +#undef V + break; + } + return 0; } @@ -69,6 +236,7 @@ main(int argc, char **argv) int s; struct sigaction sa; size_t len; + struct dwds_if *wds = NULL; while ((ch = getopt(argc, argv, "hvfc:")) != -1) switch (ch) { @@ -101,7 +269,7 @@ main(int argc, char **argv) return 1; } - if (fg) + if (!fg) switch (fork()) { case -1: printf("Error:: when fork() #%d - %s\n", errno, strerror(errno)); @@ -134,13 +302,18 @@ main(int argc, char **argv) goto end; } + if (!(wds = wifi_buildWDS(s, ifs, nif))) { + syslog(LOG_ERR, "Error:: Go to dead ...\n"); + goto end; + } + while (!Kill) { len = read(s, (void*) msg, sizeof msg); if (len == -1) { - syslog(LOG_ERR, "Error:: read() #%d - %s\n", errno, strerror(errno)); + VERB(5) syslog(LOG_ERR, "Error:: read() #%d - %s\n", errno, strerror(errno)); Kill++; } else - RtMsg((struct rt_msghdr*) msg, len); + RtMsg(&wds, (struct rt_msghdr*) msg, len); } close(s);