Trajectory generation 1D general case, no ineq constraints