Simultaneous Diagonalization of Positive Semi-definite Matrices