Fixes and improvements of the DPM planner
The bump function in the target is now larger
Gradient Optimizer and kDPM-C kind of work
introduced time to penalty function
Fixed SFO after new trajectory optimizer
Fixed broken parts of the code. IIHP is currently broken.
GradientOptimizer seems to work
Gradient Optimizer w.i.p.
Gradient-based trajectory optimizer. w.i.p.
Added progress visualization. Introduced tan multiplier.
Also available in: Atom