From 9a3c34760aafbf5af63865fb8d8b2579629f85b4 Mon Sep 17 00:00:00 2001
From: alanbjohnston <alan.b.johnston@gmail.com>
Date: Fri, 11 Jun 2021 08:22:08 -0400
Subject: [PATCH] in payload R query, added if to only query if payload not
 found

---
 afsk/main.c | 25 ++++++++++++++-----------
 1 file changed, 14 insertions(+), 11 deletions(-)

diff --git a/afsk/main.c b/afsk/main.c
index 43a05741..7b3b1de0 100644
--- a/afsk/main.c
+++ b/afsk/main.c
@@ -473,21 +473,24 @@ int main(int argc, char * argv[]) {
       unsigned int waitTime;
       int i;
       for (i = 0; i < 2; i++) {
-        serialPutchar(uart_fd, 'R');
-        printf("Querying payload with R to reset\n");
-        waitTime = millis() + 500;
-        while ((millis() < waitTime) && (payload != ON)) {
-          if (serialDataAvail(uart_fd)) {
-            printf("%c", c = (char) serialGetchar(uart_fd));
-            fflush(stdout);
-            if (c == 'O') {
+	if (payload != ON) {
+          serialPutchar(uart_fd, 'R');
+          printf("Querying payload with R to reset\n");
+          waitTime = millis() + 500;
+          while ((millis() < waitTime) && (payload != ON)) {
+            if (serialDataAvail(uart_fd)) {
               printf("%c", c = (char) serialGetchar(uart_fd));
               fflush(stdout);
-              if (c == 'K')
-                payload = ON;
+              if (c == 'O') {
+                printf("%c", c = (char) serialGetchar(uart_fd));
+                fflush(stdout);
+                if (c == 'K')
+                  payload = ON;
+              }
             }
+            printf("\n");
+            //        sleep(0.75);
           }
-          //        sleep(0.75);
         }
       }
       if (payload == ON)