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

AP_BLHeli: keep a record of disabled motors

Browse Source
This commit is contained in:
Andy Piper 2022-04-19 18:15:20 +01:00 committed by Randy Mackay
parent 7d10192550
commit 03aeca22ec
2 changed files with 6 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/AP_BLHeli/AP_BLHeli.cpp
View File

@ -485,6 +485,7 @@ void AP_BLHeli::msp_process_command(void)
// set the output to each motor
uint8_t nmotors = msp.dataSize / 2;
debug("MSP_SET_MOTOR %u", nmotors);
motors_disabled_mask = SRV_Channels::get_disabled_channel_mask();
SRV_Channels::set_disabled_channel_mask(0xFFFF);
motors_disabled = true;
EXPECT_DELAY_MS(1000);
@ -946,7 +947,7 @@ void AP_BLHeli::blheli_process_command(void)
serial_start_ms = 0;
if (motors_disabled) {
motors_disabled = false;
SRV_Channels::set_disabled_channel_mask(0);
SRV_Channels::set_disabled_channel_mask(motors_disabled_mask);
}
if (uart_locked) {
debug("Unlocked UART");
@ -1244,7 +1245,7 @@ void AP_BLHeli::run_connection_test(uint8_t chan)
}
}
hal.rcout->serial_end();
SRV_Channels::set_disabled_channel_mask(0);
SRV_Channels::set_disabled_channel_mask(motors_disabled_mask);
motors_disabled = false;
serial_start_ms = 0;
blheli.chan = saved_chan;
@ -1277,7 +1278,7 @@ void AP_BLHeli::update(void)
}
if (motors_disabled) {
motors_disabled = false;
SRV_Channels::set_disabled_channel_mask(0);
SRV_Channels::set_disabled_channel_mask(motors_disabled_mask);
}
if (uart != nullptr) {
debug("Unlocked UART");

2
libraries/AP_BLHeli/AP_BLHeli.h
View File

@ -231,6 +231,8 @@ private:
// have we disabled motor outputs?
bool motors_disabled;
// mask of channels that should normally be disabled
uint16_t motors_disabled_mask;
// have we locked the UART?
bool uart_locked;