From 00f04e0ea2275d45351cf081381f90b9e2c117a4 Mon Sep 17 00:00:00 2001
From: Dominic Clifton <me@dominicclifton.name>
Date: Thu, 19 Feb 2015 00:30:52 +0000
Subject: [PATCH] Fix frsky telemetry which was needlessly checking for
 incoming data.

Maybe it needs to check that the serial port has SENT the data?
---
 src/main/io/serial.c       |  2 ++
 src/main/telemetry/frsky.c | 10 ----------
 2 files changed, 2 insertions(+), 10 deletions(-)

diff --git a/src/main/io/serial.c b/src/main/io/serial.c
index 353f76a28d..e26a894959 100644
--- a/src/main/io/serial.c
+++ b/src/main/io/serial.c
@@ -288,6 +288,8 @@ void closeSerialPort(serialPort_t *serialPort) {
         return;
     }
 
+    // TODO wait until data has been transmitted.
+
     serialPort->callback = NULL;
 
     serialPortUsage->function = FUNCTION_NONE;
diff --git a/src/main/telemetry/frsky.c b/src/main/telemetry/frsky.c
index 49223e4b88..c02eaf756d 100644
--- a/src/main/telemetry/frsky.c
+++ b/src/main/telemetry/frsky.c
@@ -432,12 +432,6 @@ void configureFrSkyTelemetryPort(void)
     frskyTelemetryEnabled = true;
 }
 
-
-bool canSendFrSkyTelemetry(void)
-{
-    return frskyPort && serialTotalBytesWaiting(frskyPort) == 0;
-}
-
 bool hasEnoughTimeLapsedSinceLastTelemetryTransmission(uint32_t currentMillis)
 {
     return currentMillis - lastCycleTime >= CYCLETIME;
@@ -463,10 +457,6 @@ void handleFrSkyTelemetry(void)
         return;
     }
 
-    if (!canSendFrSkyTelemetry()) {
-        return;
-    }
-
     uint32_t now = millis();
 
     if (!hasEnoughTimeLapsedSinceLastTelemetryTransmission(now)) {