From 1339dd3681ddd144caad67e5b7b544d4f29e9061 Mon Sep 17 00:00:00 2001 From: David Sidrane Date: Fri, 20 Aug 2021 12:36:06 -0700 Subject: [PATCH] px4_fmuv6x:Use parameter setting for ina22x --- boards/px4/fmu-v6x/init/rc.board_defaults | 5 ++++- boards/px4/fmu-v6x/init/rc.board_sensors | 16 +++++++++++++--- 2 files changed, 17 insertions(+), 4 deletions(-) diff --git a/boards/px4/fmu-v6x/init/rc.board_defaults b/boards/px4/fmu-v6x/init/rc.board_defaults index 9c542a7730..872cbc4a88 100644 --- a/boards/px4/fmu-v6x/init/rc.board_defaults +++ b/boards/px4/fmu-v6x/init/rc.board_defaults @@ -3,4 +3,7 @@ # board specific defaults #------------------------------------------------------------------------------ -safety_button start +param set-default SENS_EN_INA228 0 +param set-default SENS_EN_INA226 1 + +safety_button start \ No newline at end of file diff --git a/boards/px4/fmu-v6x/init/rc.board_sensors b/boards/px4/fmu-v6x/init/rc.board_sensors index 92c09372e0..604fd2ed91 100644 --- a/boards/px4/fmu-v6x/init/rc.board_sensors +++ b/boards/px4/fmu-v6x/init/rc.board_sensors @@ -4,9 +4,19 @@ #------------------------------------------------------------------------------ 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 # Internal SPI BMI088 bmi088 -A -R 4 -s start