kalmanFilter function

Kalman filter for state estimate in a linear Gaussian state space model