ADVRHumanoids/CartesianInterface

[inverse_dynamics] InverseDynamics utility should be called after the tasks parsing

Closed this issue · 1 comments

There is a problem in the implementation of the Inverse Dynamics with force tasks [inverse_dynamics branch].

The utility
boost::make_sharedOpenSoT::utils::InverseDynamics(_links_in_contact, * _model)
requires the _links_in_contact vector, that is filled in the parsing of interaction tasks.
On the other side, the tasks parsing requires _qddot that is available after calling the InverseDynamics utility.

At the moment, when the utility is called, the _links_in_contact vector is empty. So the related force variables are not created.

Fixed in commit 3559090