matrix4 traspose

Author: rusoleal

inc/vector_math/mat.hpp

@@ -40,6 +40,18 @@ namespace systems::leal::vector_math {
             return toReturn;
         }
 
+        Mat<DATA_TYPE,COLS,ROWS> transpose() const {
+            Mat<DATA_TYPE,COLS,ROWS> toReturn;
+
+            int ownIndex=0;
+            for (int a=0; a<COLS; a++)
+                for (int b=0; b<ROWS; b++) {
+                    toReturn.data[COLS*b + a] = this->data[ownIndex];
+                    ownIndex++;
+                }
+
+            return toReturn;
+        }
 
     };
 

inc/vector_math/matrix4.hpp

@@ -42,6 +42,7 @@ namespace systems::leal::vector_math
         static Matrix4<DATA_TYPE> rotateX(DATA_TYPE angle);
         static Matrix4<DATA_TYPE> rotateY(DATA_TYPE angle);
         static Matrix4<DATA_TYPE> rotateZ(DATA_TYPE angle);
+        
 
     };
 

test/main.cpp

@@ -43,6 +43,10 @@ TEST(Matrix4Float, mul) {
     EXPECT_EQ(Matrix4<float>::identity()*Matrix4<float>(1), Matrix4<float>(1));
 }
 
+TEST(Matrix4Float, transpose) {
+    EXPECT_EQ(Matrix4<float>::identity().transpose(), Matrix4<float>::identity());
+}
+
 TEST(Matrix4Double, constructors) {
     EXPECT_EQ(sizeof(Matrix4<double>), 128);
     EXPECT_EQ(Matrix4<double>::identity(), Matrix4<double>::identity());
@@ -59,6 +63,10 @@ TEST(Matrix4Double, mul) {
     EXPECT_EQ(Matrix4<double>::identity()*Matrix4<double>(1), Matrix4<double>(1));
 }
 
+TEST(Matrix4Double, transpose) {
+    EXPECT_EQ(Matrix4<double>::identity().transpose(), Matrix4<double>::identity());
+}
+
 int main(int argc, char **argv) {
     testing::InitGoogleTest(&argc, argv);
     return RUN_ALL_TESTS();