From 7d2cce7c9f926dabe8beb6fe86ddad803ac666f5 Mon Sep 17 00:00:00 2001 From: Kevin Plaizier <46289813+Quick-Flash@users.noreply.github.com> Date: Mon, 28 Feb 2022 16:17:05 -0700 Subject: [PATCH] Update gyro.c --- src/main/sensors/gyro.c | 3 +-- 1 file changed, 1 insertion(+), 2 deletions(-) diff --git a/src/main/sensors/gyro.c b/src/main/sensors/gyro.c index 9721cdb162..ccb4ce7cb3 100644 --- a/src/main/sensors/gyro.c +++ b/src/main/sensors/gyro.c @@ -476,8 +476,7 @@ FAST_CODE void gyroUpdate(void) gyro.gyroADC[X] = ((gyroScaled1 * varianceGyro2) + (gyroScaled2 * varianceGyro1)) / (varianceGyro1 + varianceGyro2); DEBUG_SET(DEBUG_FUSION, 0, lrintf(gyroScaled1)); DEBUG_SET(DEBUG_FUSION, 1, lrintf(gyroScaled2)); - DEBUG_SET(DEBUG_FUSION, 2, lrintf(varianceGyro1)); - DEBUG_SET(DEBUG_FUSION, 3, lrintf(varianceGyro2)); + DEBUG_SET(DEBUG_FUSION, 2, lrintf(gyro.gyroADC[X])); gyroScaled1 = gyro.gyroSensor1.gyroDev.gyroADC[Y] * gyro.gyroSensor1.gyroDev.scale; gyroScaled2 = gyro.gyroSensor2.gyroDev.gyroADC[Y] * gyro.gyroSensor2.gyroDev.scale;