mpu60x0.h

Go to the documentation of this file.

/*
 * Copyright (C) 2013 Gautier Hattenberger
 *
 * This file is part of paparazzi.
 *
 * paparazzi is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * paparazzi is distributed in the hope that it 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 paparazzi; see the file COPYING.  If not, see
 * <http://www.gnu.org/licenses/>.
 */
 
#ifndef MPU60X0_H
#define MPU60X0_H
 
#include "std.h"
#include "math/pprz_algebra_int.h"
 
/* Include address and register definition */
#include "peripherals/mpu60x0_regs.h"
 
#define MPU60X0_DEFAULT_SMPLRT_DIV 0
#define MPU60X0_DEFAULT_FS_SEL MPU60X0_GYRO_RANGE_2000
#define MPU60X0_DEFAULT_AFS_SEL MPU60X0_ACCEL_RANGE_16G
#define MPU60X0_DEFAULT_DLPF_CFG MPU60X0_DLPF_98HZ
#define MPU60X0_DEFAULT_DLPF_CFG_ACC MPU60X0_DLPF_ACC_99HZ
#define MPU60X0_DEFAULT_INT_CFG 1
#define MPU60X0_DEFAULT_CLK_SEL 1
 
// Default number of I2C slaves
#ifndef MPU60X0_I2C_NB_SLAVES
#define MPU60X0_I2C_NB_SLAVES 5
#endif
 
#define MPU60X0_GYRO_SENS_250 0.544883
#define MPU60X0_GYRO_SENS_250_NUM 19327
#define MPU60X0_GYRO_SENS_250_DEN 35470
#define MPU60X0_GYRO_SENS_500 1.08977
#define MPU60X0_GYRO_SENS_500_NUM 57663
#define MPU60X0_GYRO_SENS_500_DEN 52913
#define MPU60X0_GYRO_SENS_1000 2.17953
#define MPU60X0_GYRO_SENS_1000_NUM 18271
#define MPU60X0_GYRO_SENS_1000_DEN 8383
#define MPU60X0_GYRO_SENS_2000 4.35906
#define MPU60X0_GYRO_SENS_2000_NUM 36542
#define MPU60X0_GYRO_SENS_2000_DEN 8383
 
// Get default sensitivity from a table
extern const float MPU60X0_GYRO_SENS[4];
// Get default sensitivity numerator and denominator from a table
extern const struct Int32Rates MPU60X0_GYRO_SENS_FRAC[4][2];
 
#define MPU60X0_ACCEL_SENS_2G 0.613125
#define MPU60X0_ACCEL_SENS_2G_NUM 981
#define MPU60X0_ACCEL_SENS_2G_DEN 1600
#define MPU60X0_ACCEL_SENS_4G 1.22625
#define MPU60X0_ACCEL_SENS_4G_NUM 981
#define MPU60X0_ACCEL_SENS_4G_DEN 800
#define MPU60X0_ACCEL_SENS_8G 2.4525
#define MPU60X0_ACCEL_SENS_8G_NUM 981
#define MPU60X0_ACCEL_SENS_8G_DEN 400
#define MPU60X0_ACCEL_SENS_16G 4.905
#define MPU60X0_ACCEL_SENS_16G_NUM 981
#define MPU60X0_ACCEL_SENS_16G_DEN 200
 
// Get default sensitivity from a table
extern const float MPU60X0_ACCEL_SENS[4];
// Get default sensitivity numerator and denominator from a table
extern const struct Int32Vect3 MPU60X0_ACCEL_SENS_FRAC[4][2];
 
enum Mpu60x0Type {
  MPU60X0,
  ICM20600,
  ICM20608,
  ICM20602,
  ICM20689
};
 
enum Mpu60x0ConfStatus {
  MPU60X0_CONF_UNINIT,
  MPU60X0_CONF_RESET,
  MPU60X0_CONF_USER_RESET,
  MPU60X0_CONF_PWR,
  MPU60X0_CONF_SD,
  MPU60X0_CONF_DLPF,
  MPU60X0_CONF_GYRO,
  MPU60X0_CONF_ACCEL,
  MPU60X0_CONF_ACCEL2,
  MPU60X0_CONF_I2C_SLAVES,
  MPU60X0_CONF_INT_ENABLE,
  MPU60X0_CONF_UNDOC1,
  MPU60X0_CONF_DONE
};
 
typedef void (*Mpu60x0ConfigSet)(void *mpu, uint8_t _reg, uint8_t _val);
 
typedef bool (*Mpu60x0I2cSlaveConfigure)(Mpu60x0ConfigSet mpu_set, void *mpu);
 
struct Mpu60x0I2cSlave {
  Mpu60x0I2cSlaveConfigure configure;
};
 
struct Mpu60x0Config {
  enum Mpu60x0Type type;                
  uint8_t smplrt_div;                   
  enum Mpu60x0DLPF dlpf_cfg;            
  enum Mpu60x0ACCDLPF dlpf_cfg_acc;     
  enum Mpu60x0GyroRanges gyro_range;    
  enum Mpu60x0AccelRanges accel_range;  
  bool drdy_int_enable;               
  uint8_t clk_sel;                      
  uint8_t nb_bytes;                     
  enum Mpu60x0ConfStatus init_status;   
  bool initialized;                   
 
  bool i2c_bypass;
 
  uint8_t nb_slaves;                    
  uint8_t nb_slave_init;                
  struct Mpu60x0I2cSlave slaves[MPU60X0_I2C_NB_SLAVES];     
  enum Mpu60x0MstClk i2c_mst_clk;       
  uint8_t i2c_mst_delay;                
};
 
extern void mpu60x0_set_default_config(struct Mpu60x0Config *c);
 
extern void mpu60x0_send_config(Mpu60x0ConfigSet mpu_set, void *mpu, struct Mpu60x0Config *config);
 
extern bool mpu60x0_configure_i2c_slaves(Mpu60x0ConfigSet mpu_set, void *mpu);
 
#endif // MPU60X0_H