diff --git a/src/main/drivers/gyro_sync.c b/src/main/drivers/gyro_sync.c index 7d88739973..1047442c0b 100644 --- a/src/main/drivers/gyro_sync.c +++ b/src/main/drivers/gyro_sync.c @@ -44,7 +44,7 @@ bool gyroSyncCheckUpdate(void) { void gyroUpdateSampleRate(uint8_t lpf, uint8_t gyroSyncDenominator) { int gyroSamplePeriod; - if (!lpf) { + if (!lpf || lpf == 7) { gyroSamplePeriod = 125; } else { gyroSamplePeriod = 1000; diff --git a/src/main/io/serial_cli.c b/src/main/io/serial_cli.c index 51ec55847b..2fe88dbb5b 100644 --- a/src/main/io/serial_cli.c +++ b/src/main/io/serial_cli.c @@ -380,7 +380,11 @@ static const char * const lookupTableGyroLpf[] = { "OFF", "188HZ", "98HZ", - "42HZ" + "42HZ", + "20HZ", + "10HZ", + "5HZ", + "EXPERIMENTAL" }; static const char * const lookupTableAccHardware[] = { diff --git a/src/main/main.c b/src/main/main.c index 78285346ca..4740019ccc 100644 --- a/src/main/main.c +++ b/src/main/main.c @@ -582,7 +582,7 @@ void init(void) afatfs_init(); #endif - if (masterConfig.gyro_lpf) { + if (masterConfig.gyro_lpf > 0 && masterConfig.gyro_lpf < 7) { masterConfig.pid_process_denom = 1; // When gyro set to 1khz always set pid speed 1:1 to sampling speed masterConfig.gyro_sync_denom = 1; }