一、初始对准基础：对准的定义与目的
做惯导这么多年，我经常被问到同一个问题：
「导航系统启动后，为什么不能直接走？」
答案其实很简单——它不知道自己朝哪。
你想想看，一个刚上电的IMU，陀螺和加速度计都在输出数据。但问题是，这些数据是相对于它自身坐标系的。而我们要的是导航坐标系下的信息。这中间缺了什么？缺的就是一个姿态矩阵。
对准，说白了就是确定初始姿态矩阵的过程。
对准的核心定义：
利用外部参考信息或传感器自身测量，确定载体坐标系（b系）与导航坐标系（n系）之间的初始变换关系。
我记得刚入行时带我的老工程师说过一句话：「对准搞不定，后面全是白搭。」当时不以为然，直到有一次在项目里因为对准误差大了0.1度，导致整个导航系统在10分钟后漂了2海里...嗯，从那以后我再也不敢轻视对准了。
1.1 对准的目的
对准的目的，我总结为三个层面：
- 建立初始姿态——给出准确的航向角、俯仰角、横滚角
- 估计传感器偏差——尤其是陀螺的零偏，这玩意儿直接影响后续精度
- 初始化导航滤波器——给卡尔曼滤波一个靠谱的起点
说白了，对准就是给整个导航系统「定调子」。调子定歪了，后面再怎么唱也唱不准。
二、对准的分类
对准的分类方式有很多种。我个人习惯按两个维度来划分：基座状态和信息来源。
2.1 按基座状态分类
静基座对准——载体不动，地面静止状态。
这是最理想的情况。没有线运动干扰，没有角运动干扰，传感器输出相对干净。我早期做实验时最喜欢这种工况，数据好处理，结果也漂亮。
静基座对准的核心思路：利用重力确定水平姿态，利用地球自转角速度确定航向。
小提示：静基座对准的精度上限，取决于陀螺的测量精度。举个例子，如果陀螺零偏稳定性是0.01°/h，理论上航向对准精度可以做到0.01°左右。但实际中还要考虑量化噪声、振动环境等因素，通常要打个折扣。
动基座对准——载体处于运动状态。
这就麻烦多了。船在晃、车在跑、飞机在滑行，IMU的输出里混入了各种运动加速度和角速度。你得想办法把这些「干扰」从测量值里剥离出来。
动基座对准常用的方法包括：
- 惯性系对准（利用重力矢量在惯性空间的变化）
- 基于GPS/里程计辅助的速度匹配
- 多矢量定姿（比如同时利用重力和地磁）
我曾经在一个船载项目中做过动基座对准。船在码头边随着波浪上下起伏，航向角一直在±3°之间摆动。那会儿我用了惯性系对准方法，配合GPS速度辅助，最终把对准时间从15分钟压缩到了3分钟。说实话，当时看到结果时还挺有成就感的。
2.2 按信息来源分类
自对准——不依赖外部信息，全靠IMU自己。
自对准利用的是两个天然参考：
- 重力矢量——指向地心，提供垂线方向
- 地球自转角速度矢量——指向北极，提供北向参考
这两个矢量在导航坐标系下的投影是已知的。通过比较它们在载体坐标系下的测量值，就能反算出姿态矩阵。
自对准的数学本质：
已知 n 系下的两个不共线矢量 gn 和 ωn，测量得到 b 系下的 gb 和 ωb，求解 Cbn 使得：
gb = Cnb · gn 且 ωb = Cnb · ωn
这就是经典的 Wahba 问题，可以用 QUEST、SVD 等方法求解。
传递对准——借助外部参考系统。
常见场景：飞机挂载的导弹或吊舱，利用载机的主惯导系统来初始化自己的子惯导。
传递对准的关键在于「匹配」：
- 速度匹配——比较主/子惯导的速度差
- 姿态匹配——比较主/子惯导的姿态差
- 角速率匹配——比较主/子惯导的角速率差
我做过一个传递对准的项目，主惯导是激光陀螺，子惯导是光纤陀螺。两者精度差了一个数量级。当时我用了速度+姿态的联合匹配，配合杆臂效应补偿，最终在10秒内完成了对准，精度优于0.05°。嗯，这个指标在当时算是相当不错的。
三、对准性能指标
评价一个对准算法好不好，我一般看三个指标：
| 指标 | 定义 | 典型要求 |
|---|---|---|
| 对准精度 | 对准结束时的姿态误差（航向、俯仰、横滚） | 航向：0.1°~0.5° 水平：0.01°~0.05° |
| 对准时间 | 从启动到输出合格姿态所需的时间 | 静基座：3~10分钟 动基座：1~5分钟 |
| 对准可靠性 | 多次对准结果的重复性和鲁棒性 | 标准差优于精度指标的1/3 |
3.1 对准精度
这是最核心的指标。精度不够，后面导航误差会随时间累积。
我个人的经验是：
- 水平姿态精度主要受加速度计噪声影响，一般能做到0.01°~0.05°
- 航向精度主要受陀螺噪声和地球自转信号的信噪比影响，通常比水平精度差一个数量级
注意：航向对准精度有一个理论下限——
σψ ≥ σω / (ωie · cosφ)
其中 σω 是陀螺角度随机游走，ωie 是地球自转角速度（15°/h），φ 是当地纬度。
举个例子，在北纬45°地区，如果陀螺角度随机游走是 0.01°/√h，理论极限航向精度大约是 0.06°。想突破这个极限？那就得靠外部辅助了。
3.2 对准时间
战场上，时间就是生命。民用场景里，用户也不想等太久。
静基座对准通常需要3~10分钟。为什么这么久？因为你要从噪声里提取地球自转信号，这需要足够长的积分时间。
动基座对准可以快一些，如果有外部辅助（比如GPS），1~2分钟就能搞定。传递对准最快，几秒到几十秒。
我曾经遇到过一个项目，要求30秒内完成对准，精度还要优于0.2°。当时试了好几种方法都不行，最后用了基于惯性系的快速对准+GPS速度辅助的组合方案，才勉强达标。说实话，那段时间没少熬夜。
3.3 对准可靠性
这个指标容易被忽视，但实际工程中特别重要。
你想想看，如果同一个IMU在相同条件下做10次对准，结果每次都不一样，你敢用吗？
可靠性通常用标准差来评价：
- 多次对准的姿态角标准差
- 对准结果的收敛一致性
- 异常工况下的鲁棒性（比如受到冲击、振动）
我的经验：提高可靠性的一个实用技巧是——不要只依赖对准结束时刻的结果。我会在最后10秒内取一个滑动平均，或者用卡尔曼滤波的协方差矩阵来判断是否收敛。如果协方差还没降到阈值以下，就延长对准时间。
小结
这一章我们聊了初始对准的基础知识。说白了就是三件事：
- 对准是什么——确定初始姿态矩阵
- 对准有哪些类型——静基座/动基座、自对准/传递对准
- 怎么评价对准好坏——精度、时间、可靠性
这些概念是后面所有内容的基础。我个人觉得，理解了对准的本质——利用已知参考矢量求解姿态——后面再学具体算法就会轻松很多。
一句话总结：
初始对准，就是用已知的「天」和「北」，来确定你朝哪。