4. 惯性导航系统（INS）误差模型

做组合导航这些年，我越来越觉得——INS误差模型是整个融合滤波的基石。你想想看，GNSS信号一丢，全靠IMU撑着，如果陀螺和加速度计的误差没摸透，那导航结果就像没舵的船，漂到哪算哪。这一章咱们就掰开揉碎，把陀螺仪误差、加速度计误差、初始对准误差这几个硬骨头啃下来。

陀螺仪是INS的“眼睛”，但它看东西总带点“散光”。我个人习惯把陀螺误差拆成三块：零偏、刻度因子、交轴耦合。这三兄弟要是没伺候好，姿态误差会像滚雪球一样越来越大。

            零偏（Bias） —— 说白了就是陀螺静止时还输出一个非零的角速度。我见过最夸张的一次，某MEMS陀螺零偏稳定性标称10°/h，上电后实际漂了30°/h，差点把导航算到沟里去。
        

刻度因子误差：输入角速度和输出值之间的比例偏差。比如你转了1 rad/s，它告诉你0.98 rad/s。这玩意儿在温度变化时特别调皮，我一般会在标定后留一组温补系数。

交轴耦合（也叫交叉轴灵敏度）：X轴感受到的角速度串到了Y轴输出上。嗯，这在高动态场景下尤其要命。我曾经在无人机急转弯时看到航向角莫名跳了5度，查了半天发现是交轴耦合没补偿。

💡 避坑指南：我曾经在标定时只做了零偏和刻度因子，忽略了交轴耦合。结果在转台实验里看着没问题，一上实际载体就露馅。所以现在我的标定流程里，交轴耦合矩阵是必选项。

加速度计和陀螺仪“师出同门”，误差结构也类似：零偏、刻度因子、交轴耦合。但加速度计对重力敏感，所以零偏会直接导致俯仰和横滚角计算偏差。

你想想看，如果加速度计Z轴有10 mg的零偏，那水平姿态就会差0.57°左右。在组合导航里，这个误差会通过姿态耦合到速度推算里，最后位置误差随时间平方增长。我习惯在静基座下做六位置标定，把零偏和刻度因子一次性抠出来。

⚠️ 注意：加速度计的交轴耦合在振动环境下会显著放大。我曾经在车载测试里发现，过减速带时加速度计X轴和Y轴出现明显的串扰，导致速度更新出现尖刺。后来在误差模型里加了交轴耦合项，滤波才稳定下来。

加速度计误差模型通常写成：

δf = b_a + diag(s_a) · f + M_a · f + w_a

其中 b_a 是零偏，s_a 是刻度因子向量，M_a 是交轴耦合矩阵，w_a 是随机噪声。实际工程中，我一般把 b_a 和 s_a 放进状态向量，M_a 如果标定好了就当作已知补偿。

初始对准误差，说白了就是一开始就没站对位置。INS是递推系统，起点偏一点，后面全偏。初始对准误差包括：姿态失准角、速度初值误差、位置初值误差。

我个人最头疼的是姿态失准角。尤其是航向角，如果没有磁力计或GNSS双天线辅助，纯靠陀螺积分根本没法在静止时对准。我记得有次在室内用高精度光纤陀螺做对准，结果航向角收敛了半小时还有0.2°的残差——这就是初始对准误差的顽固之处。

            小技巧：在滤波初始化时，我通常把初始姿态误差的协方差设得大一些（比如航向10°，水平1°），让滤波器自己去收敛。千万别把初值协方差设得太自信，否则滤波容易发飘。
        

初始对准误差的传播特性：

所以你看，INS误差模型不是一堆公式的堆砌，而是每个参数背后都有血淋淋的教训。我建议你在做融合滤波之前，先把陀螺和加速度计的零偏、刻度因子、交轴耦合都标定一遍，再认真评估初始对准的精度。这样后面的卡尔曼滤波才能“吃得饱、跑得稳”。