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

AP_BlHeli: always report test results and report band channel once

Browse Source
This commit is contained in:
Peter Hall 2020-02-01 23:29:24 +00:00 committed by Andrew Tridgell
parent d5843ff03a
commit 2c5b0ffa29
1 changed files with 5 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_BLHeli/AP_BLHeli.cpp
View File

@ -1136,15 +1136,15 @@ bool AP_BLHeli::protocol_handler(uint8_t b, AP_HAL::UARTDriver *_uart)
*/
void AP_BLHeli::run_connection_test(uint8_t chan)
{
run_test.set_and_notify(0);
debug_uart = hal.console;
uint8_t saved_chan = blheli.chan;
if (chan >= num_motors) {
debug("bad channel %u", chan);
gcs().send_text(MAV_SEVERITY_INFO, "ESC: bad channel %u", chan);
return;
}
blheli.chan = chan;
debug("Running test on channel %u", blheli.chan);
run_test.set_and_notify(0);
gcs().send_text(MAV_SEVERITY_INFO, "ESC: Running test on channel %u", blheli.chan);
bool passed = false;
for (uint8_t tries=0; tries<5; tries++) {
EXPECT_DELAY_MS(3000);
@ -1176,7 +1176,7 @@ void AP_BLHeli::run_connection_test(uint8_t chan)
motors_disabled = false;
serial_start_ms = 0;
blheli.chan = saved_chan;
debug("Test %s", passed?"PASSED":"FAILED");
gcs().send_text(MAV_SEVERITY_INFO, "ESC: Test %s", passed?"PASSED":"FAILED");
debug_uart = nullptr;
}