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