S.PORT Push with PXX2 (still not tested)
This commit is contained in:
@@ -238,3 +238,16 @@ void processPXX2TelemetryFrame(uint8_t module, uint8_t * frame)
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
void pushPXX2TelemetryPacket(uint8_t module, uint8_t rx_uid, SportTelemetryPacket * packet)
|
||||
{
|
||||
// Flag0
|
||||
outputTelemetryBuffer.push(rx_uid);
|
||||
|
||||
for (uint8_t i=1; i<sizeof(SportTelemetryPacket); i++) {
|
||||
uint8_t byte = packet->raw[i];
|
||||
outputTelemetryBuffer.push(byte);
|
||||
}
|
||||
|
||||
outputTelemetryBuffer.setDestination(module);
|
||||
}
|
||||
|
||||
@@ -197,6 +197,6 @@ extern Fifo<uint8_t, LUA_TELEMETRY_INPUT_FIFO_SIZE> * luaInputTelemetryFifo;
|
||||
#endif
|
||||
|
||||
void processPXX2TelemetryFrame(uint8_t module, uint8_t * frame);
|
||||
void pushPXX2TelemetryPacket(uint8_t module, uint8_t rx_uid, SportTelemetryPacket * packet);
|
||||
|
||||
#endif // _TELEMETRY_H_
|
||||
|
||||
|
||||
Reference in New Issue
Block a user