Kalman filter numerical example