const T & getFrictionCoeff()
typename Eigen::Matrix< T, 3, 3 > Mat3
typename Eigen::Matrix< T, 3, 1 > Vec3
virtual bool ContactDetection(const Vec3< T > &cp_pos, T &penetration, Mat3< T > &cp_frame)=0
const T & getRestitutionCoeff()
Collision(const T &mu, const T &resti)