unsigned int getNrOfJoints() const
SegmentMap::const_iterator getRootSegment() const
#define GetTreeElementParent(tree_element)
const SegmentMap & getSegments() const
unsigned int rows() const
~TreeFkSolverPos_recursive()
represents a frame transformation in 3D space (rotation + translation)
Frame recursiveFk(const JntArray &q_in, const SegmentMap::const_iterator &it)
This class encapsulates a tree kinematic interconnection structure. It is built out of segments.
#define GetTreeElementSegment(tree_element)
virtual int JntToCart(const JntArray &q_in, Frame &p_out, std::string segmentName)
SegmentMap::const_iterator getSegment(const std::string &segment_name) const
TreeFkSolverPos_recursive(const Tree &tree)
#define GetTreeElementQNr(tree_element)