aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Rover: send both SYS_STATUS or POWER_STATUS or neither

Browse Source
This commit is contained in:
Peter Barker 2018-12-04 16:08:03 +11:00 committed by Randy Mackay
parent 0bdeccb568
commit a5b5688960
1 changed files with 4 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
APMrover2/GCS_Mavlink.cpp
View File

@ -319,9 +319,11 @@ bool GCS_MAVLINK_Rover::try_send_message(enum ap_message id)
// send extended status only once vehicle has been initialised // send extended status only once vehicle has been initialised
// to avoid unnecessary errors being reported to user // to avoid unnecessary errors being reported to user
if (initialised) { if (initialised) {
CHECK_PAYLOAD_SIZE(SYS_STATUS); if (PAYLOAD_SIZE(chan, SYS_STATUS) +
PAYLOAD_SIZE(chan, POWER_STATUS) > comm_get_txspace(chan)) {
return false;
}
rover.send_sys_status(chan); rover.send_sys_status(chan);
CHECK_PAYLOAD_SIZE(POWER_STATUS);
send_power_status(); send_power_status();
} }
break; break;