double trace()

Returns the trace of the matrix. The trace of a matrix is the sum of the diagonal entries.

Source 

double trace() {
  double t = 0.0;
  t += _m4storage[0];
  t += _m4storage[5];
  t += _m4storage[10];
  t += _m4storage[15];
  return t;
}