From f2925d234e108e694c7956a85a76c918ee0944f3 Mon Sep 17 00:00:00 2001 From: David Sidrane Date: Fri, 20 Aug 2021 12:35:52 -0700 Subject: [PATCH] px4_fmuv5x:Use parameter setting for ina22x --- boards/px4/fmu-v5x/init/rc.board_defaults | 3 +++ boards/px4/fmu-v5x/init/rc.board_sensors | 17 ++++++++++++++--- 2 files changed, 17 insertions(+), 3 deletions(-) diff --git a/boards/px4/fmu-v5x/init/rc.board_defaults b/boards/px4/fmu-v5x/init/rc.board_defaults index 9c542a7730..d444aaf1d7 100644 --- a/boards/px4/fmu-v5x/init/rc.board_defaults +++ b/boards/px4/fmu-v5x/init/rc.board_defaults @@ -3,4 +3,7 @@ # board specific defaults #------------------------------------------------------------------------------ +param set-default SENS_EN_INA228 0 +param set-default SENS_EN_INA226 1 + safety_button start diff --git a/boards/px4/fmu-v5x/init/rc.board_sensors b/boards/px4/fmu-v5x/init/rc.board_sensors index 0294620ccd..237c778df8 100644 --- a/boards/px4/fmu-v5x/init/rc.board_sensors +++ b/boards/px4/fmu-v5x/init/rc.board_sensors @@ -4,9 +4,20 @@ #------------------------------------------------------------------------------ board_adc start -# Start Digital power monitors -ina226 -X -b 1 -t 1 -k start -ina226 -X -b 2 -t 2 -k start + +if param compare SENS_EN_INA226 1 +then + # Start Digital power monitors + ina226 -X -b 1 -t 1 -k start + ina226 -X -b 2 -t 2 -k start +fi + +if param compare SENS_EN_INA228 1 +then + # Start Digital power monitors + ina228 -X -b 1 -t 1 -k start + ina228 -X -b 2 -t 2 -k start +fi if ver hwtypecmp V5X90 V5X91 V5X92 V5Xa0 V5Xa1 V5Xa2 then