spline trajectory fix