Diagonalise A Matrix