This PR fixes #85 by defining the state and control action weights for every time step in the code instead of the pre-compiled NLP, and then transforming those weights from body frame into world frame, as described in #85 .
Logging of Q_world and Q_body has also been added.
This PR fixes #85 by defining the state and control action weights for every time step in the code instead of the pre-compiled NLP, and then transforming those weights from body frame into world frame, as described in #85 .
Logging of
Q_world
andQ_body
has also been added.