nav2_waypoint_follower: clear error_msg when clearing error_code (ros…

…-navigation#4341) Signed-off-by: Mike Wake <[email protected]>
aosmw · Sep 13, 2024 · 9db0eef · 9db0eef
1 parent b947597
commit 9db0eef
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
@@ -321,6 +321,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(
@@ -355,6 +356,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(
@@ -374,6 +376,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(