|
|
|
@ -74,13 +74,14 @@ void AP_RCProtocol::process_pulse(uint32_t width_s0, uint32_t width_s1)
@@ -74,13 +74,14 @@ void AP_RCProtocol::process_pulse(uint32_t width_s0, uint32_t width_s1)
|
|
|
|
|
} |
|
|
|
|
if (backend[i] != nullptr) { |
|
|
|
|
uint32_t frame_count = backend[i]->get_rc_frame_count(); |
|
|
|
|
uint32_t input_count = backend[i]->get_rc_input_count(); |
|
|
|
|
backend[i]->process_pulse(width_s0, width_s1); |
|
|
|
|
if (frame_count != backend[i]->get_rc_frame_count()) { |
|
|
|
|
_good_frames[i]++; |
|
|
|
|
if (requires_3_frames((rcprotocol_t)i) && _good_frames[i] < 3) { |
|
|
|
|
continue; |
|
|
|
|
} |
|
|
|
|
_new_input = true; |
|
|
|
|
_new_input = (input_count != backend[i]->get_rc_input_count()); |
|
|
|
|
_detected_protocol = (enum AP_RCProtocol::rcprotocol_t)i; |
|
|
|
|
memset(_good_frames, 0, sizeof(_good_frames)); |
|
|
|
|
_last_input_ms = now; |
|
|
|
@ -136,13 +137,14 @@ void AP_RCProtocol::process_byte(uint8_t byte, uint32_t baudrate)
@@ -136,13 +137,14 @@ void AP_RCProtocol::process_byte(uint8_t byte, uint32_t baudrate)
|
|
|
|
|
for (uint8_t i = 0; i < AP_RCProtocol::NONE; i++) { |
|
|
|
|
if (backend[i] != nullptr) { |
|
|
|
|
uint32_t frame_count = backend[i]->get_rc_frame_count(); |
|
|
|
|
uint32_t input_count = backend[i]->get_rc_input_count(); |
|
|
|
|
backend[i]->process_byte(byte, baudrate); |
|
|
|
|
if (frame_count != backend[i]->get_rc_frame_count()) { |
|
|
|
|
_good_frames[i]++; |
|
|
|
|
if (requires_3_frames((rcprotocol_t)i) && _good_frames[i] < 3) { |
|
|
|
|
continue; |
|
|
|
|
} |
|
|
|
|
_new_input = true; |
|
|
|
|
_new_input = (input_count != backend[i]->get_rc_input_count()); |
|
|
|
|
_detected_protocol = (enum AP_RCProtocol::rcprotocol_t)i; |
|
|
|
|
memset(_good_frames, 0, sizeof(_good_frames)); |
|
|
|
|
_last_input_ms = now; |
|
|
|
|