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

Function Documentation

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

Get the euclidean distance between 2 geometry_msgs::Points.

Parameters:
  • pos1 – First point

  • pos1 – Second point

  • is_3d – True if a true L2 distance is desired (default false)

Returns:

double L2 distance