Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_BLHeli: add battery status MSP handling 

give internal error if an unknown MSP command occurs
This commit is contained in:
Andy Piper 2023-07-02 19:08:08 +01:00 committed by Randy Mackay
parent e98cb3591b
commit 886f24764c
1 changed files with 12 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
libraries/AP_BLHeli/AP_BLHeli.cpp
View File

@ -450,6 +450,18 @@ void AP_BLHeli::msp_process_command(void)
break; break;
} }
case MSP_BATTERY_STATE: {
debug("MSP_BATTERY_STATE");
uint8_t buf[8];
buf[0] = 4; // cell count
putU16(&buf[1], 1500); // mAh
buf[3] = 16; // V
putU16(&buf[4], 1500); // mAh
putU16(&buf[6], 1); // A
msp_send_reply(msp.cmdMSP, buf, sizeof(buf));
break;
}
case MSP_MOTOR_CONFIG: { case MSP_MOTOR_CONFIG: {
debug("MSP_MOTOR_CONFIG"); debug("MSP_MOTOR_CONFIG");
uint8_t buf[10]; uint8_t buf[10];