23 const Eigen::Matrix<double, Eigen::Dynamic, 3, Eigen::RowMajor>& q);
Eigen::Vector3d compute_distance_gjk(const Eigen::Matrix< double, Eigen::Dynamic, 3, Eigen::RowMajor > &p, const Eigen::Matrix< double, Eigen::Dynamic, 3, Eigen::RowMajor > &q)
Calculate the distance between two convex bodies p and q, each defined by a set of points,...
Definition: GJK.cpp:168