1
0
Fork 0
mirror of https://github.com/opentx/opentx.git synced 2025-07-25 17:25:13 +03:00

SPORT telemetry push fix (part 1)

This commit is contained in:
Bertrand Songis 2019-05-09 10:30:36 +02:00
parent 73a21a3e7e
commit ab38676ffd
3 changed files with 3 additions and 3 deletions

View file

@ -207,7 +207,7 @@ extern "C" void TELEMETRY_USART_IRQHandler(void)
if (telemetryProtocol == PROTOCOL_TELEMETRY_FRSKY_SPORT) {
static uint8_t prevdata;
if (prevdata == 0x7E && outputTelemetryBuffer.size > 0 && outputTelemetryBuffer.destination == TELEMETRY_ENDPOINT_SPORT && data == outputTelemetryBuffer.sport.physicalId) {
sportSendBuffer(outputTelemetryBuffer.data, outputTelemetryBuffer.size);
sportSendBuffer(outputTelemetryBuffer.data + 1, outputTelemetryBuffer.size - 1);
}
prevdata = data;
}

View file

@ -159,7 +159,7 @@ extern "C" void TELEMETRY_USART_IRQHandler(void)
if (telemetryProtocol == PROTOCOL_TELEMETRY_FRSKY_SPORT) {
static uint8_t prevdata;
if (prevdata == 0x7E && outputTelemetryBuffer.destination == TELEMETRY_ENDPOINT_SPORT && data == outputTelemetryBuffer.sport.physicalId) {
sportSendBuffer(outputTelemetryBuffer.data, outputTelemetryBuffer.size);
sportSendBuffer(outputTelemetryBuffer.data + 1, outputTelemetryBuffer.size - 1);
}
prevdata = data;
}

View file

@ -209,7 +209,7 @@ class OutputTelemetryBuffer {
{
size = 0;
uint16_t crc = 0;
sport.physicalId = packet.physicalId; // no bytestuffing, no CRC
pushByte(packet.physicalId); // no bytestuffing, no CRC
for (uint8_t i=1; i<sizeof(SportTelemetryPacket); i++) {
uint8_t byte = packet.raw[i];
pushByteWithBytestuffing(byte);