Function kinematics_utils::rodrigues

Function Documentation

Eigen::Matrix3d kinematics_utils::rodrigues(const Eigen::Vector3d &a, const double theta)