如何获得可用的加速度计读数

How to get usable accelerometer readings

我有一个基于 arduino 的设备 (Teensy 3.2),我正在尝试从 H3LIS331DL 加速度计分线板上读取数据。我可以写入加速度计上的控制寄存器并从数据寄存器中读取,但我无法获得稳定、有用的数据。

首先,有用的数据。加速度计芯片的数据 sheet 只是表示数据寄存器 "X-axis acceleration data. The value is expressed as two’s complement." SparkFun LIS331 库表示 "The data that comes out is 12-bit data, left justified, so the lower four bits of the data are always zero." 如果数据是每轴 12 位,我猜输出(适当条件)应该是 0-4095,零 G 大约是 2048,但这与我得到的不匹配。加速度计现在坐在我的桌子上,X 轴和 Y 轴给出高端和低端的读数(0-19 或 4063-4095),Z 轴给出 9-80 的读数(始终低于 2048任何方向)。

我对数据的期望是错误的,还是我做了什么没有得到正确的数据?

第二,稳定的数据。此加速度计的低设置为 +/- 100G 范围。我目前的工作台测试是在 -1G 到 +1G(全范围的 1%),所以我希望输出数据的范围成比例地小,但是从一个恒定位置开始的输出范围已经几乎是全范围的 2%规模。

怎样才能得到更稳定的输出数据?

#include <i2c_t3.h>

#define ACCEL_NEW_PIN    16

#define CTRL_REG1        0x20
#define CTRL_REG2        0x21
#define CTRL_REG3        0x22
#define CTRL_REG4        0x23
#define OUT_X_L          0x28
#define OUT_X_H          0x29
#define OUT_Y_L          0x2A
#define OUT_Y_H          0x2B
#define OUT_Z_L          0x2C
#define OUT_Z_H          0x2D

#define accelAddress     0x19

volatile bool accelNew = true;
int16_t x, y, z;

void setup() {
  delay(1000);
  Serial.begin(115200);
  Serial.println("hello, world!");
  accelSetup();
}

void loop(){
  if(accelNew){
    getAccel(x, y, z);
    Serial.println(x);
    Serial.println(y);
    Serial.println(z);
    accelNew = false;
  }
}

void accelSetup(){
  Wire.begin(I2C_MASTER, 0x00, I2C_PINS_18_19, I2C_PULLUP_EXT, 1800000, I2C_OP_MODE_IMM);
  writeAccel(CTRL_REG1, B00111111); //normal mode, 1000Hz, X, Y and Z enabled
  writeAccel(CTRL_REG2, B00110000); //high pass filter enabled
  writeAccel(CTRL_REG3, B00000010); //Data ready output pin enabled
  writeAccel(CTRL_REG4, B10000000); //Block data update enabled, 100G range
  pinMode(ACCEL_NEW_PIN,INPUT);
  attachInterrupt(digitalPinToInterrupt(ACCEL_NEW_PIN), accelISR, RISING);
}

void accelISR(){
  accelNew = true;
}

void getAccel(int16_t& xAccel, int16_t& yAccel, int16_t& zAccel){
  uint8_t data[6];
  readAccel(OUT_X_L, data, 6);
  xAccel = (data[0] | data[1] << 8) >> 4;
  yAccel = (data[2] | data[3] << 8) >> 4;
  zAccel = (data[4] | data[5] << 8) >> 4;
}

void readAccel(byte address, byte* data, uint8_t bytes)
{
  Wire.beginTransmission(accelAddress);
  Wire.write(address | 0x80);//
  Wire.sendTransmission();
  Wire.sendRequest(accelAddress, bytes);
  while(Wire.available()) *(data++) = Wire.readByte();
}

void writeAccel(byte address, byte data)
{
  Wire.beginTransmission(accelAddress);
  Wire.write(address);
  Wire.write(data);
  Wire.endTransmission();
}

我基本上找到了问题的答案。数据寄存器字节 do 需要按照我的方式组合并右移,但它需要 signed 右移,而我的代码相当于 unsigned 右移。符号位被误解为值位,并且在数字应该为负数时将结果值发送到范围的顶部。在移位之前将组合的 unsigned bytes 转换为 signed int 解决了该问题并使输出数据更有意义。

xAccel = (int16_t)(data[0] | data[1] << 8) >> 4;

好消息是所有 3 个轴现在都根据方向吐出具有相同线性斜率的有意义的数据。

坏消息是每个轴在 0G 时与 0 有不同的偏移量,并且每个轴仍然有一个 variance/jitter 大约 +/- 18 的平均值(比我想要的要高) ).