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

AP_RangeFinder: TeraRangerI2C added case of out of range measurement

Browse Source
This commit is contained in:
PYBrulin 2021-03-31 10:56:20 +02:00 committed by Andrew Tridgell
parent afe9573900
commit 240bfeb6bd
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_RangeFinder/AP_RangeFinder_TeraRangerI2C.cpp
View File

@ -136,8 +136,8 @@ bool AP_RangeFinder_TeraRangerI2C::process_raw_measure(uint16_t raw_distance, ui
{
// Check for error codes
if (raw_distance == 0xFFFF) {
// Too far away is unreliable so we dont enforce max range here
return false;
// Too far away
output_distance_cm = max_distance_cm() + TR_OUT_OF_RANGE_ADD_CM;
} else if (raw_distance == 0x0000) {
// Too close
output_distance_cm = 0;