Implementation of a inverse velocity kinematics algorithm based on the generalize pseudo inverse to calculate the velocity transformation from Cartesian to joint space of a general KDL::Chain. More...
#include <chainiksolvervel_pinv_givens.hpp>
Public Member Functions | |
virtual int | CartToJnt (const JntArray &q_init, const FrameVel &v_in, JntArrayVel &q_out) |
not (yet) implemented. | |
virtual int | CartToJnt (const JntArray &q_in, const Twist &v_in, JntArray &qdot_out) |
Calculate inverse velocity kinematics, from joint positions and cartesian velocity to joint velocities. | |
ChainIkSolverVel_pinv_givens (const Chain &chain) | |
Constructor of the solver. | |
~ChainIkSolverVel_pinv_givens () |
Implementation of a inverse velocity kinematics algorithm based on the generalize pseudo inverse to calculate the velocity transformation from Cartesian to joint space of a general KDL::Chain.
It uses a svd-calculation based on householders rotations.
Definition at line 24 of file chainiksolvervel_pinv_givens.hpp.
KDL::ChainIkSolverVel_pinv_givens::ChainIkSolverVel_pinv_givens | ( | const Chain & | chain | ) |
Constructor of the solver.
chain | the chain to calculate the inverse velocity kinematics for |
Definition at line 27 of file chainiksolvervel_pinv_givens.cpp.
KDL::ChainIkSolverVel_pinv_givens::~ChainIkSolverVel_pinv_givens | ( | ) |
Definition at line 48 of file chainiksolvervel_pinv_givens.cpp.
virtual int KDL::ChainIkSolverVel_pinv_givens::CartToJnt | ( | const JntArray & | q_init, | |
const FrameVel & | v_in, | |||
JntArrayVel & | q_out | |||
) | [inline, virtual] |
not (yet) implemented.
Implements KDL::ChainIkSolverVel.
Definition at line 42 of file chainiksolvervel_pinv_givens.hpp.
int KDL::ChainIkSolverVel_pinv_givens::CartToJnt | ( | const JntArray & | q_in, | |
const Twist & | v_in, | |||
JntArray & | qdot_out | |||
) | [virtual] |
Calculate inverse velocity kinematics, from joint positions and cartesian velocity to joint velocities.
q_in | input joint positions | |
v_in | input cartesian velocity | |
qdot_out | output joint velocities |
Implements KDL::ChainIkSolverVel.
Definition at line 53 of file chainiksolvervel_pinv_givens.cpp.
References KDL::Chain::getNrOfJoints(), KDL::ChainJntToJacSolver::JntToJac(), and KDL::svd_eigen_Macie().