only process payload string if valid (begins with "OK")

pull/74/head
alanbjohnston 5 years ago committed by GitHub
parent 92366d9351
commit 7bf38384d4
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23

@ -1376,6 +1376,8 @@ if (payload == ON)
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;

Loading…
Cancel
Save

Powered by TurnKey Linux.