Uncommitted changes on a7 realtime (unstable) found during demo testing

source/RobotAPI/libraries/core/PIDController.cpp

@@ -285,9 +285,9 @@ namespace armarx
         }
         controlValue =
             std::min(fabs(controlValue), maxControlValue) * math::MathUtils::Sign(controlValue);
-        ARMARX_DEBUG << deactivateSpam(0.5) << " error: " << error << " cV: " << (controlValue)
-                     << " i: " << (Ki * integral) << " d: " << (Kd * derivative)
-                     << " dt: " << deltaSec;
+        ARMARX_DEBUG << deactivateSpam(0.5) << " error: " << error << " kp*error" << (Kp * error)
+                     << " cV: " << (controlValue) << " i: " << (Ki * integral)
+                     << " d: " << (Kd * derivative) << " dt: " << deltaSec;
 
         previousError = error;
         lastUpdateTime += IceUtil::Time::secondsDouble(deltaSec);