Kalman filter algorithm example