Renamed TrajectoryOptimization to DirectTrajectoryOptimization. Added x-dimension check when constraints are added.