Started to work on estimating the estimation error with incorporation of augmented states.