rst-tu-dortmund / teb_local_planner

An optimal trajectory planner considering distinctive topologies for mobile robots based on Timed-Elastic-Bands (ROS Package)
http://wiki.ros.org/teb_local_planner
BSD 3-Clause "New" or "Revised" License
1.06k stars 550 forks source link

Skipping parts of global plan (viapoints enabled) #358

Open willie013 opened 2 years ago

willie013 commented 2 years ago

Hi!

Is there currently an option to have a rolling window to check for the closest via points? I know the pruneGlobalPlan function discards all previous poses where the robot has been, but it takes into account the whole remaining plan.

However, due to the fact that it takes into account the whole remaining global plan it might skip large parts of the global plan, for instance if the global plan first goes to the right of a corridor and comes back on the left. If the robot then deviates from the global plan, for instance when avoiding an object, it might skip large parts of the initial global plan.

Or is there any other way to use a rolling window for checking which via-points or closest?

Thanks!