|
|
|
@ -771,20 +771,25 @@ int main(int argc, char * argv[]) {
|
|
|
|
if (gps_read != NULL) {
|
|
|
|
if (gps_read != NULL) {
|
|
|
|
fgets(cmdbuffer, 1000, gps_read);
|
|
|
|
fgets(cmdbuffer, 1000, gps_read);
|
|
|
|
|
|
|
|
|
|
|
|
const char gpsTestStr[] = "2 32.3 -54 333\n";
|
|
|
|
// const char gpsTestStr[] = "2 32.3 -54 333\n";
|
|
|
|
strcpy(cmdbuffer, gpsTestStr);
|
|
|
|
// strcpy(cmdbuffer, gpsTestStr);
|
|
|
|
|
|
|
|
|
|
|
|
fprintf(stderr, "gps read: %s\n", cmdbuffer);
|
|
|
|
fprintf(stderr, "gps read: %s\n", cmdbuffer);
|
|
|
|
if ((cmdbuffer[0] == '2') || (cmdbuffer[0] == '3'))
|
|
|
|
if ((cmdbuffer[0] == '2') || (cmdbuffer[0] == '3'))
|
|
|
|
{
|
|
|
|
{
|
|
|
|
printf("Valid gps data!\n");
|
|
|
|
printf("Valid gps data!\n");
|
|
|
|
|
|
|
|
printf("%x %x \n", cmdbuffer[strlen(cmdbuffer) - 2], cmdbuffer[strlen(cmdbuffer) - 1] );
|
|
|
|
|
|
|
|
if (cmdbuffer[strlen(cmdbuffer) - 1] == '\n')
|
|
|
|
|
|
|
|
cmdbuffer[strlen(cmdbuffer) - 1] = '\0';
|
|
|
|
|
|
|
|
printf("%x %x \n", cmdbuffer[strlen(cmdbuffer) - 2], cmdbuffer[strlen(cmdbuffer) - 1] );
|
|
|
|
|
|
|
|
|
|
|
|
int count1;
|
|
|
|
int count1;
|
|
|
|
char * token;
|
|
|
|
char * token;
|
|
|
|
|
|
|
|
|
|
|
|
const char space[2] = " ";
|
|
|
|
const char space[2] = " ";
|
|
|
|
token = strtok(cmdbuffer, space);
|
|
|
|
token = strtok(cmdbuffer, space);
|
|
|
|
// printf("token: %s\n", token);
|
|
|
|
// printf("token: %s\n", token);
|
|
|
|
for (count1 = GPS; count1 < (GPS + 3); count1++) {
|
|
|
|
for (count1 = GPS; count1 < (GPS + 4); count1++) {
|
|
|
|
if (token != NULL) {
|
|
|
|
if (token != NULL) {
|
|
|
|
sensor[count1] = (float) atof(token);
|
|
|
|
sensor[count1] = (float) atof(token);
|
|
|
|
strcpy(sensor_string[count1], token);
|
|
|
|
strcpy(sensor_string[count1], token);
|
|
|
|
@ -796,6 +801,7 @@ int main(int argc, char * argv[]) {
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
printf("\n");
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
strcpy(sensor_string[GPS], "GPS");
|
|
|
|
|
|
|
|
|
|
|
|
} else {
|
|
|
|
} else {
|
|
|
|
fprintf(stderr, "No Pi gps available\n");
|
|
|
|
fprintf(stderr, "No Pi gps available\n");
|
|
|
|
|