Updated MSCKF.m to use state update function and parcel corrected covariance into our covariance struct