diff --git a/src/drivers/boards/px4fmu-v1/board_config.h b/src/drivers/boards/px4fmu-v1/board_config.h index 6448308eb7..28f950d748 100644 --- a/src/drivers/boards/px4fmu-v1/board_config.h +++ b/src/drivers/boards/px4fmu-v1/board_config.h @@ -126,6 +126,12 @@ #define ADC_BATTERY_CURRENT_CHANNEL ((uint8_t)(-1)) #define ADC_AIRSPEED_VOLTAGE_CHANNEL 11 +/* Define Battery 1 Voltage Divider and A per V + */ + +#define BOARD_BATTERY1_V_DIV (5.7013919372f) +#define BOARD_BATTERY1_A_PER_V (15.391030303f) + /* User GPIOs * * GPIO0-1 are the buffered high-power GPIOs. diff --git a/src/modules/sensors/parameters.cpp b/src/modules/sensors/parameters.cpp index 6045d045eb..1a4a358e1d 100644 --- a/src/modules/sensors/parameters.cpp +++ b/src/modules/sensors/parameters.cpp @@ -418,10 +418,6 @@ int update_parameters(const ParameterHandles ¶meter_handles, Parameters &par /* apply scaling according to defaults if set to default */ parameters.battery_v_div = BOARD_BATTERY1_V_DIV; - -#if defined (CONFIG_ARCH_BOARD_PX4FMU_V1) - parameters.battery_v_div = 5.7013919372f; -#endif param_set(parameter_handles.battery_v_div, ¶meters.battery_v_div); } @@ -433,11 +429,6 @@ int update_parameters(const ParameterHandles ¶meter_handles, Parameters &par /* apply scaling according to defaults if set to default */ parameters.battery_a_per_v = BOARD_BATTERY1_A_PER_V; - -#if defined (CONFIG_ARCH_BOARD_PX4FMU_V1) - /* current scaling for 3DR power brick */ - parameters.battery_a_per_v = 15.391030303f; -#endif param_set(parameter_handles.battery_a_per_v, ¶meters.battery_a_per_v); }