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

Cleaned up sbus output frame initialisation.

Browse Source
This commit is contained in:
Daniel Shiels 2014-11-10 16:34:28 +11:00
parent 34e9d9efce
commit 3eeec2cce0
1 changed files with 2 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/modules/px4iofirmware/sbus.c
View File

@ -84,7 +84,6 @@ static hrt_abstime last_frame_time;
static hrt_abstime last_txframe_time = 0;
static uint8_t frame[SBUS_FRAME_SIZE];
static uint8_t oframe[SBUS_FRAME_SIZE];
static unsigned partial_frame_count;
@ -128,17 +127,13 @@ sbus1_output(uint16_t *values, uint16_t num_values)
uint8_t byteindex = 1; /*Data starts one byte into the sbus frame. */
uint8_t offset = 0;
uint16_t value;
hrt_abstime now;
oframe[0] = 0x0f;
hrt_abstime now;
now = hrt_absolute_time();
if ((now - last_txframe_time) > SBUS1_FRAME_DELAY) {
last_txframe_time = now;
for (uint16_t i = 1; i < SBUS_FRAME_SIZE; ++i) {
oframe[i] = 0;
}
uint8_t oframe[SBUS_FRAME_SIZE] = { 0x0f };
/* 16 is sbus number of servos/channels minus 2 single bit channels.
* currently ignoring single bit channels. */