fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-30 05:53:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

S.BUS parsing improvements

Browse Source
This commit is contained in:
Lorenz Meier
2015-12-07 11:41:01 +01:00
parent bff0f225b1
commit 7b73e8f9ee
1 changed files with 8 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/rc/sbus.c
+8 -8
View File
@@ -214,23 +214,23 @@ sbus_input(int sbus_fd, uint16_t *values, uint16_t *num_values, bool *sbus_fails
/* if the read failed for any reason, just give up here */ /* if the read failed for any reason, just give up here */
if (ret < 1) { if (ret < 1) {
continue; break;
} }
last_rx_time = now; last_rx_time = now;
/* if the first byte of the frame is not the start symbol, give up instantly */
if (frame[0] != SBUS_START_SYMBOL) {
sbus_frame_drops++;
partial_frame_count = 0;
continue;
}
/* /*
* Add bytes to the current frame * Add bytes to the current frame
*/ */
partial_frame_count += ret; partial_frame_count += ret;
/* if the first byte of the frame is not the start symbol, give up instantly */
if (partial_frame_count > 0 && (frame[0] != SBUS_START_SYMBOL)) {
sbus_frame_drops++;
partial_frame_count = 0;
continue;
}
/* /*
* If we don't have a full frame, return * If we don't have a full frame, return
*/ */