Second iteration of DDP solver
This PR includes an vast change of the code structure for the increase of efficiency. Additionally, there are few bug fixes most of them regarding to the solver.
This PR includes an vast change of the code structure for the increase of efficiency. Additionally, there are few bug fixes most of them regarding to the solver.