Removed some unnecessary code.
Moved trajectory optimization directory to solvers/trajectoryOptimization.