Implement Diagonal

2024-01-12 05:53:12 -05:00
parent 93759ba545
commit 32046d88cd
2 changed files with 9 additions and 0 deletions
--- a/src/J3ML/LinearAlgebra/Matrix3x3.cpp
+++ b/src/J3ML/LinearAlgebra/Matrix3x3.cpp
@@ -278,5 +278,12 @@ namespace LinearAlgebra {
        return m2;
    }

+    Vector3 Matrix3x3::Diagonal() const {
+        return {elems[0][0],
+                elems[1][1],
+                elems[2][2]
+        };
+    }
+
 }