topic with new message format
This commit is contained in:
parent
a3627818e9
commit
10cc704de3
4 changed files with 52 additions and 179 deletions
32
src/wlanSignal.cpp
Normal file
32
src/wlanSignal.cpp
Normal 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;
|
||||
}
|
Loading…
Add table
Add a link
Reference in a new issue