Robotics StackExchange | Archived questions

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.

image description

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

Comments

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