Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-08 17:08:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_RangeFinder: Benewake driver discards distances over 327m

Browse Source
This commit is contained in:
Randy Mackay 2018-10-23 14:23:44 +09:00 committed by Andrew Tridgell
parent c16a810e89
commit 9485ab8eb8
1 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
libraries/AP_RangeFinder/AP_RangeFinder_Benewake.cpp
View File

@ -23,6 +23,7 @@ extern const AP_HAL::HAL& hal;
#define BENEWAKE_FRAME_HEADER 0x59
#define BENEWAKE_FRAME_LENGTH 9
#define BENEWAKE_DIST_MAX_CM 32768
// format of serial packets received from benewake lidar
//
@ -112,7 +113,7 @@ bool AP_RangeFinder_Benewake::get_reading(uint16_t &reading_cm, bool &signal_ok)
signal_ok = true;
// calculate distance and add to sum
uint16_t dist = ((uint16_t)linebuf[3] << 8) | linebuf[2];
if (dist != 0xFFFF) {
if (dist < BENEWAKE_DIST_MAX_CM) {
// TFmini has short distance mode (mm)
if (model_type == BENEWAKE_TFmini) {
if (linebuf[6] == 0x02) {