iCubmain

iDyn is a library for computing kinematics and dynamics of seriallinks chains of revolute joints and iCub limbs.
It started as an extension of the iKin library, with the purpose of including the dynamic description of the links, and gradually evolved until considering the whole body dynamics. Thus, starting from links (from iKinLink to iDynLink) the library provides classes for links, chain of links, and generic limbs. Of course, iCub limbs are included, with the specific kinematics and dynamics data already set (by default, the CAD parameters).
The library also provides a NewtonEuler based method to compute forces, moments, and joint torques, for each link in single or multiple interconnected chains, in presence or not of FT sensors, placed anywhere in the chain (e.g. in the middle of the chain).
The main purposes of the library are:
The modules using iDyn and performing these operations are WholeBodyTorqueObserver and WrenchObserver, which are the bases for the Torque Interface, Torque Control, Impedance Control, Zeroforce control, external contact detection and so on. The complete and detailed documentation of iDyn code is available here.
The library modules are:
The base classes describing serial links chains are:
Note that iDynLink and iDynChain are derived from the corresponding classes (iKinLink and iKinChain) in the iKin library, so they provide both kinematic and dynamic data and methods. iDynLimb is, as in iKin, basically a redefinition of iDynChain methods, used to protect some chain data. iDynLink is an extension of iKinLink, since it adds the dynamic parameters of the link:
and the other characteristic variables used for dynamics:
An iDynChain is basically a list of links; the main difference with respect to iKin is that blocked links contribute to the dynamics, so there's no need to have a second list to fasten dynamic computations. However, since iDynChain inherits from iKinChain, blocked links are considered for the Jacobian computation, which is unchanged. One of the advantages of iDyn is the possibility to interconnect multiple limbs and computing also a "shared" Jacobian. To this purpose, the concept of "node" must be introduced.
iDynNode represents a virtual node where multiple limbs are connected, and may exchange kinematic and wrench information among them. Multiple limbs can be attached to the Node, but at least one must be attached.
The mutual exchange between node and limbs (full duplex) is managed used a RigidBodyTransformation class, containing the rototranslational matrix which describes the connection, and the type of `‘flow’' of kinematic and wrench variables: from limb to node or from node to limb. One limb can be attached to a node at the base or at the endeffector: this, combined with the information flows, affects the computations in particular the application of the NewtonEuler algorithm while solving the limbs dynamic.
If a FT sensor is present inside a kinematic chain, its measurements can be exploited to initialize the wrench phase of the NewtonEuler recursive algorithm, starting from the sensor instead of the endeffector of the chain (or the final link of the chain). A iDynSensor class is then used: a generic class, which attaches a FT sensor into a iDynChain. The `‘attach’' is specified by the \( sth \) link hosting the sensor, the rototranslational matrix defining the sensor frame with respect to the link frame, and the dynamical parameters of the "sublink" between the link frame and the sensor frame (the portion of link between the sensor and the end of the link).
iDyn is a generic library that could be used for any robot, but of course iCub parts/limbs are already available to the user, preconfigured with the iCub CAD parameters. A generic iCub limb name is: iCub + part + Dyn where part is: Arm, Torso, Leg, Eye, EyeNeckRef, InertialSensor, NeckInertial. For legs and arms the part can be also followed by the tag "NoTorso": the reason is that in iKin the arm limb includes the torso links in the chain, whereas in iDyn one may choose to work on the arm only; in a similar way, legs in iKin are referred to the torso \(H_0\) matrix, whereas in iDyn one can choose to have them without reference to the torso.
In order to use the iDyn library, make sure that the following steps are done:
iDyn depends only on YARP and iKin. In order to include iDyn and use it in your software, make sure you include the following line in the CMakeLists.txt:
Of course if you are developing outside the iCub project (e.g. in contrib), you may also add these lines:
In your code the iDyn namespace must be declared, and the header files needed must be included:
The NewtonEuler recursive algorithm is basically a set of computations, consisting in two steps: the so called "kinematic" and "wrench phase". In the first, the kinematic variables of the link (angular velocity/acceleration, linear acceleration, and so on) are computed, whereas in the latter the force, moment and joint torque are computed. Both phases must be initialized properly, with kinematic information (usually at the base of the chain) and external wrench information (usually at the endeffector of the chain).
Classic NewtonEuler computations
Kinematic phase (Forward): \( i=1,2,\ldots,n \)
\[ w^i_i = {R^{i1}_i}^\top (w^{i1}_{i1} + \dot{\theta}_i z_0) \]
\[ \dot{w}^i_i = {R^{i1}_i}^\top (\dot{w}^{i1}_{i1} + \ddot{\theta}_i z_0 + \dot{\theta}_i w^{i1}_{i1} \times z_0) \]
\[ \ddot{p}^i_i = {R^{i1}_i}^\top \ddot{p}^{i1}_{i1} + \dot{w}^i_i \times r^i_{i1,i} + w^i_i \times (w^i_i \times r^i_{i1,i}) \]
\[ \ddot{p}^i_{C_i} = \ddot{p}^i_i + \dot{w}^i_i \times r^i_{i,C_i} + w^i_i \times (w^i_i \times r^i_{i,C_i}) \]
initialized by \( w^0_0, \dot{w}^0_0, \ddot{p}^0_0g^0_0 \).
Wrench phase (Backward): \( i=n,n1,\ldots,1 \)
\[ f^i_i = {R^{i}_{i+1}}^\top f^{i+1}_{i+1} + m_i \ddot{p}^i_{C_i} \]
\[ \mu^i_i =  f^i_i \times ( r^i_{i1,i} + r^i_{i,C_i} ) + R^i_{i+1} \mu^{i+1}_{i+1} + R^i_{i+1} f^{i+1}_{i+1} \times r^i_{i,C_i} + \bar{I}^i_i \dot{w}^i_i + w^i_i \times (\bar{I}^i_i w^i_i) \]
\[ \tau_i = {\mu^i_i}^\top {R^{i1}_i}^\top z_0 \]
initialized by \( f^{n+1}_{n+1},\mu^{n+1}_{n+1} \).
The detailed description of the algorithm can be found in: L. Sciavicco, B. Siciliano, Modelling and Control of Robot Manipulators, 2nd Edition, SpringerVerlag, 2000.
Note
iDyn provides NewtonEuler recursive algorithm computations for the classical case, but also for all possible cases, i.e. when the external kinematic and wrench information are set at the beginning or at the end of the chain, or whenever external force measurements (coming from a FT sensor inside the chain) are available.
A more detailed description of the library, along with tutorial slides, is available in the wiki page on iDyn.
Some working examples are available under
The detailed code documentation is available here.