1. MPU6050传感器基础与数据采集MPU6050这颗六轴运动处理芯片可以说是嵌入式开发者的老朋友了。我当年第一次用它做平衡小车时就被它集成的三轴加速度计和三轴陀螺仪惊艳到了。简单来说加速度计负责测量线性运动陀螺仪负责测量旋转运动两者配合就能完整描述物体的运动状态。实际使用中我发现这个传感器有几点特别实用首先是I2C接口只需要两根线就能通信特别适合引脚资源紧张的51单片机其次是内置了16位ADC直接输出数字信号省去了外接模数转换的麻烦。不过要注意的是模块默认I2C地址是0x68AD0引脚接地时如果同时使用多个传感器就需要通过AD0引脚改变地址。说到数据采集这里有个容易踩的坑原始数据寄存器是分高低字节存储的。比如读取X轴加速度值时需要先读ACCEL_XOUT_H再读ACCEL_XOUT_L然后把两个8位数据组合成16位有符号整数。具体代码实现可以参考这个经典写法short MPU_Get_Accelerometer(short *ax, short *ay, short *az) { uint8_t buf[6]; if(MPU_Read_Len(MPU_ACCEL_XOUTH_REG, 6, buf) 0) { *ax ((uint16_t)buf[0]8) | buf[1]; *ay ((uint16_t)buf[2]8) | buf[3]; *az ((uint16_t)buf[4]8) | buf[5]; return 0; } return 1; }实测中发现直接读取的原始值存在明显的零点漂移。我的经验是在初始化后先静止放置传感器采集100组数据求平均值作为校准值。后续每次读数都减去这个校准值效果立竿见影。另外建议将采样率设置为200Hz以上这样姿态解算时才不会有明显延迟。2. 原始数据预处理与校准技巧拿到原始数据后别急着计算姿态我踩过的坑告诉我数据预处理这个环节绝对不能省。首先是单位转换加速度计原始值需要根据量程转换为g值陀螺仪数据则需要转为度/秒。以±2g量程的加速度计为例转换公式是这样的实际加速度(g) 原始值 / 16384.0这里有个细节要注意不同量程对应的分度值不同具体可以参考这个对照表量程设置加速度计分度值(LSB/g)陀螺仪分度值(LSB/°/s)±2g16384131±4g819265.5±8g409632.8±16g204816.4校准环节我推荐采用六面法把传感器六个面依次朝下静止放置分别记录各轴输出然后计算偏移量。比如检测X轴时// X轴正向朝下 ax_sum raw_ax; // X轴负向朝下 ax_sum raw_ax; offset_x ax_sum / (2*sample_count);对于陀螺仪校准更简单保持静止状态下读取的数据理论上都应该是0。我通常采集200-300个样本求平均值这个值就是零偏误差。实际项目中温度变化会导致零偏漂移有条件的话可以增加温度补偿。3. 姿态解算算法实现姿态解算可以说是MPU6050最核心的应用了。经过多次项目实践我认为互补滤波是最适合51单片机的方案它完美平衡了计算量和精度要求。基本原理是把加速度计和陀螺仪的数据优势互补加速度计在静态时准确但动态响应慢陀螺仪短期精度高但存在累积误差。具体实现时先通过加速度计数据计算俯仰角(pitch)和横滚角(roll)#define RAD_TO_DEG 57.2957795f void Get_Angle_Acc(float *roll, float *pitch, float ax, float ay, float az) { *roll atan2(ay, az) * RAD_TO_DEG; *pitch atan2(-ax, sqrt(ay*ay az*az)) * RAD_TO_DEG; }然后用陀螺仪积分计算角度变化float gyro_angle_x gyro_x * dt; // dt为采样时间间隔 float gyro_angle_y gyro_y * dt;最后用互补滤波融合两类数据float alpha 0.98f; // 滤波系数 angle_x alpha*(angle_x gyro_angle_x) (1-alpha)*acc_angle_x; angle_y alpha*(angle_y gyro_angle_y) (1-alpha)*acc_angle_y;这个系数alpha需要根据实际应用调整我做的平衡车项目中使用0.98效果不错。如果发现输出角度抖动明显可以适当增大这个值如果出现响应迟缓就减小这个值。4. 实际项目优化经验在四轴飞行器项目中我发现原始算法存在两个问题一是快速运动时加速度计数据不可靠二是长时间运行后陀螺仪积分误差累积。后来改进的方案是加入运动状态检测// 计算加速度计模值 float acc_magnitude sqrt(ax*ax ay*ay az*az); // 接近1g时为静止状态 if(fabs(acc_magnitude - 1.0) 0.2) { alpha 0.98; // 信任加速度计 } else { alpha 0.999; // 主要依赖陀螺仪 }对于51单片机来说浮点运算比较耗时。我后来把所有计算都改成了定点数运算速度提升了近3倍。比如把角度值放大100倍用short类型存储这样0.01°的分辨率完全够用short angle_x (short)(true_angle_x * 100);另外建议把MPU6050的DLPF(数字低通滤波器)设置为5Hz左右可以有效抑制高频振动干扰。具体设置方法MPU_Write_Byte(MPU_CFG_REG, 0x06); // 设置DLPF为5Hz最后要提醒的是51单片机的I2C速率不能设得太高实测在标准模式下(100kHz)最稳定。如果发现数据读取不稳定可以适当增加两次读取之间的延时。