mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-04 08:47:45 +08:00
get_plan: supporting tolerance parameter
This commit is contained in:
+1
-1
@@ -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();
|
||||||
|
|||||||
Reference in New Issue
Block a user