changed solveTraj in DircolTrajectoryOptimization to output utraj before xtraj.  (sorry for the change, but it's definitely the right order since you might want utraj without xtraj but not vice versa)