diff --git a/boards/px4/fmu-v6x/init/rc.board_defaults b/boards/px4/fmu-v6x/init/rc.board_defaults index 9c542a77300..872cbc4a88f 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 92c09372e0e..604fd2ed91f 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