Test

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

@@ -151,16 +151,16 @@ namespace armarx
 
         if (target == Eigen::Vector3f(0, 0, 0))
         {
-            if (state.norm() >= oldState.norm())
-            {
-                std::cout << "Target:\n"
-                          << target << "\nstate:\n"
-                          << state << "\noldst:\n"
-                          << oldState << "\ndelta:\n"
-                          << delta << "\nfactor: " << factor << "\n";
-
-                //                throw LocalException("haeee");
-            }
+            //            if (state.norm() >= oldState.norm())
+            //            {
+            std::cout << "====TargetZero:\nTarget:\n"
+                      << target << "\nstate:\n"
+                      << state << "\noldst:\n"
+                      << oldState << "\ndelta:\n"
+                      << delta << "\nfactor: " << factor << "\n====\n";
+
+            //                throw LocalException("haeee");
+            //            }
         }
 
         return state;