[inverse_dynamics] InverseDynamics utility should be called after the tasks parsing
edoardolamon opened this issue · 1 comments
edoardolamon commented
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.
edoardolamon commented
Fixed in commit 3559090