4. 状态估计性能指标：姿态估计精度、位置估计精度、速度估计精度、收敛时间
各位同学，咱们今天聊点实在的。状态估计做得好不好，不能光靠感觉，得拿数据说话。说白了，飞控算法里最核心的几项指标，就是姿态、位置、速度的精度，以及收敛时间。我这些年调试飞控，踩过的坑大多跟这几个指标有关。咱们一个一个掰开揉碎了讲。
4.1 姿态估计精度（角度误差）
姿态精度，是飞控的“定海神针”。你想想看，如果飞机连自己朝哪边歪都搞不清楚，那后面什么控制都白搭。通常我们用角度误差来衡量，单位是度（°）。
怎么测？
我个人习惯用高精度转台做基准。把飞控板固定在转台上，转台转一个已知角度，比如30°，然后看飞控输出的姿态角是多少。差值就是误差。
关键指标参考（我自己的经验值）：
- 静态精度： 水平放置时，俯仰和横滚角误差应小于 0.5°。偏航角受磁力计影响，通常放宽到 1°~2°。
- 动态精度： 在剧烈机动（比如快速旋转）时，误差应小于 2°~3°。超过这个值，飞控就容易出现“抽风”现象。
避坑指南： 我曾经遇到过一个问题：静态精度很好，但一飞起来就偏。后来发现是加速度计和陀螺仪的延时没对齐。嗯，这里要注意，时间同步是姿态精度的隐形杀手。
4.2 位置估计精度（位置误差）
位置精度，说白了就是飞机能不能悬停在一个点上不动。对于GPS模式，我们看水平位置误差；对于室内视觉或UWB定位，我们看三维位置误差。
怎么测？
我常用的方法是：让飞机悬停，记录10分钟的位置数据，然后计算与目标点的均方根误差（RMSE）。
| 定位方式 | 典型水平精度 | 典型垂直精度 | 我的备注 |
|---|---|---|---|
| 单点GPS | 2~5米 | 3~8米 | 受电离层影响大，飘得厉害 |
| RTK GPS | 0.02~0.05米 | 0.05~0.1米 | 精度高，但容易丢星 |
| 视觉+IMU | 0.1~0.3米 | 0.1~0.3米 | 依赖纹理，暗光下会炸 |
| UWB | 0.1~0.5米 | 0.3~1.0米 | 室内好用，但基站部署麻烦 |
注意： 位置精度不是越高越好。比如在室内用RTK，精度是厘米级，但一旦信号遮挡，位置会瞬间跳变几米。我建议根据应用场景选择合理的精度，而不是一味追求“零误差”。
4.3 速度估计精度
速度精度，很多人容易忽略。其实它直接影响控制的平滑度。你想想，如果速度估计有噪声，那飞控就会一直“抖”，电机声音都会变得刺耳。
怎么评估？
我一般用两种方法：
- 对比法： 用高精度差分GPS（比如NovAtel）作为真值，对比飞控输出的速度。计算误差的均值和标准差。
- 积分法： 对速度积分得到位移，再与位置估计对比。如果速度有偏，积分后的位移会漂移。
我的经验阈值：
- 水平速度误差：小于 0.1 m/s（RMS）
- 垂直速度误差：小于 0.15 m/s（RMS）
- 速度延迟：小于 20ms。延迟大了，控制就会“滞后感”明显。
为什么会强调延迟？我记得有一次做高速穿越机，速度延迟大了10ms，结果飞机在急转弯时直接“甩尾”撞墙。从那以后，我每次测试都会专门测速度的群延迟。
4.4 收敛时间
收敛时间，是衡量状态估计器“反应快不快”的指标。说白了，就是飞机从开机到输出稳定、可信的状态，需要多久。
关键场景：
- 上电启动： 从飞控上电到姿态稳定，我要求 小于2秒。超过5秒，用户就会觉得“这飞机怎么还没准备好”。
- 大机动后恢复： 比如飞机做了一个540度翻滚，姿态估计需要多久回到正常？我要求 小于1秒。
- GPS锁定后： 从GPS获得有效定位到位置估计收敛，我要求 小于3秒。
一个小技巧： 收敛时间不是越快越好。你想想，如果滤波器增益太大，收敛是快了，但噪声也大了。我一般会做一个“自适应增益”：大机动时增益大，快速收敛；平稳飞行时增益小，平滑输出。
4.5 知识体系总览
下面这张图，是我自己总结的状态估计性能指标评估框架。你可以把它当作一个检查清单，每次测试前过一遍。
好了，以上就是状态估计性能指标的四个核心维度。你下次做飞控测试时，可以对照这张图，看看自己的算法在哪方面还有提升空间。记住，没有完美的估计器，只有最适合你应用场景的估计器。
公众号:蓝海资料掘金营，微信deep3321