Function nav2_util::geometry_utils::find_next_matching_goal_in_waypoint_statuses

Defined in File geometry_utils.hpp

Function Documentation

inline int nav2_util::geometry_utils::find_next_matching_goal_in_waypoint_statuses(const std::vector<nav2_msgs::msg::WaypointStatus> &waypoint_statuses, const geometry_msgs::msg::PoseStamped &goal)

Find the index of the first goal in PENDING status matching the given target pose.

Parameters:

waypoint_statuses – List of waypoint statuses to search through.
goal – Target pose to match against waypoint goals.

Returns:

Index of the first matching goal in PENDING status, -1 if not found.