Text this: Diagonalization of covariance matrix in simultaneous localization and mapping of mobile robot