Arduino SAMD21平台LSM6DSO32陀螺仪±500dps量程下数据转换有效性问询

你的现有代码存在三处关键逻辑错误，当前输出的数值既不是陀螺仪原始量化值的正确解析结果，也不是标准deg/s单位的角速度结果，具体问题如下：

• 寄存器字节错位错误
  你设置的I2C读取起始地址0x20是温度输出寄存器的起始位置，按照对应寄存器映射规则，从0x20开始连续读取的字节顺序为：温度低字节、温度高字节、陀螺仪X轴低字节、陀螺仪X轴高字节、陀螺仪Y轴低字节、陀螺仪Y轴高字节、陀螺仪Z轴低字节、陀螺仪Z轴高字节。
  你当前的数组索引偏移完全错位：把前两个字节的温度数据当成了陀螺仪X轴的原始值，把陀螺仪X轴的两个字节当成了Y轴原始值，把陀螺仪Y轴的两个字节当成了Z轴原始值，实际陀螺仪Z轴的输出数据完全没有被读取。
• 原始数据拼接逻辑错误
  代码中拼接运算引用了从未定义的val数组，属于抄录官方示例时的遗漏笔误，会直接触发编译错误。
  传感器16位输出的字节规则是低地址存低8位（LSB）、高地址存高8位（MSB），拼接时需要将高字节左移8位后与低字节做按位或运算，同时必须将高字节按有符号数解析，避免二进制补码格式的负角速度出现符号扩展错误，导致负数值被解析为超大的正整数。
• 转换系数量纲错误
  手册中标注的±500dps量程下的灵敏度数值17.5，单位是mdps/LSB（毫度每秒/最小量化单位），而非dps/LSB。如果直接用原始量化值乘17.5，得到的结果单位是mdps，比真正的dps数值大1000倍，完全不符合姿态解算的输入要求。

修正后的可正常运行代码 #

Wire.beginTransmission(DSO_ADDRESS); 
// 0x20为温度输出寄存器起始地址，连续读14字节的方式可减少寄存器切换开销
Wire.write(0x20);                                      
Wire.endTransmission();   
Wire.requestFrom(DSO_ADDRESS, 14);

static int16_t data_raw_angular_rate[3];
uint8_t buff[14];    
Wire.readBytes(buff, 14);

// buff[0]、buff[1]为温度寄存器输出值，可在此处补充温度数据处理逻辑

// 陀螺仪原始数据正确索引与拼接
data_raw_angular_rate[0] = ( (int16_t)( (int8_t)buff[3] ) << 8 ) | buff[2];
data_raw_angular_rate[1] = ( (int16_t)( (int8_t)buff[5] ) << 8 ) | buff[4];
data_raw_angular_rate[2] = ( (int16_t)( (int8_t)buff[7] ) << 8 ) | buff[6];

// 转换为标准deg/s单位：17.5 mdps/LSB = 0.0175 dps/LSB
float_t gyro_x = ((float_t)data_raw_angular_rate[0]) * 0.0175f;
float_t gyro_y = ((float_t)data_raw_angular_rate[1]) * 0.0175f;
float_t gyro_z = ((float_t)data_raw_angular_rate[2]) * 0.0175f;

结果验证说明 #

修正后的代码输出的gyro_x、gyro_y、gyro_z为标准deg/s单位的角速度测量值，完全满足互补滤波、卡尔曼滤波姿态解算的输入要求。可通过简单测试校验逻辑正确性：将传感器水平静止放置时，三轴输出值应在0附近小幅波动，典型静态噪声范围在±0.15deg/s以内；手动低速旋转传感器时，输出角速度值应和实际旋转速度量级匹配，不会出现上千倍的超量程异常。

内容的提问来源于stack exchange，提问作者simon