diff --git a/sw/airborne/main_fbw.c b/sw/airborne/main_fbw.c index edc8b9048f..2c6f99b9b4 100644 --- a/sw/airborne/main_fbw.c +++ b/sw/airborne/main_fbw.c @@ -133,10 +133,6 @@ void event_task_fbw( void) { } #endif -#ifdef ADC - fbw_vsupply_decivolt = VoltageOfAdc(vsupply_adc_buf.sum/vsupply_adc_buf.av_nb_sample) * 10; -#endif - #ifdef INTER_MCU #ifdef MCU_SPI_LINK if (spi_message_received) { @@ -193,14 +189,21 @@ void periodic_task_fbw( void ) { set_failsafe_mode(); #endif -#ifdef DOWNLINK static uint8_t _10Hz; /* FIXME : sys_time should provide it */ _10Hz++; if (_10Hz >= 6) _10Hz = 0; + +#ifdef DOWNLINK if (!_10Hz) fbw_downlink_periodic_task(); #endif +#ifdef ADC + if (!_10Hz) + fbw_vsupply_decivolt = VoltageOfAdc((10*(vsupply_adc_buf.sum/vsupply_adc_buf.av_nb_sample))); +#endif + + #ifdef ACTUATORS #ifdef CTL_GRZ ctl_grz_rate_run();