fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-03 13:01:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

add parsing of host frames for D type telemetry

Browse Source
This commit is contained in:
Mark Whitehorn
2016-02-10 09:21:52 +01:00
committed by Lorenz Meier
parent 3edf304e55
commit 47337eb4a5
4 changed files with 89 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/frsky_telemetry/frsky_telemetry.c
+17 -5
View File
@@ -332,23 +332,35 @@ static int frsky_telemetry_thread_main(int argc, char *argv[])
frsky_init();
warnx("sending FrSky D type telemetry");
struct adc_linkquality host_frame;
uint8_t dbuf[45];
/* send D8 mode telemetry */
while (!thread_should_exit) {
/* Sleep 200 ms */
usleep(200000);
/* Sleep 100 ms */
usleep(100000);
/* 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);
}
/* Send frame 1 (every 200ms): acceleration values, altitude (vario), temperatures, current & voltages, RPM */
frsky_send_frame1(uart);
if (iteration % 2 == 0) {
frsky_send_frame1(uart);
}
/* Send frame 2 (every 1000ms): course, latitude, longitude, speed, altitude (GPS), fuel level */
if (iteration % 5 == 0) {
if (iteration % 10 == 0) {
frsky_send_frame2(uart);
}
/* Send frame 3 (every 5000ms): date, time */
if (iteration % 25 == 0) {
if (iteration % 50 == 0) {
frsky_send_frame3(uart);
iteration = 0;