Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_InertialSensor: Fix BMI085 accel scaling 

Original BMI088 has 24G range so it was hardcoded for *scale* within
read_fifo_accel. Added a class variable accel_range which is assigned
the correct value when the sensor type is received (16.0 or 24.0).
This commit is contained in:
Leonardo Garcia 2022-10-13 16:50:39 -07:00 committed by Andrew Tridgell
parent 41db7a1998
commit d7b3bf4675
2 changed files with 6 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_InertialSensor/AP_InertialSensor_BMI088.cpp
View File

@ -155,7 +155,7 @@ static const struct {
uint8_t value;
} accel_config[] = {
{ REGA_CONF, 0xAC },
// setup 24g range
// setup 24g range (16g for BMI085)
{ REGA_RANGE, 0x03 },
// disable low-power mode
{ REGA_PWR_CONF, 0 },
@ -207,10 +207,12 @@ bool AP_InertialSensor_BMI088::accel_init()
switch (v) {
case 0x1E:
_accel_devtype = DEVTYPE_INS_BMI088;
accel_range = 24.0;
hal.console->printf("BMI088: Found device\n");
break;
case 0x1F:
_accel_devtype = DEVTYPE_INS_BMI085;
accel_range = 16.0;
hal.console->printf("BMI085: Found device\n");
break;
default:
@ -317,8 +319,8 @@ void AP_InertialSensor_BMI088::read_fifo_accel(void)
_inc_accel_error_count(accel_instance);
return;
}
// assume configured for 24g range
const float scale = (1.0/32768.0) * GRAVITY_MSS * 24.0;
// use new accel_range depending on sensor type
const float scale = (1.0/32768.0) * GRAVITY_MSS * accel_range;
const uint8_t *p = &data[0];
while (fifo_length >= 7) {
/*

1
libraries/AP_InertialSensor/AP_InertialSensor_BMI088.h
View File

@ -82,6 +82,7 @@ private:
enum Rotation rotation;
uint8_t temperature_counter;
enum DevTypes _accel_devtype;
float accel_range;
bool done_accel_config;
uint32_t accel_config_count;