Spline trajectory generation