Merge pull request #1320 from r-aguilera/develop

CWaypointsNavigator: stop aligning after wp is reached
MRPT · Aug 7, 2024 · d1c5137 · d1c5137
2 parents a5559ba + 8aadef4
commit d1c5137
Show file tree

Hide file tree

Showing 2 changed files with 3 additions and 0 deletions.
diff --git a/doc/source/doxygen-docs/changelog.md b/doc/source/doxygen-docs/changelog.md
@@ -8,6 +8,7 @@
       - Fixed detection of timestamp fields in `Float64` format, and convert them from absolute to relative timestamps.
 - BUG FIXES:
   - ros1bridge and ros2bridge: fix conversion to PointCloud XYZI.
+  - CWaypointsNavigator::waypoints_navigationStep() stops aligning with target after the waypoint is considered as reached.
 
 # Version 2.13.4: Released July 24th, 2024
 - Fix docs typos.

diff --git a/libs/nav/src/reactive/CWaypointsNavigator.cpp b/libs/nav/src/reactive/CWaypointsNavigator.cpp
@@ -239,6 +239,8 @@ void CWaypointsNavigator::waypoints_navigationStep()
                    " segment-to-target dist: "
                 << dist2target << ", allowed_dist: " << wp.allowed_distance);
 
+            m_is_aligning = false;
+
             wp.reached = true;
             wp.skipped = false;
             wp.timestamp_reach = mrpt::Clock::now();