From eb560e8a0fc314fa116ce69f294867a2c3730a27 Mon Sep 17 00:00:00 2001 From: David Sidrane Date: Tue, 19 Nov 2019 12:37:43 -0800 Subject: [PATCH] fmu-v5x:Properly reset SPI --- boards/px4/fmu-v5x/src/init.c | 5 +---- boards/px4/fmu-v5x/src/spi.cpp | 2 +- 2 files changed, 2 insertions(+), 5 deletions(-) diff --git a/boards/px4/fmu-v5x/src/init.c b/boards/px4/fmu-v5x/src/init.c index 9b300df7c5..fbcab6091b 100644 --- a/boards/px4/fmu-v5x/src/init.c +++ b/boards/px4/fmu-v5x/src/init.c @@ -220,10 +220,7 @@ __EXPORT int board_app_initialize(uintptr_t arg) VDD_3V3_SD_CARD_EN(true); VDD_5V_PERIPH_EN(true); VDD_5V_HIPOWER_EN(true); - VDD_3V3_SENSORS1_EN(true); - VDD_3V3_SENSORS2_EN(true); - VDD_3V3_SENSORS3_EN(true); - VDD_3V3_SENSORS4_EN(true); + board_spi_reset(0xff00000A); VDD_3V3_SPEKTRUM_POWER_EN(true); /* Need hrt running before using the ADC */ diff --git a/boards/px4/fmu-v5x/src/spi.cpp b/boards/px4/fmu-v5x/src/spi.cpp index a8a2503e22..08d39b0262 100644 --- a/boards/px4/fmu-v5x/src/spi.cpp +++ b/boards/px4/fmu-v5x/src/spi.cpp @@ -306,7 +306,7 @@ __EXPORT uint8_t stm32_spi6status(FAR struct spi_dev_s *dev, uint32_t devid) __EXPORT void board_spi_reset(int mask_ms) { int ms = mask_ms & 0x00ffffff; - int mask = ((mask_ms & 0xff000000) >> 24) ^ 0xff; + int mask = ((mask_ms & 0xff000000) >> 24) & 0xff; // disable SPI bus