diff --git a/src/drivers/ms5611/ms5611_spi.cpp b/src/drivers/ms5611/ms5611_spi.cpp index 1ca0d9cec4..6d10d91ef8 100644 --- a/src/drivers/ms5611/ms5611_spi.cpp +++ b/src/drivers/ms5611/ms5611_spi.cpp @@ -143,11 +143,6 @@ MS5611_SPI::~MS5611_SPI() int MS5611_SPI::init() { - // Sharing a bus with NuttX drivers -#if defined (CONFIG_ARCH_BOARD_PX4FMU_V4) - //set_lockmode(SPI::LOCK_THREADS); -#endif - int ret; ret = SPI::init(); @@ -157,6 +152,11 @@ MS5611_SPI::init() goto out; } + /* sharing a bus with NuttX drivers */ +#if defined (CONFIG_ARCH_BOARD_PX4FMU_V4) + //set_lockmode(SPI::LOCK_THREADS); +#endif + /* send reset command */ ret = _reset();