nav2_waypoint_follower: clear error_msg when clearing error_code (ros…

…-navigation#4341) Signed-off-by: Mike Wake <michael.wake@aosgrp.com.au>
aosmw · Feb 11, 2025 · c603204 · c603204
1 parent e9c758e
commit c603204
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/nav2_waypoint_follower/src/waypoint_follower.cpp b/nav2_waypoint_follower/src/waypoint_follower.cpp
@@ -322,6 +322,7 @@ void WaypointFollower::followWaypointsHandler(
         RCLCPP_WARN(get_logger(), result->error_msg.c_str());
         action_server->terminate_current(result);
         current_goal_status_.error_code = 0;
+        current_goal_status_.error_msg = "";
         return;
       } else {
         RCLCPP_INFO(
@@ -356,6 +357,7 @@ void WaypointFollower::followWaypointsHandler(
         RCLCPP_WARN(get_logger(), result->error_msg.c_str());
         action_server->terminate_current(result);
         current_goal_status_.error_code = 0;
+        current_goal_status_.error_msg = "";
         return;
       } else {
         RCLCPP_INFO(
@@ -375,6 +377,7 @@ void WaypointFollower::followWaypointsHandler(
             poses.size());
           action_server->succeeded_current(result);
           current_goal_status_.error_code = 0;
+          current_goal_status_.error_msg = "";
           return;
         }
         RCLCPP_INFO(