Improve armar7 platform movement

source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp

@@ -153,11 +153,18 @@ namespace armarx
         {
             //            if (state.norm() >= oldState.norm())
             //            {
-            std::cout << "====TargetZero:\nTarget:\n"
-                      << target << "\nstate:\n"
-                      << state << "\noldst:\n"
-                      << oldState << "\ndelta:\n"
-                      << delta << "\nfactor: " << factor << "\n====\n";
+            std::stringstream ss;
+            ss << "====TargetZero:\nTarget:\n"
+               << target << "\nstate:\n"
+               << state << "\noldst:\n"
+               << oldState << "\ndelta:\n"
+               << delta << "\nfactor: " << factor << "\n====\n";
+            std::string s = ss.str();
+            ARMARX_RT_LOGF_IMPORTANT("%s", s.c_str());
+            if (state.norm() > oldState.norm())
+            {
+                ARMARX_RT_LOGF_IMPORTANT("!!!!NORM INVALID!!!!");
+            }
 
             //                throw LocalException("haeee");
             //            }