Update augmented matrix