fzirker/wlan_pioneer
1
0
Fork 0
Code Issues Pull requests Projects Releases Wiki Activity

format code (editorconfig and clang-format)

Browse source
This commit is contained in:
Florian Zirker 2018-12-11 14:30:33 +01:00
parent 11c0cbbdb0
commit 1e3c68054f
4 changed files with 117 additions and 40 deletions
Download patch file Download diff file Expand all files Collapse all files

61
src/wlanSignal.cpp
View file

@ -14,68 +14,65 @@ using namespace std;
using namespace ros;
using namespace wlan_pioneer;
int8_t getWlanSignalStrength(const string &interface) {
int8_t getWlanSignalStrength( const string& interface ) {
struct iw_statistics stats;
struct iwreq req;
memset(&stats, 0, sizeof(stats));
memset(&req, 0, sizeof(iwreq));
strncpy(req.ifr_name, interface.c_str(), 16);
memset( &stats, 0, sizeof( stats ) );
memset( &req, 0, sizeof( iwreq ) );
strncpy( req.ifr_name, interface.c_str(), 16 );
req.u.data.pointer = &stats;
req.u.data.length = sizeof(iw_statistics);
req.u.data.length = sizeof( iw_statistics );
#ifdef CLEAR_UPDATED
req.u.data.flags = 1;
#endif
int sockfd = socket(AF_INET, SOCK_DGRAM, 0);
if(sockfd == -1) {
ROS_ERROR("Could not create simple datagram socket");
return numeric_limits<int8_t>::min() ;
int sockfd = socket( AF_INET, SOCK_DGRAM, 0 );
if ( sockfd == -1 ) {
ROS_ERROR( "Could not create simple datagram socket" );
return numeric_limits<int8_t>::min();
}
if(ioctl(sockfd, SIOCGIWSTATS, &req) == -1) {
ROS_ERROR("Error retrieving WLAN signal strength ");
close(sockfd);
return numeric_limits<int8_t>::min() ;
if ( ioctl( sockfd, SIOCGIWSTATS, &req ) == -1 ) {
ROS_ERROR( "Error retrieving WLAN signal strength " );
close( sockfd );
return numeric_limits<int8_t>::min();
}
close(sockfd);
close( sockfd );
return stats.qual.level;
}
int main(int argc, char **argv) {
init(argc, argv, "wlanSignal");
int main( int argc, char** argv ) {
init( argc, argv, "wlanSignal" );
NodeHandle node;
string wlanInterface2G4;
string wlanInterface5G;
if (node.param<string>("wlan_interface_2G4", wlanInterface2G4, "wlan0")) {
ROS_INFO("Param wlan_interface_2G4: %s", wlanInterface2G4.c_str());
if ( node.param<string>( "wlan_interface_2G4", wlanInterface2G4, "wlan0" ) ) {
ROS_INFO( "Param wlan_interface_2G4: %s", wlanInterface2G4.c_str() );
}
else {
ROS_INFO("Param 'wlan_interface_2G4' not set. Using 'wlan0'");
ROS_INFO( "Param 'wlan_interface_2G4' not set. Using 'wlan0'" );
}
if (node.param<string>("wlan_interface_5G", wlanInterface5G, "wlan0")) {
ROS_INFO("Param wlan_interface_5G: %s", wlanInterface5G.c_str());
if ( node.param<string>( "wlan_interface_5G", wlanInterface5G, "wlan0" ) ) {
ROS_INFO( "Param wlan_interface_5G: %s", wlanInterface5G.c_str() );
}
else {
ROS_INFO("Param 'wlan_interface_5G' not set. Using 'wlan0'");
ROS_INFO( "Param 'wlan_interface_5G' not set. Using 'wlan0'" );
}
// topic: wlan_signal
Publisher publisher = node.advertise<WlanSignalMsg>("wlan_signal", 1000);
Rate loopRate(1); // every second
Publisher publisher = node.advertise<WlanSignalMsg>( "wlan_signal", 1000 );
Rate loopRate( 1 ); // every second
while (ok()) {
while ( ok() ) {
WlanSignalMsg msg;
msg.timestamp = Time::now();
msg.level_2G4 = getWlanSignalStrength(wlanInterface2G4);
msg.level_5G = getWlanSignalStrength(wlanInterface5G);
msg.level_2G4 = getWlanSignalStrength( wlanInterface2G4 );
msg.level_5G = getWlanSignalStrength( wlanInterface5G );
ROS_INFO("Signal strength 2.4G: %i Signal strength 5G: %i", msg.level_2G4, msg.level_5G);
ROS_INFO( "Signal strength 2.4G: %i Signal strength 5G: %i", msg.level_2G4, msg.level_5G );
publisher.publish(msg);
publisher.publish( msg );
spinOnce();
loopRate.sleep();
}