time_test.cpp

Go to the documentation of this file.

//#define COMPILE_TIME_CODE_ROSSERIAL
#ifdef COMPILE_TIME_CODE_ROSSERIAL
 
/*
 * rosserial::std_msgs::Time Test
 * Publishes current time
 */
 
#include "mbed.h"
#include <ros.h>
#include <ros/time.h>
#include <std_msgs/Time.h>
 
 
ros::NodeHandle  nh;
 
std_msgs::Time test;
ros::Publisher p("my_topic", &test);
 
int main() {
    nh.initNode();
    nh.advertise(p);
 
    while (1) {
        test.data = nh.now();
        p.publish( &test );
        nh.spinOnce();
        wait_ms(10);
    }
}
#endif