Extended kalman filter block diagram