Enable dump xfire telem using BT

This commit is contained in:
3djc
2019-09-05 13:45:33 +02:00
parent 5d19f71177
commit bcaeeed6ce
2 changed files with 6 additions and 1 deletions
+1 -1
View File
@@ -54,6 +54,7 @@ class Bluetooth
public:
void writeString(const char * str);
char * readline(bool error_reset = true);
void write(const uint8_t * data, uint8_t length);
void forwardTelemetry(const uint8_t * packet);
void wakeup();
@@ -66,7 +67,6 @@ class Bluetooth
protected:
void pushByte(uint8_t byte);
uint8_t read(uint8_t * data, uint8_t size, uint32_t timeout=1000/*ms*/);
void write(const uint8_t * data, uint8_t length);
void appendTrainerByte(uint8_t data);
void processTrainerFrame(const uint8_t * buffer);
void processTrainerByte(uint8_t data);
+5
View File
@@ -212,6 +212,11 @@ void processCrossfireTelemetryData(uint8_t data)
if (telemetryRxBufferCount > 4) {
uint8_t length = telemetryRxBuffer[1];
if (length + 2 == telemetryRxBufferCount) {
#if defined(BLUETOOTH)
if (g_eeGeneral.bluetoothMode == BLUETOOTH_TELEMETRY && bluetooth.state == BLUETOOTH_STATE_CONNECTED) {
bluetooth.write(telemetryRxBuffer, telemetryRxBufferCount);
}
#endif
processCrossfireTelemetryFrame();
telemetryRxBufferCount = 0;
}