From 724c1aa65fec0b341bb87b6437ca202dbd43a2e4 Mon Sep 17 00:00:00 2001 From: "Pawel Spychalski (DzikuVx)" Date: Sun, 20 Jun 2021 12:04:59 +0200 Subject: [PATCH] Log Dterm boost factor --- src/main/flight/pid.c | 9 ++++----- 1 file changed, 4 insertions(+), 5 deletions(-) diff --git a/src/main/flight/pid.c b/src/main/flight/pid.c index 5dbf6f399e..70b2c14bf2 100644 --- a/src/main/flight/pid.c +++ b/src/main/flight/pid.c @@ -68,6 +68,7 @@ FILE_COMPILE_FOR_SPEED #include "programming/logic_condition.h" typedef struct { + uint8_t axis; float kP; // Proportional gain float kI; // Integral gain float kD; // Derivative gain @@ -78,11 +79,6 @@ typedef struct { float gyroRate; float rateTarget; - // Buffer for derivative calculation -#define PID_GYRO_RATE_BUF_LENGTH 5 - float gyroRateBuf[PID_GYRO_RATE_BUF_LENGTH]; - firFilter_t gyroRateFilter; - // Rate integrator float errorGyroIf; float errorGyroIfLimit; @@ -714,6 +710,8 @@ static float FAST_CODE applyDBoost(pidState_t *pidState, float dT) { dBoost = pt1FilterApply4(&pidState->dBoostLpf, dBoost, D_BOOST_LPF_HZ, dT); dBoost = constrainf(dBoost, 0.0f, dBoostFactor); + DEBUG_SET(DEBUG_ALWAYS, pidState->axis, dBoost * 100); + return dBoost; } #else @@ -1199,6 +1197,7 @@ void pidInit(void) #endif for (uint8_t axis = FD_ROLL; axis <= FD_YAW; axis++) { + pidState[axis].axis = axis; if (axis == FD_YAW) { pidState[axis].pidSumLimit = pidProfile()->pidSumLimitYaw; if (yawLpfHz) {