[ros-users] ROS nodes & SIGINT handler

Gautier Dumonteil gautier.dumonteil at gmail.com
Tue Aug 31 19:06:48 UTC 2010


  Hi users,

In our reseach project, we would like to be able to record bags 
"automatically" (e.g recording when our UAV is flying).
So, I'm trying to write a simple node (/recorder_interface/) with two 
services "start_record" and "stop_record", where "start_record" callback 
launch the rosbag::recorder::run() in a child process using fork(). The 
"stop_record" callback just sends the SIGINT signal to recorder PID to 
stop recording ... but nothing happen. It seems that the ROS node forked 
doesn't handle SIGINT signals.

Also, when checking available nodes with "rosnode list", I've only the 
/recorder_interface/ node. I should have also something like 
"record_1283279499007996727", which is the rosbag record node.

I'm wondering if a node can launch others nodes??

Here, the console output and code:

[ INFO] [1283279481.648585599]: Recorder_interface spinning: ready to 
record.
[ INFO] [1283279499.006083281]: Request to record topics: test
[ INFO] [1283279499.007996722]: Child: pid = 10497

[ INFO] [1283279499.008979878]: Subscribing to /fake_alti
[ INFO] [1283279499.009749320]: Recording to test_2010-08-31-14-31-39.bag.

#include <signal.h>
#include "ros/ros.h"
#include "recorder_interface/rec_interface.h"
#include "rosbag/recorder.h"
#include "rosbag/exceptions.h"

bool  recording;
int   recorder_exit_code;
pid_t rosbag_pid;

void rosbagRecord (rosbag::RecorderOptions opts)
{
     char ** argv = NULL;
     int argc=0;
     ros::init(argc, argv, "record", ros::init_options::AnonymousName);

     // **** Run the recorder
     rosbag::Recorder recorder(opts);
     recorder_exit_code = recorder.run();
     ROS_INFO("recorder_exit_code: %d\n",recorder_exit_code);
}

bool startRec(recorder_interface::rec_interface::Request &req,
                   recorder_interface::rec_interface::Response &res)
{
     if(!recording)
     {
         recording=true;
         ROS_INFO("Request to record topics: %s", req.topics.c_str ());

         // **** Fill rosbag options
         rosbag::RecorderOptions opts;
         opts.record_all = false;
         opts.quiet = true;
         opts.prefix = req.prefix;
         opts.append_date = true;
         opts.topics.push_back("/fake_alti");

         rosbag_pid = fork();
         if(rosbag_pid == -1)
         {
             // **** ouch, fork() failed
             perror("fork");
             exit(-1);
         }
         else if(rosbag_pid == 0)
         {
             // **** child
             ROS_INFO("Child: pid = %d\n", (int)getpid());
             rosbagRecord(opts);
             exit(-1);
         }
     }
     else
     {
         ROS_WARN("Already recording!");
     }
    return true;
}


bool stopRec(recorder_interface::rec_interface::Request &req,
                   recorder_interface::rec_interface::Response &res)
{
    if(recording)
     {
         int err = kill(rosbag_pid, SIGINT);
         ROS_INFO("err = %d\n",err);
         if(err==0)
         {
             res.ans=recorder_exit_code;
             recording=false;
         }
     }
     else
     {
         ROS_WARN("Not recording!");
     }
    return true;
}

int main(int argc, char **argv)
{
   recording=false;

   ros::init(argc, argv, "recorder_interface");
   ros::NodeHandle n;

   ros::ServiceServer serviceStart,serviceStop;
   serviceStart = n.advertiseService("start_record", startRec);
   serviceStop = n.advertiseService("stop_record", stopRec);
   ROS_INFO("Recorder_interface spinning: ready to record.");
   ros::spin();
   return 0;
}


-------------- next part --------------
An HTML attachment was scrubbed...
URL: <http://lists.osuosl.org/pipermail/ros-users/attachments/20100831/2535f632/attachment-0003.html>


More information about the ros-users mailing list