18 if (t < -1.0 - epsilon || t > 1.0 +
epsilon)
36 vec_mid = (vec1_pull_seg + vec2_pull_seg) / 2.0;
38 for (
int i = 0; i <= 2; i++)
46 result = result * 0.5;
50 result = result * 1.0;
double operator()(const double &t) const
Eigen::Matrix< double, 1, DIM, Eigen::RowMajor > Vector3d
double integrate(const Vector3d &vec1_pull_seg, const Vector3d &vec2_pull_seg) const