diff --git a/libraries/AP_RangeFinder/AP_RangeFinder_LeddarOne.cpp b/libraries/AP_RangeFinder/AP_RangeFinder_LeddarOne.cpp index da973bee38..8c7122c559 100644 --- a/libraries/AP_RangeFinder/AP_RangeFinder_LeddarOne.cpp +++ b/libraries/AP_RangeFinder/AP_RangeFinder_LeddarOne.cpp @@ -133,14 +133,13 @@ bool AP_RangeFinder_LeddarOne::CRC16(uint8_t *aBuffer, uint8_t aLength, bool aCh */ LeddarOne_Status AP_RangeFinder_LeddarOne::parse_response(uint8_t &number_detections) { - uint8_t index; uint8_t index_offset = LEDDARONE_DETECTION_DATA_INDEX_OFFSET; // read serial uint32_t nbytes = uart->available(); if (nbytes != 0) { - for (index=read_len; index= LEDDARONE_READ_BUFFER_SIZE) { return LEDDARONE_STATE_ERR_BAD_RESPONSE; } @@ -173,7 +172,7 @@ LeddarOne_Status AP_RangeFinder_LeddarOne::parse_response(uint8_t &number_detect } sum_distance = 0; - for (index=0; index(read_buffer[index_offset])*256 + read_buffer[index_offset+1]) / 10;