Make WaypointFollower use WaypointStatus message type in action result

Signed-off-by: zz990099 <771647586@qq.com>

Author: zz990099

nav2_msgs/action/FollowGPSWaypoints.action

@@ -13,7 +13,7 @@ uint16 TASK_EXECUTOR_FAILED=601
 uint16 NO_WAYPOINTS_GIVEN=602
 uint16 STOP_ON_MISSED_WAYPOINT=603
 
-MissedWaypoint[] missed_waypoints
+WaypointStatus[] missed_waypoints
 int16 error_code
 string error_msg
 ---

nav2_msgs/action/FollowWaypoints.action

@@ -13,7 +13,7 @@ uint16 TASK_EXECUTOR_FAILED=601
 uint16 NO_VALID_WAYPOINTS=602
 uint16 STOP_ON_MISSED_WAYPOINT=603
 
-MissedWaypoint[] missed_waypoints
+WaypointStatus[] missed_waypoints
 uint16 error_code
 string error_msg
 ---

nav2_waypoint_follower/include/nav2_waypoint_follower/waypoint_follower.hpp

@@ -27,7 +27,7 @@
 #include "nav2_util/lifecycle_node.hpp"
 #include "nav2_msgs/action/navigate_to_pose.hpp"
 #include "nav2_msgs/action/follow_waypoints.hpp"
-#include "nav2_msgs/msg/missed_waypoint.hpp"
+#include "nav2_msgs/msg/waypoint_status.hpp"
 #include "nav_msgs/msg/path.hpp"
 #include "nav2_util/simple_action_server.hpp"
 #include "nav2_util/node_utils.hpp"

nav2_waypoint_follower/src/waypoint_follower.cpp

@@ -305,7 +305,7 @@ void WaypointFollower::followWaypointsHandler(
       current_goal_status_.status == ActionStatus::FAILED ||
       current_goal_status_.status == ActionStatus::UNKNOWN)
     {
-      nav2_msgs::msg::MissedWaypoint missedWaypoint;
+      nav2_msgs::msg::WaypointStatus missedWaypoint;
       missedWaypoint.index = goal_index;
       missedWaypoint.goal = poses[goal_index];
       missedWaypoint.error_code = current_goal_status_.error_code;
@@ -340,7 +340,7 @@ void WaypointFollower::followWaypointsHandler(
         is_task_executed ? "succeeded" : "failed!");
 
       if (!is_task_executed) {
-        nav2_msgs::msg::MissedWaypoint missedWaypoint;
+        nav2_msgs::msg::WaypointStatus missedWaypoint;
         missedWaypoint.index = goal_index;
         missedWaypoint.goal = poses[goal_index];
         missedWaypoint.error_code =