Python Extended Kalman Filter Equations