feat: S.Port telemetry for PPM/SBUS external module (#5689)
Co-authored-by: Michael <mha1@users.noreply.github.com>
This commit is contained in:
co-authored by
Michael
parent
3d1e7a914f
commit
6d17448be5
@@ -87,16 +87,16 @@ static inline bool pushFrskyTelemetryData(bool is_sport, uint8_t data,
|
||||
return false;
|
||||
}
|
||||
|
||||
void processFrskyDTelemetryData(uint8_t module, uint8_t data, uint8_t* buffer, uint8_t& len)
|
||||
void processFrskyDTelemetryData(uint8_t module, uint8_t data, uint8_t* buffer, uint8_t* len)
|
||||
{
|
||||
if (pushFrskyTelemetryData(false, data, buffer, len)) {
|
||||
frskyDProcessPacket(module, buffer, len);
|
||||
if (pushFrskyTelemetryData(false, data, buffer, *len)) {
|
||||
frskyDProcessPacket(module, buffer, *len);
|
||||
}
|
||||
}
|
||||
|
||||
void processFrskySportTelemetryData(uint8_t module, uint8_t data, uint8_t* buffer, uint8_t& len)
|
||||
void processFrskySportTelemetryData(uint8_t module, uint8_t data, uint8_t* buffer, uint8_t* len)
|
||||
{
|
||||
if (pushFrskyTelemetryData(true, data, buffer, len)) {
|
||||
sportProcessTelemetryPacket(module, buffer, len);
|
||||
if (pushFrskyTelemetryData(true, data, buffer, *len)) {
|
||||
sportProcessTelemetryPacket(module, buffer, *len);
|
||||
}
|
||||
}
|
||||
|
||||
@@ -105,10 +105,10 @@ void sportProcessTelemetryPacketWithoutCrc(uint8_t module, uint8_t origin,
|
||||
const uint8_t *packet);
|
||||
|
||||
void processFrskySportTelemetryData(uint8_t module, uint8_t data,
|
||||
uint8_t* buffer, uint8_t& len);
|
||||
uint8_t* buffer, uint8_t* len);
|
||||
|
||||
void processFrskyDTelemetryData(uint8_t module, uint8_t data,
|
||||
uint8_t* buffer, uint8_t& len);
|
||||
uint8_t* buffer, uint8_t* len);
|
||||
|
||||
#if defined(NO_RAS)
|
||||
inline bool isRasValueValid()
|
||||
|
||||
@@ -625,7 +625,7 @@ void processMultiTelemetryData(uint8_t data, uint8_t module)
|
||||
|
||||
case FrskyTelemetryFallback:
|
||||
setMultiTelemetryBufferState(module, FrskyTelemetryFallbackFirstByte);
|
||||
processFrskySportTelemetryData(module, data, rxBuffer, rxBufferCount);
|
||||
processFrskySportTelemetryData(module, data, rxBuffer, &rxBufferCount);
|
||||
break;
|
||||
|
||||
case FrskyTelemetryFallbackFirstByte:
|
||||
@@ -633,7 +633,7 @@ void processMultiTelemetryData(uint8_t data, uint8_t module)
|
||||
setMultiTelemetryBufferState(module, MultiStatusOrFrskyData);
|
||||
}
|
||||
else {
|
||||
processFrskySportTelemetryData(module, data, rxBuffer, rxBufferCount);
|
||||
processFrskySportTelemetryData(module, data, rxBuffer, &rxBufferCount);
|
||||
if (data != 0x7e)
|
||||
setMultiTelemetryBufferState(module, FrskyTelemetryFallbackNextBytes);
|
||||
}
|
||||
@@ -641,7 +641,7 @@ void processMultiTelemetryData(uint8_t data, uint8_t module)
|
||||
break;
|
||||
|
||||
case FrskyTelemetryFallbackNextBytes:
|
||||
processFrskySportTelemetryData(module, data, rxBuffer, rxBufferCount);
|
||||
processFrskySportTelemetryData(module, data, rxBuffer, &rxBufferCount);
|
||||
if (data == 0x7e) {
|
||||
// end of packet or start of new packet
|
||||
setMultiTelemetryBufferState(module, FrskyTelemetryFallbackFirstByte);
|
||||
|
||||
Reference in New Issue
Block a user