[WIP] Trajectory Optimization 2 - Direct Collocation

Last updated