rusefi
/
bldc
mirror of https://github.com/rusefi/bldc.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

imu: Fix lsm6ds3 applying filters 

The i2c_bb_tx_rx() function was transmitting only the register address,
not the value to set, resulting in only reading the value.

Also adds a missing return value check for one of the calls.
This commit is contained in:
Lukáš Hrázký 2023-07-30 11:19:59 +02:00
parent fd80107522
commit cdaf477fee
1 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
imu/lsm6ds3.c
View File

@ -183,7 +183,7 @@ void lsm6ds3_init(stm32_gpio_t *sda_gpio, int sda_pin,
// Standard LSM6DS3 only: Set XL anti-aliasing filter to be manually configured // Standard LSM6DS3 only: Set XL anti-aliasing filter to be manually configured
txb[1] = LSM6DS3_ACC_GYRO_BW_SCAL_ODR_ENABLED; txb[1] = LSM6DS3_ACC_GYRO_BW_SCAL_ODR_ENABLED;
} }
res = i2c_bb_tx_rx(&m_i2c_bb, lsm6ds3_addr, txb, 1, rxb, 1); res = i2c_bb_tx_rx(&m_i2c_bb, lsm6ds3_addr, txb, 2, rxb, 1);
if (!res){ if (!res){
commands_printf("LSM6DS3 ODR Config FAILED"); commands_printf("LSM6DS3 ODR Config FAILED");
return; return;
@ -195,7 +195,11 @@ void lsm6ds3_init(stm32_gpio_t *sda_gpio, int sda_pin,
#define LSM6DS3TRC_HPCF_XL_ODR9 (0x2 << 4); #define LSM6DS3TRC_HPCF_XL_ODR9 (0x2 << 4);
txb[0] = LSM6DS3_ACC_GYRO_CTRL8_XL; txb[0] = LSM6DS3_ACC_GYRO_CTRL8_XL;
txb[1] = LSM6DS3TRC_LPF2_XL_EN | LSM6DS3TRC_HPCF_XL_ODR9; txb[1] = LSM6DS3TRC_LPF2_XL_EN | LSM6DS3TRC_HPCF_XL_ODR9;
i2c_bb_tx_rx(&m_i2c_bb, lsm6ds3_addr, txb, 1, rxb, 1); res = i2c_bb_tx_rx(&m_i2c_bb, lsm6ds3_addr, txb, 2, rxb, 1);
if (!res) {
commands_printf("LSM6DS3 Accel Low Pass Config FAILED");
return;
}
} }
terminal_register_command_callback( terminal_register_command_callback(