zrzk
/
zr-v4
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

AP_Compass: Add HMC5843 and second AK8963 autodetection to BBBmini

master
mirkix 9 years ago committed by Lucas De Marchi
parent
2aba5a4643
commit
3df5a02448
1 changed files with 24 additions and 0 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 24
      libraries/AP_Compass/AP_Compass.cpp

24
libraries/AP_Compass/AP_Compass.cpp
Unescape View File

@ -453,6 +453,30 @@ void Compass::_detect_backends(void) @@ -453,6 +453,30 @@ void Compass::_detect_backends(void)
}
#elif HAL_COMPASS_DEFAULT == HAL_COMPASS_QFLIGHT
_add_backend(AP_Compass_QFLIGHT::detect(*this));
#elif HAL_COMPASS_DEFAULT == HAL_COMPASS_BBBMINI
AP_Compass_Backend *backend = AP_Compass_HMC5843::probe(*this, hal.i2c_mgr->get_device(HAL_COMPASS_HMC5843_I2C_BUS, HAL_COMPASS_HMC5843_I2C_ADDR));
if (backend) {
_add_backend(backend);
hal.console->printf("HMC5843: External compass detected\n");
} else {
hal.console->printf("HMC5843: External compass not detected\n");
}
backend = AP_Compass_AK8963::probe_mpu9250(*this, 0);
if (backend) {
_add_backend(backend);
hal.console->printf("AK8953: Onboard compass detected\n");
} else {
hal.console->printf("AK8953: Onboard compass not detected\n");
}
backend = AP_Compass_AK8963::probe_mpu9250(*this, 1);
if (backend) {
_add_backend(backend);
hal.console->printf("AK8953: External compass detected\n");
} else {
hal.console->printf("AK8953: External compass not detected\n");
}
#elif HAL_COMPASS_DEFAULT == HAL_COMPASS_AK8963_MPU9250
_add_backend(AP_Compass_AK8963::probe_mpu9250(*this, 0));
#elif HAL_COMPASS_DEFAULT == HAL_COMPASS_HMC5843

Write Preview
Loading…
Cancel
Save