Function kinematics_utils::calc_error_p

Function Documentation

Eigen::Vector3d kinematics_utils::calc_error_p(const Eigen::Vector3d &target, const Eigen::Vector3d &current)