DDP solver for quadruped case
This PR contains significantly improvement of the DDP solver before working collaboratively. The main goal achieved was to test our solver for the quadruped case where we manage to converge in few iterations.
Additionally the Python structure of the code is quite stable, however there is still need to review it before moving forward.