Added a bunch of (raw) trajectory optimization methods.