add test to .urt()

PX4 · Feb 17, 2019 · 14630d5 · 14630d5
1 parent fbef579
commit 14630d5
Show file tree

Hide file tree

Showing 2 changed files with 25 additions and 0 deletions.
diff --git a/test/CMakeLists.txt b/test/CMakeLists.txt
@@ -18,6 +18,7 @@ set(tests
     hatvee
     copyto
     least_squares
+    urt
     )
 
 add_custom_target(test_build)

diff --git a/test/urt.cpp b/test/urt.cpp
@@ -0,0 +1,24 @@
+#include "test_macros.hpp"
+
+#include <matrix/math.hpp>
+
+using namespace matrix;
+
+int main()
+{
+    float data[9] = {1, 2, 3,
+                     4, 5, 6,
+                     7, 8, 10
+                    };
+    float urt[6] = {1, 2, 3, 5, 6, 10}
+
+    SquareMatrix<float, 3> A(data);
+
+    for(int i=0; i<sizeof(urt); i++) {
+        TEST(fabs(urt[i] - A.urt().data()[i]) < FLT_EPSILON);
+    }
+
+    return 0;
+}
+
+/* vim: set et fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : */