Added DirtranTrajectorOptimization as a combination of FE/BE/Midpoint. Not really sure that I like it, however, since it's noticabely harder to make sense of.