yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 09:28:58 +00:00
Code Issues Packages Projects Releases Wiki Activity

mavsdk_tests: check for stuck baro

Browse Source
This commit is contained in:
Julian Oes
2020-06-26 14:48:53 +02:00
committed by Daniel Agar
parent a05ad9c64c
commit afcfa2fbe0
5 changed files with 57 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
src/modules/simulator/simulator_mavlink.cpp
View File

@@ -253,8 +253,14 @@ void Simulator::update_sensors(const hrt_abstime &time, const mavlink_hil_sensor
// baro
if ((sensors.fields_updated & SensorSource::BARO) == SensorSource::BARO && !_baro_blocked) {
_px4_baro_0.update(time, sensors.abs_pressure);
_px4_baro_1.update(time, sensors.abs_pressure);
if (_baro_stuck) {
_px4_baro_0.update(time, _px4_baro_0.get().pressure);
_px4_baro_1.update(time, _px4_baro_1.get().pressure);
} else {
_px4_baro_0.update(time, sensors.abs_pressure);
_px4_baro_1.update(time, sensors.abs_pressure);
}
}
// differential pressure
@@ -995,6 +1001,11 @@ void Simulator::check_failure_injections()
supported = true;
_baro_blocked = true;
} else if (failure_type == vehicle_command_s::FAILURE_TYPE_STUCK) {
supported = true;
_baro_stuck = true;
_baro_blocked = false;
} else if (failure_type == vehicle_command_s::FAILURE_TYPE_OK) {
supported = true;
_baro_blocked = false;