Basic and extended Kalman filter update