diff --git a/libraries/AP_BLHeli/AP_BLHeli.cpp b/libraries/AP_BLHeli/AP_BLHeli.cpp index 49d9dfa805..02f49baf17 100644 --- a/libraries/AP_BLHeli/AP_BLHeli.cpp +++ b/libraries/AP_BLHeli/AP_BLHeli.cpp @@ -1403,21 +1403,6 @@ void AP_BLHeli::init(void) } } -/* - implement the 8 bit CRC used by the BLHeli ESC telemetry protocol - */ -uint8_t AP_BLHeli::telem_crc8(uint8_t crc, uint8_t crc_seed) const -{ - uint8_t crc_u = crc; - crc_u ^= crc_seed; - - for (uint8_t i=0; i<8; i++) { - crc_u = ( crc_u & 0x80 ) ? 0x7 ^ ( crc_u << 1 ) : ( crc_u << 1 ); - } - - return crc_u; -} - /* read an ESC telemetry packet */ @@ -1432,7 +1417,7 @@ void AP_BLHeli::read_telemetry_packet(void) // calculate crc uint8_t crc = 0; for (uint8_t i=0; i