Function hateb_local_planner::calc_distance_line_to_line_3d

Function Documentation

inline double hateb_local_planner::calc_distance_line_to_line_3d(const Eigen::Ref<const Eigen::Vector3d> &x1, Eigen::Ref<const Eigen::Vector3d> &u, const Eigen::Ref<const Eigen::Vector3d> &x2, Eigen::Ref<const Eigen::Vector3d> &v)