src/robo_explorer_hardware.cpp

   1 #include "ros/ros.h"
   2 #include "robo_explorer_hardware.h"
   3 #include "controller_manager/controller_manager.h"
   4
   5 int main(int argc, char **argv) {
   6         ros::init(argc, argv, "robo_explorer_hardware");
   7
   8         ros::NodeHandle n;
   9
  10         RoboExplorer robot(n);
  11         controller_manager::ControllerManager cm(&robot);
  12
  13         ros::AsyncSpinner spinner(1);
  14         spinner.start();
  15
  16         ros::Time prev_time = ros::Time::now();
  17         ros::Rate loop_rate(10);
  18         while(ros::ok()) {
  19                 const ros::Time time = ros::Time::now();
  20                 const ros::Duration period = time - prev_time;
  21
  22                 robot.read(period);
  23                 cm.update(time, period);
  24                 robot.write();
  25
  26                 prev_time = time;
  27                 loop_rate.sleep();
  28         }
  29
  30         return 0;
  31 }