在STM32平台上实现姿态仪（Attitude Indicator）通常涉及以下步骤和关键技术：

核心组件

1. 传感器模块

   • MPU6050：6轴传感器（3轴加速度计 + 3轴陀螺仪）
   • MPU9250：9轴传感器（加速度计+陀螺仪+磁力计）
   • BMI160/BMI270：高性能低功耗传感器

2. 姿态解算算法

   • 互补滤波：简易实时融合加速度计和陀螺仪数据
   • 卡尔曼滤波：抑制噪声，提高动态响应
   • Mahony/Madgwick算法：开源高效姿态融合算法（推荐）
   • DMP（Digital Motion Processor）：MPU6050内置处理单元，直接输出四元数

开发步骤

1. 硬件连接

   // I2C连接示例（STM32F4）
   I2C1_SCL -> PB6
   I2C1_SDA -> PB7
   MPU6050_VCC -> 3.3V
   MPU6050_GND -> GND

2. 传感器初始化

   void MPU6050_Init(void) {
    HAL_I2C_Mem_Write(&hi2c1, MPU6050_ADDR, PWR_MGMT_1, 1, 0x00, 1, 100);
    HAL_I2C_Mem_Write(&hi2c1, MPU6050_ADDR, SMPLRT_DIV, 1, 0x07, 1, 100);
    HAL_I2C_Mem_Write(&hi2c1, MPU6050_ADDR, ACCEL_CONFIG, 1, 0x00, 1, 100);
    HAL_I2C_Mem_Write(&hi2c1, MPU6050_ADDR, GYRO_CONFIG, 1, 0x18, 1, 100);
   }

3. 数据读取（示例）

   void Read_MPU6050(float *accel, float *gyro) {
    uint8_t buf[14];
    HAL_I2C_Mem_Read(&hi2c1, MPU6050_ADDR, ACCEL_XOUT_H, 1, buf, 14, 100);
   
    accel[0] = (int16_t)(buf[0]<<8|buf[1]) / 16384.0;  // X轴加速度(g)
    accel[1] = (int16_t)(buf[2]<<8|buf[3]) / 16384.0;  // Y轴
    accel[2] = (int16_t)(buf[4]<<8|buf[5]) / 16384.0;  // Z轴
   
    gyro[0] = (int16_t)(buf[8]<<8|buf[9]) / 131.0;     // X轴角速度(°/s)
    gyro[1] = (int16_t)(buf[10]<<8|buf[11]) / 131.0;   // Y轴
    gyro[2] = (int16_t)(buf[12]<<8|buf[13]) / 131.0;   // Z轴
   }

4. 姿态解算核心（Mahony滤波伪代码）

   void MahonyAHRSupdate(float gx, float gy, float gz, float ax, float ay, float az) {
    // 1. 加速度数据归一化
    // 2. 计算误差向量 = 加速度计测量方向 × 当前姿态估计方向
    // 3. 积分误差到陀螺仪偏差
    // 4. 用偏差校正陀螺仪数据
    // 5. 四元数积分更新
    // 6. 四元数归一化
   }

5. 转换为欧拉角

   void QuaternionToEuler(float q0, float q1, float q2, float q3) {
    float roll = atan2(2*(q0*q1 + q2*q3), 1 - 2*(q1*q1 + q2*q2));
    float pitch = asin(2*(q0*q2 - q3*q1));
    float yaw = atan2(2*(q0*q3 + q1*q2), 1 - 2*(q2*q2 + q3*q3));
   
    // 弧度转角度
    roll *= 57.2958f; 
    pitch *= 57.2958f;
    yaw *= 57.2958f;
   }

关键优化技术

1. 传感器校准

   • 开机静止自动校准零偏
   • 温度补偿（可选）

2. 实时性保障

   • 使用定时器中断触发采样（推荐200-500Hz）
   • DMA传输减少CPU负载

3. 动态性能优化

   • 运动时信任陀螺仪数据
   • 静止时用加速度计校正漂移

4. 显示输出

   • 通过UART输出JSON数据：{"roll":25.3, "pitch":-12.1}
   • OLED显示姿态指示器（飞机地平线）

调试技巧

1. 使用串口绘图工具实时监控角度
2. 用STM32CubeMonitor进行数据可视化
3. 静态测试：各轴朝下检测±1g加速度
4. 旋转测试：对比标准转台精度

扩展功能建议

• 添加磁力计实现全姿态解算（Yaw角）
• 集成气压计获取高度信息
• 接入SD卡记录飞行数据
• 通过蓝牙/WiFi传输到手机APP

推荐资源

1. 参考代码库

   • MPU6050_esp-idf
   • i2cdevlib/STM32

2. 关键文档

   • 《STM32Cube_I2C_Example》
   • MPU6050寄存器手册（Rev 4.2）
   • Mahony原始论文《Nonlinear Complementary Filters on the Special Orthogonal Group》

注意：实际开发中建议使用STM32CubeMX配置时钟和I2C外设，结合HAL库加速开发。姿态解算推荐直接使用开源的MahonyAHRS实现，避免重复造轮子。