|
|
|
@ -73,15 +73,16 @@ static unsigned _rssi_adc_counts = 0;
@@ -73,15 +73,16 @@ static unsigned _rssi_adc_counts = 0;
|
|
|
|
|
|
|
|
|
|
bool dsm_port_input(uint16_t *rssi, bool *dsm_updated, bool *st24_updated, bool *sumd_updated) |
|
|
|
|
{ |
|
|
|
|
perf_begin(c_gather_dsm); |
|
|
|
|
perf_begin(c_gather_dsm); |
|
|
|
|
uint8_t n_bytes = 0; |
|
|
|
|
uint8_t *bytes; |
|
|
|
|
bool dsm_11_bit; |
|
|
|
|
*dsm_updated = dsm_input(_dsm_fd, r_raw_rc_values, &r_raw_rc_count, &dsm_11_bit, &n_bytes, &bytes, PX4IO_RC_INPUT_CHANNELS); |
|
|
|
|
bool dsm_11_bit; |
|
|
|
|
*dsm_updated = dsm_input(_dsm_fd, r_raw_rc_values, &r_raw_rc_count, &dsm_11_bit, &n_bytes, &bytes, |
|
|
|
|
PX4IO_RC_INPUT_CHANNELS); |
|
|
|
|
|
|
|
|
|
if (*dsm_updated) { |
|
|
|
|
if (*dsm_updated) { |
|
|
|
|
|
|
|
|
|
if (dsm_11_bit) { |
|
|
|
|
if (dsm_11_bit) { |
|
|
|
|
r_raw_rc_flags |= PX4IO_P_RAW_RC_FLAGS_RC_DSM11; |
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|