Added more of the EKF equations