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

SITL: ignore failure to pop servo sample from buffer

Browse Source
This commit is contained in:
Peter Barker 2020-06-03 15:29:17 +10:00 committed by Randy Mackay
parent 85b1264ff4
commit 4e3c23c969
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/SITL/SIM_Helicopter.cpp
View File

@ -326,7 +326,10 @@ void Helicopter::push_to_buffer(const uint16_t servos_input[16])
void Helicopter::pull_from_buffer(uint16_t servos_delayed[6])
{
servos_stored sample;
servos_stored_buffer->pop(sample);
if (!servos_stored_buffer->pop(sample)) {
// no sample
return;
}
servos_delayed[0] = sample.servo1;
servos_delayed[1] = sample.servo2;
servos_delayed[2] = sample.servo3;