added test for OK in sensor payload and restart

5 years ago · 3bf456089c
parent 0f848d6d46
commit 3bf456089c
1 changed files with 6 additions and 0 deletions
--- 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
 	  {