get_plan: supporting tolerance parameter

This commit is contained in:
matlabbe
2018-07-09 15:26:39 -04:00
parent 23f661827a
commit 7e155a5abb
+1 -1
View File
@@ -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();