Function pilz_industrial_motion_planner::intersectionFound

Function Documentation

bool pilz_industrial_motion_planner::intersectionFound(const Eigen::Vector3d &p_center, const Eigen::Vector3d &p_current, const Eigen::Vector3d &p_next, double r)