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

AP_Compass: Retry reading MMC5983 ID up to 10 times

Browse Source
This commit is contained in:
Willian Galvani 2022-01-05 15:56:33 -03:00 committed by Jacob Walser
parent 62285d51a8
commit c285f4c748
1 changed files with 11 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
libraries/AP_Compass/AP_Compass_MMC5xx3.cpp
View File

@ -78,9 +78,17 @@ bool AP_Compass_MMC5XX3::init()
dev->set_read_flag(0x80);
}
uint8_t whoami;
if (!dev->read_registers(REG_PRODUCT_ID, &whoami, 1) ||
whoami != MMC5983_ID) {
// Reading REG_PRODUCT_ID fails sometimes on SPI, so we retry up to 10 times
uint8_t whoami = 0;
uint8_t tries = 10;
while (whoami == 0 && tries > 0) {
tries--;
dev->read_registers(REG_PRODUCT_ID, &whoami, 1);
hal.scheduler->delay(5);
}
if (whoami != MMC5983_ID) {
printf("MMC5983 got unexpected product id: %d, expected: %d\n", whoami, MMC5983_ID);
// not a MMC5983
return false;
}