SKFS function

(Fast) Stationary Kalman Filter and Smoother