Browse Source

AP_Baro: fixed baro scaling for LPS2XH

mission-4.1.18
Andrew Tridgell 7 years ago
parent
commit
f85c82ee5d
  1. 2
      libraries/AP_Baro/AP_Baro_LPS2XH.cpp

2
libraries/AP_Baro/AP_Baro_LPS2XH.cpp

@ -177,7 +177,7 @@ void AP_Baro_LPS2XH::_update_pressure(void) @@ -177,7 +177,7 @@ void AP_Baro_LPS2XH::_update_pressure(void)
uint8_t pressure[3];
_dev->read_registers(PRESS_OUT_XL_ADDR, pressure, 3);
int32_t Pressure_Reg_s32 = ((uint32_t)pressure[2]<<16)|((uint32_t)pressure[1]<<8)|(uint32_t)pressure[0];
int32_t Pressure_mb = Pressure_Reg_s32 / 4096 *100; // scale for pa
int32_t Pressure_mb = Pressure_Reg_s32 * (100.0 / 4096); // scale for pa
if (_sem->take_nonblocking()) {
_pressure=Pressure_mb;
_sem->give();

Loading…
Cancel
Save