第4章静基座粗对准

静基座粗对准：解析法粗对准原理

各位同学，今天我们来聊聊静基座粗对准。说白了，就是让惯导系统在静止状态下，自己找到北。

我刚开始接触惯导时，觉得这玩意儿挺玄乎的。一个盒子放在那儿不动，它就能知道自己的姿态？后来搞明白了，其实原理并不复杂——靠的就是地球自转和重力这两个天然参考。

先看传感器输出。在静基座上，加速度计和陀螺的测量值是这样的：

加速度计输出：f^b = -g^n + δa^b + ∇^b
陀螺输出：ω^b = ω^n_ie + δω^b + ε^b

其中：

嗯，这里要注意：地球自转角速度很小，只有15度每小时。我当年第一次算这个数时，还以为是公式写错了。你想想看，陀螺要测这么慢的转动，精度要求得多高？

核心思想：静基座下，加速度计测的是重力在载体轴上的分量，陀螺测的是地球自转角速度在载体轴上的分量。这两个矢量在导航系中是已知的，通过对比测量值和理论值，就能反推出姿态。

解析法粗对准分两步走：先水平，后方位。

水平对准靠加速度计。当载体水平时，加速度计只感受重力。如果载体倾斜了，重力就会在水平轴上有分量。

具体做法：

θ = arcsin(f_x / g)
γ = -arcsin(f_y / (g·cosθ))

这里f_x、f_y是加速度计在x、y轴上的输出。我习惯用10秒以上的数据做平均，这样能把噪声压下去不少。

避坑指南：我曾经遇到过加速度计零偏导致水平对准误差的问题。如果零偏是1mg，水平对准误差大约就是1毫弧度。对于高精度应用，这个误差不可忽略。建议在粗对准前先做一次零偏标定。

方位对准靠陀螺。地球自转角速度在水平面上的投影，指向正北方向。陀螺测出这个投影的方向，就能确定航向角。

公式如下：

ψ = arctan(ω_x / ω_y)

其中ω_x、ω_y是陀螺在水平轴上的输出，已经扣除了地球自转的垂直分量。

这里有个坑：在中纬度地区，地球自转的水平分量大约只有10°/h。如果陀螺漂移是1°/h，那方位对准误差就是0.1弧度，约6度。这精度说实话不太够看。

注意：纬度越高，地球自转的水平分量越小，方位对准越困难。在极地附近，解析法粗对准基本失效。我当年在北极圈附近做实验时，就吃过这个亏。

粗对准的误差来源主要有三个：

说白了，粗对准的精度受限于传感器本身的精度。你想想看，用精度1°/h的陀螺，想对准到0.1度以内，那是不可能的。

我个人的经验是：粗对准完成后，水平姿态误差通常在0.1~1度，方位误差在1~10度。这个精度够不够？看应用场景。对于战术级惯导，粗对准结果可以直接用。对于导航级惯导，粗对准只是给精对准提供一个初始值。

总结一下：解析法粗对准的原理就是利用重力和地球自转这两个已知矢量，通过传感器测量值反推姿态。水平对准靠加速度计，方位对准靠陀螺。精度受传感器误差限制，但胜在简单快速，几秒钟就能完成。

好了，这一章就讲到这里。粗对准是惯导系统启动的第一步，虽然精度不高，但胜在快速可靠。下一章我们会讲精对准，那才是真正考验功夫的地方。