Added a few more solvers.
I now store the best ttrajectory in the workspace while optimizing so that I can see how the minimizer is doing