Nav2 RPP Cusp Detection Strange Behaviour
Systems: Ros2 galactic, Nav2, Smac Hybrid + RPP, Ackerman vehicle
We are currently encountering an Issue with the Cusp detection in RPP. We are trying to control a ackermann steered vehicle. As shown in the gif below the cusp detection in RPP only sometimes picks up the correct cusp for the tracking point. In some scenarios even a deadlock happens where the cusp detection and replanning lead to an infinite back and forth driving without progress.
Some questions arise:
Is the shown behavior the expected one? Shouldnt the vehicle be driven till the cusp point is reached ? Is there a logic explaining the cusp detection (tracking point selection) behaving in this way? If somebody could provide some insight or point us to some related explanations we would be very thankful.
Thanks in advance Philipp
Asked by philipp.polterauer@gmx.at on 2022-07-25 02:09:22 UTC
Answers
I think these two issues might help you
Bug in sign of backward motion (I have submitted a PR for it): https://github.com/ros-planning/navigation2/issues/3086
Bug in cusp detection: https://github.com/ros-planning/navigation2/issues/3089
Asked by jainr on 2022-07-26 03:59:30 UTC
Comments