diff --git a/src/main/sensors/gyroanalyse.c b/src/main/sensors/gyroanalyse.c index bfc05c96d0..88007bbe5b 100644 --- a/src/main/sensors/gyroanalyse.c +++ b/src/main/sensors/gyroanalyse.c @@ -276,14 +276,6 @@ void gyroDataAnalyseUpdate(biquadFilter_t *notchFilterDyn) { } } - // copy data for display in OSD - const float scaleFactor = 255.0 / MIN(1, fftResult[axis].maxVal); - const int count = MIN(GYRO_FFT_BIN_COUNT, fftBinCount); - for (int ii = 0; ii < count; ++ii) { - fftResult[axis].bins[ii] = fftData[ii] * scaleFactor; - } - - DEBUG_SET(DEBUG_FFT_FREQ, axis, fftResult[axis].centerFreq); DEBUG_SET(DEBUG_FFT_TIME, 1, micros() - startTime); break; diff --git a/src/main/sensors/gyroanalyse.h b/src/main/sensors/gyroanalyse.h index 08ba8817bb..ac4290738a 100644 --- a/src/main/sensors/gyroanalyse.h +++ b/src/main/sensors/gyroanalyse.h @@ -22,7 +22,6 @@ #define GYRO_FFT_BIN_COUNT 16 // FFT_WINDOW_SIZE / 2 typedef struct gyroFftData_s { - uint8_t bins[GYRO_FFT_BIN_COUNT]; float maxVal; uint16_t centerFreq; } gyroFftData_t; diff --git a/src/main/target/COLIBRI_RACE/i2c_bst.c b/src/main/target/COLIBRI_RACE/i2c_bst.c index 7993300bcc..467fc83469 100644 --- a/src/main/target/COLIBRI_RACE/i2c_bst.c +++ b/src/main/target/COLIBRI_RACE/i2c_bst.c @@ -151,34 +151,38 @@ typedef struct box_e { // FIXME remove ;'s static const box_t boxes[CHECKBOX_ITEM_COUNT + 1] = { - { BOXARM, "ARM;", 0 }, - { BOXANGLE, "ANGLE;", 1 }, - { BOXHORIZON, "HORIZON;", 2 }, - { BOXBARO, "BARO;", 3 }, - //{ BOXVARIO, "VARIO;", 4 }, - { BOXMAG, "MAG;", 5 }, - { BOXHEADFREE, "HEADFREE;", 6 }, - { BOXHEADADJ, "HEADADJ;", 7 }, - { BOXCAMSTAB, "CAMSTAB;", 8 }, - { BOXCAMTRIG, "CAMTRIG;", 9 }, - { BOXGPSHOME, "GPS HOME;", 10 }, - { BOXGPSHOLD, "GPS HOLD;", 11 }, - { BOXPASSTHRU, "PASSTHRU;", 12 }, - { BOXBEEPERON, "BEEPER;", 13 }, - { BOXLEDMAX, "LEDMAX;", 14 }, - { BOXLEDLOW, "LEDLOW;", 15 }, - { BOXLLIGHTS, "LLIGHTS;", 16 }, - { BOXCALIB, "CALIB;", 17 }, - { BOXGOV, "GOVERNOR;", 18 }, - { BOXOSD, "OSD SW;", 19 }, - { BOXTELEMETRY, "TELEMETRY;", 20 }, - { BOXGTUNE, "GTUNE;", 21 }, - { BOXSONAR, "SONAR;", 22 }, - { BOXSERVO1, "SERVO1;", 23 }, - { BOXSERVO2, "SERVO2;", 24 }, - { BOXSERVO3, "SERVO3;", 25 }, - { BOXBLACKBOX, "BLACKBOX;", 26 }, - { BOXFAILSAFE, "FAILSAFE;", 27 }, + { BOXARM, "ARM", 0 }, + { BOXANGLE, "ANGLE", 1 }, + { BOXHORIZON, "HORIZON", 2 }, + { BOXBARO, "BARO", 3 }, + { BOXANTIGRAVITY, "ANTI GRAVITY", 4 }, + { BOXMAG, "MAG", 5 }, + { BOXHEADFREE, "HEADFREE", 6 }, + { BOXHEADADJ, "HEADADJ", 7 }, + { BOXCAMSTAB, "CAMSTAB", 8 }, + { BOXCAMTRIG, "CAMTRIG", 9 }, + { BOXGPSHOME, "GPS HOME", 10 }, + { BOXGPSHOLD, "GPS HOLD", 11 }, + { BOXPASSTHRU, "PASSTHRU", 12 }, + { BOXBEEPERON, "BEEPER", 13 }, + { BOXLEDMAX, "LEDMAX", 14 }, + { BOXLEDLOW, "LEDLOW", 15 }, + { BOXLLIGHTS, "LLIGHTS", 16 }, + { BOXCALIB, "CALIB", 17 }, + { BOXGOV, "GOVERNOR", 18 }, + { BOXOSD, "OSD SW", 19 }, + { BOXTELEMETRY, "TELEMETRY", 20 }, + { BOXDYNAMICFILTER, "DYNAMIC FILTER", 21 }, + { BOXSONAR, "SONAR", 22 }, + { BOXSERVO1, "SERVO1", 23 }, + { BOXSERVO2, "SERVO2", 24 }, + { BOXSERVO3, "SERVO3", 25 }, + { BOXBLACKBOX, "BLACKBOX", 26 }, + { BOXFAILSAFE, "FAILSAFE", 27 }, + { BOXAIRMODE, "AIR MODE", 28 }, + { BOX3DDISABLESWITCH, "DISABLE 3D SWITCH", 29}, + { BOXFPVANGLEMIX, "FPV ANGLE MIX", 30}, + { BOXBLACKBOXERASE, "BLACKBOX ERASE (>30s)", 31 }, { CHECKBOX_ITEM_COUNT, NULL, 0xFF } }; @@ -318,7 +322,7 @@ static bool bstSlaveProcessFeedbackCommand(uint8_t bstRequest) IS_ENABLED(IS_RC_MODE_ACTIVE(BOXGOV)) << BOXGOV | IS_ENABLED(IS_RC_MODE_ACTIVE(BOXOSD)) << BOXOSD | IS_ENABLED(IS_RC_MODE_ACTIVE(BOXTELEMETRY)) << BOXTELEMETRY | - IS_ENABLED(IS_RC_MODE_ACTIVE(BOXGTUNE)) << BOXGTUNE | + IS_ENABLED(IS_RC_MODE_ACTIVE(BOXDYNAMICFILTER)) << BOXDYNAMICFILTER | IS_ENABLED(FLIGHT_MODE(SONAR_MODE)) << BOXSONAR | IS_ENABLED(ARMING_FLAG(ARMED)) << BOXARM | IS_ENABLED(IS_RC_MODE_ACTIVE(BOXBLACKBOX)) << BOXBLACKBOX | diff --git a/src/main/target/OMNIBUS/target.h b/src/main/target/OMNIBUS/target.h index 5df35d1866..6b2c62d551 100644 --- a/src/main/target/OMNIBUS/target.h +++ b/src/main/target/OMNIBUS/target.h @@ -20,6 +20,7 @@ #undef TELEMETRY_IBUS //no space left #undef TELEMETRY_HOTT //no space left #undef TELEMETRY_JETIEXBUS +#undef USE_GYRO_DATA_ANALYSE #define TARGET_BOARD_IDENTIFIER "OMNI" // https://en.wikipedia.org/wiki/Omnibus diff --git a/src/main/target/common_fc_pre.h b/src/main/target/common_fc_pre.h index 16a24e8986..2a31aef325 100644 --- a/src/main/target/common_fc_pre.h +++ b/src/main/target/common_fc_pre.h @@ -49,6 +49,7 @@ #define USE_ESC_SENSOR #define I2C3_OVERCLOCK true #define TELEMETRY_IBUS +#define USE_GYRO_DATA_ANALYSE #endif #ifdef STM32F7 @@ -57,6 +58,7 @@ #define I2C3_OVERCLOCK true #define I2C4_OVERCLOCK true #define TELEMETRY_IBUS +#define USE_GYRO_DATA_ANALYSE #endif #if defined(STM32F4) || defined(STM32F7)