Math: do Matrix::trace() using diagonal() and Vector::sum().

Use (future) SIMD optimizations in Vector::sum() instead of doing it all
over again.