diff --git a/source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp b/source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp index d19f55109f6176e7609c27d4cca317ad0d5518b0..ea3da74f6f04891465fe3726148d7fdc9b6b773b 100644 --- a/source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp +++ b/source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp @@ -161,6 +161,10 @@ namespace armarx << 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"); // }