commander: consider COM_MOT_TEST_EN for COMMAND_ACTUATOR_TEST as well

This commit is contained in:
Beat Küng
2021-12-15 09:11:42 +01:00
committed by Daniel Agar
parent 39d441317a
commit 8e04934eab
+4
View File
@@ -1508,6 +1508,10 @@ Commander::handle_command_actuator_test(const vehicle_command_s &cmd)
return vehicle_command_s::VEHICLE_CMD_RESULT_DENIED;
}
if (_param_com_mot_test_en.get() != 1) {
return vehicle_command_s::VEHICLE_CMD_RESULT_DENIED;
}
actuator_test_s actuator_test{};
actuator_test.timestamp = hrt_absolute_time();
actuator_test.function = (int)(cmd.param5 + 0.5);