diff --git a/src/main/target/NAZE/hardware_revision.c b/src/main/target/NAZE/hardware_revision.c index bed18b72f1..94c6404cea 100644 --- a/src/main/target/NAZE/hardware_revision.c +++ b/src/main/target/NAZE/hardware_revision.c @@ -66,9 +66,8 @@ uint8_t detectSpiDevice(void) uint8_t in[4]; uint32_t flash_id; - delay(50); // short delay required after initialisation of SPI device instance. - // try autodetect flash chip + delay(50); // short delay required after initialisation of SPI device instance. ENABLE_SPI_CS; spiTransfer(NAZE_SPI_INSTANCE, in, out, sizeof(out)); DISABLE_SPI_CS; @@ -77,7 +76,9 @@ uint8_t detectSpiDevice(void) if (flash_id == FLASH_M25P16_ID) return SPI_DEVICE_FLASH; + // try autodetect MPU + delay(50); ENABLE_SPI_CS; spiTransferByte(NAZE_SPI_INSTANCE, MPU6500_RA_WHOAMI | MPU6500_BIT_RESET); in[0] = spiTransferByte(NAZE_SPI_INSTANCE, 0xff); diff --git a/src/main/target/NAZE/target.h b/src/main/target/NAZE/target.h index c19d4f2583..e080224e09 100644 --- a/src/main/target/NAZE/target.h +++ b/src/main/target/NAZE/target.h @@ -72,6 +72,8 @@ #define GYRO #define USE_GYRO_MPU3050 #define USE_GYRO_MPU6050 +#define USE_GYRO_SPI_MPU6500 + #define GYRO_MPU3050_ALIGN CW0_DEG #define GYRO_MPU6050_ALIGN CW0_DEG @@ -82,13 +84,13 @@ #define USE_ACC_BMA280 #define USE_ACC_MMA8452 #define USE_ACC_MPU6050 -//#define ACC_SPI_MPU6500 +#define USE_ACC_SPI_MPU6500 #define ACC_ADXL345_ALIGN CW270_DEG #define ACC_MPU6050_ALIGN CW0_DEG #define ACC_MMA8452_ALIGN CW90_DEG #define ACC_BMA280_ALIGN CW0_DEG -//#define ACC_SPI_MPU6500_ALIGN CW0_DEG +#define ACC_SPI_MPU6500_ALIGN CW0_DEG #define BARO #define USE_BARO_MS5611