61 const std::vector<kdl_kinematics_plugin::JointMimic>& mimic_joints,
62 bool position_ik =
false,
double threshold = 0.001);
68 int CartToJnt(
const JntArray& q_in,
const Twist& v_in, JntArray& qdot_out)
override
70 return CartToJnt(q_in, v_in, qdot_out, Eigen::VectorXd::Constant(jac_reduced_.columns(), 1.0),
71 Eigen::Matrix<double, 6, 1>::Constant(1.0));
79 int CartToJnt(
const JntArray& q_in,
const Twist& v_in, JntArray& qdot_out,
const Eigen::VectorXd& joint_weights,
80 const Eigen::Matrix<double, 6, 1>& cartesian_weights);
83 int CartToJnt(
const JntArray& ,
const FrameVel& , JntArrayVel& )
override
95 bool jacToJacReduced(
const Jacobian& jac, Jacobian& jac_reduced);
98 const std::vector<kdl_kinematics_plugin::JointMimic>& mimic_joints_;
99 int num_mimic_joints_;
102 ChainJntToJacSolver jnt2jac_;
106 Eigen::VectorXd qdot_out_reduced_;
109 Jacobian jac_reduced_;