Se la matrice è quadrata
For I:=1 to N do
For J:=1 to N do
If I=J then somma:=somma+matrice[I,J]
Per le alter diagonali devi solo spostare gli indici

chiedo scusa la regola mi è sfuggita, ho penato si trattasse di un normale algoritmo