diff --git a/radio/src/bluetooth.cpp b/radio/src/bluetooth.cpp index 591e04c5a..b8b9fe36c 100644 --- a/radio/src/bluetooth.cpp +++ b/radio/src/bluetooth.cpp @@ -279,7 +279,7 @@ void Bluetooth::sendTrainer() pushByte(((channelValue1 & 0x0f00) >> 4) + ((channelValue2 & 0x00f0) >> 4)); pushByte(((channelValue2 & 0x000f) << 4) + ((channelValue2 & 0x0f00) >> 8)); } - buffer[bufferIndex++] = crc; + pushByte(crc); buffer[bufferIndex++] = START_STOP; // end byte write(buffer, bufferIndex); @@ -294,7 +294,7 @@ void Bluetooth::forwardTelemetry(const uint8_t * packet) for (uint8_t i=0; i= 2*FRSKY_SPORT_PACKET_SIZE) {