Function hateb_local_planner::distance_point_to_segment_2d

Function Documentation

inline double hateb_local_planner::distance_point_to_segment_2d(const Eigen::Ref<const Eigen::Vector2d> &point, const Eigen::Ref<const Eigen::Vector2d> &line_start, const Eigen::Ref<const Eigen::Vector2d> &line_end)

Helper function to calculate the distance between a line segment and a point.

Parameters:
  • point – 2D point

  • line_start – 2D point representing the start of the line segment

  • line_end – 2D point representing the end of the line segment

Returns:

minimum distance to a given line segment