Yet Another Kalman filter