First version of the DDP structure
This PR reflects the first version of the DDP structure but all cases and unit-test are working. It still doesn't exploit efficiency from static functions and there are redundant computations for the dynamics and cost.
@rbudhira As discussed yesterday, I will merge this first attend of the DDP structure. It would help us to do further comparisons and debugging of the ongoing structure.
Edited by Carlos Mastalli