i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-04 00:37:46 +08:00
Code Issues Packages Projects Releases Wiki Activity

get_plan: supporting tolerance parameter

Browse Source
This commit is contained in:
matlabbe
2018-07-09 15:26:39 -04:00
parent 23f661827a
commit 7e155a5abb
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/CoreWrapper.cpp
+2 -2
View File
@@ -2401,7 +2401,7 @@ bool CoreWrapper::publishMapCallback(rtabmap_ros::PublishMap::Request& req, rtab
return true; return true;
} }
bool CoreWrapper::getPlanCallback(nav_msgs::GetPlan::Request &req, nav_msgs::GetPlan::Response &res) bool CoreWrapper::getPlanCallback(nav_msgs::GetPlan::Request &req, nav_msgs::GetPlan::Response &res)
{ {
Transform pose = rtabmap_ros::transformFromPoseMsg(req.goal.pose); Transform pose = rtabmap_ros::transformFromPoseMsg(req.goal.pose);
UTimer timer; UTimer timer;
@@ -2420,7 +2420,7 @@ bool CoreWrapper::getPlanCallback(nav_msgs::GetPlan::Request &req, nav_msgs::Ge
pose = t * pose; pose = t * pose;
} }
if(rtabmap_.computePath(pose)) if(rtabmap_.computePath(pose, req.tolerance))
{ {
NODELET_INFO("Planning: Time computing path = %f s", timer.ticks()); NODELET_INFO("Planning: Time computing path = %f s", timer.ticks());
const std::vector<std::pair<int, Transform> > & poses = rtabmap_.getPath(); const std::vector<std::pair<int, Transform> > & poses = rtabmap_.getPath();