Template Function pinocchio::normalizeRotation

Function Documentation

template<typename Matrix3>
void pinocchio::normalizeRotation(const Eigen::MatrixBase<Matrix3> &rot)

Orthogonormalization procedure for a rotation matrix (closed enough to SO(3)).

Parameters:

rot[inout] A 3x3 matrix to orthonormalize