Testing RoundTrip for new rotation type conversions

main.cpp

@@ -11,6 +11,7 @@
 
 
 #include <iostream>
+#include <J3ML/LinearAlgebra.hpp>
 #include <J3ML/Geometry.hpp>
 #include <J3ML/J3ML.hpp>
 #include <jlog/Logger.hpp>
@@ -18,6 +19,20 @@
 
 int main(int argc, char** argv)
 {
+    Matrix3x3 matrix_rep = {
+            0.9902160,  0.0000000,  0.1395431,
+            0.1273699,  0.4084874, -0.9038334,
+            -0.0570016,  0.9127640,  0.4044908};
+
+    Quaternion quat_rep = {0.5425029, 0.0586955, 0.0380374, 0.8371371};
+
+    AxisAngle aa_rep = { {0.9917912, 0.1073057, 0.069539}, 1.1575362};
+
+    EulerAngleXYZ euler_rep = {1.15, 0.14,0};
+
+    Quaternion q_from_matrix = Quaternion(matrix_rep);
+    assert(quat_rep.Equals(q_from_matrix));
+
 
     using namespace J3ML::Math;