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

AP_RangeFinder: fix Lua timeout

This commit is contained in:
Clyde McQueen 2024-04-16 14:49:32 -07:00 committed by Andrew Tridgell
parent 5651585694
commit 8a0c1d3ba1
1 changed files with 11 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
libraries/AP_RangeFinder/AP_RangeFinder_Lua.cpp
View File

@ -48,16 +48,11 @@ bool AP_RangeFinder_Lua::handle_script_msg(float dist_m) {
WITH_SEMAPHORE(_sem); WITH_SEMAPHORE(_sem);
// Time out on incoming data; if we don't get new data in 500ms, dump it _state_pending.last_reading_ms = now;
if (now - _state_pending.last_reading_ms > AP_RANGEFINDER_LUA_TIMEOUT_MS) { _state_pending.distance_m = dist_m;
set_status(_state_pending, RangeFinder::Status::NoData); _state_pending.signal_quality_pct = RangeFinder::SIGNAL_QUALITY_UNKNOWN;
} else { _state_pending.voltage_mv = 0;
_state_pending.last_reading_ms = now; update_status(_state_pending);
_state_pending.distance_m = dist_m;
_state_pending.signal_quality_pct = RangeFinder::SIGNAL_QUALITY_UNKNOWN;
_state_pending.voltage_mv = 0;
update_status(_state_pending);
}
return true; return true;
} }
@ -66,6 +61,12 @@ bool AP_RangeFinder_Lua::handle_script_msg(float dist_m) {
void AP_RangeFinder_Lua::update(void) void AP_RangeFinder_Lua::update(void)
{ {
WITH_SEMAPHORE(_sem); WITH_SEMAPHORE(_sem);
// Time out on incoming data
if (_state_pending.status != RangeFinder::Status::NotConnected &&
AP_HAL::millis() - _state_pending.last_reading_ms > AP_RANGEFINDER_LUA_TIMEOUT_MS) {
set_status(_state_pending, RangeFinder::Status::NoData);
}
state = _state_pending; state = _state_pending;
} }