diff --git a/sw/airborne/booz/booz2_datalink.c b/sw/airborne/booz/booz2_datalink.c index 19a0c47634..87305e2e5c 100644 --- a/sw/airborne/booz/booz2_datalink.c +++ b/sw/airborne/booz/booz2_datalink.c @@ -53,6 +53,7 @@ void dl_parse_msg(void) { case DL_SETTING : { + if (DL_SETTING_ac_id(dl_buffer) != AC_ID) break; uint8_t i = DL_SETTING_index(dl_buffer); float var = DL_SETTING_value(dl_buffer); DlSetting(i, var); @@ -60,6 +61,15 @@ void dl_parse_msg(void) { } break; + case DL_GET_SETTING : + { + if (DL_GET_SETTING_ac_id(dl_buffer) != AC_ID) break; + uint8_t i = DL_GET_SETTING_index(dl_buffer); + float val = settings_get_value(i); + DOWNLINK_SEND_DL_VALUE(DefaultChannel, &i, &val); + } + break; + #if defined BOOZ2_FMS_TYPE && BOOZ2_FMS_TYPE == BOOZ2_FMS_TYPE_DATALINK case DL_BOOZ2_FMS_COMMAND : {