From 3bf456089c2cba4b2f8df4caec478b041f3d6e2b Mon Sep 17 00:00:00 2001
From: alanbjohnston <alan.b.johnston@gmail.com>
Date: Thu, 10 Dec 2020 14:00:51 -0500
Subject: [PATCH] added test for OK in sensor payload and restart

---
 afsk/main.c | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/afsk/main.c b/afsk/main.c
index 73c094a4..85badd48 100644
--- a/afsk/main.c
+++ b/afsk/main.c
@@ -1216,6 +1216,12 @@ if (payload == ON)
 	  if (c != '\n')
 	  {
 	  	sensor_payload[i++] = c;
+		if (i == 2)
+			if ((sensor_payload[0] != 'O') || (sensor_payload[1] != 'K'))
+			{
+				i = 0; // restart read
+				printf("Restarting sensor read!\n");
+			}
 	  }
 	  else
 	  {