diff --git a/boards/cuav/7-nano/default.px4board b/boards/cuav/7-nano/default.px4board index eb1dc29bc37..5337f54d90a 100644 --- a/boards/cuav/7-nano/default.px4board +++ b/boards/cuav/7-nano/default.px4board @@ -20,6 +20,7 @@ CONFIG_DRIVERS_GPS=y CONFIG_DRIVERS_IMU_BOSCH_BMI088=y CONFIG_DRIVERS_IMU_INVENSENSE_ICM20948=y CONFIG_DRIVERS_IMU_INVENSENSE_IIM42652=y +CONFIG_DRIVERS_IMU_INVENSENSE_IIM42653=y CONFIG_COMMON_INS=y CONFIG_COMMON_LIGHT=y CONFIG_COMMON_MAGNETOMETER=y @@ -42,8 +43,8 @@ CONFIG_MODULES_EVENTS=y CONFIG_MODULES_FLIGHT_MODE_MANAGER=y CONFIG_MODULES_FW_ATT_CONTROL=y CONFIG_MODULES_FW_AUTOTUNE_ATTITUDE_CONTROL=y -CONFIG_MODULES_FW_MODE_MANAGER=y CONFIG_MODULES_FW_LATERAL_LONGITUDINAL_CONTROL=y +CONFIG_MODULES_FW_MODE_MANAGER=y CONFIG_MODULES_FW_RATE_CONTROL=y CONFIG_MODULES_GIMBAL=y CONFIG_MODULES_GYRO_CALIBRATION=y diff --git a/boards/cuav/7-nano/init/rc.board_sensors b/boards/cuav/7-nano/init/rc.board_sensors index 82a764962de..343a9a4e8b4 100644 --- a/boards/cuav/7-nano/init/rc.board_sensors +++ b/boards/cuav/7-nano/init/rc.board_sensors @@ -12,10 +12,17 @@ else fi iim42652 -s -R 22 start -bmi088 -A -R 29 -s start -bmi088 -G -R 29 -s start -ist8310 -I -R 18 start +bmi088 -A -R 29 -s start +if ! bmi088 -G -R 29 -s start +then + iim42653 -s -b 2 -R 22 start +fi + +if ! ist8310 -I -R 18 start +then + iis2mdc -I -R 37 start +fi bmp581 -s start icp201xx -I start diff --git a/boards/cuav/7-nano/src/spi.cpp b/boards/cuav/7-nano/src/spi.cpp index f55a89563ca..05eb3697c6f 100644 --- a/boards/cuav/7-nano/src/spi.cpp +++ b/boards/cuav/7-nano/src/spi.cpp @@ -42,6 +42,7 @@ constexpr px4_spi_bus_t px4_spi_buses[SPI_BUS_MAX_BUS_ITEMS] = { initSPIBus(SPI::Bus::SPI2, { initSPIDevice(DRV_GYR_DEVTYPE_BMI088, SPI::CS{GPIO::PortG, GPIO::Pin2}, SPI::DRDY{GPIO::PortG, GPIO::Pin3}), initSPIDevice(DRV_ACC_DEVTYPE_BMI088, SPI::CS{GPIO::PortH, GPIO::Pin5}, SPI::DRDY{GPIO::PortA, GPIO::Pin10}), + initSPIDevice(DRV_IMU_DEVTYPE_IIM42653, SPI::CS{GPIO::PortD, GPIO::Pin12}, SPI::DRDY{GPIO::PortA, GPIO::Pin10}), }, {GPIO::PortI, GPIO::Pin11}), // initSPIBus(SPI::Bus::SPI3,{ // // no devices