Kinematics and Dynamics Library extensions developed in the CoDyCo project.