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

HAL_ChibiOS: use blocking semaphore for new_input()

Browse Source 
this prevents a race where we continually fail to get new input
This commit is contained in:
Andrew Tridgell 2020-01-30 08:25:24 +11:00
parent 05f095f338
commit c8395bb2c1
1 changed files with 6 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
libraries/AP_HAL_ChibiOS/RCInput.cpp
View File

@ -73,13 +73,12 @@ bool RCInput::new_input()
if (!_init) {
return false;
}
if (!rcin_mutex.take_nonblocking()) {
return false;
bool valid;
{
WITH_SEMAPHORE(rcin_mutex);
valid = _rcin_timestamp_last_signal != _last_read;
_last_read = _rcin_timestamp_last_signal;
}
bool valid = _rcin_timestamp_last_signal != _last_read;
_last_read = _rcin_timestamp_last_signal;
rcin_mutex.give();
#if HAL_RCINPUT_WITH_AP_RADIO
if (!_radio_init) {
@ -134,7 +133,7 @@ uint8_t RCInput::read(uint16_t* periods, uint8_t len)
memcpy(periods, _rc_values, len*sizeof(periods[0]));
}
#if HAL_RCINPUT_WITH_AP_RADIO
if (radio && channel == 0) {
if (radio) {
// hook to allow for update of radio on main thread, for mavlink sends
radio->update();
}