Get the trace of the matrix (sum of the values along the diagonal)
double MatrixTrace( MatrixD mat, );