added eigen output test

source/RobotAPI/libraries/core/test/MathUtilsTest.cpp

@@ -26,6 +26,7 @@
 #include <ArmarXCore/core/test/IceTestHelper.h>
 #include "../math/MathUtils.h"
 #include "../math/ColorUtils.h"
+#include "../FramedPose.h"
 using namespace armarx;
 
 void check_close(float a, float b, float tolerance)
@@ -37,8 +38,21 @@ void check_close(float a, float b, float tolerance)
     }
 }
 
+BOOST_AUTO_TEST_CASE(eigenOutputTest)
+{
+    Eigen::Vector3f v;
+    v << 10, 1000, -10;
+    std::cout << "v:\n" << v << std::endl;
+
+    armarx::Vector3 v2(v);
+    std::cout << "v2:\n" << v2.output() << std::endl;
 
 
+    FramedPose p(Eigen::Matrix4f::Identity(), "", "");
+    p.position->x = 100;
+    ARMARX_INFO << "pose:\n" << p.output();
+}
+
 
 BOOST_AUTO_TEST_CASE(fmodTest)
 {