Function nav2_util::geometry_utils::euclidean_distance(const geometry_msgs::msg::Pose&, const geometry_msgs::msg::Pose&, const bool)

Defined in File geometry_utils.hpp

Function Documentation

inline double nav2_util::geometry_utils::euclidean_distance(const geometry_msgs::msg::Pose &pos1, const geometry_msgs::msg::Pose &pos2, const bool is_3d = false)

Get the L2 distance between 2 geometry_msgs::Poses.

Parameters:

pos1 – First pose
pos1 – Second pose
is_3d – True if a true L2 distance is desired (default false)

Returns:

double euclidean distance