//============================================================================== btTransform convertTransform(const Eigen::Isometry3d& _T) { btTransform trans; trans.setOrigin(convertVector3(_T.translation())); trans.setBasis(convertMatrix3x3(_T.linear())); return trans; }
//============================================================================== fcl::Transform3f FCLTypes::convertTransform(const Eigen::Isometry3d& _T) { fcl::Transform3f trans; trans.setTranslation(convertVector3(_T.translation())); trans.setRotation(convertMatrix3x3(_T.linear())); return trans; }
//============================================================================== dart::collision::fcl::Transform3 FCLTypes::convertTransform(const Eigen::Isometry3d& _T) { #if FCL_VERSION_AT_LEAST(0,6,0) return _T; #else dart::collision::fcl::Transform3 trans; trans.setTranslation(convertVector3(_T.translation())); trans.setRotation(convertMatrix3x3(_T.linear())); return trans; #endif }