27 unsigned int _maxiter,
double _eps):
28 chain(_chain),nj (chain.getNrOfJoints()),
29 iksolver(_iksolver),fksolver(_fksolver),
30 delta_q(_chain.getNrOfJoints()),
31 maxiter(_maxiter),eps(_eps)
virtual const char * strError(const int error) const
unsigned int rows() const
This class encapsulates a serial kinematic interconnection structure. It is built out of segments...
ChainFkSolverPos & fksolver
virtual int CartToJnt(const JntArray &q_init, const Frame &p_in, JntArray &q_out)
IMETHOD Vector diff(const Vector &p_w_a, const Vector &p_w_b, double dt=1)
Maximum number of iterations exceeded.
virtual const char * strError(const int error) const
This class represents an fixed size array containing joint values of a KDL::Chain.
Input size does not match internal state.
void Add(const JntArray &src1, const JntArray &src2, JntArray &dest)
virtual int CartToJnt(const JntArray &q_in, const Twist &v_in, JntArray &qdot_out)=0
Converged but degraded solution (e.g. WDLS with psuedo-inverse singular)
ChainIkSolverVel & iksolver
IMETHOD bool Equal(const FrameAcc &r1, const FrameAcc &r2, double eps=epsilon)
virtual int JntToCart(const JntArray &q_in, Frame &p_out, int segmentNr=-1)=0
virtual void updateInternalDataStructures()=0
ChainIkSolverPos_NR(const Chain &chain, ChainFkSolverPos &fksolver, ChainIkSolverVel &iksolver, unsigned int maxiter=100, double eps=1e-6)
Child FK solver failed.
unsigned int getNrOfJoints() const
static const int E_FKSOLVERPOS_FAILED
Child IK solver vel failed.
void resize(unsigned int newSize)
virtual void updateInternalDataStructures()=0
represents a frame transformation in 3D space (rotation + translation)
static const int E_IKSOLVER_FAILED
int error
Latest error, initialized to E_NOERROR in constructor.
virtual void updateInternalDataStructures()
This abstract class encapsulates the inverse velocity solver for a KDL::Chain.
This abstract class encapsulates a solver for the forward position kinematics for a KDL::Chain...