fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-20 04:03:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

mavsdk_tests: ensure motor is stopped for motor failure test

Browse Source
This commit is contained in:
Beat Küng
2022-05-12 07:58:56 +02:00
parent b5a3c58a95
commit 0a9378e0f6
3 changed files with 27 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/mavsdk_tests/autopilot_tester_failure.cpp
+20
View File
@@ -78,3 +78,23 @@ void AutopilotTesterFailure::inject_failure(mavsdk::Failure::FailureUnit failure
{
CHECK(_failure->inject(failure_unit, failure_type, instance) == expected_result);
}
void AutopilotTesterFailure::enable_actuator_output_status()
{
CHECK(getTelemetry()->set_rate_actuator_output_status(20.f) == Telemetry::Result::Success);
}
void AutopilotTesterFailure::ensure_motor_stopped(unsigned index, unsigned num_motors)
{
const Telemetry::ActuatorOutputStatus &status = getTelemetry()->actuator_output_status();
CHECK(status.active >= num_motors);
for (unsigned i = 0; i < num_motors; ++i) {
if (i == index) {
CHECK(status.actuator[i] <= 901.f);
} else { // ensure all others are still running
CHECK(status.actuator[i] >= 999.f);
}
}
}