Browse Source

AP_Compass: restore low speed change on register read failure

master
Andrew Tridgell 12 years ago
parent
commit
b70f7f57ba
  1. 3
      libraries/AP_Compass/AP_Compass_HMC5843.cpp

3
libraries/AP_Compass/AP_Compass_HMC5843.cpp

@ -73,6 +73,9 @@ bool AP_Compass_HMC5843::read_raw()
uint8_t buff[6]; uint8_t buff[6];
if (hal.i2c->readRegisters(COMPASS_ADDRESS, 0x03, 6, buff) != 0) { if (hal.i2c->readRegisters(COMPASS_ADDRESS, 0x03, 6, buff) != 0) {
if (healthy) {
hal.i2c->setHighSpeed(false);
}
healthy = false; healthy = false;
return false; return false;
} }

Loading…
Cancel
Save