aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Sub: use ahrs set-alt-measurement-noise instead of direct calls to EKF

Browse Source
This commit is contained in:
Randy Mackay 2020-04-22 08:58:10 +09:00
parent 8caf7d5811
commit 36b551b75b
1 changed files with 2 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
ArduSub/system.cpp
View File

@ -132,19 +132,9 @@ void Sub::init_ardupilot()
// We only have onboard baro // We only have onboard baro
// No external underwater depth sensor detected // No external underwater depth sensor detected
barometer.set_primary_baro(0); barometer.set_primary_baro(0);
#if HAL_NAVEKF2_AVAILABLE ahrs.set_alt_measurement_noise(10.0f); // Readings won't correspond with rest of INS
ahrs.EKF2.set_baro_alt_noise(10.0f); // Readings won't correspond with rest of INS
#endif
#if HAL_NAVEKF3_AVAILABLE
ahrs.EKF3.set_baro_alt_noise(10.0f);
#endif
} else { } else {
#if HAL_NAVEKF2_AVAILABLE ahrs.set_alt_measurement_noise(0.1f);
ahrs.EKF2.set_baro_alt_noise(0.1f);
#endif
#if HAL_NAVEKF3_AVAILABLE
ahrs.EKF3.set_baro_alt_noise(0.1f);
#endif
} }
leak_detector.init(); leak_detector.init();