Diff for /embedtools/src/vap.c between versions 1.1.2.2 and 1.1.2.8

version 1.1.2.2, 2010/10/27 16:04:52 version 1.1.2.8, 2010/11/02 02:12:49
Line 2 Line 2
 #include "dwds.h"  #include "dwds.h"
   
   
inline intstatic inline int
 wifi_getParent(const char *csVAP, char *psParent, size_t plen)  wifi_getParent(const char *csVAP, char *psParent, size_t plen)
 {  {
         char szOID[STRSIZ] = { 0 };          char szOID[STRSIZ] = { 0 };
Line 15  wifi_getParent(const char *csVAP, char *psParent, size Line 15  wifi_getParent(const char *csVAP, char *psParent, size
         memset(psParent, 0, plen);          memset(psParent, 0, plen);
         snprintf(szOID, STRSIZ, "net.wlan.%s.%%parent", csVAP + 4);          snprintf(szOID, STRSIZ, "net.wlan.%s.%%parent", csVAP + 4);
         if (sysctlbyname(szOID, psParent, &plen, NULL, 0) == -1) {          if (sysctlbyname(szOID, psParent, &plen, NULL, 0) == -1) {
                syslog(LOG_ERR, "Error:: can`t get parent #%d - %s\n", errno, strerror(errno));//                syslog(LOG_ERR, "Error:: can`t get parent #%d - %s\n", errno, strerror(errno));
                 return -1;                  return -1;
         } else          } else
                 psParent[plen] = 0;                  psParent[plen] = 0;
Line 24  wifi_getParent(const char *csVAP, char *psParent, size Line 24  wifi_getParent(const char *csVAP, char *psParent, size
 }  }
   
 inline int  inline int
wifi_chkIface(const char *csIface, char **ppsIF, int nIF)wifi_chkIface(const char *csVAP, char **ppsIF, int nIF)
 {  {
         char szParent[IFNAMSIZ];          char szParent[IFNAMSIZ];
         register int i;          register int i;
   
         FTRACE(5);          FTRACE(5);
   
        assert(csIface);        assert(csVAP);
   
        if (wifi_getParent(csIface, szParent, IFNAMSIZ) == -1)        if (wifi_getParent(csVAP, szParent, IFNAMSIZ) == -1)
                return -1;                return 0;
   
         for (i = 0; i < nIF; i++)          for (i = 0; i < nIF; i++)
                 if (!strcasecmp(ppsIF[i], "any") || !strcmp(ppsIF[i], szParent))                  if (!strcasecmp(ppsIF[i], "any") || !strcmp(ppsIF[i], szParent))
                         return 1; /* OK, vap is child */                          return 1; /* OK, vap is child */
   
        syslog(LOG_ERR, "Error:: Interface %s parent %s not being monitored", csIface, szParent);        VERB(2) syslog(LOG_ERR, "Error:: Interface %s parent %s not being monitored", csVAP, szParent);
         return 0;          return 0;
 }  }
   
inline intstatic inline int
 wifi_isWDS(int fd, const char *csVAP)  wifi_isWDS(int fd, const char *csVAP)
 {  {
         struct ifmediareq ifmr;          struct ifmediareq ifmr;
Line 64  wifi_isWDS(int fd, const char *csVAP) Line 64  wifi_isWDS(int fd, const char *csVAP)
         return (ifmr.ifm_current & IFM_IEEE80211_WDS) != 0;          return (ifmr.ifm_current & IFM_IEEE80211_WDS) != 0;
 }  }
   
inline intstatic inline int
 wifi_getBSSID(int fd, const char *csVAP, uint8_t *psBSSID, int len)  wifi_getBSSID(int fd, const char *csVAP, uint8_t *psBSSID, int len)
 {  {
         struct ieee80211req ireq;          struct ieee80211req ireq;
Line 83  wifi_getBSSID(int fd, const char *csVAP, uint8_t *psBS Line 83  wifi_getBSSID(int fd, const char *csVAP, uint8_t *psBS
                 syslog(LOG_ERR, "Error:: can`t get BSSID for %s #%d - %s\n", csVAP,                   syslog(LOG_ERR, "Error:: can`t get BSSID for %s #%d - %s\n", csVAP, 
                                 errno, strerror(errno));                                  errno, strerror(errno));
                 return -1;                  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;          return 0;

Removed from v.1.1.2.2  
changed lines
  Added in v.1.1.2.8


FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>