diff --git a/src/main/build/debug.c b/src/main/build/debug.c index a6a83a8796..7a2e823f82 100644 --- a/src/main/build/debug.c +++ b/src/main/build/debug.c @@ -50,5 +50,6 @@ const char * const debugModeNames[DEBUG_COUNT] = { "FFT", "FFT_TIME", "FFT_FREQ", - "FRSKY_D_RX" + "FRSKY_D_RX", + "GYRO_RAW" }; diff --git a/src/main/build/debug.h b/src/main/build/debug.h index 79b1a195a4..925788aba1 100644 --- a/src/main/build/debug.h +++ b/src/main/build/debug.h @@ -69,6 +69,7 @@ typedef enum { DEBUG_FFT_TIME, DEBUG_FFT_FREQ, DEBUG_FRSKY_D_RX, + DEBUG_GYRO_RAW, DEBUG_COUNT } debugType_e; diff --git a/src/main/sensors/gyro.c b/src/main/sensors/gyro.c index 504c438d00..e1e58fee12 100644 --- a/src/main/sensors/gyro.c +++ b/src/main/sensors/gyro.c @@ -575,6 +575,7 @@ void gyroUpdateSensor(gyroSensor_t *gyroSensor) #endif for (int axis = 0; axis < XYZ_AXIS_COUNT; axis++) { + DEBUG_SET(DEBUG_GYRO_RAW, axis, gyroSensor->gyroDev.gyroADCRaw[axis]); // scale gyro output to degrees per second float gyroADCf = (float)gyroSensor->gyroDev.gyroADC[axis] * gyroSensor->gyroDev.scale; // DEBUG_GYRO_NOTCH records the unfiltered gyro output