Pololu3piPlus32U4IMU_declaration.h

Go to the documentation of this file.

// Copyright (C) Pololu Corporation.  See www.pololu.com for details.
 
 
#pragma once
 
#include <Arduino.h>
 
namespace Pololu3piPlus32U4
{
 
 
#define LSM6DS33_ADDR 0b1101011
#define LIS3MDL_ADDR  0b0011110
 
#define LSM6DS33_REG_WHO_AM_I   0x0F
#define LSM6DS33_REG_CTRL1_XL   0x10
#define LSM6DS33_REG_CTRL2_G    0x11
#define LSM6DS33_REG_CTRL3_C    0x12
#define LSM6DS33_REG_STATUS_REG 0x1E
#define LSM6DS33_REG_OUTX_L_G   0x22
#define LSM6DS33_REG_OUTX_L_XL  0x28
 
#define LIS3MDL_REG_WHO_AM_I   0x0F
#define LIS3MDL_REG_CTRL_REG1  0x20
#define LIS3MDL_REG_CTRL_REG2  0x21
#define LIS3MDL_REG_CTRL_REG3  0x22
#define LIS3MDL_REG_CTRL_REG4  0x23
#define LIS3MDL_REG_STATUS_REG 0x27
#define LIS3MDL_REG_OUT_X_L    0x28
 
enum class IMUType : uint8_t {
  Unknown,
  LSM6DS33_LIS3MDL
};
 
class IMU
{
public:
 
  template <typename T> struct vector
  {
    T x, y, z;
  };
 
  vector<int16_t> a = {0, 0, 0};
 
  vector<int16_t> g = {0, 0, 0};
 
  vector<int16_t> m = {0, 0, 0};
 
  uint8_t getLastError() { return lastError; }
 
  bool init();
 
  IMUType getType() { return type; }
 
  void enableDefault();
 
  void configureForTurnSensing();
 
  void configureForFaceUphill();
 
  void configureForCompassHeading();
 
  void writeReg(uint8_t addr, uint8_t reg, uint8_t value);
 
  uint8_t readReg(uint8_t addr, uint8_t reg);
 
  void readAcc();
 
  void readGyro();
 
  void readMag();
 
  void read();
 
  bool accDataReady();
 
  bool gyroDataReady();
 
  bool magDataReady();
 
private:
 
  uint8_t lastError = 0;
  IMUType type = IMUType::Unknown;
 
  int16_t testReg(uint8_t addr, uint8_t reg);
  void readAxes16Bit(uint8_t addr, uint8_t firstReg, vector<int16_t> & v);
};
 
}