Browse Source

fix format

sbg
Mark Whitehorn 9 years ago committed by Lorenz Meier
parent
commit
e25b26e2a8
  1. 16
      src/drivers/frsky_telemetry/frsky_data.c
  2. 1
      src/drivers/frsky_telemetry/frsky_telemetry.c

16
src/drivers/frsky_telemetry/frsky_data.c

@ -308,30 +308,40 @@ bool frsky_parse_host(uint8_t * sbuf, int nbytes, struct adc_linkquality * v) @@ -308,30 +308,40 @@ bool frsky_parse_host(uint8_t * sbuf, int nbytes, struct adc_linkquality * v)
if (sbuf[i] == 0x7E) {
state = TYPE;
}
break;
case TYPE:
if (sbuf[i] != 0x7E) {
state = DATA;
type = sbuf[i];
dcount = 0;
}
break;
case DATA:
/* read 8 data bytes */
if (dcount < 7) {
data[dcount++] = sbuf[i];
}
else {
} else {
/* received all data bytes */
state = TRAILER;
}
break;
case TRAILER:
state = HEADER;
if (sbuf[i] != 0x7E) {
warnx("host packet error: %x", sbuf[i]);
} else {
data_ready = true;
if (type == 0xFE) {
/* this is an adc_linkquality packet */
v->ad1 = data[0];
@ -339,9 +349,11 @@ bool frsky_parse_host(uint8_t * sbuf, int nbytes, struct adc_linkquality * v) @@ -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;
}

1
src/drivers/frsky_telemetry/frsky_telemetry.c

@ -344,6 +344,7 @@ static int frsky_telemetry_thread_main(int argc, char *argv[]) @@ -344,6 +344,7 @@ 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);

Loading…
Cancel
Save