MPU6050 的航向角（Yaw）漂移问题确实是一个常见的技术难点，主要根源在于其传感器特性和算法限制。以下是详细的原因分析和解决方案：

1. 根本原因分析

• 无磁力计支持：MPU6050 仅有加速度计和陀螺仪，缺乏磁力计（指南针）数据，导致航向角无法通过地磁场绝对定位，只能依赖陀螺仪积分计算。
• 陀螺仪积分误差：陀螺仪测量的角速度存在零偏（Bias），即使微小的零偏在积分过程中也会随时间累积，导致航向角持续漂移。
• 温度漂移：传感器温度变化会加剧零偏的不稳定性，进一步放大误差。

2. 纯MPU6050的改进方案（不增加硬件）

(1) 传感器校准

• 陀螺仪零偏校准：

  // 示例：静止状态下采样N次，计算零偏均值
  float gyro_bias_x = 0, gyro_bias_y = 0, gyro_bias_z = 0;
  for (int i = 0; i < 1000; i++) {
    gyro_bias_x += gyroX;
    gyro_bias_y += gyroY;
    gyro_bias_z += gyroZ;
    delay(10);
  }
  gyro_bias_x /= 1000; // 后续积分时减去此零偏

• 定期动态校准：在运行中检测静止状态（通过加速度计），动态更新零偏。

(2) 传感器融合算法优化

• 互补滤波：结合加速度计的低频可靠性与陀螺仪的高频响应。

  float dt = 0.01; // 采样时间间隔
  float alpha = 0.98; // 滤波系数
  // 使用加速度计计算俯仰/横滚角
  float acc_pitch = atan2(accY, sqrt(accX*accX + accZ*accZ));
  float acc_roll = atan2(-accX, accZ);
  // 融合陀螺仪积分
  pitch = alpha * (pitch + gyroY * dt) + (1-alpha) * acc_pitch;
  roll = alpha * (roll + gyroX * dt) + (1-alpha) * acc_roll;
  // 航向角无加速度计参考，仍需依赖陀螺仪积分（漂移不可避免）
  yaw += gyroZ * dt;

• 卡尔曼滤波：通过状态估计抑制噪声，但需针对MPU6050调参。

(3) 软件级修正

• 航向角重置机制：在已知设备绝对方向时（如启动时水平放置），手动重置航向角。
• 限制使用场景：仅在短时间、对航向精度要求不高的场景中使用。

3. 硬件升级方案（推荐）

(1) 增加磁力计（如HMC5883L/QMC5883）

• 通过磁力计获取绝对航向，与陀螺仪数据融合。
• 传感器融合算法（如AHRS）：

  // 磁力计校准（去硬铁干扰）
  // 1. 采集磁力计数据，绕8字旋转
  // 2. 计算磁力计椭球拟合参数
  // 融合磁力计数据到航向角
  float mag_yaw = atan2(magY, magX); // 需校准后使用
  yaw = 0.95 * (yaw + gyroZ * dt) + 0.05 * mag_yaw; // 简单互补滤波

• 现成库支持：Arduino的MPU6050_6Axis_MotionApps20或Madgwick滤波库。

(2) 升级到9轴传感器（如MPU9250）

• 直接集成磁力计，简化硬件设计。

4. 其他注意事项

• 电源稳定性：确保传感器供电纯净，避免电压波动导致噪声。
• 机械固定：减少振动对陀螺仪的干扰。
• 温度管理：避免传感器过热，或加入温度补偿算法。

5. 总结建议

• 短期方案：优化校准和滤波，接受有限时间内的航向角精度。
• 长期方案：增加磁力计，采用9轴传感器融合，彻底解决漂移问题。

通过软硬件结合的方法，可以显著改善MPU6050的航向角漂移问题，具体方案需根据应用场景和成本权衡选择。