深入解析FishBot中的MPU6050数据采集方法

鱼香ROS

于 2024-06-06 10:53:54 发布

阅读量347

点赞数 3

文章标签： MPU6050 数据采集

本文链接：https://blog.csdn.net/qq_27865227/article/details/139482821

版权

大家好，我是爱吃猪脚饭的小鱼，今天接着上一节，标定完数据以后，怎么来用标定好的数据在读取的时候去掉校准误差呢？

深入解析FishBot中的MPU6050数据采集方法

在机器人和自动化系统中，精确的传感器数据是实现有效控制的关键。本文将详细解释FishBot项目中用于从MPU6050惯性测量单元（IMU）获取数据的方法，该方法涵盖了数据读取、处理以及应用校准值以确保数据的准确性。

数据获取方法解析

FishBot中的MPU6050::fetchData()函数是一个核心功能，它直接从MPU6050读取原始数据，并将这些数据转换成实用的加速度、温度和角速度测量值。以下是该函数的具体实现和各部分的详细说明：

1. 初始化通信并设置数据寄存器

wire->beginTransmission(address);
wire->write(MPU6050_ACCEL_OUT_REGISTER);
wire->endTransmission(false);
wire->requestFrom(address, (uint8_t) 14);

beginTransmission(address): 启动与MPU6050的I2C通信，address是传感器的I2C地址。
write(MPU6050_ACCEL_OUT_REGISTER): 设置要从哪个寄存器开始读取数据。此处指定从加速度输出寄存器开始读取。
endTransmission(false): 结束传输，false参数表示主设备（MCU）将继续保持总线控制权，为读取操作做准备。
requestFrom(address, 14): 请求从传感器读取14个字节的数据，这覆盖了加速度、温度和角速度的所有轴。

2. 读取和转换数据

int16_t rawData[7]; // [ax,ay,az,temp,gx,gy,gz]

for(int i = 0; i < 7; i++) {
  rawData[i]  = wire->read() << 8;
  rawData[i] |= wire->read();
}

数组rawData存储从传感器读取的原始二进制数据。
通过两次调用read()方法并结合位移操作，将两个8位字节合并为一个16位的整数，这样可以正确地形成每个传感器输出的完整值。

3. 应用校准和转换公式

accX = ((float)rawData[0]) / acc_lsb_to_g - accXoffset;
accY = ((float)rawData[1]) / acc_lsb_to_g - accYoffset;
accZ = (!upsideDownMounting - upsideDownMounting) * ((float)rawData[2]) / acc_lsb_to_g - accZoffset;
temp = (rawData[3] + TEMP_LSB_OFFSET) / TEMP_LSB_2_DEGREE;
gyroX = ((float)rawData[4]) / gyro_lsb_to_degsec - gyroXoffset;
gyroY = ((float)rawData[5]) / gyro_lsb_to_degsec - gyroYoffset;
gyroZ = ((float)rawData[6]) / gyro_lsb_to_degsec - gyroZoffset;