Function nav2_util::geometry_utils::calculate_path_length
Defined in File geometry_utils.hpp
Function Documentation
-
inline double nav2_util::geometry_utils::calculate_path_length(const nav_msgs::msg::Path &path, size_t start_index = 0)
Calculate the length of the provided path, starting at the provided index.
- Parameters:
path – Path containing the poses that are planned
start_index – Optional argument specifying the starting index for the calculation of path length. Provide this if you want to calculate length of a subset of the path.
- Returns:
double Path length