diff --git a/libraries/AP_RangeFinder/AP_RangeFinder_RDS02UF.cpp b/libraries/AP_RangeFinder/AP_RangeFinder_RDS02UF.cpp index 6e6087aaa6..5044d4bb1f 100644 --- a/libraries/AP_RangeFinder/AP_RangeFinder_RDS02UF.cpp +++ b/libraries/AP_RangeFinder/AP_RangeFinder_RDS02UF.cpp @@ -97,8 +97,9 @@ bool AP_RangeFinder_RDS02UF::get_reading(float &distance_m) } } - // reset buffer - body_length = 0; + // consume this message: + move_header_in_buffer(ARRAY_SIZE(u.parse_buffer)); + return true; }