Added ConstantStepSegmentedTrajectory