diff options
author | Don Gagne <don@thegagnes.com> | 2014-11-16 14:12:58 -0800 |
---|---|---|
committer | Don Gagne <don@thegagnes.com> | 2014-11-16 14:12:58 -0800 |
commit | 852fa611730be2433156b010c6162606ec857ef3 (patch) | |
tree | cbe285220485f9ef5acf4e545b35771450ad6488 /src/modules | |
parent | d907b030ee618b581e31964a34a61648e88793a3 (diff) | |
download | px4-firmware-852fa611730be2433156b010c6162606ec857ef3.tar.gz px4-firmware-852fa611730be2433156b010c6162606ec857ef3.tar.bz2 px4-firmware-852fa611730be2433156b010c6162606ec857ef3.zip |
Correct setting of DSM and ST24 flags
Diffstat (limited to 'src/modules')
-rw-r--r-- | src/modules/px4iofirmware/controls.c | 7 |
1 files changed, 6 insertions, 1 deletions
diff --git a/src/modules/px4iofirmware/controls.c b/src/modules/px4iofirmware/controls.c index 3fd73fc60..75d80ba5d 100644 --- a/src/modules/px4iofirmware/controls.c +++ b/src/modules/px4iofirmware/controls.c @@ -71,7 +71,6 @@ bool dsm_port_input(uint16_t *rssi, bool *dsm_updated, bool *st24_updated) uint8_t *bytes; *dsm_updated = dsm_input(r_raw_rc_values, &temp_count, &n_bytes, &bytes); if (*dsm_updated) { - r_raw_rc_flags |= PX4IO_P_STATUS_FLAGS_RC_DSM; r_raw_rc_count = temp_count & 0x7fff; if (temp_count & 0x8000) r_raw_rc_flags |= PX4IO_P_RAW_RC_FLAGS_RC_DSM11; @@ -172,6 +171,12 @@ controls_tick() { perf_begin(c_gather_dsm); bool dsm_updated, st24_updated; (void)dsm_port_input(&rssi, &dsm_updated, &st24_updated); + if (dsm_updated) { + r_status_flags |= PX4IO_P_STATUS_FLAGS_RC_DSM; + } + if (st24_updated) { + r_status_flags |= PX4IO_P_STATUS_FLAGS_RC_ST24; + } perf_end(c_gather_dsm); perf_begin(c_gather_sbus); |