Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-24 16:55:36 +03:00
Code Issues Wiki Activity

Revised LPF1+LPF2 filter cutoff bandwidths from STMicro (#13239)

Browse source 
Revised LPF1+LPF2 filter cutoff bandwidths from STmicro
This commit is contained in:
Steve Evans 2023-12-23 12:01:50 +00:00 • committed by GitHub
parent fc7afed28d
commit a39ae3c89c
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
1 changed files with 9 additions and 8 deletions
Download patch file Download diff file Expand all files Collapse all files

17
src/main/drivers/accgyro/accgyro_spi_lsm6dsv16x.c
View file

@ -321,10 +321,11 @@
#define LSM6DSV_CTRL6_LPF1_G_BW_SHIFT 4
// Gyro LPF1 + LPF2 bandwidth selection when ODR=7.68kHz
#define LSM6DSV_CTRL6_FS_G_BW_281HZ 0
#define LSM6DSV_CTRL6_FS_G_BW_213HZ 1
#define LSM6DSV_CTRL6_FS_G_BW_156HZ 2
#define LSM6DSV_CTRL6_FS_G_BW_407HZ 3
// Note that these figures were advised by STmicro tech support and differ from the datasheet
#define LSM6DSV_CTRL6_FS_G_BW_288HZ 0
#define LSM6DSV_CTRL6_FS_G_BW_215HZ 1
#define LSM6DSV_CTRL6_FS_G_BW_157HZ 2
#define LSM6DSV_CTRL6_FS_G_BW_455HZ 3
#define LSM6DSV_CTRL6_FS_G_BW_102HZ 4
#define LSM6DSV_CTRL6_FS_G_BW_58HZ 5
#define LSM6DSV_CTRL6_FS_G_BW_28_8HZ 6
@ -947,11 +948,11 @@ void lsm6dsv16xGyroInit(gyroDev_t *gyro)
const extDevice_t *dev = &gyro->dev;
// Set default LPF1 filter bandwidth to be as close as possible to MPU6000's 250Hz cutoff
uint8_t lsm6dsv16xLPF1BandwidthOptions[GYRO_HARDWARE_LPF_COUNT] = {
[GYRO_HARDWARE_LPF_NORMAL] = LSM6DSV_CTRL6_FS_G_BW_281HZ,
[GYRO_HARDWARE_LPF_OPTION_1] = LSM6DSV_CTRL6_FS_G_BW_156HZ,
[GYRO_HARDWARE_LPF_OPTION_2] = LSM6DSV_CTRL6_FS_G_BW_213HZ,
[GYRO_HARDWARE_LPF_NORMAL] = LSM6DSV_CTRL6_FS_G_BW_288HZ,
[GYRO_HARDWARE_LPF_OPTION_1] = LSM6DSV_CTRL6_FS_G_BW_157HZ,
[GYRO_HARDWARE_LPF_OPTION_2] = LSM6DSV_CTRL6_FS_G_BW_215HZ,
#ifdef USE_GYRO_DLPF_EXPERIMENTAL
[GYRO_HARDWARE_LPF_EXPERIMENTAL] = LSM6DSV_CTRL6_FS_G_BW_407HZ
[GYRO_HARDWARE_LPF_EXPERIMENTAL] = LSM6DSV_CTRL6_FS_G_BW_455HZ
#endif
};