Browse Source

AP_RangeFinder: remove clear buffer in send_request

mission-4.1.18
ShingoMatsuura 8 years ago committed by Tom Pittenger
parent
commit
c1c643e56e
  1. 13
      libraries/AP_RangeFinder/AP_RangeFinder_LeddarOne.cpp

13
libraries/AP_RangeFinder/AP_RangeFinder_LeddarOne.cpp

@ -162,17 +162,6 @@ bool AP_RangeFinder_LeddarOne::CRC16(uint8_t *aBuffer, uint8_t aLength, bool aCh @@ -162,17 +162,6 @@ bool AP_RangeFinder_LeddarOne::CRC16(uint8_t *aBuffer, uint8_t aLength, bool aCh
LeddarOne_Status AP_RangeFinder_LeddarOne::send_request(void)
{
uint8_t send_buffer[8] = {0};
uint8_t index = 0;
uint32_t nbytes = uart->available();
// clear buffer
while (nbytes-- > 0) {
uart->read();
if (++index > LEDDARONE_SERIAL_PORT_MAX) {
return LEDDARONE_STATE_ERR_SERIAL_PORT;
}
}
// Modbus read input register (function code 0x04)
send_buffer[0] = LEDDARONE_DEFAULT_ADDRESS;
@ -186,7 +175,7 @@ LeddarOne_Status AP_RangeFinder_LeddarOne::send_request(void) @@ -186,7 +175,7 @@ LeddarOne_Status AP_RangeFinder_LeddarOne::send_request(void)
CRC16(send_buffer, 6, false);
// write buffer data with CRC16 bits
for (index=0; index<8; index++) {
for (uint8_t index=0; index<8; index++) {
uart->write(send_buffer[index]);
}
uart->flush();

Loading…
Cancel
Save