Text this: Improving Covariance Matrix Diagonalization in SLAM of Mobile Robot