Function kinematics_utils::calc_error

Defined in File kinematics_utils.hpp

Function Documentation

Eigen::VectorXd kinematics_utils::calc_error(const Eigen::Vector3d &target_p, const Eigen::Matrix3d &target_R, const manipulators_link::Link &current_link)