diff --git a/src/drivers/frsky_telemetry/frsky_data.c b/src/drivers/frsky_telemetry/frsky_data.c index 8b806451eb..ef5beeeb44 100644 --- a/src/drivers/frsky_telemetry/frsky_data.c +++ b/src/drivers/frsky_telemetry/frsky_data.c @@ -289,7 +289,7 @@ void frsky_send_frame3(int uart) } /* parse 11 byte frames */ -bool frsky_parse_host(uint8_t * sbuf, int nbytes, struct adc_linkquality * v) +bool frsky_parse_host(uint8_t *sbuf, int nbytes, struct adc_linkquality *v) { bool data_ready = false; static int dcount = 0; @@ -302,36 +302,46 @@ bool frsky_parse_host(uint8_t * sbuf, int nbytes, struct adc_linkquality * v) TRAILER } state = HEADER; - for (int i=0; iad1 = data[0]; @@ -339,9 +349,11 @@ bool frsky_parse_host(uint8_t * sbuf, int nbytes, struct adc_linkquality * v) v->linkq = data[2]; } } + break; } } + return data_ready; } diff --git a/src/drivers/frsky_telemetry/frsky_data.h b/src/drivers/frsky_telemetry/frsky_data.h index 4ece886055..96948e0cff 100644 --- a/src/drivers/frsky_telemetry/frsky_data.h +++ b/src/drivers/frsky_telemetry/frsky_data.h @@ -55,6 +55,6 @@ struct adc_linkquality { uint8_t ad2; uint8_t linkq; }; -bool frsky_parse_host(uint8_t * sbuf, int nbytes, struct adc_linkquality * v); +bool frsky_parse_host(uint8_t *sbuf, int nbytes, struct adc_linkquality *v); #endif /* _FRSKY_TELEMETRY_H */ diff --git a/src/drivers/frsky_telemetry/frsky_telemetry.c b/src/drivers/frsky_telemetry/frsky_telemetry.c index 4fe30a3e1c..ee8495ef63 100644 --- a/src/drivers/frsky_telemetry/frsky_telemetry.c +++ b/src/drivers/frsky_telemetry/frsky_telemetry.c @@ -344,9 +344,10 @@ static int frsky_telemetry_thread_main(int argc, char *argv[]) /* parse incoming data */ int nbytes = read(uart, &dbuf[0], sizeof(dbuf)); bool new_input = frsky_parse_host(&dbuf[0], nbytes, &host_frame); + if (new_input) { warnx("host frame: ad1:%u, ad2: %u, rssi: %u", - host_frame.ad1, host_frame.ad2, host_frame.linkq); + host_frame.ad1, host_frame.ad2, host_frame.linkq); } /* Send frame 1 (every 200ms): acceleration values, altitude (vario), temperatures, current & voltages, RPM */