diff --git a/src/Math/Matrix.h b/src/Math/Matrix.h
index b4f482391..6334038cc 100644
--- a/src/Math/Matrix.h
+++ b/src/Math/Matrix.h
@@ -100,12 +100,7 @@ template<std::size_t size, class T> class Matrix: public RectangularMatrix<size,
          * @f]
          */
         T trace() const {
-            T out(0);
-
-            for(std::size_t i = 0; i != size; ++i)
-                out += (*this)[i][i];
-
-            return out;
+            return this->diagonal().sum();
         }
 
         /** @brief %Matrix without given column and row */