Browse Source

FMUV4 Moved magic numbers for battery V div and A per V to board_config.h

sbg
David Sidrane 8 years ago committed by Lorenz Meier
parent
commit
0baefec09f
  1. 7
      src/drivers/boards/px4fmu-v4/board_config.h
  2. 10
      src/modules/sensors/parameters.cpp

7
src/drivers/boards/px4fmu-v4/board_config.h

@ -166,6 +166,13 @@ @@ -166,6 +166,13 @@
#define ADC_5V_RAIL_SENSE 4
#define ADC_RC_RSSI_CHANNEL 11
/* Define Battery 1 Voltage Divider and A per V
*/
#define BOARD_BATTERY1_V_DIV (13.653333333f)
#define BOARD_BATTERY1_A_PER_V (36.367515152f)
/* User GPIOs
*
* GPIO0-5 are the PWM servo outputs.

10
src/modules/sensors/parameters.cpp

@ -419,9 +419,7 @@ int update_parameters(const ParameterHandles &parameter_handles, Parameters &par @@ -419,9 +419,7 @@ int update_parameters(const ParameterHandles &parameter_handles, Parameters &par
parameters.battery_v_div = BOARD_BATTERY1_V_DIV;
#if defined (CONFIG_ARCH_BOARD_PX4FMU_V4)
parameters.battery_v_div = 13.653333333f;
#elif defined (CONFIG_ARCH_BOARD_PX4FMU_V2) || defined ( CONFIG_ARCH_BOARD_MINDPX_V2 )
#if defined (CONFIG_ARCH_BOARD_PX4FMU_V2) || defined ( CONFIG_ARCH_BOARD_MINDPX_V2 )
parameters.battery_v_div = 10.177939394f;
#elif defined (CONFIG_ARCH_BOARD_AEROCORE)
parameters.battery_v_div = 7.8196363636f;
@ -440,11 +438,7 @@ int update_parameters(const ParameterHandles &parameter_handles, Parameters &par @@ -440,11 +438,7 @@ int update_parameters(const ParameterHandles &parameter_handles, Parameters &par
parameters.battery_a_per_v = BOARD_BATTERY1_A_PER_V;
#if defined (CONFIG_ARCH_BOARD_PX4FMU_V4)
/* current scaling for ACSP4 */
parameters.battery_a_per_v = 36.367515152f;
#elif defined (CONFIG_ARCH_BOARD_PX4FMU_V2) || defined (CONFIG_ARCH_BOARD_MINDPX_V2) || defined (CONFIG_ARCH_BOARD_AEROCORE) || defined (CONFIG_ARCH_BOARD_PX4FMU_V1)
#if defined (CONFIG_ARCH_BOARD_PX4FMU_V2) || defined (CONFIG_ARCH_BOARD_MINDPX_V2) || defined (CONFIG_ARCH_BOARD_AEROCORE) || defined (CONFIG_ARCH_BOARD_PX4FMU_V1)
/* current scaling for 3DR power brick */
parameters.battery_a_per_v = 15.391030303f;
#endif

Loading…
Cancel
Save