Support closed kinematics

[ahoarau]

Hi all,

This is just a feature request. I think it would be useful to have closed loop kinematics support such as :

It may start by have a "passive" chain that would follow the other one, the "active". That would mean solve an IK problem in forward kinematics. what do you think ?

[jcarpent]

I don't know what is the current status of using Pinocchio inside iDyntree, but soon, Pinocchio will support such kind of mechanisms both at the kinematic and dynamic level. So, if relying Pinocchio remains valid, it will be normally straightforward.

[traversaro]

Hi @ahoarau ! In theory iDynTree::Model is already designed to support closed kinematics, the problem is that most of the algorithms does not support it, starting from computeFullTreeTraversal that in the case of closed kinematics model should provide a suitable spanning tree of the closed kinematics model. In general any improvements to better support closed kinematics in iDynTree is welcome, but at the moment I don't think anyone is working in that direction.

[traversaro]

I don't what is the current status of using Pinocchio inside iDyntree, but soon, Pinocchio will support such kind of mechanisms both at the kinematic and dynamic level. So, if relying Pinocchio remains valid, it will be normally straighforward.

Hi @jcarpenter, the work on building a shim on the top of Pinocchio that loads models from iDynTree::Model and offer a functionality similar to an API similar to iDynTree::KinDynComputations is currently tracked in the separate repository (https://github.com/dic-iit/idynfor) and at the moment we don't have an ETA for when the work on it will start. However, I imagined that even in that case to support closed kinematics chain use cases the APIs of iDynTree::KinDynComputations would need to be revised accordingly.

[traversaro]

fyi @FabioBergonti , given that you are working on closed kinematics (even if you are not using iDynTree at the moment).