[ros2-master] fix prune path

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

Closed doisyg closed 3 years ago

doisyg commented 3 years ago

Similar to https://github.com/rst-tu-dortmund/teb_local_planner/pull/198 but against last version of the [ros2-master] branch. Fix https://github.com/rst-tu-dortmund/teb_local_planner/issues/203 I was able to reproduce the issue and check that it is fixed with this PR: Before PR: teb_prune2