Two Stage Trajectory Generation