Semmai matrice identità.
Comunque il tuo problema è che non stai controllando solo gli elementi sulla diagonale principale. Gli elementi sulla diagonale principale sono quelli per cui i coincide con j: pensaci bene, un solo ciclo for ti basta.