Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-12 02:44:00 -04:00
Code Issues Packages Projects Releases Wiki Activity

HAL_SITL: make cork/push safe to call nested

Browse Source
This commit is contained in:
Andrew Tridgell 2017-04-18 09:40:27 +10:00
parent 351304ebcb
commit f257a869ac
1 changed files with 8 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_HAL_SITL/RCOutput.cpp
View File

@ -69,14 +69,18 @@ void RCOutput::read(uint16_t* period_us, uint8_t len)
void RCOutput::cork(void) void RCOutput::cork(void)
{ {
if (!_corked) {
memcpy(_pending, _sitlState->pwm_output, SITL_NUM_CHANNELS * sizeof(uint16_t)); memcpy(_pending, _sitlState->pwm_output, SITL_NUM_CHANNELS * sizeof(uint16_t));
_corked = true; _corked = true;
} }
}
void RCOutput::push(void) void RCOutput::push(void)
{ {
if (_corked) {
memcpy(_sitlState->pwm_output, _pending, SITL_NUM_CHANNELS * sizeof(uint16_t)); memcpy(_sitlState->pwm_output, _pending, SITL_NUM_CHANNELS * sizeof(uint16_t));
_corked = false; _corked = false;
} }
}
#endif #endif