21 #ifndef KDL_CHAINJNTTOJACDOTSOLVER_HPP 22 #define KDL_CHAINJNTTOJACDOTSOLVER_HPP 129 const unsigned int& joint_idx,
130 const unsigned int& column_idx);
140 const unsigned int& joint_idx,
141 const unsigned int& column_idx);
151 const unsigned int& joint_idx,
152 const unsigned int& column_idx);
163 const unsigned int& joint_idx,
164 const unsigned int& column_idx,
165 const int& representation);
void setRepresentation(const int &representation)
Sets the internal variable for the representation (with a check on the value)
Definition: chainjnttojacdotsolver.cpp:210
static const int BODYFIXED
Definition: chainjnttojacdotsolver.hpp:58
int setLockedJoints(const std::vector< bool > &locked_joints)
Definition: chainjnttojacdotsolver.cpp:219
Implementation of a recursive forward position kinematics algorithm to calculate the position transfo...
Definition: chainfksolverpos_recursive.hpp:36
static const int E_JAC_DOT_FAILED
Definition: chainjnttojacdotsolver.hpp:51
Computes the Jacobian time derivative (Jdot) by calculating the partial derivatives regarding to a jo...
Definition: chainjnttojacdotsolver.hpp:48
unsigned int nr_of_unlocked_joints_
Definition: chainjnttojacdotsolver.hpp:170
Definition: jacobian.hpp:36
const Twist & getPartialDerivativeHybrid(const Jacobian &bs_J_ee, const unsigned int &joint_idx, const unsigned int &column_idx)
Computes .
Definition: chainjnttojacdotsolver.cpp:136
This class encapsulates a serial kinematic interconnection structure.
Definition: chain.hpp:35
static const int E_JACSOLVER_FAILED
Definition: chainjnttojacdotsolver.hpp:52
const Twist & getPartialDerivativeBodyFixed(const Jacobian &ee_J_ee, const unsigned int &joint_idx, const unsigned int &column_idx)
Computes .
Definition: chainjnttojacdotsolver.cpp:167
virtual ~ChainJntToJacDotSolver()
Definition: chainjnttojacdotsolver.cpp:241
Solver interface supporting storage and description of the latest error.
Definition: solveri.hpp:84
Twist jac_i_
Definition: chainjnttojacdotsolver.hpp:178
ChainFkSolverPos_recursive fk_solver_
Definition: chainjnttojacdotsolver.hpp:175
Twist jac_j_
Definition: chainjnttojacdotsolver.hpp:178
void setBodyFixedRepresentation()
JntToJacDot() will compute in the Body-fixed representation (ref Frame: end-effector, ref Point: end-effector)
Definition: chainjnttojacdotsolver.hpp:97
Class to calculate the jacobian of a general KDL::Chain, it is used by other solvers.
Definition: chainjnttojacsolver.hpp:41
represents both translational and rotational velocities.
Definition: frames.hpp:720
Jacobian jac_
Definition: chainjnttojacdotsolver.hpp:172
Definition: articulatedbodyinertia.cpp:28
void setInternialRepresentation()
JntToJacDot() will compute in the Inertial representation (ref Frame: base, ref Point: base) ...
Definition: chainjnttojacdotsolver.hpp:103
virtual const char * strError(const int error) const
Return a description of the latest error.
Definition: chainjnttojacdotsolver.cpp:233
Jacobian jac_dot_
Definition: chainjnttojacdotsolver.hpp:173
const Chain & chain
Definition: chainjnttojacdotsolver.hpp:168
Definition: jntarrayvel.hpp:45
ChainJntToJacSolver jac_solver_
Definition: chainjnttojacdotsolver.hpp:171
void setHybridRepresentation()
JntToJacDot() will compute in the Hybrid representation (ref Frame: base, ref Point: end-effector) ...
Definition: chainjnttojacdotsolver.hpp:91
static const int E_FKSOLVERPOS_FAILED
Definition: chainjnttojacdotsolver.hpp:53
std::vector< bool > locked_joints_
Definition: chainjnttojacdotsolver.hpp:169
ChainJntToJacDotSolver(const Chain &chain)
Definition: chainjnttojacdotsolver.cpp:26
Twist jac_dot_k_
Definition: chainjnttojacdotsolver.hpp:177
virtual int JntToJacDot(const KDL::JntArrayVel &q_in, KDL::Twist &jac_dot_q_dot, int seg_nr=-1)
Computes .
Definition: chainjnttojacdotsolver.cpp:47
represents a frame transformation in 3D space (rotation + translation)
Definition: frames.hpp:570
Frame F_bs_ee_
Definition: chainjnttojacdotsolver.hpp:176
Twist t_djdq_
Definition: chainjnttojacdotsolver.hpp:179
static const int HYBRID
Definition: chainjnttojacdotsolver.hpp:56
virtual void updateInternalDataStructures()
Update the internal data structures.
Definition: chainjnttojacdotsolver.cpp:38
const Twist & getPartialDerivative(const Jacobian &J, const unsigned int &joint_idx, const unsigned int &column_idx, const int &representation)
Computes .
Definition: chainjnttojacdotsolver.cpp:117
int error
Latest error, initialized to E_NOERROR in constructor.
Definition: solveri.hpp:149
const Twist & getPartialDerivativeInertial(const Jacobian &bs_J_bs, const unsigned int &joint_idx, const unsigned int &column_idx)
Computes .
Definition: chainjnttojacdotsolver.cpp:189
static const int INTERTIAL
Definition: chainjnttojacdotsolver.hpp:60
int representation_
Definition: chainjnttojacdotsolver.hpp:174