- improve scan function using the wireless extensions.

- fix bug in setSSID().
Major parts of this patch are courtesy Skyhusker - thanks!

5 files changed, 207 insertions, 26 deletions

diff --git a/libopie2/opienet/onetutils.h b/libopie2/opienet/onetutils.h
index f1d34a0..32f5355 100644
--- a/libopie2/opienet/onetutils.h
+++ b/libopie2/opienet/onetutils.h
@@ -1,12 +1,11 @@
 /*
                              This file is part of the Opie Project
-
-                             (C) 2003 Michael 'Mickey' Lauer <mickey@tm.informatik.uni-frankfurt.de>
+                             (C) 2003-2005 Michael 'Mickey' Lauer <mickey@Vanille.de>
               =.
             .=l.
            .>+-=
  _;:,     .>    :=|.         This program is free software; you can
 .> <`_,   >  .   <=          redistribute it and/or  modify it under
 :`=1 )Y*s>-.--   :           the terms of the GNU Library General Public
 .="- .-=="i,     .._         License as published by the Free Software
  - .   .-<_>     .<>         Foundation; version 2 of the License.
@@ -145,23 +144,43 @@ int stringToMode( const QString& );
 #define IW_PRIV_TYPE_BYTE       0x1000
 #define IW_PRIV_TYPE_CHAR       0x2000
 #define IW_PRIV_TYPE_INT        0x4000
 #define IW_PRIV_TYPE_FLOAT      0x5000
 #define IW_PRIV_TYPE_ADDR       0x6000
 #define IW_PRIV_SIZE_FIXED      0x0800
 #define IW_PRIV_SIZE_MASK       0x07FF
 
+#define IW_HEADER_TYPE_NULL     0       /* Not available */
+#define IW_HEADER_TYPE_CHAR     2       /* char [IFNAMSIZ] */
+#define IW_HEADER_TYPE_UINT     4       /* __u32 */
+#define IW_HEADER_TYPE_FREQ     5       /* struct iw_freq */
+#define IW_HEADER_TYPE_ADDR     6       /* struct sockaddr */
+#define IW_HEADER_TYPE_POINT    8       /* struct iw_point */
+#define IW_HEADER_TYPE_PARAM    9       /* struct iw_param */
+#define IW_HEADER_TYPE_QUAL     10      /* struct iw_quality */
+
+#define IW_EV_POINT_OFF (((char *) &(((struct iw_point *) NULL)->length)) - \
+                                  (char *) NULL)
+
 #ifndef ARPHRD_IEEE80211
 #define ARPHRD_IEEE80211 801
 #endif
 #ifndef ARPHRD_IEEE80211_PRISM
 #define ARPHRD_IEEE80211_PRISM 802
 #endif
 
+/* Wireless Extension Scanning Stuff */
+struct iw_stream_descr
+{
+    char *        end;            /* End of the stream */
+    char *        current;        /* Current event in stream of events */
+    char *        value;          /* Current value in event */
+};
+
 
 /* Network to host order macros */
 
 #ifdef LBL_ALIGN
 #define EXTRACT_16BITS(p) \
         ((u_int16_t)((u_int16_t)*((const u_int8_t *)(p) + 0) << 8 | \
                      (u_int16_t)*((const u_int8_t *)(p) + 1)))
 #define EXTRACT_32BITS(p) \
diff --git a/libopie2/opienet/onetwork.cpp b/libopie2/opienet/onetwork.cpp
index ae1865d..546be9e 100644
--- a/libopie2/opienet/onetwork.cpp
+++ b/libopie2/opienet/onetwork.cpp
@@ -1,12 +1,12 @@
 /*
                              This file is part of the Opie Project
-                             Copyright (C) 2003-2004 by Michael 'Mickey' Lauer
-              =.             <mickey@Vanille.de>
+                             Copyright (C) 2003-2005 by Michael 'Mickey' Lauer <mickey@Vanille.de>
+              =.
             .=l.
            .>+-=
  _;:,     .>    :=|.         This program is free software; you can
 .> <`_,   >  .   <=          redistribute it and/or  modify it under
 :`=1 )Y*s>-.--   :           the terms of the GNU Library General Public
 .="- .-=="i,     .._         License as published by the Free Software
  - .   .-<_>     .<>         Foundation; version 2 of the License.
      ._= =}       :           
@@ -53,17 +53,16 @@
 #include <unistd.h>
 #include <linux/sockios.h>
 #include <net/if_arp.h>
 #include <stdarg.h>
 
 #ifndef NODEBUG
 #include <opie2/odebugmapper.h>
 
-
 using namespace Opie::Core;
 using namespace Opie::Net::Internal;
 DebugMapper* debugmapper = new DebugMapper();
 #endif
 
 /*======================================================================================
  * ONetwork
  *======================================================================================*/
@@ -860,33 +859,33 @@ QString OWirelessNetworkInterface::SSID() const
         return str;
     }
 }
 
 
 void OWirelessNetworkInterface::setSSID( const QString& ssid )
 {
     _iwr.u.essid.pointer = const_cast<char*>( (const char*) ssid );
-    _iwr.u.essid.length = ssid.length();
+    _iwr.u.essid.length = ssid.length()+1; // zero byte
     wioctl( SIOCSIWESSID );
 }
 
 
 OStationList* OWirelessNetworkInterface::scanNetwork()
 {
     _iwr.u.param.flags = IW_SCAN_DEFAULT;
     _iwr.u.param.value = 0;
     if ( !wioctl( SIOCSIWSCAN ) )
     {
         return 0;
     }
 
     OStationList* stations = new OStationList();
 
-    int timeout = 1000000;
+    int timeout = 10000000;
 
     odebug << "ONetworkInterface::scanNetwork() - scan started." << oendl;
 
     bool results = false;
     struct timeval tv;
     tv.tv_sec = 0;
     tv.tv_usec = 250000; // initial timeout ~ 250ms
     char buffer[IW_SCAN_MAX_DATA];
@@ -930,24 +929,190 @@ OStationList* OWirelessNetworkInterface::scanNetwork()
             odebug << " - no results (empty neighbourhood)" << oendl;
             return stations;
         }
 
         odebug << " - results are in!" << oendl;
         dumpBytes( (const unsigned char*) &buffer[0], _iwr.u.data.length );
 
         // parse results
+        struct iw_event iwe;
+        struct iw_stream_descr stream;
+        unsigned int cmd_index, event_type, event_len;
+        char *pointer;
+
+        const char standard_ioctl_hdr[] = {
+                IW_HEADER_TYPE_NULL,    /* SIOCSIWCOMMIT */
+                IW_HEADER_TYPE_CHAR,    /* SIOCGIWNAME */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWNWID */
+                IW_HEADER_TYPE_PARAM,   /* SIOCGIWNWID */
+                IW_HEADER_TYPE_FREQ,    /* SIOCSIWFREQ */
+                IW_HEADER_TYPE_FREQ,    /* SIOCGIWFREQ */
+                IW_HEADER_TYPE_UINT,    /* SIOCSIWMODE */
+                IW_HEADER_TYPE_UINT,    /* SIOCGIWMODE */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWSENS */
+                IW_HEADER_TYPE_PARAM,   /* SIOCGIWSENS */
+                IW_HEADER_TYPE_NULL,    /* SIOCSIWRANGE */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWRANGE */
+                IW_HEADER_TYPE_NULL,    /* SIOCSIWPRIV */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWPRIV */
+                IW_HEADER_TYPE_NULL,    /* SIOCSIWSTATS */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWSTATS */
+                IW_HEADER_TYPE_POINT,   /* SIOCSIWSPY */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWSPY */
+                IW_HEADER_TYPE_POINT,   /* SIOCSIWTHRSPY */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWTHRSPY */
+                IW_HEADER_TYPE_ADDR,    /* SIOCSIWAP */
+                IW_HEADER_TYPE_ADDR,    /* SIOCGIWAP */
+                IW_HEADER_TYPE_NULL,    /* -- hole -- */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWAPLIST */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWSCAN */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWSCAN */
+                IW_HEADER_TYPE_POINT,   /* SIOCSIWESSID */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWESSID */
+                IW_HEADER_TYPE_POINT,   /* SIOCSIWNICKN */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWNICKN */
+                IW_HEADER_TYPE_NULL,    /* -- hole -- */
+                IW_HEADER_TYPE_NULL,    /* -- hole -- */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWRATE */
+                IW_HEADER_TYPE_PARAM,   /* SIOCGIWRATE */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWRTS */
+                IW_HEADER_TYPE_PARAM,   /* SIOCGIWRTS */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWFRAG */
+                IW_HEADER_TYPE_PARAM,   /* SIOCGIWFRAG */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWTXPOW */
+                IW_HEADER_TYPE_PARAM,   /* SIOCGIWTXPOW */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWRETRY */
+                IW_HEADER_TYPE_PARAM,   /* SIOCGIWRETRY */
+                IW_HEADER_TYPE_POINT,   /* SIOCSIWENCODE */
+                IW_HEADER_TYPE_POINT,   /* SIOCGIWENCODE */
+                IW_HEADER_TYPE_PARAM,   /* SIOCSIWPOWER */
+                IW_HEADER_TYPE_PARAM,   /* SIOCGIWPOWER */
+        };
+
+        const char standard_event_hdr[] = {
+                IW_HEADER_TYPE_ADDR,    /* IWEVTXDROP */
+                IW_HEADER_TYPE_QUAL,    /* IWEVQUAL */
+                IW_HEADER_TYPE_POINT,   /* IWEVCUSTOM */
+                IW_HEADER_TYPE_ADDR,    /* IWEVREGISTERED */
+                IW_HEADER_TYPE_ADDR,    /* IWEVEXPIRED */
+                IW_HEADER_TYPE_POINT,   /* IWEVGENIE */
+                IW_HEADER_TYPE_POINT,   /* IWEVMICHAELMICFAILURE */
+                IW_HEADER_TYPE_POINT,   /* IWEVASSOCREQIE */
+                IW_HEADER_TYPE_POINT,   /* IWEVASSOCRESPIE */
+                IW_HEADER_TYPE_POINT,   /* IWEVPMKIDCAND */
+        };
+
+
+        const int event_type_size[] = {
+                IW_EV_LCP_LEN,          /* IW_HEADER_TYPE_NULL */
+                0,
+                IW_EV_CHAR_LEN,         /* IW_HEADER_TYPE_CHAR */
+                0,
+                IW_EV_UINT_LEN,         /* IW_HEADER_TYPE_UINT */
+                IW_EV_FREQ_LEN,         /* IW_HEADER_TYPE_FREQ */
+                IW_EV_ADDR_LEN,         /* IW_HEADER_TYPE_ADDR */
+                0,
+                IW_EV_POINT_LEN,        /* Without variable payload */
+                IW_EV_PARAM_LEN,        /* IW_HEADER_TYPE_PARAM */
+                IW_EV_QUAL_LEN,         /* IW_HEADER_TYPE_QUAL */
+        };
+
+
+        //Initialize the stream
+        memset( &stream, 0, sizeof(struct iw_stream_descr) );
+        stream.current = buffer;
+        stream.end = buffer + _iwr.u.data.length;
+
+        do
+        {
+            if ((stream.current + IW_EV_LCP_LEN) > stream.end)
+                break;
+            memcpy((char *) &iwe, stream.current, IW_EV_LCP_LEN);
 
-        int offset = 0;
-        struct iw_event* we = (struct iw_event*) &buffer[0];
+            if (iwe.len <= IW_EV_LCP_LEN) //If yes, it is an invalid event
+                break;
+            if (iwe.cmd <= SIOCIWLAST) {
+                cmd_index = iwe.cmd - SIOCIWFIRST;
 
-        while ( offset < _iwr.u.data.length )
-        {
-            //const char* cmd = *(*_ioctlmap)[we->cmd];
-            //if ( !cmd ) cmd = "<unknown>";
+                if(cmd_index < sizeof(standard_ioctl_hdr))
+                    event_type = standard_ioctl_hdr[cmd_index];
+            }
+            else {
+                cmd_index = iwe.cmd - IWEVFIRST;
+
+                if(cmd_index < sizeof(standard_event_hdr))
+                    event_type = standard_event_hdr[cmd_index];
+            }
+
+            /* Unknown events -> event_type=0 => IW_EV_LCP_LEN */
+            event_len = event_type_size[event_type];
+
+            /* Fixup for later version of WE */
+            if((_range.we_version_compiled > 18) && (event_type == IW_HEADER_TYPE_POINT))
+                event_len -= IW_EV_POINT_OFF;
+
+            /* Check if we know about this event */
+            if(event_len <= IW_EV_LCP_LEN) {
+                /* Skip to next event */
+                stream.current += iwe.len;
+                continue;
+            }
+
+            event_len -= IW_EV_LCP_LEN;
+
+            /* Set pointer on data */
+            if(stream.value != NULL)
+                pointer = stream.value;                    /* Next value in event */
+            else
+                pointer = stream.current + IW_EV_LCP_LEN;  /* First value in event */
+
+            if((pointer + event_len) > stream.end) {
+                /* Go to next event */
+                stream.current += iwe.len;
+                break;
+            }
+
+            /* Fixup for later version of WE */
+            if((_range.we_version_compiled > 18) && (event_type == IW_HEADER_TYPE_POINT))
+                memcpy((char *) &iwe + IW_EV_LCP_LEN + IW_EV_POINT_OFF, pointer, event_len);
+            else
+                memcpy((char *) &iwe + IW_EV_LCP_LEN, pointer, event_len);
+
+            /* Skip event in the stream */
+            pointer += event_len;
+
+            /* Special processing for iw_point events */
+            if(event_type == IW_HEADER_TYPE_POINT) {
+            /* Check the length of the payload */
+
+                if((iwe.len - (event_len + IW_EV_LCP_LEN)) > 0)
+                    /* Set pointer on variable part (warning : non aligned) */
+                    iwe.u.data.pointer = pointer;
+                else
+                    /* No data */
+                    iwe.u.data.pointer = NULL;
+                    /* Go to next event */
+                    stream.current += iwe.len;
+            }
+
+            else {
+                /* Is there more value in the event ? */
+                if((pointer + event_len) <= (stream.current + iwe.len))
+                    /* Go to next value */
+                     stream.value = pointer;
+                else {
+                    /* Go to next event */
+                    stream.value = NULL;
+                    stream.current += iwe.len;
+                }
+            }
+
+            struct iw_event *we = &iwe;
+            //------
             odebug << " - reading next event... cmd=" << we->cmd << ", len=" << we->len << oendl;
             switch (we->cmd)
             {
                 case SIOCGIWAP:
                 {
                     odebug << "SIOCGIWAP" << oendl;
                     stations->append( new OStation() );
                     stations->last()->macAddress = (const unsigned char*) &we->u.ap_addr.sa_data[0];
@@ -963,42 +1128,38 @@ OStationList* OWirelessNetworkInterface::scanNetwork()
                 {
                     odebug << "SIOCGIWFREQ" << oendl;
                     stations->last()->channel = _channels[ static_cast<int>(double( we->u.freq.m ) * pow( 10.0, we->u.freq.e ) / 1000000) ];
                     break;
                 }
                 case SIOCGIWESSID:
                 {
                     odebug << "SIOCGIWESSID" << oendl;
+                    we->u.essid.length = '\0'; // make sure it is zero terminated
                     stations->last()->ssid = static_cast<const char*>( we->u.essid.pointer );
+                    odebug << "ESSID: " << stations->last()->ssid << oendl;
                     break;
                 }
                 case SIOCGIWSENS: odebug << "SIOCGIWSENS" << oendl; break;
                 case SIOCGIWENCODE: odebug << "SIOCGIWENCODE" << oendl; break;
                 case IWEVTXDROP: odebug << "IWEVTXDROP" << oendl; break;         /* Packet dropped to excessive retry */
                 case IWEVQUAL: odebug << "IWEVQUAL" << oendl; break;             /* Quality part of statistics (scan) */
                 case IWEVCUSTOM: odebug << "IWEVCUSTOM" << oendl; break;         /* Driver specific ascii string */
                 case IWEVREGISTERED: odebug << "IWEVREGISTERED" << oendl; break; /* Discovered a new node (AP mode) */
                 case IWEVEXPIRED: odebug << "IWEVEXPIRED" << oendl; break;       /* Expired a node (AP mode) */
                 default: odebug << "unhandled event" << oendl;
             }
 
-            offset += we->len;
-            we = (struct iw_event*) &buffer[offset];
-        }
-        return stations;
-
-        return stations;
-
+        } while (true);
     }
     else
     {
         odebug << " - no results (timeout) :(" << oendl;
-        return stations;
     }
+    return stations;
 }
 
 
 int OWirelessNetworkInterface::signalStrength() const
 {
     iw_statistics stat;
     ::memset( &stat, 0, sizeof stat );
     _iwr.u.data.pointer = (char*) &stat;
diff --git a/libopie2/opienet/onetwork.h b/libopie2/opienet/onetwork.h
index be4bb46..4d9912d 100644
--- a/libopie2/opienet/onetwork.h
+++ b/libopie2/opienet/onetwork.h
@@ -1,12 +1,12 @@
 /*
                              This file is part of the Opie Project
-                             Copyright (C) 2003-2004 by Michael 'Mickey' Lauer
-              =.             <mickey@Vanille.de>
+                             Copyright (C) 2003-2005 by Michael 'Mickey' Lauer <mickey@Vanille.de>
+              =.
             .=l.
            .>+-=
  _;:,     .>    :=|.         This program is free software; you can
 .> <`_,   >  .   <=          redistribute it and/or  modify it under
 :`=1 )Y*s>-.--   :           the terms of the GNU Library General Public
 .="- .-=="i,     .._         License as published by the Free Software
  - .   .-<_>     .<>         Foundation; version 2 of the License.
      ._= =}       :           
@@ -38,17 +38,17 @@
 /* QT */
 #include <qvaluelist.h>
 #include <qdict.h>
 #include <qmap.h>
 #include <qobject.h>
 #include <qhostaddress.h>
 
 /* STD */
-// hacky workaround until we have a user space wireless.h
+// hacky workarounds until we have a true user space wireless.h
 #include <net/if.h>
 #define _LINUX_IF_H
 #include <linux/wireless.h>
 #ifndef IW_MAX_PRIV_DEF
 #define IW_MAX_PRIV_DEF        128
 #endif
 
 namespace Opie {
diff --git a/libopie2/opienet/opienet.pro b/libopie2/opienet/opienet.pro
index 98fa175..a10a949 100644
--- a/libopie2/opienet/opienet.pro
+++ b/libopie2/opienet/opienet.pro
@@ -13,17 +13,17 @@ HEADERS     = 802_11_user.h       \
 SOURCES     = odebugmapper.cpp    \
               omanufacturerdb.cpp \
               onetutils.cpp       \
               onetwork.cpp        \
               opcap.cpp           \
               ostation.cpp
 INTERFACES  =
 TARGET      = opienet2
-VERSION     = 1.8.4
+VERSION     = 1.8.5
 INCLUDEPATH += $(OPIEDIR)/include
 DEPENDPATH  += $(OPIEDIR)/include
 LIBS        += -lpcap
 
 
 !contains( platform, x11 ) {
   include( $(OPIEDIR)/include.pro )
 }
diff --git a/libopie2/opienet/ostation.h b/libopie2/opienet/ostation.h
index bdc653f..5219d92 100644
--- a/libopie2/opienet/ostation.h
+++ b/libopie2/opienet/ostation.h
@@ -1,11 +1,11 @@
 /*
                              This file is part of the Opie Project
-                             Copyright (C) 2003 by Michael 'Mickey' Lauer <mickey@Vanille.de>
+                             Copyright (C) 2003-2005 by Michael 'Mickey' Lauer <mickey@Vanille.de>
               =.
             .=l.
            .>+-=
  _;:,     .>    :=|.         This program is free software; you can
 .> <`_,   >  .   <=          redistribute it and/or  modify it under
 :`=1 )Y*s>-.--   :           the terms of the GNU Library General Public
 .="- .-=="i,     .._         License as published by the Free Software
  - .   .-<_>     .<>         Foundation; version 2 of the License.
@@ -64,16 +64,17 @@ class OStation
     QString type;
     OMacAddress macAddress;
     QHostAddress ipAddress;
 
     /* WaveLan */
     QString ssid;
     OMacAddress apAddress;
     int channel;
+    int level;
     bool encrypted;
   private:
     class Private;
     Private *d;
 };
 
 }
 }