Added pause/resume services to visual_odometry node (also linked to pause action in rtabmapviz)

git-svn-id: http://rtabmap.googlecode.com/svn/trunk/ros-pkg@1353 f169173b-cf89-36c8-b27e-44dbe73f0c83
This commit is contained in:
matlabbe
2014-06-11 18:14:28 +00:00
parent 9a2d96b99e
commit 1d0b9002e8
4 changed files with 122 additions and 74 deletions
+6
View File
@@ -386,6 +386,9 @@ void GuiWrapper::handleEvent(UEvent * anEvent)
system(str.c_str());
}
// Pause visual_odometry
ros::service::call("pause_odom", srv);
// Pause rtabmap
if(!ros::service::call("pause", srv))
{
@@ -400,6 +403,9 @@ void GuiWrapper::handleEvent(UEvent * anEvent)
ROS_ERROR("Can't call \"resume\" service");
}
// Pause visual_odometry
ros::service::call("resume_odom", srv);
// Resume the camera if the rtabmap/camera node is used
if(!cameraNodeName_.empty())
{