File content as of revision 1:bdd17feaa4ce:

#include "mbed.h"

#include "myRos.h"
#include <ros.h>
#include <ros/time.h>
#include <std_msgs/Empty.h>

#include "odom.h"

//Create subscliber
ros::Subscriber<std_msgs::Empty> ack_sub("nucleo/ack_from_pc", &ack_from_pc_cb);

DigitalOut myled(LED1);
DigitalOut  led0(PC_0);
DigitalOut  led1(PC_1);
DigitalOut  led2(PB_0);
DigitalIn   mysw(PC_13);

int main() {
    //Initialize TIM
    Timer GetTick;
    GetTick.start();
    uint32_t debug_ts = 0;
    uint32_t ros_loop_ts = 0;
        
    //Initialize ROS
    My_Ros my_ros;
    my_ros.set_subscliber(ack_sub);
    

    while(1) {
        //For debug
        if(debug_ts <= GetTick.read_ms()){
            debug_ts = GetTick.read_ms() + 20;
            led0 = !led0;
        }

        //For myRos loop
        if(ros_loop_ts <= GetTick.read_ms()){        
            ros_loop_ts = GetTick.read_ms() + 10;
            my_ros.loop();
        }
    }
}