From 7bf38384d487e1fe73ffc92f59b1b55e4339f901 Mon Sep 17 00:00:00 2001 From: alanbjohnston Date: Sat, 12 Dec 2020 13:01:45 -0500 Subject: [PATCH] only process payload string if valid (begins with "OK") --- afsk/main.c | 5 ++++- 1 file changed, 4 insertions(+), 1 deletion(-) diff --git a/afsk/main.c b/afsk/main.c index 9e63b5bf..65f72c7b 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -1375,7 +1375,9 @@ if (payload == ON) // sensor_payload[i++] = '\n'; sensor_payload[i] = '\0'; printf("Payload string: %s \n", sensor_payload); - + + if ((sensor_payload[0] == 'O') && (sensor_payload[1] == 'K')) // only process if valid payload response + { int count1; char *token; // char cmdbuffer[1000]; @@ -1523,6 +1525,7 @@ if (payload == ON) printf("Smin %f Smax %f \n", sensor_min[count1], sensor_max[count1]); } +} xAngularVelocity = (int)(gyroX + 0.5) + 2048; yAngularVelocity = (int)(gyroY + 0.5) + 2048; zAngularVelocity = (int)(gyroZ + 0.5) + 2048;