第1章：Q矩阵调优——加速度计噪声、陀螺仪噪声、随机游走参数

各位同学，咱们今天聊点实在的。

Q矩阵，说白了就是EKF里那个“过程噪声协方差矩阵”。很多新手一上来就照着论文抄参数，结果飞起来抖得像筛子。我当年也干过这事——调了一整天，无人机在地上打转，差点把实验室的窗帘给绞进去。

嗯，咱们今天就把Q矩阵的三个核心参数掰开揉碎讲清楚：加速度计噪声、陀螺仪噪声、还有那个让人头疼的随机游走。

1.1 Q矩阵到底在干啥？

先问个问题：EKF凭什么能估计出姿态？

它靠的是“预测+观测”的闭环。预测这一步，用的就是IMU数据。但IMU有噪声啊，你预测得越久，误差就越大。Q矩阵就是用来告诉滤波器：“嘿，我对IMU的信任度是多少。”

Q值设得太大，滤波器会过度依赖观测（比如磁力计），结果姿态跟着磁力计乱跳。Q值设得太小，滤波器又太“自信”，IMU的漂移就压不住。我见过一个项目，Q矩阵设小了，无人机悬停时慢慢往一个方向偏，飞手还以为是地磁异常……其实只是陀螺仪零偏没处理好。

1.2 加速度计噪声参数

加速度计噪声，通常用acc_noise表示。单位是m/s²，或者归一化后直接用g。

这个参数控制的是：你对加速度计测量值的信任程度。数值越小，说明你越相信加速度计。但注意——加速度计在剧烈运动时根本不可信！

我个人习惯的做法是：先看IMU的数据手册，找到加速度计的噪声密度（单位：µg/√Hz），然后换算成方差。但说实话，手册上的值往往偏理想。我建议你实际跑一下数据，算一下静止时的标准差，那个值更靠谱。

1.3 陀螺仪噪声参数

陀螺仪噪声，用gyro_noise表示。单位是rad/s。

这个参数直接影响姿态预测的精度。陀螺仪噪声设大了，姿态预测会发散；设小了，又跟不上快速转动。

我记得有一次做竞速无人机，飞手抱怨说“飞机翻个滚就找不着北了”。我一看日志，陀螺仪噪声设成了0.001，太小了。实际上那架飞机用的IMU芯片噪声水平在0.005左右。改完之后，翻滚动作干净利落。

怎么确定这个值？

• 查手册：看陀螺仪的“角度随机游走”（ARW）参数，单位是°/√h
• 实测：让IMU静止，录陀螺仪数据，计算标准差
• 经验值：大多数消费级IMU的陀螺仪噪声在0.005~0.02 rad/s之间

1.4 随机游走参数

随机游走，英文叫Random Walk，或者叫“零偏不稳定性”。

这个参数描述的是：陀螺仪零偏随时间漂移的速度。单位是rad/s²，或者°/s²。

为什么要有这个参数？因为陀螺仪的零偏不是固定的。温度一变、时间一长，零偏就慢慢跑了。如果不建模这个漂移，EKF会一直用错误的零偏去预测姿态，误差越积越大。

我曾经遇到一个案例：无人机在室外飞了10分钟，高度和位置都正常，但偏航角慢慢偏了5度。查了半天，发现是随机游走参数设成了0。也就是说，滤波器认为陀螺仪零偏永远不会变。这怎么可能呢？

随机游走参数的调法：

• 保守值：0.0001~0.001（适合长时间飞行）
• 激进值：0.01~0.1（适合快速机动，但会引入噪声）
• 如果IMU有温控，可以设小一点；没有温控，建议设大一点

1.5 知识体系结构图

下面这张图，帮你理清Q矩阵调优的整体逻辑：

1.6 实战调参步骤

好了，理论讲完了，咱们来点实际的。下面是我常用的调参流程：

1. 第一步：静止标定

   把无人机放在水平桌面，录2分钟IMU数据。计算加速度计和陀螺仪的标准差。这个值就是你的初始Q矩阵对角线元素。

2. 第二步：设置初始值

   把标准差乘以1.5作为初始Q值。随机游走先设0.0001。

3. 第三步：悬停测试

   让无人机悬停1分钟。看姿态估计是否稳定。如果抖动明显，说明Q值偏大；如果缓慢漂移，说明Q值偏小。

4. 第四步：机动测试

   做几个快速俯仰、滚转动作。看姿态跟踪是否及时。如果滞后明显，适当增大陀螺仪噪声。

5. 第五步：长时间飞行

   飞10分钟以上，检查偏航角是否漂移。如果漂移明显，增大随机游走参数。

1.7 常见问题与避坑

现象	可能原因	解决方法
悬停时姿态抖动	加速度计噪声偏大	减小加速度计噪声
快速机动时姿态滞后	陀螺仪噪声偏小	增大陀螺仪噪声
长时间飞行偏航漂移	随机游走偏小	增大随机游走参数
姿态估计发散	Q矩阵整体偏大	减小所有Q值
零偏估计值乱跳	随机游走偏大	减小随机游走参数

嗯，以上就是Q矩阵调优的核心内容。记住一句话：Q矩阵不是调出来的，是“测”出来的。先测后调，才是正道。

---