documentation and clean up
This commit is contained in:
parent
692d1e83f9
commit
2ec1d70e97
4 changed files with 106 additions and 125 deletions
|
@ -8,20 +8,19 @@ AllowAllParametersOfDeclarationOnNextLine: false
|
||||||
AllowShortIfStatementsOnASingleLine: false
|
AllowShortIfStatementsOnASingleLine: false
|
||||||
AllowShortLoopsOnASingleLine: false
|
AllowShortLoopsOnASingleLine: false
|
||||||
AllowShortFunctionsOnASingleLine: None
|
AllowShortFunctionsOnASingleLine: None
|
||||||
AllowShortLoopsOnASingleLine: false
|
|
||||||
AlwaysBreakTemplateDeclarations: true
|
AlwaysBreakTemplateDeclarations: true
|
||||||
AlwaysBreakBeforeMultilineStrings: false
|
AlwaysBreakBeforeMultilineStrings: false
|
||||||
BreakBeforeBinaryOperators: false
|
BreakBeforeBinaryOperators: false
|
||||||
BreakBeforeTernaryOperators: false
|
BreakBeforeTernaryOperators: false
|
||||||
BreakConstructorInitializersBeforeComma: true
|
BreakConstructorInitializersBeforeComma: true
|
||||||
BinPackParameters: true
|
BinPackParameters: false
|
||||||
ColumnLimit: 120
|
ColumnLimit: 100
|
||||||
ConstructorInitializerAllOnOneLineOrOnePerLine: true
|
ConstructorInitializerAllOnOneLineOrOnePerLine: true
|
||||||
DerivePointerBinding: false
|
DerivePointerBinding: false
|
||||||
PointerBindsToType: true
|
PointerBindsToType: true
|
||||||
ExperimentalAutoDetectBinPacking: false
|
ExperimentalAutoDetectBinPacking: false
|
||||||
IndentCaseLabels: true
|
IndentCaseLabels: true
|
||||||
MaxEmptyLinesToKeep: 1
|
MaxEmptyLinesToKeep: 2
|
||||||
NamespaceIndentation: None
|
NamespaceIndentation: None
|
||||||
ObjCSpaceBeforeProtocolList: true
|
ObjCSpaceBeforeProtocolList: true
|
||||||
PenaltyBreakBeforeFirstCallParameter: 19
|
PenaltyBreakBeforeFirstCallParameter: 19
|
||||||
|
@ -46,6 +45,7 @@ SpaceBeforeAssignmentOperators: true
|
||||||
ContinuationIndentWidth: 4
|
ContinuationIndentWidth: 4
|
||||||
SortIncludes: false
|
SortIncludes: false
|
||||||
SpaceAfterCStyleCast: false
|
SpaceAfterCStyleCast: false
|
||||||
|
AlignConsecutiveAssignments: true
|
||||||
|
|
||||||
# Configure each individual brace in BraceWrapping
|
# Configure each individual brace in BraceWrapping
|
||||||
BreakBeforeBraces: Custom
|
BreakBeforeBraces: Custom
|
||||||
|
|
|
@ -1,42 +1,32 @@
|
||||||
cmake_minimum_required(VERSION 2.8.3)
|
cmake_minimum_required(VERSION 2.8.3)
|
||||||
project(wlan_pioneer)
|
project(wlan_pioneer)
|
||||||
|
|
||||||
add_compile_options(-std=c++11)
|
|
||||||
|
|
||||||
find_package(catkin REQUIRED COMPONENTS
|
find_package(catkin REQUIRED COMPONENTS
|
||||||
roscpp
|
roscpp
|
||||||
std_msgs
|
std_msgs
|
||||||
message_generation
|
message_generation
|
||||||
)
|
)
|
||||||
|
|
||||||
add_message_files(
|
add_message_files(FILES WlanSignalMsg.msg)
|
||||||
FILES
|
|
||||||
WlanSignalMsg.msg
|
|
||||||
)
|
|
||||||
|
|
||||||
generate_messages(
|
generate_messages(DEPENDENCIES std_msgs)
|
||||||
DEPENDENCIES
|
|
||||||
std_msgs
|
|
||||||
)
|
|
||||||
|
|
||||||
catkin_package( )
|
catkin_package()
|
||||||
|
|
||||||
include_directories(
|
include_directories(${catkin_INCLUDE_DIRS} /usr/local/include/)
|
||||||
${catkin_INCLUDE_DIRS}
|
link_directories(${catkin_INCLUDE_DIRS} /usr/local/lib/)
|
||||||
/usr/local/include/
|
|
||||||
)
|
|
||||||
|
|
||||||
link_directories(
|
|
||||||
${catkin_INCLUDE_DIRS}
|
|
||||||
/usr/local/lib/
|
|
||||||
)
|
|
||||||
|
|
||||||
add_executable(wlanSignal src/wlanSignal.cpp)
|
add_executable(wlanSignal src/wlanSignal.cpp)
|
||||||
target_link_libraries(wlanSignal ${catkin_LIBRARIES} wifi-scan)
|
target_link_libraries(wlanSignal ${catkin_LIBRARIES} wifi-scan)
|
||||||
add_dependencies(wlanSignal wlan_pioneer_generate_messages_cpp)
|
add_dependencies(wlanSignal wlan_pioneer_generate_messages_cpp)
|
||||||
|
|
||||||
|
|
||||||
SET(CMAKE_INSTALL_RPATH ${catkin_LIBRARIES})
|
# This setting disable new dtags for ld linker. So RUNPATH is
|
||||||
SET(CMAKE_INSTALL_RPATH_USE_LINK_PATH TRUE)
|
# replaced with RPATH in wlanSignal executable. We need RPATH
|
||||||
|
# for finding linked libraries at runtime when executed with
|
||||||
|
# sudo. WLAN scanning needs enhanced privileges. With RUNPATH
|
||||||
|
# linker disables LD_LIBRARY_PATH for security reasons if
|
||||||
|
# setuid/setgid is set. So this is a workaround.
|
||||||
|
# https://gitlab.kitware.com/cmake/community/wikis/doc/cmake/RPATH-handling
|
||||||
|
# https://answers.ros.org/question/165246/launch-node-with-root-permissions/
|
||||||
SET(CMAKE_EXE_LINKER_FLAGS "-Wl,--disable-new-dtags")
|
SET(CMAKE_EXE_LINKER_FLAGS "-Wl,--disable-new-dtags")
|
||||||
|
|
|
@ -1,7 +1,7 @@
|
||||||
<launch>
|
<launch>
|
||||||
|
|
||||||
<!-- <param name="wlan_interface" type="string" value="wlx74da38ef8aca" /> -->
|
<param name="wlan_interface" type="string" value="wlx74da38ef8aca" />
|
||||||
<!-- <param name="wlan_ssid" type="string" value="HSMA-VPN" /> -->
|
<param name="wlan_ssid" type="string" value="HSMA-VPN" />
|
||||||
|
|
||||||
<node pkg="wlan_pioneer" type="wlanSignal" name="wlanSignal" launch-prefix="sudo -S -E"/>
|
<node pkg="wlan_pioneer" type="wlanSignal" name="wlanSignal" launch-prefix="sudo -S -E"/>
|
||||||
|
|
||||||
|
|
|
@ -1,60 +1,60 @@
|
||||||
#include "ros/ros.h"
|
|
||||||
#include "wlan_pioneer/WlanSignalMsg.h"
|
|
||||||
#include <iostream>
|
|
||||||
#include <stdio.h>
|
|
||||||
#include <stdlib.h>
|
|
||||||
#include <cstring>
|
#include <cstring>
|
||||||
#include <limits>
|
#include <limits>
|
||||||
|
#include <string>
|
||||||
|
#include "ros/ros.h"
|
||||||
|
#include "wlan_pioneer/WlanSignalMsg.h"
|
||||||
#include "wifi_scan.h"
|
#include "wifi_scan.h"
|
||||||
|
|
||||||
using namespace std;
|
using namespace std;
|
||||||
using namespace ros;
|
using namespace ros;
|
||||||
using namespace wlan_pioneer;
|
using namespace wlan_pioneer;
|
||||||
|
|
||||||
// Global variables for wifi scanning
|
const int MAX_APS = 64; // the maximum amounts of APs (Access Points) we want to store
|
||||||
const int MAX_APS = 64; // the maximum amounts of APs (Access Points) we want to store
|
|
||||||
struct wifi_scan* wifi = nullptr; // this stores all the library information
|
struct wifi_scan* wifi = nullptr; // this stores all the library information
|
||||||
struct bss_info bss[MAX_APS]; // this is where we are going to keep informatoin about APs (Access Points)
|
struct bss_info bss[MAX_APS]; // this is where we are going to keep informatoin about APs
|
||||||
|
WlanSignalMsg msg; // global message, will be set and published in every loop
|
||||||
|
|
||||||
WlanSignalMsg msg;
|
|
||||||
|
|
||||||
void scanInterface( const string& interface, const string& monitoringSsid ) {
|
void scanInterface( const string& interface, const string& monitoringSsid ) {
|
||||||
|
msg.ssid = monitoringSsid;
|
||||||
msg.level_2G4 = numeric_limits<int8_t>::min();
|
msg.timestamp = Time::now();
|
||||||
msg.level_5G = numeric_limits<int8_t>::min();
|
msg.level_2G4 = numeric_limits<int8_t>::min();
|
||||||
|
msg.level_5G = numeric_limits<int8_t>::min();
|
||||||
msg.cellCount_2G4 = 0;
|
msg.cellCount_2G4 = 0;
|
||||||
msg.cellCount_5G = 0;
|
msg.cellCount_5G = 0;
|
||||||
|
|
||||||
if ( wifi == nullptr ) {
|
if ( wifi == nullptr ) {
|
||||||
|
// initialise wlan for scanning
|
||||||
wifi = wifi_scan_init( interface.c_str() );
|
wifi = wifi_scan_init( interface.c_str() );
|
||||||
}
|
}
|
||||||
|
|
||||||
int status = wifi_scan_all( wifi, bss, MAX_APS );
|
int status = wifi_scan_all( wifi, bss, MAX_APS );
|
||||||
|
|
||||||
if ( status < 0 ) {
|
if ( status < 0 ) {
|
||||||
ROS_ERROR( "Unable to get WLAN scan data: %s", std::strerror( errno ) );
|
ROS_ERROR( "Unable to get WLAN scan data: %s", std::strerror( errno ) );
|
||||||
wifi_scan_close( wifi );
|
wifi_scan_close( wifi ); // close wlan to re-init in next loop
|
||||||
wifi = nullptr;
|
wifi = nullptr;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
|
// run trought list of cells
|
||||||
for ( int i = 0; i < status && i < MAX_APS; ++i ) {
|
for ( int i = 0; i < status && i < MAX_APS; ++i ) {
|
||||||
if ( bss[i].seen_ms_ago > 100 ) {
|
if ( bss[i].seen_ms_ago > 100 ) {
|
||||||
continue; // we do not want old results
|
continue; // we do not want old results
|
||||||
}
|
}
|
||||||
|
|
||||||
if ( std::strcmp( bss[i].ssid, monitoringSsid.c_str() ) != 0 ) {
|
if ( std::strcmp( bss[i].ssid, monitoringSsid.c_str() ) != 0 ) {
|
||||||
continue;
|
continue; // only cells on monitoring SSID should be scanned
|
||||||
}
|
}
|
||||||
|
|
||||||
int8_t level = bss[i].signal_mbm / 100;
|
int8_t level = bss[i].signal_mbm / 100; // mBm to dBm
|
||||||
if ( bss[i].frequency >= 2400 && bss[i].frequency <= 2499 ) {
|
if ( bss[i].frequency >= 2400 && bss[i].frequency <= 2499 ) {
|
||||||
// this AP is sending on 2.4 GHz band
|
// maximum of scanned levels of 2.4 GHz band
|
||||||
msg.level_2G4 = std::max( msg.level_2G4, level );
|
msg.level_2G4 = std::max( msg.level_2G4, level );
|
||||||
msg.cellCount_2G4++;
|
msg.cellCount_2G4++;
|
||||||
}
|
}
|
||||||
else if ( bss[i].frequency >= 5000 && bss[i].frequency <= 5999 ) {
|
else if ( bss[i].frequency >= 5000 && bss[i].frequency <= 5999 ) {
|
||||||
// this AP is sending on 5 GHz band
|
// maximum of scanned levels of 5 GHz band
|
||||||
msg.level_5G = std::max( msg.level_5G, level );
|
msg.level_5G = std::max( msg.level_5G, level );
|
||||||
msg.cellCount_5G++;
|
msg.cellCount_5G++;
|
||||||
}
|
}
|
||||||
|
@ -62,12 +62,15 @@ void scanInterface( const string& interface, const string& monitoringSsid ) {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int main( int argc, char** argv ) {
|
int main( int argc, char** argv ) {
|
||||||
init( argc, argv, "wlanSignal" );
|
init( argc, argv, "wlanSignal" );
|
||||||
|
|
||||||
NodeHandle node;
|
NodeHandle node;
|
||||||
string wlanInterface;
|
string wlanInterface;
|
||||||
string monitoringSsid;
|
string monitoringSsid;
|
||||||
|
Publisher publisher = node.advertise<WlanSignalMsg>( "wlan_signal", 1000 );
|
||||||
|
Rate loopRate = Rate( 1 ); // every second
|
||||||
|
|
||||||
if ( node.param<string>( "wlan_ssid", monitoringSsid, "" ) ) {
|
if ( node.param<string>( "wlan_ssid", monitoringSsid, "" ) ) {
|
||||||
ROS_INFO( "Param wlan_ssid: %s", monitoringSsid.c_str() );
|
ROS_INFO( "Param wlan_ssid: %s", monitoringSsid.c_str() );
|
||||||
|
@ -83,23 +86,11 @@ int main( int argc, char** argv ) {
|
||||||
ROS_INFO( "Param 'wlan_interface' not set. Using 'wlan0'" );
|
ROS_INFO( "Param 'wlan_interface' not set. Using 'wlan0'" );
|
||||||
}
|
}
|
||||||
|
|
||||||
// topic: wlan_signal
|
|
||||||
Publisher publisher = node.advertise<WlanSignalMsg>( "wlan_signal", 1000 );
|
|
||||||
Rate loopRate( 1 ); // every second
|
|
||||||
|
|
||||||
msg.ssid = monitoringSsid;
|
|
||||||
|
|
||||||
while ( ok() ) {
|
while ( ok() ) {
|
||||||
|
|
||||||
scanInterface( wlanInterface, monitoringSsid );
|
scanInterface( wlanInterface, monitoringSsid );
|
||||||
msg.timestamp = Time::now();
|
ROS_INFO( "Signal strength 2.4G: %i (%d Cells) Signal strength 5G: %i "
|
||||||
|
"(%d Cells)",
|
||||||
ROS_INFO( "Signal strength 2.4G: %i (%d Cells) Signal strength 5G: %i (%d Cells)",
|
msg.level_2G4, msg.cellCount_2G4, msg.level_5G, msg.cellCount_5G );
|
||||||
msg.level_2G4,
|
|
||||||
msg.cellCount_2G4,
|
|
||||||
msg.level_5G,
|
|
||||||
msg.cellCount_5G);
|
|
||||||
|
|
||||||
publisher.publish( msg );
|
publisher.publish( msg );
|
||||||
spinOnce();
|
spinOnce();
|
||||||
loopRate.sleep();
|
loopRate.sleep();
|
||||||
|
|
Loading…
Reference in a new issue