topic with new message format

This commit is contained in:
Florian Zirker 2018-11-22 19:48:11 +01:00
parent a3627818e9
commit 10cc704de3
4 changed files with 52 additions and 179 deletions

32
src/wlanSignal.cpp Normal file
View file

@ -0,0 +1,32 @@
#include "ros/ros.h"
#include "wlan_pioneer/WlanSignalMsg.h"
#include <sstream>
using namespace ros;
using namespace wlan_pioneer;
int main(int argc, char **argv)
{
init(argc, argv, "wlanSignal");
NodeHandle node;
// topic: wlan_signal
Publisher publisher = node.advertise<WlanSignalMsg>("wlan_signal", 1000);
Rate loopRate(1); // every second
while (ros::ok())
{
WlanSignalMsg msg;
msg.timestamp = ros::Time::now();
msg.level_24G = 0; // TODO: read real WLAN signal strength
msg.level_5G = 0;
ROS_INFO("Signal strength 2.4G: %li Signal strength 5G: %li", msg.level_24G, msg.level_5G);
publisher.publish(msg);
spinOnce();
loopRate.sleep();
}
return 0;
}