Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Baro: added register checking on BMP280

Browse Source 
this follows a log which seems to show an in-flight register
corruption on a MatekF405
This commit is contained in:
Andrew Tridgell 2018-08-04 16:11:16 +10:00
parent 88df4d127e
commit 769c99d4d7
1 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
libraries/AP_Baro/AP_Baro_BMP280.cpp
View File

@ -105,10 +105,12 @@ bool AP_Baro_BMP280::_init()
mask = 0x7F;
}
_dev->write_register((BMP280_REG_CTRL_MEAS & mask), (BMP280_OVERSAMPLING_T << 5) |
(BMP280_OVERSAMPLING_P << 2) | BMP280_MODE);
_dev->setup_checked_registers(2, 20);
_dev->write_register((BMP280_REG_CONFIG & mask), BMP280_FILTER_COEFFICIENT << 2);
_dev->write_register((BMP280_REG_CTRL_MEAS & mask), (BMP280_OVERSAMPLING_T << 5) |
(BMP280_OVERSAMPLING_P << 2) | BMP280_MODE, true);
_dev->write_register((BMP280_REG_CONFIG & mask), BMP280_FILTER_COEFFICIENT << 2, true);
_instance = _frontend.register_sensor();
@ -131,6 +133,8 @@ void AP_Baro_BMP280::_timer(void)
_update_temperature((buf[3] << 12) | (buf[4] << 4) | (buf[5] >> 4));
_update_pressure((buf[0] << 12) | (buf[1] << 4) | (buf[2] >> 4));
_dev->check_next_register();
}
// transfer data to the frontend