Diagonalization matrix first find eigen values and eigen matrix