src/main/drivers/accgyro/accgyro.h

   1 /*
   2  * This file is part of Cleanflight and Betaflight.
   3  *
   4  * Cleanflight and Betaflight are free software. You can redistribute
   5  * this software and/or modify this software under the terms of the
   6  * GNU General Public License as published by the Free Software
   7  * Foundation, either version 3 of the License, or (at your option)
   8  * any later version.
   9  *
  10  * Cleanflight and Betaflight are distributed in the hope that they
  11  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  12  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  * See the GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this software.
  17  *
  18  * If not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #pragma once
  22
  23 #include "platform.h"
  24
  25 #include "common/axis.h"
  26 #include "common/maths.h"
  27 #include "common/sensor_alignment.h"
  28 #include "common/time.h"
  29 #include "drivers/exti.h"
  30 #include "drivers/bus.h"
  31 #include "drivers/sensor.h"
  32 #include "drivers/accgyro/accgyro_mpu.h"
  33
  34 #pragma GCC diagnostic push
  35 #if defined(SIMULATOR_BUILD) && defined(SIMULATOR_MULTITHREAD)
  36 #include <pthread.h>
  37 #endif
  38
  39 #define GYRO_SCALE_2000DPS (2000.0f / (1 << 15))   // 16.384 dps/lsb scalefactor for 2000dps sensors
  40 #define GYRO_SCALE_4000DPS (4000.0f / (1 << 15))   //  8.192 dps/lsb scalefactor for 4000dps sensors
  41
  42 typedef enum {
  43     GYRO_NONE = 0,
  44     GYRO_DEFAULT,
  45     GYRO_MPU6050,
  46     GYRO_L3G4200D,
  47     GYRO_MPU3050,
  48     GYRO_L3GD20,
  49     GYRO_MPU6000,
  50     GYRO_MPU6500,
  51     GYRO_MPU9250,
  52     GYRO_ICM20601,
  53     GYRO_ICM20602,
  54     GYRO_ICM20608G,
  55     GYRO_ICM20649,
  56     GYRO_ICM20689,
  57     GYRO_ICM42605,
  58     GYRO_ICM42688P,
  59     GYRO_BMI160,
  60     GYRO_BMI270,
  61     GYRO_LSM6DSO,
  62     GYRO_FAKE
  63 } gyroHardware_e;
  64
  65 typedef enum {
  66     GYRO_HARDWARE_LPF_NORMAL,
  67 #ifdef USE_GYRO_DLPF_EXPERIMENTAL
  68     GYRO_HARDWARE_LPF_EXPERIMENTAL
  69 #endif
  70 } gyroHardwareLpf_e;
  71
  72 typedef enum {
  73     GYRO_RATE_1_kHz,
  74     GYRO_RATE_1100_Hz,
  75     GYRO_RATE_3200_Hz,
  76     GYRO_RATE_6400_Hz,
  77     GYRO_RATE_6664_Hz,
  78     GYRO_RATE_8_kHz,
  79     GYRO_RATE_9_kHz,
  80     GYRO_RATE_32_kHz,
  81 } gyroRateKHz_e;
  82
  83 typedef enum {
  84     GYRO_EXTI_INIT = 0,
  85     GYRO_EXTI_INT_DMA,
  86     GYRO_EXTI_INT,
  87     GYRO_EXTI_NO_INT
  88 } gyroModeSPI_e;
  89
  90 typedef struct gyroDev_s {
  91 #if defined(SIMULATOR_BUILD) && defined(SIMULATOR_MULTITHREAD)
  92     pthread_mutex_t lock;
  93 #endif
  94     sensorGyroInitFuncPtr initFn;                             // initialize function
  95     sensorGyroReadFuncPtr readFn;                             // read 3 axis data function
  96     sensorGyroReadDataFuncPtr temperatureFn;                  // read temperature if available
  97     extiCallbackRec_t exti;
  98     extDevice_t dev;
  99     float scale;                                             // scalefactor
 100     float gyroZero[XYZ_AXIS_COUNT];
 101     float gyroADC[XYZ_AXIS_COUNT];                           // gyro data after calibration and alignment
 102     int32_t gyroADCRawPrevious[XYZ_AXIS_COUNT];
 103     int16_t gyroADCRaw[XYZ_AXIS_COUNT];                      // raw data from sensor
 104     int16_t temperature;
 105     mpuDetectionResult_t mpuDetectionResult;
 106     sensor_align_e gyroAlign;
 107     gyroRateKHz_e gyroRateKHz;
 108     gyroModeSPI_e gyroModeSPI;
 109 #ifdef USE_GYRO_EXTI
 110     uint32_t detectedEXTI;
 111     uint32_t gyroLastEXTI;
 112     uint32_t gyroSyncEXTI;
 113     int32_t gyroShortPeriod;
 114     int32_t gyroDmaMaxDuration;
 115     busSegment_t segments[2];
 116 #endif
 117     volatile bool dataReady;
 118     bool gyro_high_fsr;
 119     uint8_t hardware_lpf;
 120     uint8_t hardware_32khz_lpf;
 121     uint8_t mpuDividerDrops;
 122     ioTag_t mpuIntExtiTag;
 123     uint8_t gyroHasOverflowProtection;
 124     gyroHardware_e gyroHardware;
 125     fp_rotationMatrix_t rotationMatrix;
 126     uint16_t gyroSampleRateHz;
 127     uint16_t accSampleRateHz;
 128     uint8_t accDataReg;
 129     uint8_t gyroDataReg;
 130 } gyroDev_t;
 131
 132 typedef struct accDev_s {
 133 #if defined(SIMULATOR_BUILD) && defined(SIMULATOR_MULTITHREAD)
 134     pthread_mutex_t lock;
 135 #endif
 136     float acc_1G_rec;
 137     sensorAccInitFuncPtr initFn;                              // initialize function
 138     sensorAccReadFuncPtr readFn;                              // read 3 axis data function
 139     uint16_t acc_1G;
 140     int16_t ADCRaw[XYZ_AXIS_COUNT];
 141     mpuDetectionResult_t mpuDetectionResult;
 142     sensor_align_e accAlign;
 143     bool dataReady;
 144     gyroDev_t *gyro;
 145     bool acc_high_fsr;
 146     char revisionCode;                                      // a revision code for the sensor, if known
 147     uint8_t filler[2];
 148     fp_rotationMatrix_t rotationMatrix;
 149 } accDev_t;
 150
 151 static inline void accDevLock(accDev_t *acc)
 152 {
 153 #if defined(SIMULATOR_BUILD) && defined(SIMULATOR_MULTITHREAD)
 154     pthread_mutex_lock(&acc->lock);
 155 #else
 156     (void)acc;
 157 #endif
 158 }
 159
 160 static inline void accDevUnLock(accDev_t *acc)
 161 {
 162 #if defined(SIMULATOR_BUILD) && defined(SIMULATOR_MULTITHREAD)
 163     pthread_mutex_unlock(&acc->lock);
 164 #else
 165     (void)acc;
 166 #endif
 167 }
 168
 169 static inline void gyroDevLock(gyroDev_t *gyro)
 170 {
 171 #if defined(SIMULATOR_BUILD) && defined(SIMULATOR_MULTITHREAD)
 172     pthread_mutex_lock(&gyro->lock);
 173 #else
 174     (void)gyro;
 175 #endif
 176 }
 177
 178 static inline void gyroDevUnLock(gyroDev_t *gyro)
 179 {
 180 #if defined(SIMULATOR_BUILD) && defined(SIMULATOR_MULTITHREAD)
 181     pthread_mutex_unlock(&gyro->lock);
 182 #else
 183     (void)gyro;
 184 #endif
 185 }
 186 #pragma GCC diagnostic pop