From eac2aa4ac194205a284d1bc8e0613f7bc1677724 Mon Sep 17 00:00:00 2001
From: Geoffrey Merck <F4FXL@users.noreply.github.com>
Date: Mon, 11 May 2020 14:36:30 +0200
Subject: [PATCH] Write larger chunks of FM audio to the serial port

---
 FM.cpp | 18 ++++++++++++++----
 1 file changed, 14 insertions(+), 4 deletions(-)

diff --git a/FM.cpp b/FM.cpp
index 4c8b45b..9913863 100644
--- a/FM.cpp
+++ b/FM.cpp
@@ -158,10 +158,20 @@ void CFM::process()
   while (io.getSpace() >= 3U && m_outputRFRB.get(sample))
     io.write(STATE_FM, &sample, 1U);
 
-  uint8_t serialSample;
-  //write data to serial port
-  while (m_downsampler.getPackedData(serialSample))
-    serial.writeFMData(&serialSample, 1U);
+  if(m_downsampler.getData() >= 127) {
+    uint8_t length = uint8_t(m_downsampler.getData());
+
+    if(length > 127U)//max message size on serial is 127
+      length = 127U;
+
+    uint8_t serialSamples[length];
+
+    for(uint8_t i = 0U; i < length; i++) {
+      uint8_t serialSample = 0U;
+      m_downsampler.getPackedData(serialSample);
+    }
+    serial.writeFMData(serialSamples, length);
+  }
 }
 
 void CFM::reset()