diff --git a/src/main/build/debug.c b/src/main/build/debug.c index 9ad6d60404..90fddec09b 100644 --- a/src/main/build/debug.c +++ b/src/main/build/debug.c @@ -69,4 +69,5 @@ const char * const debugModeNames[DEBUG_COUNT] = { "USB", "SMARTAUDIO", "RTH", + "ITERM_RELAX" }; diff --git a/src/main/build/debug.h b/src/main/build/debug.h index 9432e75e48..82134d3ef4 100644 --- a/src/main/build/debug.h +++ b/src/main/build/debug.h @@ -87,6 +87,7 @@ typedef enum { DEBUG_USB, DEBUG_SMARTAUDIO, DEBUG_RTH, + DEBUG_ITERM_RELAX, DEBUG_COUNT } debugType_e; diff --git a/src/main/flight/pid.c b/src/main/flight/pid.c index 91950f1e0b..e87268a1ed 100644 --- a/src/main/flight/pid.c +++ b/src/main/flight/pid.c @@ -631,6 +631,8 @@ void FAST_CODE pidController(const pidProfile_t *pidProfile, const rollAndPitchT if (itermRelax) { const float gyroTargetHigh = pt1FilterApply(&windupLpf[axis][0], currentPidSetpoint); const float gyroTargetLow = pt1FilterApply(&windupLpf[axis][1], currentPidSetpoint); + DEBUG_SET(DEBUG_ITERM_RELAX, 0, gyroTargetHigh); + DEBUG_SET(DEBUG_ITERM_RELAX, 1, gyroTargetLow); const float gmax = MAX(gyroTargetHigh, gyroTargetLow); const float gmin = MIN(gyroTargetHigh, gyroTargetLow); if (gyroRate >= gmin && gyroRate <= gmax)