Diffstat (limited to 'libopie2/opienet/onetwork.cpp') (more/less context) (ignore whitespace changes)
-rw-r--r-- | libopie2/opienet/onetwork.cpp | 203 |
1 files changed, 182 insertions, 21 deletions
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,20 +1,20 @@ /* 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. - ._= =} : + ._= =} : .%`+i> _;_. .i_,=:_. -<s. This program is distributed in the hope that + . -:. = it will be useful, but WITHOUT ANY WARRANTY; : .. .:, . . . without even the implied warranty of =_ + =;=|` MERCHANTABILITY or FITNESS FOR A _.=:. : :=>`: PARTICULAR PURPOSE. See the GNU ..}^=.= = ; Library General Public License for more ++= -. .` .: details. @@ -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; - stations->last()->ssid = static_cast<const char*>( we->u.essid.pointer ); + 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; |