Function crx_kinematics::to_xyzwpr

• Defined in File robot.hpp

Function Documentation

std::array<double, 6> crx_kinematics::to_xyzwpr(const Eigen::Isometry3d &T)