本文整理汇总了C++中eigen::MatrixBase::trace方法的典型用法代码示例。如果您正苦于以下问题：C++ MatrixBase::trace方法的具体用法？C++ MatrixBase::trace怎么用？C++ MatrixBase::trace使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类eigen::MatrixBase的用法示例。
在下文中一共展示了MatrixBase::trace方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: R
Eigen::Matrix<typename Derived::Scalar, 4, 1> rotmat2axis(const Eigen::MatrixBase<Derived>& R)
{
EIGEN_STATIC_ASSERT_MATRIX_SPECIFIC_SIZE(Eigen::MatrixBase<Derived>, 3, 3);
typename Derived::Scalar theta = std::acos((R.trace() - 1.0) / 2.0);
Vector4d a;
if (theta > std::numeric_limits<typename Derived::Scalar>::epsilon()) {
a << R(2, 1) - R(1, 2), R(0, 2) - R(2, 0), R(1, 0) - R(0, 1), theta;
a.head<3>() *= 1.0 / (2.0 * std::sin(theta));
}
else {
a << 1.0, 0.0, 0.0, 0.0;
}
return a;
}