From b90e8a71f03764ec6dc9a7d930535d6a67015520 Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Tue, 17 Nov 2015 09:28:18 +0100 Subject: [PATCH] FMU: Fix sensor reset command, by Dmitry Prokhorov --- src/drivers/px4fmu/fmu.cpp | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/src/drivers/px4fmu/fmu.cpp b/src/drivers/px4fmu/fmu.cpp index 4d82ef9e08e..64d9dced4a0 100644 --- a/src/drivers/px4fmu/fmu.cpp +++ b/src/drivers/px4fmu/fmu.cpp @@ -1469,6 +1469,10 @@ PX4FMU::sensor_reset(int ms) stm32_gpiowrite(GPIO_SPI_CS_BARO, 1); stm32_gpiowrite(GPIO_SPI_CS_MPU, 1); + stm32_configgpio(GPIO_SPI1_SCK); + stm32_configgpio(GPIO_SPI1_MISO); + stm32_configgpio(GPIO_SPI1_MOSI); + // // XXX bring up the EXTI pins again // stm32_configgpio(GPIO_GYRO_DRDY); // stm32_configgpio(GPIO_MAG_DRDY);