diff --git a/afsk/main.c b/afsk/main.c index 309435f2..86fa3823 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -1365,10 +1365,10 @@ void get_tlm_fox() { unsigned int waitTime; int i, end, trys = 0; - while (((sensor_payload[0] != 'O') || (sensor_payload[1] != 'K')) && (trys++ < 2)) { + while ((sensor_payload[0] != 'O') && (sensor_payload[1] != 'K') && (trys++ < 3)) { i = 0; serialPutchar(uart_fd, '?'); - printf("Querying payload with ?\n"); + printf("%d Querying payload with ?\n", trys); waitTime = millis() + 500; end = FALSE; // int retry = FALSE; @@ -1385,12 +1385,12 @@ void get_tlm_fox() { } } } - } - sensor_payload[i++] = ' '; - // sensor_payload[i++] = '\n'; - sensor_payload[i] = '\0'; - printf(" Payload string: %s\n", sensor_payload); - + + sensor_payload[i++] = ' '; + // 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;