Function nav2_util::geometry_utils::euclidean_distance(const geometry_msgs::msg::Pose2D&, const geometry_msgs::msg::Pose2D&)

• Defined in File geometry_utils.hpp

Function Documentation

inline double nav2_util::geometry_utils::euclidean_distance(const geometry_msgs::msg::Pose2D &pos1, const geometry_msgs::msg::Pose2D &pos2)

Get the L2 distance between 2 geometry_msgs::Pose2D.

Parameters:

• pos1 – First pose

• pos1 – Second pose

Returns:

double L2 distance