Extended Kalman Filter Equations