From c802553189acfad55ec0c7457381821f5182d34b Mon Sep 17 00:00:00 2001
From: dlktdr <cblackburn320@gmail.com>
Date: Thu, 9 Dec 2021 20:42:10 -0800
Subject: [PATCH] Break non-verbose o/p on complete frames, add timestamp

---
 radio/src/bluetooth.cpp | 29 +++++++++++++++++++++++++++--
 1 file changed, 27 insertions(+), 2 deletions(-)

diff --git a/radio/src/bluetooth.cpp b/radio/src/bluetooth.cpp
index 3a3c5dd87..66324c4f0 100644
--- a/radio/src/bluetooth.cpp
+++ b/radio/src/bluetooth.cpp
@@ -150,8 +150,6 @@ char * Bluetooth::readline(bool error_reset)
 
 void Bluetooth::processTrainerFrame(const uint8_t * buffer)
 {
-  BLUETOOTH_TRACE(CRLF);
-
   for (uint8_t channel=0, i=1; channel<BLUETOOTH_TRAINER_CHANNELS; channel+=2, i+=3) {
     // +-500 != 512, but close enough.
     ppmInput[channel] = buffer[i] + ((buffer[i+1] & 0xf0) << 4) - 1500;
@@ -285,6 +283,16 @@ void Bluetooth::sendTrainer()
   buffer[bufferIndex++] = START_STOP; // end byte
 
   write(buffer, bufferIndex);
+
+  // If not in verbose mode output one buffer per line
+  #if defined(DEBUG_BLUETOOTH) && !defined(DEBUG_BLUETOOTH_VERBOSE)
+    BLUETOOTH_TRACE_TIMESTAMP();
+    for(int i=0; i < bufferIndex; i++) {
+      BLUETOOTH_TRACE(" %02X", buffer[i]);
+    }
+    BLUETOOTH_TRACE(CRLF);
+  #endif
+
   bufferIndex = 0;
 }
 
@@ -303,6 +311,15 @@ void Bluetooth::forwardTelemetry(const uint8_t * packet)
     write(buffer, bufferIndex);
     bufferIndex = 0;
   }
+
+  // If not in verbose mode output one buffer per line
+  #if defined(DEBUG_BLUETOOTH) && !defined(DEBUG_BLUETOOTH_VERBOSE)
+    BLUETOOTH_TRACE_TIMESTAMP();
+    for(int i=0; i < bufferIndex; i++) {
+      BLUETOOTH_TRACE(" %02X", buffer[i]);
+    }
+    BLUETOOTH_TRACE(CRLF);
+  #endif
 }
 
 void Bluetooth::receiveTrainer()
@@ -314,7 +331,15 @@ void Bluetooth::receiveTrainer()
       return;
     }
 
+#if defined(DEBUG_BLUETOOTH)
+    static uint8_t lastb=0;
     BLUETOOTH_TRACE("%02X ", byte);
+    if(byte == START_STOP && lastb != START_STOP) {
+      BLUETOOTH_TRACE(CRLF);
+      BLUETOOTH_TRACE_TIMESTAMP();
+    }
+    lastb = byte;
+#endif
 
     processTrainerByte(byte);
   }