diff --git a/source/RobotAPI/libraries/core/PIDController.cpp b/source/RobotAPI/libraries/core/PIDController.cpp index 1356141172d4a06cceeeee6c29cb0cd31ef54e85..1cf92b73cdc617a775d53bb2bdbcf4e6675281b8 100644 --- a/source/RobotAPI/libraries/core/PIDController.cpp +++ b/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);