src/main/sensors/acceleration.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 "common/time.h"
  24 #include "pg/pg.h"
  25 #include "drivers/accgyro/accgyro.h"
  26 #include "sensors/sensors.h"
  27
  28 // Type of accelerometer used/detected
  29 typedef enum {
  30     ACC_DEFAULT,
  31     ACC_NONE,
  32     ACC_ADXL345,
  33     ACC_MPU6050,
  34     ACC_MMA8452,
  35     ACC_BMA280,
  36     ACC_LSM303DLHC,
  37     ACC_MPU6000,
  38     ACC_MPU6500,
  39     ACC_MPU9250,
  40     ACC_ICM20601,
  41     ACC_ICM20602,
  42     ACC_ICM20608G,
  43     ACC_ICM20649,
  44     ACC_ICM20689,
  45     ACC_BMI160,
  46     ACC_FAKE
  47 } accelerationSensor_e;
  48
  49 typedef struct acc_s {
  50     accDev_t dev;
  51     uint32_t accSamplingInterval;
  52     float accADC[XYZ_AXIS_COUNT];
  53     bool isAccelUpdatedAtLeastOnce;
  54 } acc_t;
  55
  56 extern acc_t acc;
  57
  58 typedef struct rollAndPitchTrims_s {
  59     int16_t roll;
  60     int16_t pitch;
  61 } rollAndPitchTrims_t_def;
  62
  63 typedef union rollAndPitchTrims_u {
  64     int16_t raw[2];
  65     rollAndPitchTrims_t_def values;
  66 } rollAndPitchTrims_t;
  67
  68 #if defined(USE_ACC)
  69 typedef struct accelerometerConfig_s {
  70     uint16_t acc_lpf_hz;                    // cutoff frequency for the low pass filter used on the acc z-axis for althold in Hz
  71     uint8_t acc_hardware;                   // Which acc hardware to use on boards with more than one device
  72     bool acc_high_fsr;
  73     flightDynamicsTrims_t accZero;
  74     rollAndPitchTrims_t accelerometerTrims;
  75 } accelerometerConfig_t;
  76
  77 PG_DECLARE(accelerometerConfig_t, accelerometerConfig);
  78 #endif
  79
  80 bool accInit(uint32_t gyroTargetLooptime);
  81 bool accIsCalibrationComplete(void);
  82 void accSetCalibrationCycles(uint16_t calibrationCyclesRequired);
  83 void resetRollAndPitchTrims(rollAndPitchTrims_t *rollAndPitchTrims);
  84 void accUpdate(timeUs_t currentTimeUs, rollAndPitchTrims_t *rollAndPitchTrims);
  85 bool accGetAccumulationAverage(float *accumulation);
  86 union flightDynamicsTrims_u;
  87 void setAccelerationTrims(union flightDynamicsTrims_u *accelerationTrimsToUse);
  88 void accInitFilters(void);
  89 void applyAccelerometerTrimsDelta(union rollAndPitchTrims_u *rollAndPitchTrimsDelta);