kf function

Kalman filter for SS models