Added support for dynamic problems and collision avoidance in optimisation problems
- Added support for dynamic shooting problems and a variety of associated solvers (iLQR, DDP, Box-DDP, Control-RRT, etc.)
- Added a variety of taskmaps including for discrete-time collision avoidance in optimisation problems