orocos_kdl
chainiksolvervel_pinv_givens.hpp
Go to the documentation of this file.
1 // Copyright (C) 2007 Ruben Smits <ruben dot smits at mech dot kuleuven dot be>
2 
3 #ifndef KDL_CHAIN_IKSOLVERVEL_PINV_GIVENS_HPP
4 #define KDL_CHAIN_IKSOLVERVEL_PINV_GIVENS_HPP
5 
6 #include "chainiksolver.hpp"
8 
9 #include <Eigen/Core>
10 
11 namespace KDL
12 {
23  {
24  public:
25 
33  explicit ChainIkSolverVel_pinv_givens(const Chain& chain);
35 
36  virtual int CartToJnt(const JntArray& q_in, const Twist& v_in, JntArray& qdot_out);
41  virtual int CartToJnt(const JntArray& /*q_init*/, const FrameVel& /*v_in*/, JntArrayVel& /*q_out*/){return (error = E_NOT_IMPLEMENTED);};
42 
44  virtual void updateInternalDataStructures();
45 
46  private:
47  const Chain& chain;
48  unsigned int nj;
52  unsigned int m,n;
53  Eigen::MatrixXd jac_eigen,U,V,B;
54  Eigen::VectorXd S,tempi,UY,SUY,qdot_eigen,v_in_eigen;
55  };
56 }
57 #endif
KDL::JntArray
Definition: jntarray.hpp:69
KDL::ChainIkSolverVel_pinv_givens::jac_eigen
Eigen::MatrixXd jac_eigen
Definition: chainiksolvervel_pinv_givens.hpp:53
KDL::ChainIkSolverVel_pinv_givens::transpose
bool transpose
Definition: chainiksolvervel_pinv_givens.hpp:51
KDL::ChainIkSolverVel_pinv_givens::CartToJnt
virtual int CartToJnt(const JntArray &q_in, const Twist &v_in, JntArray &qdot_out)
Definition: chainiksolvervel_pinv_givens.cpp:70
KDL::ChainIkSolverVel_pinv_givens::toggle
bool toggle
Definition: chainiksolvervel_pinv_givens.hpp:51
KDL::SolverI::E_NOT_IMPLEMENTED
@ E_NOT_IMPLEMENTED
Not yet implemented.
Definition: solveri.hpp:105
KDL
Definition: kukaLWR_DHnew.cpp:25
KDL::ChainIkSolverVel_pinv_givens
Definition: chainiksolvervel_pinv_givens.hpp:22
KDL::ChainIkSolverVel_pinv_givens::n
unsigned int n
Definition: chainiksolvervel_pinv_givens.hpp:52
KDL::Twist
represents both translational and rotational velocities.
Definition: frames.hpp:723
chainiksolver.hpp
KDL::ChainIkSolverVel_pinv_givens::U
Eigen::MatrixXd U
Definition: chainiksolvervel_pinv_givens.hpp:53
KDL::ChainIkSolverVel_pinv_givens::qdot_eigen
Eigen::VectorXd qdot_eigen
Definition: chainiksolvervel_pinv_givens.hpp:54
KDL::ChainIkSolverVel_pinv_givens::m
unsigned int m
Definition: chainiksolvervel_pinv_givens.hpp:52
KDL::ChainIkSolverVel_pinv_givens::tempi
Eigen::VectorXd tempi
Definition: chainiksolvervel_pinv_givens.hpp:54
KDL::ChainIkSolverVel_pinv_givens::jac
Jacobian jac
Definition: chainiksolvervel_pinv_givens.hpp:50
KDL::ChainIkSolverVel_pinv_givens::V
Eigen::MatrixXd V
Definition: chainiksolvervel_pinv_givens.hpp:53
KDL::ChainIkSolverVel_pinv_givens::UY
Eigen::VectorXd UY
Definition: chainiksolvervel_pinv_givens.hpp:54
KDL::JntArrayVel
Definition: jntarrayvel.hpp:45
KDL::ChainIkSolverVel_pinv_givens::B
Eigen::MatrixXd B
Definition: chainiksolvervel_pinv_givens.hpp:53
KDL::ChainIkSolverVel_pinv_givens::CartToJnt
virtual int CartToJnt(const JntArray &, const FrameVel &, JntArrayVel &)
Definition: chainiksolvervel_pinv_givens.hpp:41
KDL::ChainIkSolverVel_pinv_givens::chain
const Chain & chain
Definition: chainiksolvervel_pinv_givens.hpp:47
KDL::FrameVel
Definition: framevel.hpp:209
KDL::ChainIkSolverVel
This abstract class encapsulates the inverse velocity solver for a KDL::Chain.
Definition: chainiksolver.hpp:66
chainjnttojacsolver.hpp
KDL::ChainIkSolverVel_pinv_givens::S
Eigen::VectorXd S
Definition: chainiksolvervel_pinv_givens.hpp:54
KDL::ChainIkSolverVel_pinv_givens::nj
unsigned int nj
Definition: chainiksolvervel_pinv_givens.hpp:48
KDL::ChainIkSolverVel_pinv_givens::updateInternalDataStructures
virtual void updateInternalDataStructures()
Definition: chainiksolvervel_pinv_givens.cpp:48
KDL::ChainIkSolverVel_pinv_givens::v_in_eigen
Eigen::VectorXd v_in_eigen
Definition: chainiksolvervel_pinv_givens.hpp:54
KDL::ChainIkSolverVel_pinv_givens::jnt2jac
ChainJntToJacSolver jnt2jac
Definition: chainiksolvervel_pinv_givens.hpp:49
KDL::ChainJntToJacSolver
Class to calculate the jacobian of a general KDL::Chain, it is used by other solvers.
Definition: chainjnttojacsolver.hpp:38
KDL::Chain
This class encapsulates a serial kinematic interconnection structure. It is built out of segments.
Definition: chain.hpp:35
KDL::ChainIkSolverVel_pinv_givens::ChainIkSolverVel_pinv_givens
ChainIkSolverVel_pinv_givens(const Chain &chain)
Definition: chainiksolvervel_pinv_givens.cpp:27
KDL::ChainIkSolverVel_pinv_givens::SUY
Eigen::VectorXd SUY
Definition: chainiksolvervel_pinv_givens.hpp:54
KDL::SolverI::error
int error
Latest error, initialized to E_NOERROR in constructor.
Definition: solveri.hpp:149
KDL::Jacobian
Definition: jacobian.hpp:36
KDL::ChainIkSolverVel_pinv_givens::~ChainIkSolverVel_pinv_givens
~ChainIkSolverVel_pinv_givens()
Definition: chainiksolvervel_pinv_givens.cpp:65