navigation2
navigation2 copied to clipboard
nav2_simple_commander skips waypoints after every recovery action
Bug report
Required Info:
- Operating System:
- Ubuntu 22.04 docker container
- ROS2 Version:
- Humble
- Version or commit hash: 1.1.0-2jammy.20220621.010619
- DDS implementation:
- CycloneDDS
Steps to reproduce issue
Use more goal poses in example_waypoint_follower.py
Expected behavior
Only execute next waypoint when robot is near the waypoint
Actual behavior
The waypoints are skipped very quickly, presumably during the recovery actions