Mirror/opentx
1
0
Fork 0
mirror of https://github.com/opentx/opentx.git synced 2025-07-26 01:35:21 +03:00
Code Issues Wiki Activity

SPORT telemetry push fix (part 1)

Browse source
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
Download patch file Download diff file Expand all files Collapse all files

2
radio/src/targets/horus/telemetry_driver.cpp
View file

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

2
radio/src/targets/taranis/telemetry_driver.cpp
View file

@ -159,7 +159,7 @@ extern "C" void TELEMETRY_USART_IRQHandler(void)
if (telemetryProtocol == PROTOCOL_TELEMETRY_FRSKY_SPORT) { if (telemetryProtocol == PROTOCOL_TELEMETRY_FRSKY_SPORT) {
static uint8_t prevdata; static uint8_t prevdata;
if (prevdata == 0x7E && outputTelemetryBuffer.destination == TELEMETRY_ENDPOINT_SPORT && data == outputTelemetryBuffer.sport.physicalId) { 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; prevdata = data;
} }

2
radio/src/telemetry/telemetry.h
View file

@ -209,7 +209,7 @@ class OutputTelemetryBuffer {
{ {
size = 0; size = 0;
uint16_t crc = 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++) { for (uint8_t i=1; i<sizeof(SportTelemetryPacket); i++) {
uint8_t byte = packet.raw[i]; uint8_t byte = packet.raw[i];
pushByteWithBytestuffing(byte); pushByteWithBytestuffing(byte);