1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-13 19:40:31 +03:00

Configurable acc/gyro

This commit is contained in:
jflyper 2018-05-10 22:25:37 +09:00
parent 5ef68ef6a3
commit fc6c24c38e
133 changed files with 1095 additions and 1116 deletions

View file

@ -35,10 +35,6 @@
#pragma GCC diagnostic warning "-Wpadded" #pragma GCC diagnostic warning "-Wpadded"
#endif #endif
#ifndef MPU_I2C_INSTANCE
#define MPU_I2C_INSTANCE I2C_DEVICE
#endif
typedef enum { typedef enum {
GYRO_NONE = 0, GYRO_NONE = 0,
GYRO_DEFAULT, GYRO_DEFAULT,

View file

@ -54,9 +54,8 @@
#include "drivers/accgyro/accgyro_spi_mpu9250.h" #include "drivers/accgyro/accgyro_spi_mpu9250.h"
#include "drivers/accgyro/accgyro_mpu.h" #include "drivers/accgyro/accgyro_mpu.h"
#ifndef MPU_I2C_INSTANCE #include "pg/pg.h"
#define MPU_I2C_INSTANCE I2C_DEVICE #include "pg/gyrodev.h"
#endif
#ifndef MPU_ADDRESS #ifndef MPU_ADDRESS
#define MPU_ADDRESS 0x68 #define MPU_ADDRESS 0x68
@ -64,7 +63,7 @@
#define MPU_INQUIRY_MASK 0x7E #define MPU_INQUIRY_MASK 0x7E
#ifdef USE_I2C #ifdef USE_I2C_GYRO
static void mpu6050FindRevision(gyroDev_t *gyro) static void mpu6050FindRevision(gyroDev_t *gyro)
{ {
// There is a map of revision contained in the android source tree which is quite comprehensive and may help to understand this code // There is a map of revision contained in the android source tree which is quite comprehensive and may help to understand this code
@ -103,7 +102,7 @@ static void mpu6050FindRevision(gyroDev_t *gyro)
/* /*
* Gyro interrupt service routine * Gyro interrupt service routine
*/ */
#if defined(MPU_INT_EXTI) #ifdef USE_GYRO_EXTI
static void mpuIntExtiHandler(extiCallbackRec_t *cb) static void mpuIntExtiHandler(extiCallbackRec_t *cb)
{ {
#ifdef DEBUG_MPU_DATA_READY_INTERRUPT #ifdef DEBUG_MPU_DATA_READY_INTERRUPT
@ -136,11 +135,11 @@ static void mpuIntExtiInit(gyroDev_t *gyro)
#endif #endif
#if defined (STM32F7) #if defined (STM32F7)
IOInit(mpuIntIO, OWNER_MPU_EXTI, 0); IOInit(mpuIntIO, OWNER_GYRO_EXTI, 0);
EXTIHandlerInit(&gyro->exti, mpuIntExtiHandler); EXTIHandlerInit(&gyro->exti, mpuIntExtiHandler);
EXTIConfig(mpuIntIO, &gyro->exti, NVIC_PRIO_MPU_INT_EXTI, IO_CONFIG(GPIO_MODE_INPUT,0,GPIO_NOPULL)); // TODO - maybe pullup / pulldown ? EXTIConfig(mpuIntIO, &gyro->exti, NVIC_PRIO_MPU_INT_EXTI, IO_CONFIG(GPIO_MODE_INPUT,0,GPIO_NOPULL)); // TODO - maybe pullup / pulldown ?
#else #else
IOInit(mpuIntIO, OWNER_MPU_EXTI, 0); IOInit(mpuIntIO, OWNER_GYRO_EXTI, 0);
IOConfigGPIO(mpuIntIO, IOCFG_IN_FLOATING); // TODO - maybe pullup / pulldown ? IOConfigGPIO(mpuIntIO, IOCFG_IN_FLOATING); // TODO - maybe pullup / pulldown ?
EXTIHandlerInit(&gyro->exti, mpuIntExtiHandler); EXTIHandlerInit(&gyro->exti, mpuIntExtiHandler);
@ -182,6 +181,7 @@ bool mpuGyroRead(gyroDev_t *gyro)
return true; return true;
} }
#ifdef USE_SPI_GYRO
bool mpuGyroReadSPI(gyroDev_t *gyro) bool mpuGyroReadSPI(gyroDev_t *gyro)
{ {
static const uint8_t dataToSend[7] = {MPU_RA_GYRO_XOUT_H | 0x80, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF}; static const uint8_t dataToSend[7] = {MPU_RA_GYRO_XOUT_H | 0x80, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
@ -199,120 +199,78 @@ bool mpuGyroReadSPI(gyroDev_t *gyro)
return true; return true;
} }
#ifdef USE_SPI typedef uint8_t (*gyroSpiDetectFn_t)(const busDevice_t *bus);
static bool detectSPISensorsAndUpdateDetectionResult(gyroDev_t *gyro)
static gyroSpiDetectFn_t gyroSpiDetectFnTable[] = {
#ifdef USE_GYRO_SPI_MPU6000
mpu6000SpiDetect,
#endif
#ifdef USE_GYRO_SPI_MPU6500
mpu6500SpiDetect, // some targets using MPU_9250_SPI, ICM_20608_SPI or ICM_20602_SPI state sensor is MPU_65xx_SPI
#endif
#ifdef USE_GYRO_SPI_MPU9250
mpu9250SpiDetect,
#endif
#ifdef USE_GYRO_SPI_ICM20649
icm20649SpiDetect,
#endif
#ifdef USE_GYRO_SPI_ICM20689
icm20689SpiDetect, // icm20689SpiDetect detects ICM20602 and ICM20689
#endif
#ifdef USE_ACCGYRO_BMI160
bmi160Detect,
#endif
NULL // Avoid an empty array
};
static bool detectSPISensorsAndUpdateDetectionResult(gyroDev_t *gyro, const gyroDeviceConfig_t *config)
{ {
UNUSED(gyro); // since there are FCs which have gyro on I2C but other devices on SPI gyro->bus.bustype = BUSTYPE_SPI;
spiBusSetInstance(&gyro->bus, spiInstanceByDevice(SPI_CFG_TO_DEV(config->spiBus)));
gyro->bus.busdev_u.spi.csnPin = IOGetByTag(config->csnTag);
IOInit(gyro->bus.busdev_u.spi.csnPin, OWNER_GYRO_CS, RESOURCE_INDEX(config->index));
IOConfigGPIO(gyro->bus.busdev_u.spi.csnPin, SPI_IO_CS_CFG);
IOHi(gyro->bus.busdev_u.spi.csnPin); // Ensure device is disabled, important when two devices are on the same bus.
uint8_t sensor = MPU_NONE; uint8_t sensor = MPU_NONE;
UNUSED(sensor);
// note, when USE_DUAL_GYRO is enabled the gyro->bus must already be initialised. // It is hard to use hardware to optimize the detection loop here,
// as hardware type and detection function name doesn't match.
// May need a bitmap of hardware to detection function to do it right?
#ifdef USE_GYRO_SPI_MPU6000 for (size_t index = 0 ; gyroSpiDetectFnTable[index] ; index++) {
#ifndef USE_DUAL_GYRO sensor = (gyroSpiDetectFnTable[index])(&gyro->bus);
spiBusSetInstance(&gyro->bus, MPU6000_SPI_INSTANCE);
#endif
#ifdef MPU6000_CS_PIN
gyro->bus.busdev_u.spi.csnPin = gyro->bus.busdev_u.spi.csnPin == IO_NONE ? IOGetByTag(IO_TAG(MPU6000_CS_PIN)) : gyro->bus.busdev_u.spi.csnPin;
#endif
sensor = mpu6000SpiDetect(&gyro->bus);
if (sensor != MPU_NONE) { if (sensor != MPU_NONE) {
gyro->mpuDetectionResult.sensor = sensor; gyro->mpuDetectionResult.sensor = sensor;
return true; return true;
} }
#endif
#ifdef USE_GYRO_SPI_MPU6500
#ifndef USE_DUAL_GYRO
spiBusSetInstance(&gyro->bus, MPU6500_SPI_INSTANCE);
#endif
#ifdef MPU6500_CS_PIN
gyro->bus.busdev_u.spi.csnPin = gyro->bus.busdev_u.spi.csnPin == IO_NONE ? IOGetByTag(IO_TAG(MPU6500_CS_PIN)) : gyro->bus.busdev_u.spi.csnPin;
#endif
sensor = mpu6500SpiDetect(&gyro->bus);
// some targets using MPU_9250_SPI, ICM_20608_SPI or ICM_20602_SPI state sensor is MPU_65xx_SPI
if (sensor != MPU_NONE) {
gyro->mpuDetectionResult.sensor = sensor;
return true;
} }
#endif
#ifdef USE_GYRO_SPI_MPU9250 spiPreinitCsByTag(config->csnTag);
#ifndef USE_DUAL_GYRO
spiBusSetInstance(&gyro->bus, MPU9250_SPI_INSTANCE);
#endif
#ifdef MPU9250_CS_PIN
gyro->bus.busdev_u.spi.csnPin = gyro->bus.busdev_u.spi.csnPin == IO_NONE ? IOGetByTag(IO_TAG(MPU9250_CS_PIN)) : gyro->bus.busdev_u.spi.csnPin;
#endif
sensor = mpu9250SpiDetect(&gyro->bus);
if (sensor != MPU_NONE) {
gyro->mpuDetectionResult.sensor = sensor;
return true;
}
#endif
#ifdef USE_GYRO_SPI_ICM20649
#ifdef ICM20649_SPI_INSTANCE
spiBusSetInstance(&gyro->bus, ICM20649_SPI_INSTANCE);
#endif
#ifdef ICM20649_CS_PIN
gyro->bus.busdev_u.spi.csnPin = gyro->bus.busdev_u.spi.csnPin == IO_NONE ? IOGetByTag(IO_TAG(ICM20649_CS_PIN)) : gyro->bus.busdev_u.spi.csnPin;
#endif
sensor = icm20649SpiDetect(&gyro->bus);
if (sensor != MPU_NONE) {
gyro->mpuDetectionResult.sensor = sensor;
return true;
}
#endif
#ifdef USE_GYRO_SPI_ICM20689
#ifndef USE_DUAL_GYRO
spiBusSetInstance(&gyro->bus, ICM20689_SPI_INSTANCE);
#endif
#ifdef ICM20689_CS_PIN
gyro->bus.busdev_u.spi.csnPin = gyro->bus.busdev_u.spi.csnPin == IO_NONE ? IOGetByTag(IO_TAG(ICM20689_CS_PIN)) : gyro->bus.busdev_u.spi.csnPin;
#endif
sensor = icm20689SpiDetect(&gyro->bus);
// icm20689SpiDetect detects ICM20602 and ICM20689
if (sensor != MPU_NONE) {
gyro->mpuDetectionResult.sensor = sensor;
return true;
}
#endif
#ifdef USE_ACCGYRO_BMI160
#ifndef USE_DUAL_GYRO
spiBusSetInstance(&gyro->bus, BMI160_SPI_INSTANCE);
#endif
#ifdef BMI160_CS_PIN
gyro->bus.busdev_u.spi.csnPin = gyro->bus.busdev_u.spi.csnPin == IO_NONE ? IOGetByTag(IO_TAG(BMI160_CS_PIN)) : gyro->bus.busdev_u.spi.csnPin;
#endif
sensor = bmi160Detect(&gyro->bus);
if (sensor != MPU_NONE) {
gyro->mpuDetectionResult.sensor = sensor;
return true;
}
#endif
return false; return false;
} }
#endif #endif
void mpuDetect(gyroDev_t *gyro) void mpuDetect(gyroDev_t *gyro, const gyroDeviceConfig_t *config)
{ {
// MPU datasheet specifies 30ms. // MPU datasheet specifies 30ms.
delay(35); delay(35);
#ifdef USE_I2C if (config->bustype == BUSTYPE_NONE) {
if (gyro->bus.bustype == BUSTYPE_NONE) { return;
// if no bustype is selected try I2C first.
gyro->bus.bustype = BUSTYPE_I2C;
} }
if (config->bustype == BUSTYPE_GYRO_AUTO) {
gyro->bus.bustype = BUSTYPE_I2C;
} else {
gyro->bus.bustype = config->bustype;
}
#ifdef USE_I2C_GYRO
if (gyro->bus.bustype == BUSTYPE_I2C) { if (gyro->bus.bustype == BUSTYPE_I2C) {
gyro->bus.busdev_u.i2c.device = MPU_I2C_INSTANCE; gyro->bus.busdev_u.i2c.address = config->i2cAddress ? config->i2cAddress : MPU_ADDRESS;
gyro->bus.busdev_u.i2c.address = MPU_ADDRESS;
uint8_t sig = 0; uint8_t sig = 0;
bool ack = busReadRegisterBuffer(&gyro->bus, MPU_RA_WHO_AM_I, &sig, 1); bool ack = busReadRegisterBuffer(&gyro->bus, MPU_RA_WHO_AM_I, &sig, 1);
@ -339,15 +297,15 @@ void mpuDetect(gyroDev_t *gyro)
} }
#endif #endif
#ifdef USE_SPI #ifdef USE_SPI_GYRO
gyro->bus.bustype = BUSTYPE_SPI; gyro->bus.bustype = BUSTYPE_SPI;
detectSPISensorsAndUpdateDetectionResult(gyro); detectSPISensorsAndUpdateDetectionResult(gyro, config);
#endif #endif
} }
void mpuGyroInit(gyroDev_t *gyro) void mpuGyroInit(gyroDev_t *gyro)
{ {
#ifdef MPU_INT_EXTI #ifdef USE_GYRO_EXTI
mpuIntExtiInit(gyro); mpuIntExtiInit(gyro);
#else #else
UNUSED(gyro); UNUSED(gyro);

View file

@ -218,10 +218,11 @@ typedef struct mpuDetectionResult_s {
} mpuDetectionResult_t; } mpuDetectionResult_t;
struct gyroDev_s; struct gyroDev_s;
struct gyroDeviceConfig_s;
void mpuGyroInit(struct gyroDev_s *gyro); void mpuGyroInit(struct gyroDev_s *gyro);
bool mpuGyroRead(struct gyroDev_s *gyro); bool mpuGyroRead(struct gyroDev_s *gyro);
bool mpuGyroReadSPI(struct gyroDev_s *gyro); bool mpuGyroReadSPI(struct gyroDev_s *gyro);
void mpuDetect(struct gyroDev_s *gyro); void mpuDetect(struct gyroDev_s *gyro, const struct gyroDeviceConfig_s *config);
uint8_t mpuGyroDLPF(struct gyroDev_s *gyro); uint8_t mpuGyroDLPF(struct gyroDev_s *gyro);
uint8_t mpuGyroFCHOICE(struct gyroDev_s *gyro); uint8_t mpuGyroFCHOICE(struct gyroDev_s *gyro);
uint8_t mpuGyroReadRegister(const busDevice_t *bus, uint8_t reg); uint8_t mpuGyroReadRegister(const busDevice_t *bus, uint8_t reg);

View file

@ -97,11 +97,6 @@ uint8_t bmi160Detect(const busDevice_t *bus)
return BMI_160_SPI; return BMI_160_SPI;
} }
#ifndef USE_DUAL_GYRO
IOInit(bus->busdev_u.spi.csnPin, OWNER_MPU_CS, 0);
IOConfigGPIO(bus->busdev_u.spi.csnPin, SPI_IO_CS_CFG);
IOHi(bus->busdev_u.spi.csnPin);
#endif
spiSetDivisor(bus->busdev_u.spi.instance, BMI160_SPI_DIVISOR); spiSetDivisor(bus->busdev_u.spi.instance, BMI160_SPI_DIVISOR);
@ -250,22 +245,18 @@ void bmi160ExtiHandler(extiCallbackRec_t *cb)
static void bmi160IntExtiInit(gyroDev_t *gyro) static void bmi160IntExtiInit(gyroDev_t *gyro)
{ {
static bool bmi160ExtiInitDone = false; if (gyro->mpuIntExtiTag == IO_TAG_NONE) {
if (bmi160ExtiInitDone) {
return; return;
} }
IO_t mpuIntIO = IOGetByTag(IO_TAG(BMI160_INT_EXTI)); IO_t mpuIntIO = IOGetByTag(gyro->mpuIntExtiTag);
IOInit(mpuIntIO, OWNER_MPU_EXTI, 0); IOInit(mpuIntIO, OWNER_GYRO_EXTI, 0);
IOConfigGPIO(mpuIntIO, IOCFG_IN_FLOATING); // TODO - maybe pullup / pulldown ? IOConfigGPIO(mpuIntIO, IOCFG_IN_FLOATING); // TODO - maybe pullup / pulldown ?
EXTIHandlerInit(&gyro->exti, bmi160ExtiHandler); EXTIHandlerInit(&gyro->exti, bmi160ExtiHandler);
EXTIConfig(mpuIntIO, &gyro->exti, NVIC_PRIO_MPU_INT_EXTI, EXTI_Trigger_Rising); EXTIConfig(mpuIntIO, &gyro->exti, NVIC_PRIO_MPU_INT_EXTI, EXTI_Trigger_Rising);
EXTIEnable(mpuIntIO, true); EXTIEnable(mpuIntIO, true);
bmi160ExtiInitDone = true;
} }

View file

@ -45,11 +45,6 @@ static void icm20649SpiInit(const busDevice_t *bus)
return; return;
} }
#ifndef USE_DUAL_GYRO
IOInit(bus->busdev_u.spi.csnPin, OWNER_MPU_CS, 0);
IOConfigGPIO(bus->busdev_u.spi.csnPin, SPI_IO_CS_CFG);
IOHi(bus->busdev_u.spi.csnPin);
#endif
// all registers can be read/written at full speed (7MHz +-10%) // all registers can be read/written at full speed (7MHz +-10%)
// TODO verify that this works at 9MHz and 10MHz on non F7 // TODO verify that this works at 9MHz and 10MHz on non F7

View file

@ -45,11 +45,6 @@ static void icm20689SpiInit(const busDevice_t *bus)
return; return;
} }
#ifndef USE_DUAL_GYRO
IOInit(bus->busdev_u.spi.csnPin, OWNER_MPU_CS, 0);
IOConfigGPIO(bus->busdev_u.spi.csnPin, SPI_IO_CS_CFG);
IOHi(bus->busdev_u.spi.csnPin);
#endif
spiSetDivisor(bus->busdev_u.spi.instance, SPI_CLOCK_STANDARD); spiSetDivisor(bus->busdev_u.spi.instance, SPI_CLOCK_STANDARD);

View file

@ -127,11 +127,6 @@ void mpu6000SpiAccInit(accDev_t *acc)
uint8_t mpu6000SpiDetect(const busDevice_t *bus) uint8_t mpu6000SpiDetect(const busDevice_t *bus)
{ {
#ifndef USE_DUAL_GYRO
IOInit(bus->busdev_u.spi.csnPin, OWNER_MPU_CS, 0);
IOConfigGPIO(bus->busdev_u.spi.csnPin, SPI_IO_CS_CFG);
IOHi(bus->busdev_u.spi.csnPin);
#endif
spiSetDivisor(bus->busdev_u.spi.instance, SPI_CLOCK_INITIALIZATON); spiSetDivisor(bus->busdev_u.spi.instance, SPI_CLOCK_INITIALIZATON);

View file

@ -41,11 +41,6 @@
static void mpu6500SpiInit(const busDevice_t *bus) static void mpu6500SpiInit(const busDevice_t *bus)
{ {
#ifndef USE_DUAL_GYRO
IOInit(bus->busdev_u.spi.csnPin, OWNER_MPU_CS, 0);
IOConfigGPIO(bus->busdev_u.spi.csnPin, SPI_IO_CS_CFG);
IOHi(bus->busdev_u.spi.csnPin);
#endif
spiSetDivisor(bus->busdev_u.spi.instance, SPI_CLOCK_FAST); spiSetDivisor(bus->busdev_u.spi.instance, SPI_CLOCK_FAST);
} }

View file

@ -151,11 +151,6 @@ static void mpu9250AccAndGyroInit(gyroDev_t *gyro) {
uint8_t mpu9250SpiDetect(const busDevice_t *bus) uint8_t mpu9250SpiDetect(const busDevice_t *bus)
{ {
#ifndef USE_DUAL_GYRO
IOInit(bus->busdev_u.spi.csnPin, OWNER_MPU_CS, 0);
IOConfigGPIO(bus->busdev_u.spi.csnPin, SPI_IO_CS_CFG);
IOHi(bus->busdev_u.spi.csnPin);
#endif
spiSetDivisor(bus->busdev_u.spi.instance, SPI_CLOCK_INITIALIZATON); //low speed spiSetDivisor(bus->busdev_u.spi.instance, SPI_CLOCK_INITIALIZATON); //low speed
mpu9250SpiWriteRegister(bus, MPU_RA_PWR_MGMT_1, MPU9250_BIT_RESET); mpu9250SpiWriteRegister(bus, MPU_RA_PWR_MGMT_1, MPU9250_BIT_RESET);

View file

@ -82,12 +82,6 @@ static void l3gd20SpiInit(SPI_TypeDef *SPIx)
UNUSED(SPIx); // FIXME UNUSED(SPIx); // FIXME
mpul3gd20CsPin = IOGetByTag(IO_TAG(L3GD20_CS_PIN)); mpul3gd20CsPin = IOGetByTag(IO_TAG(L3GD20_CS_PIN));
#ifndef USE_DUAL_GYRO
IOInit(mpul3gd20CsPin, OWNER_MPU_CS, 0);
IOConfigGPIO(mpul3gd20CsPin, SPI_IO_CS_CFG);
DISABLE_L3GD20;
#endif
spiSetDivisor(L3GD20_SPI, SPI_CLOCK_STANDARD); spiSetDivisor(L3GD20_SPI, SPI_CLOCK_STANDARD);
} }

View file

@ -86,7 +86,7 @@ static uint8_t device_id;
static inline void mma8451ConfigureInterrupt(void) static inline void mma8451ConfigureInterrupt(void)
{ {
#ifdef MMA8451_INT_PIN #ifdef MMA8451_INT_PIN
IOInit(IOGetByTag(IO_TAG(MMA8451_INT_PIN)), OWNER_MPU_EXTI, 0); IOInit(IOGetByTag(IO_TAG(MMA8451_INT_PIN)), OWNER_GYRO_EXTI, 0);
// TODO - maybe pullup / pulldown ? // TODO - maybe pullup / pulldown ?
IOConfigGPIO(IOGetByTag(IO_TAG(MMA8451_INT_PIN)), IOCFG_IN_FLOATING); IOConfigGPIO(IOGetByTag(IO_TAG(MMA8451_INT_PIN)), IOCFG_IN_FLOATING);
#endif #endif

View file

@ -29,7 +29,8 @@ typedef enum {
BUSTYPE_NONE = 0, BUSTYPE_NONE = 0,
BUSTYPE_I2C, BUSTYPE_I2C,
BUSTYPE_SPI, BUSTYPE_SPI,
BUSTYPE_MPU_SLAVE // Slave I2C on SPI master BUSTYPE_MPU_SLAVE, // Slave I2C on SPI master
BUSTYPE_GYRO_AUTO // Only used by acc/gyro bus auto detection code
} busType_e; } busType_e;
typedef struct busDevice_s { typedef struct busDevice_s {

View file

@ -49,11 +49,11 @@ const char * const ownerNames[OWNER_TOTAL_COUNT] = {
"SDCARD_DETECT", "SDCARD_DETECT",
"FLASH_CS", "FLASH_CS",
"BARO_CS", "BARO_CS",
"MPU_CS", "GYRO_CS",
"OSD_CS", "OSD_CS",
"RX_SPI_CS", "RX_SPI_CS",
"SPI_CS", "SPI_CS",
"MPU_EXTI", "GYRO_EXTI",
"BARO_EXTI", "BARO_EXTI",
"COMPASS_EXTI", "COMPASS_EXTI",
"USB", "USB",
@ -76,4 +76,6 @@ const char * const ownerNames[OWNER_TOTAL_COUNT] = {
"USB_MSC_PIN", "USB_MSC_PIN",
"SPI_PREINIT_IPU", "SPI_PREINIT_IPU",
"SPI_PREINIT_OPU", "SPI_PREINIT_OPU",
"GYRO1_CS",
"GYRO2_CS",
}; };

View file

@ -49,11 +49,11 @@ typedef enum {
OWNER_SDCARD_DETECT, OWNER_SDCARD_DETECT,
OWNER_FLASH_CS, OWNER_FLASH_CS,
OWNER_BARO_CS, OWNER_BARO_CS,
OWNER_MPU_CS, OWNER_GYRO_CS,
OWNER_OSD_CS, OWNER_OSD_CS,
OWNER_RX_SPI_CS, OWNER_RX_SPI_CS,
OWNER_SPI_CS, OWNER_SPI_CS,
OWNER_MPU_EXTI, OWNER_GYRO_EXTI,
OWNER_BARO_EXTI, OWNER_BARO_EXTI,
OWNER_COMPASS_EXTI, OWNER_COMPASS_EXTI,
OWNER_USB, OWNER_USB,
@ -76,6 +76,8 @@ typedef enum {
OWNER_USB_MSC_PIN, OWNER_USB_MSC_PIN,
OWNER_SPI_PREINIT_IPU, OWNER_SPI_PREINIT_IPU,
OWNER_SPI_PREINIT_OPU, OWNER_SPI_PREINIT_OPU,
OWNER_GYRO1_CS,
OWNER_GYRO2_CS,
OWNER_TOTAL_COUNT OWNER_TOTAL_COUNT
} resourceOwner_e; } resourceOwner_e;

View file

@ -126,6 +126,7 @@ extern uint8_t __config_end;
#include "pg/board.h" #include "pg/board.h"
#include "pg/bus_i2c.h" #include "pg/bus_i2c.h"
#include "pg/bus_spi.h" #include "pg/bus_spi.h"
#include "pg/gyrodev.h"
#include "pg/max7456.h" #include "pg/max7456.h"
#include "pg/pinio.h" #include "pg/pinio.h"
#include "pg/pg.h" #include "pg/pg.h"
@ -2701,7 +2702,7 @@ static void cliPrintGyroRegisters(uint8_t whichSensor)
static void cliDumpGyroRegisters(char *cmdline) static void cliDumpGyroRegisters(char *cmdline)
{ {
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
if ((gyroConfig()->gyro_to_use == GYRO_CONFIG_USE_GYRO_1) || (gyroConfig()->gyro_to_use == GYRO_CONFIG_USE_GYRO_BOTH)) { if ((gyroConfig()->gyro_to_use == GYRO_CONFIG_USE_GYRO_1) || (gyroConfig()->gyro_to_use == GYRO_CONFIG_USE_GYRO_BOTH)) {
cliPrintLinef("\r\n# Gyro 1"); cliPrintLinef("\r\n# Gyro 1");
cliPrintGyroRegisters(GYRO_CONFIG_USE_GYRO_1); cliPrintGyroRegisters(GYRO_CONFIG_USE_GYRO_1);
@ -2712,7 +2713,7 @@ static void cliDumpGyroRegisters(char *cmdline)
} }
#else #else
cliPrintGyroRegisters(GYRO_CONFIG_USE_GYRO_1); cliPrintGyroRegisters(GYRO_CONFIG_USE_GYRO_1);
#endif // USE_DUAL_GYRO #endif
UNUSED(cmdline); UNUSED(cmdline);
} }
#endif #endif
@ -3823,6 +3824,8 @@ const cliResourceValue_t resourceTable[] = {
#ifdef USE_RX_SPI #ifdef USE_RX_SPI
DEFS( OWNER_RX_SPI_CS, PG_RX_SPI_CONFIG, rxSpiConfig_t, csnTag ), DEFS( OWNER_RX_SPI_CS, PG_RX_SPI_CONFIG, rxSpiConfig_t, csnTag ),
#endif #endif
#define PG_ARRAY_OFFSET(type, index, member) (index * sizeof(type) + offsetof(type, member))
DEFW( OWNER_GYRO_CS, PG_GYRO_DEVICE_CONFIG, gyroDeviceConfig_t, csnTag, 2 ),
}; };
#undef DEFS #undef DEFS

View file

@ -70,6 +70,7 @@
#include "pg/beeper_dev.h" #include "pg/beeper_dev.h"
#include "pg/dashboard.h" #include "pg/dashboard.h"
#include "pg/flash.h" #include "pg/flash.h"
#include "pg/gyrodev.h"
#include "pg/max7456.h" #include "pg/max7456.h"
#include "pg/pg.h" #include "pg/pg.h"
#include "pg/pg_ids.h" #include "pg/pg_ids.h"
@ -158,7 +159,7 @@ static const char * const lookupTableAlignment[] = {
"CW270FLIP" "CW270FLIP"
}; };
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
static const char * const lookupTableGyro[] = { static const char * const lookupTableGyro[] = {
"FIRST", "SECOND", "BOTH" "FIRST", "SECOND", "BOTH"
}; };
@ -289,7 +290,10 @@ static const char * const lookupTableFailsafeSwitchMode[] = {
}; };
static const char * const lookupTableBusType[] = { static const char * const lookupTableBusType[] = {
"NONE", "I2C", "SPI", "SLAVE" "NONE", "I2C", "SPI", "SLAVE",
#if defined(USE_SPI_GYRO) && defined(USE_I2C_GYRO)
"GYROAUTO"
#endif
}; };
#ifdef USE_MAX7456 #ifdef USE_MAX7456
@ -458,7 +462,7 @@ const lookupTableEntry_t lookupTables[] = {
#ifdef USE_LED_STRIP #ifdef USE_LED_STRIP
LOOKUP_TABLE_ENTRY(lookupLedStripFormatRGB), LOOKUP_TABLE_ENTRY(lookupLedStripFormatRGB),
#endif #endif
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
LOOKUP_TABLE_ENTRY(lookupTableGyro), LOOKUP_TABLE_ENTRY(lookupTableGyro),
#endif #endif
LOOKUP_TABLE_ENTRY(lookupTableThrottleLimitType), LOOKUP_TABLE_ENTRY(lookupTableThrottleLimitType),
@ -485,6 +489,7 @@ const lookupTableEntry_t lookupTables[] = {
#ifdef USE_VTX_COMMON #ifdef USE_VTX_COMMON
LOOKUP_TABLE_ENTRY(lookupTableVtxLowPowerDisarm), LOOKUP_TABLE_ENTRY(lookupTableVtxLowPowerDisarm),
#endif #endif
LOOKUP_TABLE_ENTRY(lookupTableGyroHardware),
}; };
#undef LOOKUP_TABLE_ENTRY #undef LOOKUP_TABLE_ENTRY
@ -526,7 +531,8 @@ const clivalue_t valueTable[] = {
#if defined(GYRO_USES_SPI) && defined(USE_32K_CAPABLE_GYRO) #if defined(GYRO_USES_SPI) && defined(USE_32K_CAPABLE_GYRO)
{ "gyro_use_32khz", VAR_UINT8 | MASTER_VALUE | MODE_LOOKUP, .config.lookup = { TABLE_OFF_ON }, PG_GYRO_CONFIG, offsetof(gyroConfig_t, gyro_use_32khz) }, { "gyro_use_32khz", VAR_UINT8 | MASTER_VALUE | MODE_LOOKUP, .config.lookup = { TABLE_OFF_ON }, PG_GYRO_CONFIG, offsetof(gyroConfig_t, gyro_use_32khz) },
#endif #endif
#ifdef USE_DUAL_GYRO #endif
#ifdef USE_MULTI_GYRO
{ "gyro_to_use", VAR_UINT8 | MASTER_VALUE | MODE_LOOKUP, .config.lookup = { TABLE_GYRO }, PG_GYRO_CONFIG, offsetof(gyroConfig_t, gyro_to_use) }, { "gyro_to_use", VAR_UINT8 | MASTER_VALUE | MODE_LOOKUP, .config.lookup = { TABLE_GYRO }, PG_GYRO_CONFIG, offsetof(gyroConfig_t, gyro_to_use) },
#endif #endif
#if defined(USE_GYRO_DATA_ANALYSE) #if defined(USE_GYRO_DATA_ANALYSE)
@ -1153,6 +1159,20 @@ const clivalue_t valueTable[] = {
{ "rcdevice_init_dev_attempts", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, 10 }, PG_RCDEVICE_CONFIG, offsetof(rcdeviceConfig_t, initDeviceAttempts) }, { "rcdevice_init_dev_attempts", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, 10 }, PG_RCDEVICE_CONFIG, offsetof(rcdeviceConfig_t, initDeviceAttempts) },
{ "rcdevice_init_dev_attempt_interval", VAR_UINT32 | MASTER_VALUE, .config.minmax = { 500, 5000 }, PG_RCDEVICE_CONFIG, offsetof(rcdeviceConfig_t, initDeviceAttemptInterval) } { "rcdevice_init_dev_attempt_interval", VAR_UINT32 | MASTER_VALUE, .config.minmax = { 500, 5000 }, PG_RCDEVICE_CONFIG, offsetof(rcdeviceConfig_t, initDeviceAttemptInterval) }
#endif #endif
#define PG_ARRAY_OFFSET(type, index, member) (index * sizeof(type) + offsetof(type, member))
// PG_GYRO_DEVICE_CONFIG
{ "gyro_1_bustype", VAR_UINT8 | MASTER_VALUE | MODE_LOOKUP, .config.lookup = { TABLE_BUS_TYPE }, PG_GYRO_DEVICE_CONFIG, PG_ARRAY_OFFSET(gyroDeviceConfig_t, 0, bustype) },
{ "gyro_1_spibus", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, SPIDEV_COUNT }, PG_GYRO_DEVICE_CONFIG, PG_ARRAY_OFFSET(gyroDeviceConfig_t, 0, spiBus) },
{ "gyro_1_i2cBus", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, I2CDEV_COUNT }, PG_GYRO_DEVICE_CONFIG, PG_ARRAY_OFFSET(gyroDeviceConfig_t, 0, i2cBus) },
{ "gyro_1_i2c_address", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, I2C_ADDR7_MAX }, PG_GYRO_DEVICE_CONFIG, PG_ARRAY_OFFSET(gyroDeviceConfig_t, 0, i2cAddress) },
#ifdef USE_MULTI_GYRO
{ "gyro_2_bustype", VAR_UINT8 | MASTER_VALUE | MODE_LOOKUP, .config.lookup = { TABLE_BUS_TYPE }, PG_GYRO_DEVICE_CONFIG, PG_ARRAY_OFFSET(gyroDeviceConfig_t, 1, bustype) },
{ "gyro_2_spibus", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, SPIDEV_COUNT }, PG_GYRO_DEVICE_CONFIG, PG_ARRAY_OFFSET(gyroDeviceConfig_t, 1, spiBus) },
{ "gyro_2_i2cBus", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, I2CDEV_COUNT }, PG_GYRO_DEVICE_CONFIG, PG_ARRAY_OFFSET(gyroDeviceConfig_t, 1, i2cBus) },
{ "gyro_2_i2c_address", VAR_UINT8 | MASTER_VALUE, .config.minmax = { 0, I2C_ADDR7_MAX }, PG_GYRO_DEVICE_CONFIG, PG_ARRAY_OFFSET(gyroDeviceConfig_t, 1, i2cAddress) },
#endif
}; };
const uint16_t valueTableEntryCount = ARRAYLEN(valueTable); const uint16_t valueTableEntryCount = ARRAYLEN(valueTable);

View file

@ -92,7 +92,7 @@ typedef enum {
#ifdef USE_LED_STRIP #ifdef USE_LED_STRIP
TABLE_RGB_GRB, TABLE_RGB_GRB,
#endif #endif
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
TABLE_GYRO, TABLE_GYRO,
#endif #endif
TABLE_THROTTLE_LIMIT_TYPE, TABLE_THROTTLE_LIMIT_TYPE,
@ -119,6 +119,7 @@ typedef enum {
#ifdef USE_VTX_COMMON #ifdef USE_VTX_COMMON
TABLE_VTX_LOW_POWER_DISARM, TABLE_VTX_LOW_POWER_DISARM,
#endif #endif
TABLE_GYRO_HARDWARE,
LOOKUP_TABLE_COUNT LOOKUP_TABLE_COUNT
} lookupTableIndex_e; } lookupTableIndex_e;

89
src/main/pg/gyrodev.c Normal file
View file

@ -0,0 +1,89 @@
/*
* This file is part of Cleanflight and Betaflight.
*
* Cleanflight and Betaflight are free software. You can redistribute
* this software and/or modify this software under the terms of the
* GNU General Public License as published by the Free Software
* Foundation, either version 3 of the License, or (at your option)
* any later version.
*
* Cleanflight and Betaflight are distributed in the hope that they
* will be useful, but WITHOUT ANY WARRANTY; without even the implied
* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
* See the GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this software.
*
* If not, see <http://www.gnu.org/licenses/>.
*/
#include <stdbool.h>
#include <stdint.h>
#include "platform.h"
#include "pg/pg.h"
#include "pg/pg_ids.h"
#include "drivers/io.h"
#include "drivers/bus_spi.h"
#include "pg/gyrodev.h"
ioTag_t selectMPUIntExtiConfigByHardwareRevision(void); // XXX Should be gone
#if defined(USE_SPI_GYRO) || defined(USE_I2C_GYRO)
static void gyroResetCommonDeviceConfig(gyroDeviceConfig_t *devconf, ioTag_t extiTag, sensor_align_e align)
{
devconf->extiTag = extiTag;
devconf->align = align;
}
#endif
#ifdef USE_SPI_GYRO
static void gyroResetSpiDeviceConfig(gyroDeviceConfig_t *devconf, SPI_TypeDef *instance, ioTag_t csnTag, ioTag_t extiTag, sensor_align_e align)
{
devconf->bustype = BUSTYPE_SPI;
devconf->spiBus = SPI_DEV_TO_CFG(spiDeviceByInstance(instance));
devconf->csnTag = csnTag;
gyroResetCommonDeviceConfig(devconf, extiTag, align);
}
#endif
#ifdef USE_I2C_GYRO
static void gyroResetI2cDeviceConfig(gyroDeviceConfig_t *devconf, I2CDevice i2cbus, ioTag_t extiTag, sensor_align_e align)
{
devconf->bustype = BUSTYPE_I2C;
devconf->i2cBus = I2C_DEV_TO_CFG(i2cbus);
devconf->i2cAddress = GYRO_I2C_ADDRESS;
gyroResetCommonDeviceConfig(devconf, extiTag, align);
}
#endif
PG_REGISTER_ARRAY_WITH_RESET_FN(gyroDeviceConfig_t, MAX_GYRODEV_COUNT, gyroDeviceConfig, PG_GYRO_DEVICE_CONFIG, 0);
void pgResetFn_gyroDeviceConfig(gyroDeviceConfig_t *devconf)
{
devconf[0].index = 0;
// All multi-gyro boards use SPI based gyros.
#ifdef USE_SPI_GYRO
gyroResetSpiDeviceConfig(&devconf[0], GYRO_1_SPI_INSTANCE, IO_TAG(GYRO_1_CS_PIN), IO_TAG(GYRO_1_EXTI_PIN), GYRO_1_ALIGN);
#ifdef USE_MULTI_GYRO
gyroResetSpiDeviceConfig(&devconf[1], GYRO_2_SPI_INSTANCE, IO_TAG(GYRO_2_CS_PIN), IO_TAG(GYRO_2_EXTI_PIN), GYRO_2_ALIGN);
devconf[1].index = 1;
#endif
#endif
// I2C gyros appear as a sole gyro in single gyro boards.
#if defined(USE_I2C_GYRO) && !defined(USE_MULTI_GYRO)
devconf[0].i2cBus = I2C_DEV_TO_CFG(I2CINVALID); // XXX Not required?
gyroResetI2cDeviceConfig(&devconf[0], I2C_DEVICE, IO_TAG(GYRO_1_EXTI_PIN), GYRO_1_ALIGN);
#endif
// Special treatment for very rare F3 targets with variants having either I2C or SPI acc/gyro chip; mark it for run time detection.
#if defined(USE_SPI_GYRO) && defined(USE_I2C_GYRO)
devconf[0].bustype = BUSTYPE_GYRO_AUTO;
#endif
}

49
src/main/pg/gyrodev.h Normal file
View file

@ -0,0 +1,49 @@
/*
* This file is part of Cleanflight and Betaflight.
*
* Cleanflight and Betaflight are free software. You can redistribute
* this software and/or modify this software under the terms of the
* GNU General Public License as published by the Free Software
* Foundation, either version 3 of the License, or (at your option)
* any later version.
*
* Cleanflight and Betaflight are distributed in the hope that they
* will be useful, but WITHOUT ANY WARRANTY; without even the implied
* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
* See the GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this software.
*
* If not, see <http://www.gnu.org/licenses/>.
*/
#pragma once
#include <stdint.h>
//#include <stdbool.h>
#include "pg/pg.h"
#include "drivers/io_types.h"
#include "drivers/sensor.h"
#include "sensors/gyro.h"
typedef struct gyroDeviceConfig_s {
int8_t index;
uint8_t bustype;
uint8_t spiBus;
ioTag_t csnTag;
uint8_t i2cBus;
uint8_t i2cAddress;
ioTag_t extiTag;
sensor_align_e align;
} gyroDeviceConfig_t;
#ifdef USE_MULTI_GYRO
#define MAX_GYRODEV_COUNT 2
#else
#define MAX_GYRODEV_COUNT 1
#endif
PG_DECLARE_ARRAY(gyroDeviceConfig_t, MAX_GYRODEV_COUNT, gyroDeviceConfig);

View file

@ -134,7 +134,8 @@
#define PG_RX_SPI_CONFIG 537 #define PG_RX_SPI_CONFIG 537
#define PG_BOARD_CONFIG 538 #define PG_BOARD_CONFIG 538
#define PG_RCDEVICE_CONFIG 539 #define PG_RCDEVICE_CONFIG 539
#define PG_BETAFLIGHT_END 539 #define PG_GYRO_DEVICE_CONFIG 540
#define PG_BETAFLIGHT_END 540
// OSD configuration (subject to change) // OSD configuration (subject to change)

View file

@ -347,14 +347,11 @@ bool accInit(uint32_t gyroSamplingInverval)
acc.dev.mpuDetectionResult = *gyroMpuDetectionResult(); acc.dev.mpuDetectionResult = *gyroMpuDetectionResult();
acc.dev.acc_high_fsr = accelerometerConfig()->acc_high_fsr; acc.dev.acc_high_fsr = accelerometerConfig()->acc_high_fsr;
#ifdef USE_DUAL_GYRO acc.dev.accAlign = ACC_1_ALIGN;
#ifdef ACC_2_ALIGN
if (gyroConfig()->gyro_to_use == GYRO_CONFIG_USE_GYRO_2) { if (gyroConfig()->gyro_to_use == GYRO_CONFIG_USE_GYRO_2) {
acc.dev.accAlign = ACC_2_ALIGN; acc.dev.accAlign = ACC_2_ALIGN;
} else {
acc.dev.accAlign = ACC_1_ALIGN;
} }
#else
acc.dev.accAlign = ALIGN_DEFAULT;
#endif #endif
if (!accDetect(&acc.dev, accelerometerConfig()->acc_hardware)) { if (!accDetect(&acc.dev, accelerometerConfig()->acc_hardware)) {

View file

@ -36,6 +36,7 @@
#include "pg/pg.h" #include "pg/pg.h"
#include "pg/pg_ids.h" #include "pg/pg_ids.h"
#include "pg/gyrodev.h"
#include "drivers/accgyro/accgyro.h" #include "drivers/accgyro/accgyro.h"
#include "drivers/accgyro/accgyro_fake.h" #include "drivers/accgyro/accgyro_fake.h"
@ -77,10 +78,6 @@
#endif #endif
#include "sensors/sensors.h" #include "sensors/sensors.h"
#ifdef USE_HARDWARE_REVISION_DETECTION
#include "hardware_revision.h"
#endif
#if ((FLASH_SIZE > 128) && (defined(USE_GYRO_SPI_ICM20601) || defined(USE_GYRO_SPI_ICM20689) || defined(USE_GYRO_SPI_MPU6500))) #if ((FLASH_SIZE > 128) && (defined(USE_GYRO_SPI_ICM20601) || defined(USE_GYRO_SPI_ICM20689) || defined(USE_GYRO_SPI_MPU6500)))
#define USE_GYRO_SLEW_LIMITER #define USE_GYRO_SLEW_LIMITER
#endif #endif
@ -152,7 +149,7 @@ typedef struct gyroSensor_s {
} gyroSensor_t; } gyroSensor_t;
STATIC_UNIT_TESTED FAST_RAM_ZERO_INIT gyroSensor_t gyroSensor1; STATIC_UNIT_TESTED FAST_RAM_ZERO_INIT gyroSensor_t gyroSensor1;
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
STATIC_UNIT_TESTED FAST_RAM_ZERO_INIT gyroSensor_t gyroSensor2; STATIC_UNIT_TESTED FAST_RAM_ZERO_INIT gyroSensor_t gyroSensor2;
#endif #endif
@ -211,47 +208,34 @@ PG_RESET_TEMPLATE(gyroConfig_t, gyroConfig,
.dyn_filter_range = DYN_FILTER_RANGE_MEDIUM, .dyn_filter_range = DYN_FILTER_RANGE_MEDIUM,
); );
#ifdef USE_MULTI_GYRO
#define ACTIVE_GYRO ((gyroToUse == GYRO_CONFIG_USE_GYRO_2) ? &gyroSensor2 : &gyroSensor1)
#else
#define ACTIVE_GYRO (&gyroSensor1)
#endif
const busDevice_t *gyroSensorBus(void) const busDevice_t *gyroSensorBus(void)
{ {
#ifdef USE_DUAL_GYRO return &ACTIVE_GYRO->gyroDev.bus;
if (gyroToUse == GYRO_CONFIG_USE_GYRO_2) {
return &gyroSensor2.gyroDev.bus;
} else {
return &gyroSensor1.gyroDev.bus;
}
#else
return &gyroSensor1.gyroDev.bus;
#endif
} }
#ifdef USE_GYRO_REGISTER_DUMP #ifdef USE_GYRO_REGISTER_DUMP
const busDevice_t *gyroSensorBusByDevice(uint8_t whichSensor) const busDevice_t *gyroSensorBusByDevice(uint8_t whichSensor)
{ {
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
if (whichSensor == GYRO_CONFIG_USE_GYRO_2) { if (whichSensor == GYRO_CONFIG_USE_GYRO_2) {
return &gyroSensor2.gyroDev.bus; return &gyroSensor2.gyroDev.bus;
} else {
return &gyroSensor1.gyroDev.bus;
} }
#else #else
UNUSED(whichSensor); UNUSED(whichSensor);
return &gyroSensor1.gyroDev.bus;
#endif #endif
return &gyroSensor1.gyroDev.bus;
} }
#endif // USE_GYRO_REGISTER_DUMP #endif // USE_GYRO_REGISTER_DUMP
const mpuDetectionResult_t *gyroMpuDetectionResult(void) const mpuDetectionResult_t *gyroMpuDetectionResult(void)
{ {
#ifdef USE_DUAL_GYRO return &ACTIVE_GYRO->gyroDev.mpuDetectionResult;
if (gyroToUse == GYRO_CONFIG_USE_GYRO_2) {
return &gyroSensor2.gyroDev.mpuDetectionResult;
} else {
return &gyroSensor1.gyroDev.mpuDetectionResult;
}
#else
return &gyroSensor1.gyroDev.mpuDetectionResult;
#endif
} }
STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev) STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
@ -266,9 +250,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_MPU6050: case GYRO_MPU6050:
if (mpu6050GyroDetect(dev)) { if (mpu6050GyroDetect(dev)) {
gyroHardware = GYRO_MPU6050; gyroHardware = GYRO_MPU6050;
#ifdef GYRO_MPU6050_ALIGN
dev->gyroAlign = GYRO_MPU6050_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -278,9 +259,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_L3G4200D: case GYRO_L3G4200D:
if (l3g4200dDetect(dev)) { if (l3g4200dDetect(dev)) {
gyroHardware = GYRO_L3G4200D; gyroHardware = GYRO_L3G4200D;
#ifdef GYRO_L3G4200D_ALIGN
dev->gyroAlign = GYRO_L3G4200D_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -290,9 +268,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_MPU3050: case GYRO_MPU3050:
if (mpu3050Detect(dev)) { if (mpu3050Detect(dev)) {
gyroHardware = GYRO_MPU3050; gyroHardware = GYRO_MPU3050;
#ifdef GYRO_MPU3050_ALIGN
dev->gyroAlign = GYRO_MPU3050_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -302,9 +277,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_L3GD20: case GYRO_L3GD20:
if (l3gd20Detect(dev)) { if (l3gd20Detect(dev)) {
gyroHardware = GYRO_L3GD20; gyroHardware = GYRO_L3GD20;
#ifdef GYRO_L3GD20_ALIGN
dev->gyroAlign = GYRO_L3GD20_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -314,9 +286,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_MPU6000: case GYRO_MPU6000:
if (mpu6000SpiGyroDetect(dev)) { if (mpu6000SpiGyroDetect(dev)) {
gyroHardware = GYRO_MPU6000; gyroHardware = GYRO_MPU6000;
#ifdef GYRO_MPU6000_ALIGN
dev->gyroAlign = GYRO_MPU6000_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -348,9 +317,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
default: default:
gyroHardware = GYRO_MPU6500; gyroHardware = GYRO_MPU6500;
} }
#ifdef GYRO_MPU6500_ALIGN
dev->gyroAlign = GYRO_MPU6500_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -360,9 +326,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_MPU9250: case GYRO_MPU9250:
if (mpu9250SpiGyroDetect(dev)) { if (mpu9250SpiGyroDetect(dev)) {
gyroHardware = GYRO_MPU9250; gyroHardware = GYRO_MPU9250;
#ifdef GYRO_MPU9250_ALIGN
dev->gyroAlign = GYRO_MPU9250_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -372,9 +335,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_ICM20649: case GYRO_ICM20649:
if (icm20649SpiGyroDetect(dev)) { if (icm20649SpiGyroDetect(dev)) {
gyroHardware = GYRO_ICM20649; gyroHardware = GYRO_ICM20649;
#ifdef GYRO_ICM20649_ALIGN
dev->gyroAlign = GYRO_ICM20649_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -384,9 +344,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_ICM20689: case GYRO_ICM20689:
if (icm20689SpiGyroDetect(dev)) { if (icm20689SpiGyroDetect(dev)) {
gyroHardware = GYRO_ICM20689; gyroHardware = GYRO_ICM20689;
#ifdef GYRO_ICM20689_ALIGN
dev->gyroAlign = GYRO_ICM20689_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -396,9 +353,6 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
case GYRO_BMI160: case GYRO_BMI160:
if (bmi160SpiGyroDetect(dev)) { if (bmi160SpiGyroDetect(dev)) {
gyroHardware = GYRO_BMI160; gyroHardware = GYRO_BMI160;
#ifdef GYRO_BMI160_ALIGN
dev->gyroAlign = GYRO_BMI160_ALIGN;
#endif
break; break;
} }
FALLTHROUGH; FALLTHROUGH;
@ -426,14 +380,16 @@ STATIC_UNIT_TESTED gyroHardware_e gyroDetect(gyroDev_t *dev)
return gyroHardware; return gyroHardware;
} }
static bool gyroInitSensor(gyroSensor_t *gyroSensor) static bool gyroInitSensor(gyroSensor_t *gyroSensor, const gyroDeviceConfig_t *config)
{ {
gyroSensor->gyroDev.gyro_high_fsr = gyroConfig()->gyro_high_fsr; gyroSensor->gyroDev.gyro_high_fsr = gyroConfig()->gyro_high_fsr;
gyroSensor->gyroDev.gyroAlign = config->align;
gyroSensor->gyroDev.mpuIntExtiTag = config->extiTag;
#if defined(USE_GYRO_MPU6050) || defined(USE_GYRO_MPU3050) || defined(USE_GYRO_MPU6500) || defined(USE_GYRO_SPI_MPU6500) || defined(USE_GYRO_SPI_MPU6000) \ #if defined(USE_GYRO_MPU6050) || defined(USE_GYRO_MPU3050) || defined(USE_GYRO_MPU6500) || defined(USE_GYRO_SPI_MPU6500) || defined(USE_GYRO_SPI_MPU6000) \
|| defined(USE_ACC_MPU6050) || defined(USE_GYRO_SPI_MPU9250) || defined(USE_GYRO_SPI_ICM20601) || defined(USE_GYRO_SPI_ICM20649) || defined(USE_GYRO_SPI_ICM20689) || defined(USE_ACC_MPU6050) || defined(USE_GYRO_SPI_MPU9250) || defined(USE_GYRO_SPI_ICM20601) || defined(USE_GYRO_SPI_ICM20649) || defined(USE_GYRO_SPI_ICM20689)
mpuDetect(&gyroSensor->gyroDev); mpuDetect(&gyroSensor->gyroDev, config);
#endif #endif
const gyroHardware_e gyroHardware = gyroDetect(&gyroSensor->gyroDev); const gyroHardware_e gyroHardware = gyroDetect(&gyroSensor->gyroDev);
@ -536,79 +492,23 @@ bool gyroInit(void)
bool ret = false; bool ret = false;
gyroToUse = gyroConfig()->gyro_to_use; gyroToUse = gyroConfig()->gyro_to_use;
#if defined(USE_DUAL_GYRO) && defined(GYRO_1_CS_PIN)
if (gyroToUse == GYRO_CONFIG_USE_GYRO_1 || gyroToUse == GYRO_CONFIG_USE_GYRO_BOTH) { if (gyroToUse == GYRO_CONFIG_USE_GYRO_1 || gyroToUse == GYRO_CONFIG_USE_GYRO_BOTH) {
gyroSensor1.gyroDev.bus.busdev_u.spi.csnPin = IOGetByTag(IO_TAG(GYRO_1_CS_PIN)); ret = gyroInitSensor(&gyroSensor1, gyroDeviceConfig(0));
IOInit(gyroSensor1.gyroDev.bus.busdev_u.spi.csnPin, OWNER_MPU_CS, RESOURCE_INDEX(0));
IOHi(gyroSensor1.gyroDev.bus.busdev_u.spi.csnPin); // Ensure device is disabled, important when two devices are on the same bus.
IOConfigGPIO(gyroSensor1.gyroDev.bus.busdev_u.spi.csnPin, SPI_IO_CS_CFG);
}
#endif
#if defined(USE_DUAL_GYRO) && defined(GYRO_2_CS_PIN)
if (gyroToUse == GYRO_CONFIG_USE_GYRO_2 || gyroToUse == GYRO_CONFIG_USE_GYRO_BOTH) {
gyroSensor2.gyroDev.bus.busdev_u.spi.csnPin = IOGetByTag(IO_TAG(GYRO_2_CS_PIN));
IOInit(gyroSensor2.gyroDev.bus.busdev_u.spi.csnPin, OWNER_MPU_CS, RESOURCE_INDEX(1));
IOHi(gyroSensor2.gyroDev.bus.busdev_u.spi.csnPin); // Ensure device is disabled, important when two devices are on the same bus.
IOConfigGPIO(gyroSensor2.gyroDev.bus.busdev_u.spi.csnPin, SPI_IO_CS_CFG);
}
#endif
gyroSensor1.gyroDev.gyroAlign = ALIGN_DEFAULT;
#if defined(GYRO_1_EXTI_PIN)
gyroSensor1.gyroDev.mpuIntExtiTag = IO_TAG(GYRO_1_EXTI_PIN);
#elif defined(MPU_INT_EXTI)
gyroSensor1.gyroDev.mpuIntExtiTag = IO_TAG(MPU_INT_EXTI);
#elif defined(USE_HARDWARE_REVISION_DETECTION)
gyroSensor1.gyroDev.mpuIntExtiTag = selectMPUIntExtiConfigByHardwareRevision();
#else
gyroSensor1.gyroDev.mpuIntExtiTag = IO_TAG_NONE;
#endif // GYRO_1_EXTI_PIN
#ifdef USE_DUAL_GYRO
#ifdef GYRO_1_ALIGN
gyroSensor1.gyroDev.gyroAlign = GYRO_1_ALIGN;
#endif
gyroSensor1.gyroDev.bus.bustype = BUSTYPE_SPI;
spiBusSetInstance(&gyroSensor1.gyroDev.bus, GYRO_1_SPI_INSTANCE);
if (gyroToUse == GYRO_CONFIG_USE_GYRO_1 || gyroToUse == GYRO_CONFIG_USE_GYRO_BOTH) {
ret = gyroInitSensor(&gyroSensor1);
if (!ret) { if (!ret) {
return false; // TODO handle failure of first gyro detection better. - Perhaps update the config to use second gyro then indicate a new failure mode and reboot. return false; // TODO handle failure of first gyro detection better. - Perhaps update the config to use second gyro then indicate a new failure mode and reboot.
} }
gyroHasOverflowProtection = gyroHasOverflowProtection && gyroSensor1.gyroDev.gyroHasOverflowProtection; gyroHasOverflowProtection = gyroHasOverflowProtection && gyroSensor1.gyroDev.gyroHasOverflowProtection;
} }
#else // USE_DUAL_GYRO
ret = gyroInitSensor(&gyroSensor1);
gyroHasOverflowProtection = gyroHasOverflowProtection && gyroSensor1.gyroDev.gyroHasOverflowProtection;
#endif // USE_DUAL_GYRO
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
gyroSensor2.gyroDev.gyroAlign = ALIGN_DEFAULT;
#if defined(GYRO_2_EXTI_PIN)
gyroSensor2.gyroDev.mpuIntExtiTag = IO_TAG(GYRO_2_EXTI_PIN);
#elif defined(USE_HARDWARE_REVISION_DETECTION)
gyroSensor2.gyroDev.mpuIntExtiTag = selectMPUIntExtiConfigByHardwareRevision();
#else
gyroSensor2.gyroDev.mpuIntExtiTag = IO_TAG_NONE;
#endif // GYRO_2_EXTI_PIN
#ifdef GYRO_2_ALIGN
gyroSensor2.gyroDev.gyroAlign = GYRO_2_ALIGN;
#endif
gyroSensor2.gyroDev.bus.bustype = BUSTYPE_SPI;
spiBusSetInstance(&gyroSensor2.gyroDev.bus, GYRO_2_SPI_INSTANCE);
if (gyroToUse == GYRO_CONFIG_USE_GYRO_2 || gyroToUse == GYRO_CONFIG_USE_GYRO_BOTH) { if (gyroToUse == GYRO_CONFIG_USE_GYRO_2 || gyroToUse == GYRO_CONFIG_USE_GYRO_BOTH) {
ret = gyroInitSensor(&gyroSensor2); ret = gyroInitSensor(&gyroSensor2, gyroDeviceConfig(1));
if (!ret) { if (!ret) {
return false; // TODO handle failure of second gyro detection better. - Perhaps update the config to use first gyro then indicate a new failure mode and reboot. return false; // TODO handle failure of second gyro detection better. - Perhaps update the config to use first gyro then indicate a new failure mode and reboot.
} }
gyroHasOverflowProtection = gyroHasOverflowProtection && gyroSensor2.gyroDev.gyroHasOverflowProtection; gyroHasOverflowProtection = gyroHasOverflowProtection && gyroSensor2.gyroDev.gyroHasOverflowProtection;
} }
#endif // USE_DUAL_GYRO
#ifdef USE_DUAL_GYRO
// Only allow using both gyros simultaneously if they are the same hardware type. // Only allow using both gyros simultaneously if they are the same hardware type.
// If the user selected "BOTH" and they are not the same type, then reset to using only the first gyro. // If the user selected "BOTH" and they are not the same type, then reset to using only the first gyro.
if (gyroToUse == GYRO_CONFIG_USE_GYRO_BOTH) { if (gyroToUse == GYRO_CONFIG_USE_GYRO_BOTH) {
@ -620,7 +520,8 @@ bool gyroInit(void)
} }
} }
#endif // USE_DUAL_GYRO #endif
return ret; return ret;
} }
@ -778,7 +679,7 @@ static void gyroInitSensorFilters(gyroSensor_t *gyroSensor)
void gyroInitFilters(void) void gyroInitFilters(void)
{ {
gyroInitSensorFilters(&gyroSensor1); gyroInitSensorFilters(&gyroSensor1);
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
gyroInitSensorFilters(&gyroSensor2); gyroInitSensorFilters(&gyroSensor2);
#endif #endif
} }
@ -790,22 +691,20 @@ FAST_CODE bool isGyroSensorCalibrationComplete(const gyroSensor_t *gyroSensor)
FAST_CODE bool isGyroCalibrationComplete(void) FAST_CODE bool isGyroCalibrationComplete(void)
{ {
#ifdef USE_DUAL_GYRO
switch (gyroToUse) { switch (gyroToUse) {
default: default:
case GYRO_CONFIG_USE_GYRO_1: { case GYRO_CONFIG_USE_GYRO_1: {
return isGyroSensorCalibrationComplete(&gyroSensor1); return isGyroSensorCalibrationComplete(&gyroSensor1);
} }
#ifdef USE_MULTI_GYRO
case GYRO_CONFIG_USE_GYRO_2: { case GYRO_CONFIG_USE_GYRO_2: {
return isGyroSensorCalibrationComplete(&gyroSensor2); return isGyroSensorCalibrationComplete(&gyroSensor2);
} }
case GYRO_CONFIG_USE_GYRO_BOTH: { case GYRO_CONFIG_USE_GYRO_BOTH: {
return isGyroSensorCalibrationComplete(&gyroSensor1) && isGyroSensorCalibrationComplete(&gyroSensor2); return isGyroSensorCalibrationComplete(&gyroSensor1) && isGyroSensorCalibrationComplete(&gyroSensor2);
} }
}
#else
return isGyroSensorCalibrationComplete(&gyroSensor1);
#endif #endif
}
} }
static bool isOnFinalGyroCalibrationCycle(const gyroCalibration_t *gyroCalibration) static bool isOnFinalGyroCalibrationCycle(const gyroCalibration_t *gyroCalibration)
@ -832,7 +731,7 @@ void gyroStartCalibration(bool isFirstArmingCalibration)
{ {
if (!(isFirstArmingCalibration && firstArmingCalibrationWasStarted)) { if (!(isFirstArmingCalibration && firstArmingCalibrationWasStarted)) {
gyroSetCalibrationCycles(&gyroSensor1); gyroSetCalibrationCycles(&gyroSensor1);
#ifdef USE_DUAL_GYRO #ifdef USE_MULTI_GYRO
gyroSetCalibrationCycles(&gyroSensor2); gyroSetCalibrationCycles(&gyroSensor2);
#endif #endif
@ -1073,7 +972,6 @@ static FAST_CODE FAST_CODE_NOINLINE void gyroUpdateSensor(gyroSensor_t *gyroSens
FAST_CODE void gyroUpdate(timeUs_t currentTimeUs) FAST_CODE void gyroUpdate(timeUs_t currentTimeUs)
{ {
#ifdef USE_DUAL_GYRO
switch (gyroToUse) { switch (gyroToUse) {
case GYRO_CONFIG_USE_GYRO_1: case GYRO_CONFIG_USE_GYRO_1:
gyroUpdateSensor(&gyroSensor1, currentTimeUs); gyroUpdateSensor(&gyroSensor1, currentTimeUs);
@ -1089,6 +987,7 @@ FAST_CODE void gyroUpdate(timeUs_t currentTimeUs)
DEBUG_SET(DEBUG_DUAL_GYRO_COMBINE, 0, lrintf(gyro.gyroADCf[X])); DEBUG_SET(DEBUG_DUAL_GYRO_COMBINE, 0, lrintf(gyro.gyroADCf[X]));
DEBUG_SET(DEBUG_DUAL_GYRO_COMBINE, 1, lrintf(gyro.gyroADCf[Y])); DEBUG_SET(DEBUG_DUAL_GYRO_COMBINE, 1, lrintf(gyro.gyroADCf[Y]));
break; break;
#ifdef USE_MULTI_GYRO
case GYRO_CONFIG_USE_GYRO_2: case GYRO_CONFIG_USE_GYRO_2:
gyroUpdateSensor(&gyroSensor2, currentTimeUs); gyroUpdateSensor(&gyroSensor2, currentTimeUs);
if (isGyroSensorCalibrationComplete(&gyroSensor2)) { if (isGyroSensorCalibrationComplete(&gyroSensor2)) {
@ -1125,13 +1024,8 @@ FAST_CODE void gyroUpdate(timeUs_t currentTimeUs)
DEBUG_SET(DEBUG_DUAL_GYRO_DIFF, 1, lrintf(gyroSensor1.gyroDev.gyroADCf[Y] - gyroSensor2.gyroDev.gyroADCf[Y])); DEBUG_SET(DEBUG_DUAL_GYRO_DIFF, 1, lrintf(gyroSensor1.gyroDev.gyroADCf[Y] - gyroSensor2.gyroDev.gyroADCf[Y]));
DEBUG_SET(DEBUG_DUAL_GYRO_DIFF, 2, lrintf(gyroSensor1.gyroDev.gyroADCf[Z] - gyroSensor2.gyroDev.gyroADCf[Z])); DEBUG_SET(DEBUG_DUAL_GYRO_DIFF, 2, lrintf(gyroSensor1.gyroDev.gyroADCf[Z] - gyroSensor2.gyroDev.gyroADCf[Z]));
break; break;
}
#else
gyroUpdateSensor(&gyroSensor1, currentTimeUs);
gyro.gyroADCf[X] = gyroSensor1.gyroDev.gyroADCf[X];
gyro.gyroADCf[Y] = gyroSensor1.gyroDev.gyroADCf[Y];
gyro.gyroADCf[Z] = gyroSensor1.gyroDev.gyroADCf[Z];
#endif #endif
}
} }
bool gyroGetAccumulationAverage(float *accumulationAverage) bool gyroGetAccumulationAverage(float *accumulationAverage)
@ -1166,15 +1060,7 @@ int16_t gyroGetTemperature(void)
int16_t gyroRateDps(int axis) int16_t gyroRateDps(int axis)
{ {
#ifdef USE_DUAL_GYRO return lrintf(gyro.gyroADCf[axis] / ACTIVE_GYRO->gyroDev.scale);
if (gyroToUse == GYRO_CONFIG_USE_GYRO_2) {
return lrintf(gyro.gyroADCf[axis] / gyroSensor2.gyroDev.scale);
} else {
return lrintf(gyro.gyroADCf[axis] / gyroSensor1.gyroDev.scale);
}
#else
return lrintf(gyro.gyroADCf[axis] / gyroSensor1.gyroDev.scale);
#endif
} }
bool gyroOverflowDetected(void) bool gyroOverflowDetected(void)

View file

@ -42,21 +42,28 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_ACC #define USE_ACC
#define USE_GYRO
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define USE_GYRO_SPI_MPU6000
#define MPU6000_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1
#define ACC_MPU6000_ALIGN CW0_DEG_FLIP
#define GYRO_MPU6000_ALIGN CW0_DEG_FLIP
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define USE_GYRO
#define USE_GYRO_SPI_MPU6000
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define MPU6500_CS_PIN MPU6000_CS_PIN
#define MPU6500_SPI_INSTANCE MPU6000_SPI_INSTANCE #define USE_MULTI_GYRO
#define ACC_MPU6500_ALIGN CW0_DEG_FLIP
#define GYRO_MPU6500_ALIGN CW0_DEG_FLIP #define GYRO_1_SPI_INSTANCE SPI1
#define GYRO_1_CS_PIN PA4
#define GYRO_1_EXTI_PIN NONE
#define ACC_1_ALIGN CW0_DEG_FLIP
#define GYRO_1_ALIGN CW0_DEG_FLIP
#define GYRO_2_SPI_INSTANCE SPI1
#define GYRO_2_CS_PIN PC15
#define GYRO_2_EXTI_PIN NONE
#define ACC_2_ALIGN CW0_DEG_FLIP
#define GYRO_2_ALIGN CW0_DEG_FLIP
#define USE_MAG #define USE_MAG
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883

View file

@ -33,24 +33,22 @@
#define INVERTER_PIN_UART1 PC0 #define INVERTER_PIN_UART1 PC0
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4
#define USE_MPU_DATA_READY_SIGNAL
#define MPU6000_CS_PIN SPI1_NSS_PIN
#define MPU6000_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define USE_GYRO_SPI_MPU6500
#define GYRO_1_CS_PIN SPI1_NSS_PIN
#define GYRO_1_SPI_INSTANCE SPI1
#define GYRO_1_ALIGN CW0_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW0_DEG
#define ACC_MPU6000_ALIGN CW0_DEG
#define USE_GYRO_SPI_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define MPU6500_CS_PIN MPU6000_CS_PIN #define ACC_1_ALIGN CW0_DEG
#define MPU6500_SPI_INSTANCE MPU6000_SPI_INSTANCE
#define GYRO_MPU6500_ALIGN GYRO_MPU6000_ALIGN #define USE_GYRO_EXTI
#define ACC_MPU6500_ALIGN ACC_MPU6000_ALIGN #define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL
#define USE_BARO #define USE_BARO
#define USE_BARO_BMP280 #define USE_BARO_BMP280

View file

@ -30,26 +30,27 @@
// MPU6050 interrupts // MPU6050 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA15 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA15
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
//#define ENSURE_MPU_DATA_READY_IS_LOW //#define ENSURE_MPU_DATA_READY_IS_LOW
#define USE_GYRO #define USE_GYRO
#define USE_ACC #define USE_ACC
#define USE_GYRO_MPU6050 // MPU6050 support has been dropped according to board wiki
#define GYRO_MPU6050_ALIGN CW180_DEG // https://github.com/betaflight/betaflight/wiki/Board---AIR32
//#define USE_GYRO_MPU6050
#define USE_ACC_MPU6050 //#define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW180_DEG
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#define MPU6000_CS_PIN PB12 #define GYRO_1_CS_PIN PB12
#define MPU6000_SPI_INSTANCE SPI2 #define GYRO_1_SPI_INSTANCE SPI2
#define GYRO_1_ALIGN CW180_DEG
#define ACC_1_ALIGN CW180_DEG
//#define USE_BARO //#define USE_BARO
//#define USE_BARO_MS5611 //#define USE_BARO_MS5611

View file

@ -32,23 +32,24 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define USE_SPI #define USE_SPI
#define USE_SPI_DEVICE_2 #define USE_SPI_DEVICE_2
#define MPU6500_CS_PIN PB12 #define GYRO_1_CS_PIN PB12
#define MPU6500_SPI_INSTANCE SPI2 #define GYRO_1_SPI_INSTANCE SPI2
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_SPI_BMP280 #define USE_BARO_SPI_BMP280

View file

@ -37,12 +37,12 @@
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define USE_UART1 #define USE_UART1
#define USE_UART2 #define USE_UART2

View file

@ -37,6 +37,7 @@
#include "flight/pid.h" #include "flight/pid.h"
#include "pg/beeper_dev.h" #include "pg/beeper_dev.h"
#include "pg/gyrodev.h"
#include "pg/rx.h" #include "pg/rx.h"
#include "rx/rx.h" #include "rx/rx.h"
@ -60,6 +61,8 @@
// alternative defaults settings for AlienFlight targets // alternative defaults settings for AlienFlight targets
void targetConfiguration(void) void targetConfiguration(void)
{ {
gyroDeviceConfigMutable(0)->extiTag = selectMPUIntExtiConfigByHardwareRevision();
/* depending on revision ... depends on the LEDs to be utilised. */ /* depending on revision ... depends on the LEDs to be utilised. */
if (hardwareRevision == AFF3_REV_2) { if (hardwareRevision == AFF3_REV_2) {
statusLedConfigMutable()->inversion = 0 statusLedConfigMutable()->inversion = 0

View file

@ -49,15 +49,15 @@
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6050_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define GYRO_MPU6500_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6050_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define ACC_MPU6500_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
// No baro support. // No baro support.
//#define USE_BARO //#define USE_BARO
@ -106,8 +106,8 @@
#define SPI3_MISO_PIN PB4 #define SPI3_MISO_PIN PB4
#define SPI3_MOSI_PIN PB5 #define SPI3_MOSI_PIN PB5
#define MPU6500_CS_PIN SPI3_NSS_PIN #define GYRO_1_CS_PIN SPI3_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI3 #define GYRO_1_SPI_INSTANCE SPI3
#define USE_ADC #define USE_ADC

View file

@ -38,21 +38,22 @@
// MPU interrupt // MPU interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC14 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC14
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define MPU6500_CS_PIN SPI1_NSS_PIN #define GYRO_1_CS_PIN SPI1_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_MAG #define USE_MAG
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883

View file

@ -36,21 +36,22 @@
// MPU interrupt // MPU interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC14 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC14
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define MPU6500_CS_PIN SPI1_NSS_PIN #define GYRO_1_CS_PIN SPI1_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_MAG #define USE_MAG
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883

View file

@ -121,10 +121,11 @@
*/ */
// Interrupt // Interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC14 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC14
// MPU // MPU
#define MPU6500_CS_PIN SPI1_NSS_PIN #define GYRO_1_CS_PIN SPI1_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
// MAG // MAG
@ -136,11 +137,11 @@
// GYRO // GYRO
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
// ACC // ACC
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
/* Optional Digital Pressure Sensor (barometer) - Bosch BMP280 /* Optional Digital Pressure Sensor (barometer) - Bosch BMP280
* TODO: not implemented on V1 or V2 pcb * TODO: not implemented on V1 or V2 pcb

View file

@ -31,20 +31,22 @@
#define BEEPER_PIN PB2 // Unused pin, can be mapped to elsewhere #define BEEPER_PIN PB2 // Unused pin, can be mapped to elsewhere
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
// MPU6000 interrupts // MPU6000 interrupts
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU_INT_EXTI PC4 #define USE_EXTI
#define USE_GYRO_EXTI
#define GYRO_1_EXTI_PINPC4
#define USE_EXTI #define USE_EXTI
#define USE_MAG #define USE_MAG

View file

@ -31,20 +31,22 @@
#define BEEPER_PIN PB2 // Unused pin, can be mapped to elsewhere #define BEEPER_PIN PB2 // Unused pin, can be mapped to elsewhere
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
// MPU6000 interrupts // MPU6000 interrupts
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU_INT_EXTI PC4 #define USE_EXTI
#define USE_GYRO_EXTI
#define GYRO_1_EXTI_PINPC4
#define USE_EXTI #define USE_EXTI
#define USE_MAG #define USE_MAG

View file

@ -32,23 +32,24 @@
#define LED1_PIN PB2 #define LED1_PIN PB2
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PB6 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PB6
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#if defined(BEESTORM) #if defined(BEESTORM)
#define GYRO_MPU6500_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#else #else
#define GYRO_MPU6500_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#endif #endif
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#if defined(BEESTORM) #if defined(BEESTORM)
#define ACC_MPU6500_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
#else #else
#define ACC_MPU6500_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#endif #endif
#define SERIAL_PORT_COUNT 4 #define SERIAL_PORT_COUNT 4
@ -85,8 +86,8 @@
#define SPI3_MISO_PIN PB4 #define SPI3_MISO_PIN PB4
#define SPI3_MOSI_PIN PB5 #define SPI3_MOSI_PIN PB5
#define MPU6500_CS_PIN PA15 #define GYRO_1_CS_PIN PA15
#define MPU6500_SPI_INSTANCE SPI3 #define GYRO_1_SPI_INSTANCE SPI3
#define USE_MAX7456 #define USE_MAX7456
#define MAX7456_SPI_INSTANCE SPI1 #define MAX7456_SPI_INSTANCE SPI1

View file

@ -33,21 +33,22 @@
// ICM20689 interrupt // ICM20689 interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA8 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA8
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define ICM20689_CS_PIN SPI1_NSS_PIN #define GYRO_1_CS_PIN SPI1_NSS_PIN
#define ICM20689_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_ICM20689 #define USE_ACC_SPI_ICM20689
#define ACC_ICM20689_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_ICM20689 #define USE_GYRO_SPI_ICM20689
#define GYRO_ICM20689_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_BMP280 #define USE_BARO_BMP280

View file

@ -51,20 +51,22 @@
#define USABLE_TIMER_CHANNEL_COUNT 10 #define USABLE_TIMER_CHANNEL_COUNT 10
#define MPU6000_CS_PIN PA15 #define GYRO_1_CS_PIN PA15
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
// MPU6000 interrupts // MPU6000 interrupts
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU_INT_EXTI PC13 #define USE_EXTI
#define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define USE_EXTI #define USE_EXTI
#define REMAP_TIM16_DMA #define REMAP_TIM16_DMA

View file

@ -32,22 +32,23 @@
// PC13 used as inverter select GPIO for UART2 // PC13 used as inverter select GPIO for UART2
#define INVERTER_PIN_UART2 PC13 #define INVERTER_PIN_UART2 PC13
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_BARO #define USE_BARO

View file

@ -47,22 +47,21 @@
// MPU6500 interrupt // MPU6500 interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC5 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC5
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define MPU6500_CS_PIN PC4 #define GYRO_1_CS_PIN PC4
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define USE_MAG #define USE_MAG
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883

View file

@ -31,7 +31,8 @@
#define BEEPER_OPT PA2 #define BEEPER_OPT PA2
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA3 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA3
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
@ -39,8 +40,8 @@
#define USE_SPI_DEVICE_1 #define USE_SPI_DEVICE_1
#define USE_SPI_DEVICE_2 #define USE_SPI_DEVICE_2
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define FLASH_CS_PIN PB12 #define FLASH_CS_PIN PB12
#define FLASH_SPI_INSTANCE SPI2 #define FLASH_SPI_INSTANCE SPI2
@ -50,11 +51,11 @@
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
// MPU6000 interrupts // MPU6000 interrupts
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL

View file

@ -69,7 +69,7 @@
//#define L3GD20_CS_PIN PE3 //#define L3GD20_CS_PIN PE3
//#define GYRO_L3GD20_ALIGN CW270_DEG //#define GYRO_L3GD20_ALIGN CW270_DEG
#define GYRO_MPU6050_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
@ -81,7 +81,7 @@
//#define LSM303DLHC_I2C_INT1_PIN PE4 //#define LSM303DLHC_I2C_INT1_PIN PE4
//#define LSM303DLHC_I2C_INT2_PIN PE5 //#define LSM303DLHC_I2C_INT2_PIN PE5
#define ACC_MPU6050_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_MS5611 #define USE_BARO_MS5611

View file

@ -6,12 +6,6 @@ TARGET_SRC = \
drivers/accgyro/accgyro_mpu.c \ drivers/accgyro/accgyro_mpu.c \
drivers/accgyro/accgyro_mpu3050.c \ drivers/accgyro/accgyro_mpu3050.c \
drivers/accgyro/accgyro_mpu6050.c \ drivers/accgyro/accgyro_mpu6050.c \
drivers/accgyro_legacy/accgyro_l3gd20.c \
drivers/accgyro_legacy/accgyro_lsm303dlhc.c \
drivers/accgyro_legacy/accgyro_adxl345.c \
drivers/accgyro_legacy/accgyro_bma280.c \
drivers/accgyro_legacy/accgyro_mma845x.c \
drivers/accgyro_legacy/accgyro_l3g4200d.c \
drivers/barometer/barometer_ms5611.c \ drivers/barometer/barometer_ms5611.c \
drivers/barometer/barometer_bmp280.c \ drivers/barometer/barometer_bmp280.c \
drivers/compass/compass_ak8975.c drivers/compass/compass_ak8975.c

View file

@ -0,0 +1,38 @@
/*
* This file is part of Cleanflight and Betaflight.
*
* Cleanflight and Betaflight are free software. You can redistribute
* this software and/or modify this software under the terms of the
* GNU General Public License as published by the Free Software
* Foundation, either version 3 of the License, or (at your option)
* any later version.
*
* Cleanflight and Betaflight are distributed in the hope that they
* will be useful, but WITHOUT ANY WARRANTY; without even the implied
* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
* See the GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this software.
*
* If not, see <http://www.gnu.org/licenses/>.
*/
#include <stdbool.h>
#include <stdint.h>
#include "platform.h"
#ifdef USE_TARGET_CONFIG
#include "drivers/io_types.h"
#include "hardware_revision.h"
#include "pg/pg.h"
#include "pg/gyrodev.h"
void targetConfiguration(void)
{
gyroDeviceConfigMutable(0)->extiTag = selectMPUIntExtiConfigByHardwareRevision();
}
#endif

View file

@ -22,6 +22,7 @@
#define TARGET_BOARD_IDENTIFIER "CJM1" // CJMCU #define TARGET_BOARD_IDENTIFIER "CJM1" // CJMCU
#define USE_HARDWARE_REVISION_DETECTION #define USE_HARDWARE_REVISION_DETECTION
#define USE_TARGET_CONFIG
#define TARGET_BUS_INIT #define TARGET_BUS_INIT
#define LED0_PIN PC14 #define LED0_PIN PC14

View file

@ -38,32 +38,29 @@
#define INVERTER_PIN_UART1 PC0 // PC0 used as inverter select GPIO #define INVERTER_PIN_UART1 PC0 // PC0 used as inverter select GPIO
#define CAMERA_CONTROL_PIN PB9 // define dedicated camera_osd_control pin
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
// MPU 6000
#define MPU6000_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000
#define USE_GYRO #define USE_GYRO
// MPU 6000
#define USE_ACC_SPI_MPU6000
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW0_DEG
#define ACC_MPU6000_ALIGN CW0_DEG
// ICM-20602 // ICM-20602
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW0_DEG #define GYRO_1_CS_PIN PA4
#define GYRO_MPU6500_ALIGN CW0_DEG #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN PA4 #define GYRO_1_ALIGN CW0_DEG
#define MPU6500_SPI_INSTANCE SPI1 #define ACC_1_ALIGN CW0_DEG
#define USE_MAX7456 #define USE_MAX7456
#define MAX7456_SPI_INSTANCE SPI3 #define MAX7456_SPI_INSTANCE SPI3

View file

@ -30,29 +30,27 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
//MPU-6000
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000
#define USE_GYRO #define USE_GYRO
//MPU-6000
#define USE_ACC_SPI_MPU6000
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW0_DEG
#define ACC_MPU6000_ALIGN CW0_DEG
#define MPU6000_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1
// ICM-20602 // ICM-20602
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW0_DEG #define GYRO_1_CS_PIN PA4
#define GYRO_MPU6500_ALIGN CW0_DEG #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN SPI1_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_ALIGN CW0_DEG
#define ACC_1_ALIGN CW0_DEG
#define USE_MAX7456 #define USE_MAX7456
#define MAX7456_SPI_INSTANCE SPI3 #define MAX7456_SPI_INSTANCE SPI3

View file

@ -37,20 +37,21 @@
#define INVERTER_PIN_UART2 PB2 // PB2 used as inverter select GPIO #define INVERTER_PIN_UART2 PB2 // PB2 used as inverter select GPIO
#define MPU6000_CS_PIN PC4 #define GYRO_1_CS_PIN PC4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG_FLIP #define ACC_1_ALIGN CW270_DEG_FLIP
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG_FLIP #define GYRO_1_ALIGN CW270_DEG_FLIP
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC0 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC0
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_MAG #define USE_MAG

View file

@ -40,7 +40,8 @@
// MPU6500 interrupt // MPU6500 interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA5 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA5
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
@ -52,25 +53,18 @@
#define SPI1_MOSI_PIN PB5 #define SPI1_MOSI_PIN PB5
#define SPI1_NSS_PIN PA4 #define SPI1_NSS_PIN PA4
#define MPU6500_CS_PIN SPI1_NSS_PIN #define GYRO_1_CS_PIN SPI1_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6000_CS_PIN SPI1_NSS_PIN
#define MPU6000_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_MS5611 #define USE_BARO_MS5611

View file

@ -63,16 +63,17 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PINPC13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#define USE_VCP #define USE_VCP
#define USE_UART3 #define USE_UART3

View file

@ -82,17 +82,20 @@
#define USE_I2C_DEVICE_3 #define USE_I2C_DEVICE_3
#define I2C_DEVICE (I2CDEV_3) #define I2C_DEVICE (I2CDEV_3)
// This board only uses I2C acc/gyro
#undef USE_MULTI_GYRO
// MPU9250 has the AD0 pin held high so the // MPU9250 has the AD0 pin held high so the
// address is 0x69 instead of the default 0x68 // address is 0x69 instead of the default 0x68
#define MPU_ADDRESS 0x69 #define MPU_ADDRESS 0x69
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6500 #define USE_GYRO_MPU6500
#define GYRO_MPU6500_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6500 #define USE_ACC_MPU6500
#define ACC_MPU6500_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_MAG #define USE_MAG
#define USE_MPU9250_MAG // Enables bypass configuration on the MPU9250 I2C bus #define USE_MPU9250_MAG // Enables bypass configuration on the MPU9250 I2C bus
@ -100,7 +103,8 @@
#define MAG_AK8963_ALIGN CW270_DEG #define MAG_AK8963_ALIGN CW270_DEG
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define USE_SERIALRX_TARGET_CUSTOM #define USE_SERIALRX_TARGET_CUSTOM
#define SERIALRX_UART SERIAL_PORT_USART6 #define SERIALRX_UART SERIAL_PORT_USART6

View file

@ -40,7 +40,8 @@
#define SPI1_MOSI_PIN PA7 #define SPI1_MOSI_PIN PA7
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_GYRO #define USE_GYRO
@ -55,14 +56,14 @@
#define USE_ACC_SPI_ICM20689 #define USE_ACC_SPI_ICM20689
#define ACC_ICM20689_ALIGN CW90_DEG #define ACC_ICM20689_ALIGN CW90_DEG
//------MPU6000 //------MPU6000
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
//Baro & MAG------------------------------- //Baro & MAG-------------------------------
#define USE_I2C #define USE_I2C

View file

@ -57,10 +57,8 @@
#define SPI2_NSS_PIN PB12 #define SPI2_NSS_PIN PB12
// tqfp48 pin 3 // tqfp48 pin 3
#define MPU6500_CS_PIN SPI1_NSS_PIN #define GYRO_1_CS_PIN SPI1_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6000_CS_PIN SPI1_NSS_PIN
#define MPU6000_SPI_INSTANCE SPI1
// tqfp48 pin 25 // tqfp48 pin 25
#define BMP280_CS_PIN SPI2_NSS_PIN #define BMP280_CS_PIN SPI2_NSS_PIN
@ -73,19 +71,14 @@
#define FLASH_SPI_INSTANCE SPI2 #define FLASH_SPI_INSTANCE SPI2
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW270_DEG
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW270_DEG
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_BMP280 #define USE_BARO_BMP280
@ -121,7 +114,8 @@
// mpu_int definition in sensors/initialisation.c // mpu_int definition in sensors/initialisation.c
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW

View file

@ -26,7 +26,8 @@
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA15 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA15
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
@ -35,20 +36,20 @@
#define USE_SPI_DEVICE_2 #define USE_SPI_DEVICE_2
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define SPI1_SCK_PIN PB3 #define SPI1_SCK_PIN PB3
#define SPI1_MISO_PIN PB4 #define SPI1_MISO_PIN PB4
#define SPI1_MOSI_PIN PB5 #define SPI1_MOSI_PIN PB5
#define MPU6500_CS_PIN PA5 #define GYRO_1_CS_PIN PA5
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#define USE_RX_SPI #define USE_RX_SPI

View file

@ -31,22 +31,23 @@
// MPU9250 interrupt // MPU9250 interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PB5 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PB5
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define MPU6500_CS_PIN PB12 #define GYRO_1_CS_PIN PB12
#define MPU6500_SPI_INSTANCE SPI2 #define GYRO_1_SPI_INSTANCE SPI2
// Using MPU6050 for the moment. // Using MPU6050 for the moment.
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
//#define USE_BARO //#define USE_BARO
//#define USE_BARO_MS5611 //#define USE_BARO_MS5611

View file

@ -36,19 +36,20 @@
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PB0 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PB0
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_MAG #define USE_MAG
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883

View file

@ -52,44 +52,32 @@
/*------------SENSORS--------------*/ /*------------SENSORS--------------*/
// MPU interrupt // MPU interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define USE_GYRO #define USE_GYRO
#define USE_ACC
#if !defined(FF_FORTINIF4_REV03)
#define MPU6000_CS_PIN SPI1_NSS_PIN
#define MPU6000_SPI_INSTANCE SPI1
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG #define USE_GYRO_SPI_MPU6500
#define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#define ICM20689_CS_PIN SPI1_NSS_PIN
#define ICM20689_SPI_INSTANCE SPI1
#define USE_GYRO_SPI_ICM20689 #define USE_GYRO_SPI_ICM20689
#define GYRO_ICM20689_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_ACC_SPI_ICM20689 #define GYRO_1_SPI_INSTANCE SPI1
#define ACC_ICM20689_ALIGN CW180_DEG
#if defined(FF_FORTINIF4_REV03)
#define GYRO_1_CS_PIN PA4
#else
#define GYRO_1_CS_PIN PA8
#endif #endif
#define MPU6500_CS_PIN SPI1_NSS_PIN #define USE_ACC
#define MPU6500_SPI_INSTANCE SPI1 #define USE_ACC_SPI_MPU6000
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW180_DEG
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW180_DEG #define USE_ACC_SPI_ICM20689
#define ACC_1_ALIGN CW180_DEG
/*---------------------------------*/ /*---------------------------------*/
#if !defined(FF_FORTINIF4_REV03) #if !defined(FF_FORTINIF4_REV03)

View file

@ -45,20 +45,21 @@
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA15 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA15
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
#define MPU6000_CS_GPIO GPIOB #define MPU6000_CS_GPIO GPIOB
#define MPU6000_CS_PIN PB12 #define GYRO_1_CS_PIN PB12
#define MPU6000_SPI_INSTANCE SPI2 #define GYRO_1_SPI_INSTANCE SPI2
#define USE_VCP #define USE_VCP
#define USE_UART1 #define USE_UART1

View file

@ -46,38 +46,29 @@
/*------------SENSORS--------------*/ /*------------SENSORS--------------*/
// MPU interrupt // MPU interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#if defined(FF_PIKOF4OSD) #if defined(FF_PIKOF4OSD)
#define MPU6000_CS_PIN PA15 #define GYRO_1_CS_PIN PA15
#define MPU6000_SPI_INSTANCE SPI3 #define GYRO_1_SPI_INSTANCE SPI3
#define MPU6500_CS_PIN PA15
#define MPU6500_SPI_INSTANCE SPI3
#else #else
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN PA4
#define MPU6500_SPI_INSTANCE SPI1
#endif #endif
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
/*---------------------------------*/ /*---------------------------------*/
#if defined(FF_PIKOF4OSD) #if defined(FF_PIKOF4OSD)

View file

@ -38,23 +38,24 @@
#define INVERTER_PIN_UART6 PC8 #define INVERTER_PIN_UART6 PC8
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
// *************** Gyro & ACC ********************** // *************** Gyro & ACC **********************
#define USE_SPI #define USE_SPI
#define USE_SPI_DEVICE_1 #define USE_SPI_DEVICE_1
#define MPU6500_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
// *************** UART ***************************** // *************** UART *****************************
#define USE_VCP #define USE_VCP

View file

@ -40,7 +40,8 @@
#define SPI1_MOSI_PIN PA7 #define SPI1_MOSI_PIN PA7
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_GYRO #define USE_GYRO
@ -55,14 +56,14 @@
#define USE_ACC_SPI_ICM20689 #define USE_ACC_SPI_ICM20689
#define ACC_ICM20689_ALIGN CW90_DEG #define ACC_ICM20689_ALIGN CW90_DEG
//------MPU6000 //------MPU6000
#define MPU6000_CS_PIN PB2 #define GYRO_1_CS_PIN PB2
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
//Baro & MAG------------------------------- //Baro & MAG-------------------------------
#define USE_I2C #define USE_I2C

View file

@ -53,29 +53,30 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PINPC13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define EXTI15_10_CALLBACK_HANDLER_COUNT 1 // MPU_INT, SDCardDetect #define EXTI15_10_CALLBACK_HANDLER_COUNT 1 // MPU_INT, SDCardDetect
#define MPU_ADDRESS 0x69 #define MPU_ADDRESS 0x69
#ifdef MYMPU6000 #ifdef MYMPU6000
#define MPU6000_SPI_INSTANCE SPI2 #define GYRO_1_SPI_INSTANCE SPI2
#define MPU6000_CS_PIN PB12 #define GYRO_1_CS_PIN PB12
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#else #else
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#endif #endif
#define USE_VCP #define USE_VCP

View file

@ -31,8 +31,8 @@
#define INVERTER_PIN_UART6 PC8 #define INVERTER_PIN_UART6 PC8
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
@ -40,11 +40,12 @@
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_BARO #define USE_BARO

View file

@ -64,40 +64,28 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA3 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA3
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define ICM20689_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define ICM20689_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6000_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN PA4
#define MPU6500_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_ICM20689
#define GYRO_ICM20689_ALIGN CW180_DEG
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW90_DEG #define USE_GYRO_SPI_ICM20689
// MPU6000 and ICM20689 are CW180 aligned.
// MPU6500 is CW90 aligned, but can't handle this.
// Must be configured after flashing.
#define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_ICM20689
#define ACC_ICM20689_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW90_DEG #define USE_ACC_SPI_ICM20689
#define ACC_1_ALIGN CW180_DEG
#define USE_SPI #define USE_SPI
#define USE_SPI_DEVICE_1 #define USE_SPI_DEVICE_1

View file

@ -39,41 +39,24 @@
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ICM20689_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define ICM20689_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6000_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN PA4
#define MPU6500_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_ICM20689
#define GYRO_ICM20689_ALIGN CW180_DEG
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW180_DEG #define USE_GYRO_SPI_ICM20689
#define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_ICM20689
#define ACC_ICM20689_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW180_DEG #define USE_ACC_SPI_ICM20689
#define ACC_1_ALIGN CW180_DEG
#ifdef FURYF4OSD #ifdef FURYF4OSD
#define USE_MAX7456 #define USE_MAX7456

View file

@ -32,19 +32,20 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ICM20689_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define ICM20689_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_ICM20689 #define USE_GYRO_SPI_ICM20689
#define GYRO_ICM20689_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_ICM20689 #define USE_ACC_SPI_ICM20689
#define ACC_ICM20689_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
//#define USE_BARO //#define USE_BARO
//#define USE_BARO_MS5611 //#define USE_BARO_MS5611

View file

@ -50,17 +50,18 @@
#define BEEPER_PIN PC15 #define BEEPER_PIN PC15
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define USE_FLASHFS #define USE_FLASHFS
#define USE_FLASH_M25P16 #define USE_FLASH_M25P16
@ -93,8 +94,8 @@
#define FLASH_CS_PIN PB12 #define FLASH_CS_PIN PB12
#define FLASH_SPI_INSTANCE SPI2 #define FLASH_SPI_INSTANCE SPI2
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_MAX7456 #define USE_MAX7456
#define MAX7456_SPI_INSTANCE SPI1 #define MAX7456_SPI_INSTANCE SPI1

View file

@ -26,17 +26,18 @@
#define LED0_PIN PB3 #define LED0_PIN PB3
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_BMP085 #define USE_BARO_BMP085

View file

@ -31,7 +31,8 @@
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
@ -40,11 +41,9 @@
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6500 #define USE_GYRO_MPU6500
//#define USE_GYRO_SPI_MPU6500
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6500 #define USE_ACC_MPU6500
//#define USE_ACC_SPI_MPU6500
#define USE_BARO #define USE_BARO
#define USE_BARO_BMP280 #define USE_BARO_BMP280

View file

@ -56,21 +56,22 @@
// ICM20689 interrupt // ICM20689 interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC5 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC5
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define ICM20689_CS_PIN PC4 #define GYRO_1_CS_PIN PC4
#define ICM20689_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_ICM20689 #define USE_ACC_SPI_ICM20689
#define ACC_ICM20689_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_ICM20689 #define USE_GYRO_SPI_ICM20689
#define GYRO_ICM20689_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#if defined(FLYWOOF405) #if defined(FLYWOOF405)
//------MPU6000 //------MPU6000

View file

@ -31,26 +31,24 @@
#define BEEPER_PIN PD15 #define BEEPER_PIN PD15
#define BEEPER_INVERTED #define BEEPER_INVERTED
//define camera control
#define CAMERA_CONTROL_PIN PE13
#define USE_ACC #define USE_ACC
#define USE_GYRO #define USE_GYRO
#define USE_EXTI
// ICM-20689 // ICM-20689
#define USE_ACC_SPI_ICM20689 #define USE_ACC_SPI_ICM20689
#define USE_GYRO_SPI_ICM20689 #define USE_GYRO_SPI_ICM20689
#define GYRO_ICM20689_ALIGN CW270_DEG #define GYRO_1_CS_PIN SPI4_NSS_PIN
#define ACC_ICM20689_ALIGN CW270_DEG #define GYRO_1_SPI_INSTANCE SPI4
#define MPU_INT_EXTI PE1 #define GYRO_1_ALIGN CW270_DEG
#define ACC_1_ALIGN CW270_DEG
#define ICM20689_CS_PIN SPI4_NSS_PIN
#define ICM20689_SPI_INSTANCE SPI4
#define GYRO_1_CS_PIN ICM20689_CS_PIN
#define GYRO_1_SPI_INSTANCE ICM20689_SPI_INSTANCE
#define ACC_1_ALIGN ACC_ICM20689_ALIGN
#define GYRO_1_ALIGN GYRO_ICM20689_ALIGN
#define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PE1
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_EXTI
#define USE_VCP #define USE_VCP
#define USE_USB_DETECT #define USE_USB_DETECT
@ -173,4 +171,3 @@
#define USABLE_TIMER_CHANNEL_COUNT 8 #define USABLE_TIMER_CHANNEL_COUNT 8
#define USED_TIMERS ( TIM_N(1) | TIM_N(5) | TIM_N(3) | TIM_N(4) | TIM_N(8) ) #define USED_TIMERS ( TIM_N(1) | TIM_N(5) | TIM_N(3) | TIM_N(4) | TIM_N(8) )

View file

@ -36,19 +36,21 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PB2 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PB2
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#ifdef KISSCC #ifdef KISSCC
#define USE_TARGET_CONFIG #define USE_TARGET_CONFIG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#define TARGET_DEFAULT_MIXER MIXER_QUADX_1234 #define TARGET_DEFAULT_MIXER MIXER_QUADX_1234
@ -56,11 +58,11 @@
#else #else
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
#endif #endif
#define USE_VCP #define USE_VCP

View file

@ -34,16 +34,16 @@
#define BEEPER_PIN PC9 #define BEEPER_PIN PC9
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define MPU6000_CS_PIN PB12 #define GYRO_1_CS_PIN PB12
#define MPU6000_SPI_INSTANCE SPI2 #define GYRO_1_SPI_INSTANCE SPI2
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#define USE_SPI #define USE_SPI

View file

@ -49,21 +49,19 @@
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#if defined(KIWIF4) || defined(KIWIF4V2) #if defined(KIWIF4) || defined(KIWIF4V2)
#define USE_MAX7456 #define USE_MAX7456

View file

@ -39,21 +39,22 @@
#define INVERTER_PIN_UART1 PB13 #define INVERTER_PIN_UART1 PB13
#define INVERTER_PIN_UART6 PB12 #define INVERTER_PIN_UART6 PB12
#define MPU6000_CS_PIN PB2 #define GYRO_1_CS_PIN PB2
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU_INT_EXTI PA4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA4
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_MAG #define USE_MAG
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883

View file

@ -27,15 +27,16 @@
#define BEEPER_PIN PC15 #define BEEPER_PIN PC15
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA3 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA3
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_SPI #define USE_SPI
#define USE_SPI_DEVICE_1 #define USE_SPI_DEVICE_1
#define USE_SPI_DEVICE_2 #define USE_SPI_DEVICE_2
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define FLASH_CS_PIN PB12 #define FLASH_CS_PIN PB12
#define FLASH_SPI_INSTANCE SPI2 #define FLASH_SPI_INSTANCE SPI2
@ -45,11 +46,11 @@
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#define USE_VCP #define USE_VCP
#define USE_UART1 #define USE_UART1

View file

@ -51,7 +51,8 @@
// MPU6500 interrupt // MPU6500 interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA5 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA5
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
@ -92,31 +93,27 @@
#define SDCARD_DMA_CHANNEL_TX DMA1_Channel5 #define SDCARD_DMA_CHANNEL_TX DMA1_Channel5
#endif #endif
#define MPU6000_CS_PIN SPI1_NSS_PIN #define GYRO_1_CS_PIN SPI1_NSS_PIN
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN SPI1_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI1
#define USE_GYRO #define USE_GYRO
#ifdef LUXV2_RACE #ifdef LUXV2_RACE
#define USE_GYRO_MPU6000
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#else #else
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#endif #endif
#define USE_ACC #define USE_ACC
#ifdef LUXV2_RACE #ifdef LUXV2_RACE
#define USE_ACC_MPU6000 #define USE_ACC_MPU6000
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#else #else
#define USE_ACC_MPU6500 #define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#endif #endif
#define USE_VCP #define USE_VCP

View file

@ -40,29 +40,28 @@
#define SPI1_MISO_PIN PA6 #define SPI1_MISO_PIN PA6
#define SPI1_MOSI_PIN PA7 #define SPI1_MOSI_PIN PA7
#define MPU6000_CS_PIN PC2 #define GYRO_1_CS_PIN PC2
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN PC2 #define GYRO_1_CS_PIN PC2
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC3 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC3
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW270_DEG
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW180_DEG #define GYRO_1_ALIGN CW270_DEG
//#define GYRO_1_ALIGN CW180_DEG // XXX MPU6500 align, must be configured after flashing
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW270_DEG
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW180_DEG #define ACC_1_ALIGN CW270_DEG
//#define ACC_1_ALIGN CW180_DEG // XXX MPU6500 align, must be configured after flashing
#define USE_MAG #define USE_MAG
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883

View file

@ -38,27 +38,22 @@
#define SPI1_MISO_PIN PA6 #define SPI1_MISO_PIN PA6
#define SPI1_MOSI_PIN PA7 #define SPI1_MOSI_PIN PA7
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN PA4
#define MPU6500_SPI_INSTANCE SPI1
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA1 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA1
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG #define USE_GYRO_SPI_MPU6500
#define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
// *************** Baro ************************** // *************** Baro **************************
#define USE_I2C #define USE_I2C

View file

@ -37,19 +37,20 @@
#define SPI1_MISO_PIN PA6 #define SPI1_MISO_PIN PA6
#define SPI1_MOSI_PIN PA7 #define SPI1_MOSI_PIN PA7
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA1 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA1
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
// *************** SPI2 OSD ***************************** // *************** SPI2 OSD *****************************
#define USE_SPI_DEVICE_2 #define USE_SPI_DEVICE_2

View file

@ -41,29 +41,28 @@
#define SPI1_MISO_PIN PA6 #define SPI1_MISO_PIN PA6
#define SPI1_MOSI_PIN PA7 #define SPI1_MOSI_PIN PA7
#define MPU6500_CS_PIN PC2 #define GYRO_1_CS_PIN PC2
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define ICM20689_CS_PIN PC2 #define ICM20689_CS_PIN PC2
#define ICM20689_SPI_INSTANCE SPI1 #define ICM20689_SPI_INSTANCE SPI1
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC3 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC3
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW180_DEG
#define USE_GYRO_SPI_ICM20689 #define USE_GYRO_SPI_ICM20689
#define GYRO_ICM20689_ALIGN CW90_DEG #define GYRO_1_ALIGN CW180_DEG
//#define GYRO_ICM20689_ALIGN CW90_DEG // XXX has to be post-flash configured
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW180_DEG
#define USE_ACC_SPI_ICM20689 #define USE_ACC_SPI_ICM20689
#define ACC_ICM20689_ALIGN CW90_DEG #define ACC_1_ALIGN CW180_DEG
//#define ACC_ICM20689_ALIGN CW90_DEG // XXX has to be post-flash configured
// *************** Baro ************************** // *************** Baro **************************
#define USE_I2C #define USE_I2C

View file

@ -51,11 +51,11 @@
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_MS5611 #define USE_BARO_MS5611

View file

@ -38,14 +38,15 @@
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_VCP #define USE_VCP

View file

@ -33,7 +33,8 @@
// MPU6050 interrupts // MPU6050 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA15 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA15
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
@ -41,20 +42,16 @@
#define USE_ACC #define USE_ACC
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW180_DEG
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW180_DEG
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG
#define MPU6000_CS_GPIO GPIOB #define GYRO_1_CS_PIN PB12
#define MPU6000_CS_PIN PB12 #define GYRO_1_SPI_INSTANCE SPI2
#define MPU6000_SPI_INSTANCE SPI2
#define ACC_1_ALIGN CW180_DEG
#define GYRO_1_ALIGN CW180_DEG
#define USE_VCP #define USE_VCP
#define USE_UART1 #define USE_UART1

View file

@ -38,20 +38,21 @@
#define BEEPER_PIN PB4 #define BEEPER_PIN PB4
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC5 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC5
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
//#define ENSURE_MPU_DATA_READY_IS_LOW //#define ENSURE_MPU_DATA_READY_IS_LOW
//#define EXTI_CALLBACK_HANDLER_COUNT 1 // MPU data ready //#define EXTI_CALLBACK_HANDLER_COUNT 1 // MPU data ready

View file

@ -31,17 +31,18 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define ENSURE_MPU_DATA_READY_IS_LOW #define ENSURE_MPU_DATA_READY_IS_LOW
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_MS5611 #define USE_BARO_MS5611

View file

@ -61,6 +61,8 @@ void targetConfiguration(void)
motorConfigMutable()->minthrottle = 1049; motorConfigMutable()->minthrottle = 1049;
gyroDeviceConfigMutable()->extiTag = selectMPUIntExtiConfigByHardwareRevision();
gyroConfigMutable()->gyro_hardware_lpf = GYRO_HARDWARE_LPF_1KHZ_SAMPLE; gyroConfigMutable()->gyro_hardware_lpf = GYRO_HARDWARE_LPF_1KHZ_SAMPLE;
gyroConfigMutable()->gyro_soft_lpf_hz = 100; gyroConfigMutable()->gyro_soft_lpf_hz = 100;
gyroConfigMutable()->gyro_soft_notch_hz_1 = 0; gyroConfigMutable()->gyro_soft_notch_hz_1 = 0;

View file

@ -58,7 +58,8 @@
#define USE_EXTI #define USE_EXTI
#define MAG_INT_EXTI PC14 #define MAG_INT_EXTI PC14
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define MMA8451_INT_PIN PA5 #define MMA8451_INT_PIN PA5
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
@ -74,8 +75,8 @@
#define FLASH_CS_PIN NAZE_SPI_CS_PIN #define FLASH_CS_PIN NAZE_SPI_CS_PIN
#define FLASH_SPI_INSTANCE NAZE_SPI_INSTANCE #define FLASH_SPI_INSTANCE NAZE_SPI_INSTANCE
#define MPU6500_CS_PIN NAZE_SPI_CS_PIN #define GYRO_1_CS_PIN NAZE_SPI_CS_PIN
#define MPU6500_SPI_INSTANCE NAZE_SPI_INSTANCE #define GYRO_1_SPI_INSTANCE NAZE_SPI_INSTANCE
#define USE_FLASHFS #define USE_FLASHFS
#define USE_FLASH_M25P16 #define USE_FLASH_M25P16
@ -86,9 +87,7 @@
#define USE_GYRO_MPU6500 #define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU3050_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define GYRO_MPU6050_ALIGN CW0_DEG
#define GYRO_MPU6500_ALIGN CW0_DEG
#define USE_ACC #define USE_ACC
//#define USE_ACC_ADXL345 //#define USE_ACC_ADXL345
@ -99,10 +98,9 @@
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
//#define ACC_ADXL345_ALIGN CW270_DEG //#define ACC_ADXL345_ALIGN CW270_DEG
#define ACC_MPU6050_ALIGN CW0_DEG
//#define ACC_MMA8452_ALIGN CW90_DEG //#define ACC_MMA8452_ALIGN CW90_DEG
//#define ACC_BMA280_ALIGN CW0_DEG //#define ACC_BMA280_ALIGN CW0_DEG
#define ACC_MPU6500_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define USE_BARO #define USE_BARO
#define USE_BARO_MS5611 // needed for Flip32 board #define USE_BARO_MS5611 // needed for Flip32 board

View file

@ -2,10 +2,6 @@ F1_TARGETS += $(TARGET)
FEATURES = ONBOARDFLASH FEATURES = ONBOARDFLASH
TARGET_SRC = \ TARGET_SRC = \
drivers/accgyro_legacy/accgyro_adxl345.c \
drivers/accgyro_legacy/accgyro_bma280.c \
drivers/accgyro_legacy/accgyro_l3g4200d.c \
drivers/accgyro_legacy/accgyro_mma845x.c \
drivers/accgyro/accgyro_mpu.c \ drivers/accgyro/accgyro_mpu.c \
drivers/accgyro/accgyro_mpu3050.c \ drivers/accgyro/accgyro_mpu3050.c \
drivers/accgyro/accgyro_mpu6050.c \ drivers/accgyro/accgyro_mpu6050.c \

View file

@ -37,22 +37,21 @@
// MPU6500 interrupt // MPU6500 interrupt
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PB2 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PB2
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
//#define DEBUG_MPU_DATA_READY_INTERRUPT //#define DEBUG_MPU_DATA_READY_INTERRUPT
#define MPU6500_CS_PIN PC4 #define GYRO_1_CS_PIN PC4
#define MPU6500_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define ACC_MPU6500_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define GYRO_MPU6500_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define USE_SDCARD #define USE_SDCARD

View file

@ -41,14 +41,12 @@
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define MPU6500_CS_PIN PB12 #define GYRO_1_CS_PIN PB12
#define MPU6500_SPI_INSTANCE SPI2 #define GYRO_1_SPI_INSTANCE SPI2
#define MPU6000_CS_PIN PB12
#define MPU6000_SPI_INSTANCE SPI2
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PA8 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PA8
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_BARO #define USE_BARO

View file

@ -51,11 +51,8 @@
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define USE_ACC_SPI_MPU9250 #define USE_ACC_SPI_MPU9250
#define MPU9250_CS_PIN PB12 #define GYRO_1_SPI_INSTANCE SPI2
#define MPU9250_SPI_INSTANCE SPI2 #define GYRO_1_CS_PIN PB12
#define MPU6500_CS_PIN PB12
#define MPU6500_SPI_INSTANCE SPI2
#define USE_EXTI #define USE_EXTI

View file

@ -33,19 +33,23 @@
#define BEEPER_PIN PA0 #define BEEPER_PIN PA0
#define BEEPER_INVERTED #define BEEPER_INVERTED
#undef USE_MULTI_GYRO // XXX Drop this if target has I2C configured
#define USE_ACC #define USE_ACC
#define USE_FAKE_ACC #define USE_FAKE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_GYRO #define USE_GYRO
#define USE_FAKE_GYRO #define USE_FAKE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
// MPU6050 interrupts // MPU6050 interrupts
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU_INT_EXTI PB15 #define USE_EXTI
#define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PB15
#define USE_EXTI #define USE_EXTI
#define USE_MAG #define USE_MAG

View file

@ -33,19 +33,23 @@
//#define BEEPER_PIN PA0 //#define BEEPER_PIN PA0
//#define BEEPER_INVERTED //#define BEEPER_INVERTED
#undef USE_MULTI_GYRO
#define USE_ACC #define USE_ACC
#define USE_FAKE_ACC #define USE_FAKE_ACC
#define USE_ACC_MPU6050 #define USE_ACC_MPU6050
#define ACC_MPU6050_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#define USE_GYRO #define USE_GYRO
#define USE_FAKE_GYRO #define USE_FAKE_GYRO
#define USE_GYRO_MPU6050 #define USE_GYRO_MPU6050
#define GYRO_MPU6050_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
// MPU6050 interrupts // MPU6050 interrupts
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU_INT_EXTI PB15 #define USE_EXTI
#define USE_GYRO_EXTI
#define GYRO_1_EXTI_PINPB15
#define USE_EXTI #define USE_EXTI
#define USE_MAG #define USE_MAG

View file

@ -56,19 +56,20 @@
#define BEEPER_INVERTED #define BEEPER_INVERTED
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC13 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC13
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define ACC_MPU6000_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#define BMP280_SPI_INSTANCE SPI1 #define BMP280_SPI_INSTANCE SPI1
#define BMP280_CS_PIN PA13 #define BMP280_CS_PIN PA13

View file

@ -71,29 +71,33 @@
#define INVERTER_PIN_UART1 PC0 // DYS F4 Pro; Omnibus F4 AIO (1st gen) have a FIXED inverter on UART1 #define INVERTER_PIN_UART1 PC0 // DYS F4 Pro; Omnibus F4 AIO (1st gen) have a FIXED inverter on UART1
#endif #endif
#define USE_EXTI
#define USE_MULTI_GYRO
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_GYRO_EXTI
#define MPU_INT_EXTI PC4 #define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#if defined(OMNIBUSF4SD) #if defined(OMNIBUSF4SD)
#define GYRO_MPU6000_ALIGN CW270_DEG #define GYRO_1_ALIGN CW270_DEG
#define ACC_MPU6000_ALIGN CW270_DEG #define ACC_1_ALIGN CW270_DEG
#elif defined(XRACERF4) || defined(EXUAVF4PRO) #elif defined(XRACERF4) || defined(EXUAVF4PRO)
#define GYRO_MPU6000_ALIGN CW90_DEG #define GYRO_1_ALIGN CW90_DEG
#define ACC_MPU6000_ALIGN CW90_DEG #define ACC_1_ALIGN CW90_DEG
#else #else
#define GYRO_MPU6000_ALIGN CW180_DEG #define GYRO_1_ALIGN CW180_DEG
#define ACC_MPU6000_ALIGN CW180_DEG #define ACC_1_ALIGN CW180_DEG
#endif #endif
// Support for iFlight OMNIBUS F4 V3 // Support for iFlight OMNIBUS F4 V3
@ -102,12 +106,15 @@
#if defined (OMNIBUSF4SD) || defined(OMNIBUSF4BASE) #if defined (OMNIBUSF4SD) || defined(OMNIBUSF4BASE)
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define MPU6500_CS_PIN MPU6000_CS_PIN
#define MPU6500_SPI_INSTANCE MPU6000_SPI_INSTANCE
#define GYRO_MPU6500_ALIGN GYRO_MPU6000_ALIGN
#define ACC_MPU6500_ALIGN ACC_MPU6000_ALIGN
#endif #endif
// Dummy defines
#define GYRO_2_SPI_INSTANCE GYRO_1_SPI_INSTANCE
#define GYRO_2_CS_PIN NONE
#define GYRO_2_ALIGN ALIGN_DEFAULT
#define GYRO_2_EXTI_PIN NONE
#define ACC_2_ALIGN ALIGN_DEFAULT
#define USE_MAG #define USE_MAG
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883
#define USE_MAG_QMC5883 #define USE_MAG_QMC5883

View file

@ -68,7 +68,9 @@
// MPU6000 interrupts // MPU6000 interrupts
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define GYRO_2_EXTI_PIN NONE
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
#define USE_MAG #define USE_MAG

View file

@ -46,66 +46,48 @@
#define USE_GYRO #define USE_GYRO
#define USE_DUAL_GYRO #define USE_DUAL_GYRO
// ICM-20608-G // ICM-20608-G
#define USE_ACC_MPU6500
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define USE_GYRO_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
//#define MPU_INT_EXTI PE8 //#define MPU_INT_EXTI PE8
// MPU6000 // MPU6000
#define USE_ACC_MPU6000
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define USE_GYRO_MPU6000
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
//#define MPU_INT_EXTI PD0 //#define MPU_INT_EXTI PD0
// Provisioned, but not used
#define GYRO_1_EXTI_PIN NONE
#define GYRO_2_EXTI_PIN NONE
#if defined(OMNIBUSF7V2) #if defined(OMNIBUSF7V2)
#define MPU6000_CS_PIN SPI1_NSS_PIN #define GYRO_1_SPI_INSTANCE SPI3
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_CS_PIN PA15
#define MPU6500_CS_PIN SPI3_NSS_PIN #define GYRO_2_SPI_INSTANCE SPI1
#define MPU6500_SPI_INSTANCE SPI3 #define GYRO_2_CS_PIN PA4
#define GYRO_1_CS_PIN MPU6500_CS_PIN #define GYRO_1_ALIGN CW90_DEG
#define GYRO_2_CS_PIN MPU6000_CS_PIN
#define GYRO_MPU6500_ALIGN CW90_DEG
#define ACC_MPU6500_ALIGN CW90_DEG
#define GYRO_MPU6000_ALIGN ALIGN_DEFAULT
#define ACC_MPU6000_ALIGN ALIGN_DEFAULT
#define ACC_1_ALIGN ACC_MPU6500_ALIGN
#define ACC_2_ALIGN ACC_MPU6000_ALIGN
#define GYRO_1_ALIGN GYRO_MPU6500_ALIGN
#define GYRO_2_ALIGN GYRO_MPU6000_ALIGN
#define GYRO_1_SPI_INSTANCE MPU6500_SPI_INSTANCE
#define GYRO_2_SPI_INSTANCE MPU6000_SPI_INSTANCE
#elif defined(FPVM_BETAFLIGHTF7)
#define MPU6000_CS_PIN SPI1_NSS_PIN
#define MPU6000_SPI_INSTANCE SPI1
#define MPU6500_CS_PIN SPI3_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI3
#define GYRO_1_CS_PIN MPU6000_CS_PIN
#define GYRO_2_CS_PIN MPU6500_CS_PIN
#define GYRO_MPU6500_ALIGN CW270_DEG
#define ACC_MPU6500_ALIGN CW270_DEG
#define GYRO_MPU6000_ALIGN CW90_DEG
#define ACC_MPU6000_ALIGN CW90_DEG
#define ACC_1_ALIGN ACC_MPU6000_ALIGN
#define ACC_2_ALIGN ACC_MPU6500_ALIGN
#define GYRO_1_ALIGN GYRO_MPU6000_ALIGN
#define GYRO_2_ALIGN GYRO_MPU6500_ALIGN
#define GYRO_1_SPI_INSTANCE MPU6000_SPI_INSTANCE
#define GYRO_2_SPI_INSTANCE MPU6500_SPI_INSTANCE
#else
#define MPU6000_CS_PIN SPI3_NSS_PIN
#define MPU6000_SPI_INSTANCE SPI3
#define MPU6500_CS_PIN SPI1_NSS_PIN
#define MPU6500_SPI_INSTANCE SPI1
#define GYRO_1_CS_PIN MPU6000_CS_PIN
#define GYRO_2_CS_PIN MPU6500_CS_PIN
#define ACC_1_ALIGN ALIGN_DEFAULT
#define ACC_2_ALIGN ALIGN_DEFAULT
#define GYRO_1_ALIGN ALIGN_DEFAULT
#define GYRO_2_ALIGN ALIGN_DEFAULT #define GYRO_2_ALIGN ALIGN_DEFAULT
#define GYRO_1_SPI_INSTANCE MPU6000_SPI_INSTANCE #define ACC_1_ALIGN CW90_DEG
#define GYRO_2_SPI_INSTANCE MPU6500_SPI_INSTANCE #define ACC_2_ALIGN ALIGN_DEFAULT
#elif defined(FPVM_BETAFLIGHTF7)
#define GYRO_1_SPI_INSTANCE SPI1
#define GYRO_1_CS_PIN PA4
#define GYRO_2_SPI_INSTANCE SPI3
#define GYRO_2_CS_PIN PA15
#define GYRO_1_ALIGN CW90_DEG
#define ACC_1_ALIGN CW90_DEG
#define GYRO_2_ALIGN CW270_DEG
#define ACC_2_ALIGN CW270_DEG
#else
#define GYRO_1_SPI_INSTANCE SPI3
#define GYRO_1_CS_PIN PA15
#define GYRO_2_SPI_INSTANCE SPI1
#define GYRO_2_CS_PIN PA4
#define GYRO_1_ALIGN ALIGN_DEFAULT
#define ACC_1_ALIGN ALIGN_DEFAULT
#define GYRO_2_ALIGN ALIGN_DEFAULT
#define ACC_2_ALIGN ALIGN_DEFAULT
#endif #endif
// TODO: dual gyro support // TODO: dual gyro support

View file

@ -296,6 +296,7 @@ void updateHardwareRevision(void)
// Empty // Empty
} }
// XXX Can be gone as sensors/gyro.c is not calling this anymore
ioTag_t selectMPUIntExtiConfigByHardwareRevision(void) ioTag_t selectMPUIntExtiConfigByHardwareRevision(void)
{ {
return IO_TAG_NONE; return IO_TAG_NONE;

View file

@ -46,6 +46,10 @@
#define USE_ACC #define USE_ACC
#define USE_GYRO #define USE_GYRO
// MPU interrupts
//#define USE_EXTI
//#define USE_GYRO_EXTI
//#define USE_MPU_DATA_READY_SIGNAL
// For debugging with NUC405RG // For debugging with NUC405RG
#define USE_FAKE_ACC #define USE_FAKE_ACC
@ -57,25 +61,20 @@
#define USE_ACC_SPI_MPU6500 #define USE_ACC_SPI_MPU6500
#define USE_GYRO_SPI_MPU6500 #define USE_GYRO_SPI_MPU6500
#define USE_DUAL_GYRO
#define GYRO_1_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define GYRO_1_CS_PIN PB12 // Onboard IMU #define GYRO_1_CS_PIN PB12 // Onboard IMU
#define GYRO_1_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define ACC_1_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
#define GYRO_1_EXTI_PIN NONE
#define GYRO_2_SPI_INSTANCE SPI1 #define GYRO_2_SPI_INSTANCE SPI1
#define GYRO_2_CS_PIN PA8 // External IMU #define GYRO_2_CS_PIN PA8 // External IMU
#define GYRO_2_ALIGN CW0_DEG #define GYRO_2_ALIGN CW0_DEG
#define ACC_2_ALIGN CW0_DEG #define ACC_2_ALIGN CW0_DEG
#define GYRO_2_EXTI_PIN NONE
#define GYRO_CONFIG_USE_GYRO_DEFAULT GYRO_CONFIG_USE_GYRO_1 #define GYRO_CONFIG_USE_GYRO_DEFAULT GYRO_CONFIG_USE_GYRO_1
// MPU interrupts
//#define USE_EXTI
//#define MPU_INT_EXTI PC4
//#define USE_MPU_DATA_READY_SIGNAL
#define USE_MAG #define USE_MAG
#define MAG_I2C_INSTANCE (I2CDEV_1) #define MAG_I2C_INSTANCE (I2CDEV_1)
#define USE_MAG_HMC5883 #define USE_MAG_HMC5883

View file

@ -30,7 +30,8 @@
#define INVERTER_PIN_UART1 PC3 // PC3 used as sBUS inverter select GPIO #define INVERTER_PIN_UART1 PC3 // PC3 used as sBUS inverter select GPIO
#define USE_EXTI #define USE_EXTI
#define MPU_INT_EXTI PC4 #define USE_GYRO_EXTI
#define GYRO_1_EXTI_PIN PC4
#define USE_MPU_DATA_READY_SIGNAL #define USE_MPU_DATA_READY_SIGNAL
// DEFINE SPI USAGE // DEFINE SPI USAGE
@ -38,14 +39,14 @@
#define USE_SPI_DEVICE_1 #define USE_SPI_DEVICE_1
// MPU 6000 // MPU 6000
#define MPU6000_CS_PIN PA4 #define GYRO_1_CS_PIN PA4
#define MPU6000_SPI_INSTANCE SPI1 #define GYRO_1_SPI_INSTANCE SPI1
#define USE_ACC #define USE_ACC
#define USE_ACC_SPI_MPU6000 #define USE_ACC_SPI_MPU6000
#define USE_GYRO #define USE_GYRO
#define USE_GYRO_SPI_MPU6000 #define USE_GYRO_SPI_MPU6000
#define GYRO_MPU6000_ALIGN CW0_DEG #define GYRO_1_ALIGN CW0_DEG
#define ACC_MPU6000_ALIGN CW0_DEG #define ACC_1_ALIGN CW0_DEG
// DEFINE OSD // DEFINE OSD
#define USE_SPI_DEVICE_2 #define USE_SPI_DEVICE_2

Some files were not shown because too many files have changed in this diff Show more