Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 06:28:27 -04:00
Code Issues Packages Projects Releases Wiki Activity

Sub: rate-limit init_motor_test() calls

Browse Source
This commit is contained in:
Willian Galvani 2019-09-16 21:54:38 -03:00 committed by Jacob Walser
parent 47f9defe3f
commit 2e9bd43c49
1 changed files with 12 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
ArduSub/motors.cpp
View File

@ -82,10 +82,19 @@ bool Sub::handle_do_motor_test(mavlink_command_long_t command) {
last_do_motor_test_ms = AP_HAL::millis(); last_do_motor_test_ms = AP_HAL::millis();
// If we are not already testing motors, initialize test // If we are not already testing motors, initialize test
static uint32_t tLastInitializationFailed = 0;
if(!ap.motor_test) { if(!ap.motor_test) {
if (!init_motor_test()) { // Do not allow initializations attempt under 2 seconds
gcs().send_text(MAV_SEVERITY_WARNING, "motor test initialization failed!"); // If one fails, we need to give the user time to fix the issue
return false; // init fail // instead of spamming error messages
if (AP_HAL::millis() > (tLastInitializationFailed + 2000)) {
if (!init_motor_test()) {
gcs().send_text(MAV_SEVERITY_WARNING, "motor test initialization failed!");
tLastInitializationFailed = AP_HAL::millis();
return false; // init fail
}
} else {
return false;
} }
} }