diff --git a/sw/airborne/fms/fms_autopilot_msg.h b/sw/airborne/fms/fms_autopilot_msg.h index 34dec8e35d..f3fae20350 100644 --- a/sw/airborne/fms/fms_autopilot_msg.h +++ b/sw/airborne/fms/fms_autopilot_msg.h @@ -85,6 +85,8 @@ struct __attribute__ ((packed)) AutopilotMessagePTUp int16_t rc_aux4; uint8_t rc_status; struct PTUpValidFlags valid; + uint32_t stm_msg_cnt; + uint32_t stm_crc_err_cnt; }; struct __attribute__ ((packed)) AutopilotMessagePTDown diff --git a/sw/airborne/lisa/lisa_stm_passthrough_main.c b/sw/airborne/lisa/lisa_stm_passthrough_main.c index a8fc437364..9586dd353f 100644 --- a/sw/airborne/lisa/lisa_stm_passthrough_main.c +++ b/sw/airborne/lisa/lisa_stm_passthrough_main.c @@ -119,6 +119,9 @@ static inline void on_overo_link_msg_received(void) { overo_link.up.msg.rc_aux4 = radio_control.values[RADIO_CONTROL_AUX4]; overo_link.up.msg.rc_status = radio_control.status; + overo_link.up.msg.stm_msg_cnt = overo_link.msg_cnt; + overo_link.up.msg.stm_crc_err_cnt = overo_link.crc_err_cnt; + for (int i = 0; i < LISA_PWM_OUTPUT_NB; i++) booz_actuators_pwm_values[i] = overo_link.down.msg.pwm_outputs_usecs[i]; booz_actuators_pwm_commit();