第四章 初始对准：静基座粗对准、解析粗对准、精对准与罗经对准

各位同学，今天我们聊一个非常关键的话题——初始对准。说白了，就是导弹发射前，你得让惯导系统知道“自己现在脸朝哪边”。

我刚开始做弹载惯导那会儿，总觉得对准不就是算个姿态嘛，有啥难的？结果第一次上转台测试，数据飘得我头皮发麻。嗯，从那以后我再也不敢小看这一步了。

4.1 静基座粗对准

静基座粗对准，是初始对准的第一步。它的目标很简单：快速给出一个大概的姿态角，精度要求不高，但速度要快。

原理上，我们利用的是地球自转角速度和重力加速度。你想想看，在静止状态下，加速度计测到的是重力g，陀螺测到的是地球自转角速度ωie。这两个矢量在地理坐标系下的投影是已知的，而在载体坐标系下的测量值我们也有。那么，姿态矩阵就能解出来。

具体做法是这样的：

  • 加速度计输出：fb = [fx, fy, fz]T，归一化后得到重力方向
  • 陀螺输出：ωb = [ωx, ωy, ωz]T，包含地球自转分量
  • 利用双矢量定姿原理，构建两个不共线的矢量，解算姿态矩阵

核心公式：

gn = [0, 0, g]T，ωn = [ωiecosL, 0, -ωiesinL]T

通过测量值fb和ωb，构建矢量对，解算Cbn

我在项目中遇到过一个问题：如果载体有轻微晃动，粗对准的精度会急剧下降。所以实际工程中，我们通常会对加速度计和陀螺的输出做几十秒的平滑滤波，再去解算。

避坑指南：

我曾经在车载试验中，因为没注意车辆发动机的振动频率，导致粗对准结果偏差了5度。后来加了50Hz的陷波滤波器，问题才解决。记住，粗对准虽然“粗”，但也不能太随意。

4.2 解析粗对准

解析粗对准，其实是对静基座粗对准的一种数学优化。它不依赖迭代，直接通过解析表达式求解姿态角。

为什么需要解析法？因为传统的粗对准如果遇到加速度计或陀螺噪声较大，解算结果可能不收敛。解析法直接给出闭式解，稳定可靠。

具体推导我就不展开了，直接给结论：

// 解析粗对准核心代码（C语言伪代码）
void coarse_align_analytic(float acc[3], float gyro[3], float lat, float *roll, float *pitch, float *yaw)
{
    float g = 9.7803;  // 当地重力加速度
    float wie = 7.292115e-5;  // 地球自转角速度
    
    // 计算俯仰角和横滚角
    *pitch = atan2f(-acc[0], sqrtf(acc[1]*acc[1] + acc[2]*acc[2]));
    *roll  = atan2f(acc[1], acc[2]);
    
    // 计算航向角（需要补偿地球自转）
    float omega_n = wie * cosf(lat);
    float omega_e = 0.0f;
    float omega_d = -wie * sinf(lat);
    
    // 利用陀螺输出解算航向
    float C11 = cosf(*pitch) * cosf(*yaw);
    // ... 实际工程中需要解算完整的姿态矩阵
}

我个人习惯在解析粗对准之后，加一个简单的卡方检验，判断解算结果是否合理。如果残差太大，说明可能有异常数据，需要重新采集。

4.3 精对准

粗对准给出了大概的姿态，但精度通常只有几度甚至十几度。精对准的任务，就是把姿态误差降到角分级甚至角秒级。

精对准的核心思想是：利用卡尔曼滤波，估计失准角。说白了，就是建立误差模型，用观测量去修正。

状态量通常包括：

  • 姿态误差角：φE, φN, φU
  • 速度误差：δvE, δvN
  • 陀螺漂移：εx, εy, εz
  • 加速度计零偏：∇x, ∇y, ∇z

观测量就是速度误差。在静基座下，真实速度为零，所以导航解算出的速度就是误差。

精对准的观测方程：

z = [δvE, δvN]T = H·x + v

其中H矩阵将失准角与速度误差联系起来

我记得有一次做半实物仿真，精对准跑了10分钟，姿态误差还在0.1度左右下不去。后来发现是陀螺的随机游走参数没设对。嗯，卡尔曼滤波的噪声矩阵Q和R，一定要根据实际器件标定结果来设，不能拍脑袋。

注意事项：

精对准过程中，如果载体有微小的角运动（比如风引起的晃动），卡尔曼滤波可能会发散。我曾经在野外试验中遇到过这种情况，后来加了运动检测逻辑，检测到角运动超过阈值就暂停对准，等稳定后再继续。

4.4 罗经对准

罗经对准，是精对准的一种特殊形式。它利用地球自转角速度的北向分量，通过罗经效应来估计航向角。

你想想看，地球自转的北向分量是ωiecosL，这个量很小，在中纬度地区大约10度/小时。陀螺要测准这么小的角速度，对器件要求很高。

罗经对准的流程是这样的：

  1. 先完成水平对准（调平），使俯仰和横滚误差足够小
  2. 利用陀螺测量地球自转角速度在水平面的投影
  3. 通过罗经效应方程，解算航向角

罗经对准的精度，主要取决于陀螺的测量精度。如果陀螺零偏稳定性是0.01度/小时，那么航向对准精度大约能做到0.1度左右。

工程经验：

我曾经在车载罗经对准中，发现车辆停在铁轨附近时，航向误差特别大。后来一查，铁轨的磁场干扰了地磁传感器？不对，这里是纯惯导，没有磁传感器。其实是铁轨附近的振动耦合到了陀螺。所以，罗经对准对环境振动非常敏感，选址很重要。

罗经对准的时间通常比较长，一般需要5-15分钟。时间越长，对陀螺噪声的平滑效果越好，精度也越高。但弹载应用往往有时间限制，所以需要在精度和时间之间做权衡。

4.5 四种对准方法的对比

对准方法 精度 时间 适用场景 优缺点
静基座粗对准 1°~5° 几十秒 快速启动 简单快速，精度低
解析粗对准 0.5°~2° 几十秒 噪声较大环境 稳定不发散，计算量稍大
精对准 0.01°~0.1° 5~15分钟 高精度需求 精度高，依赖模型准确性
罗经对准 0.05°~0.2° 5~15分钟 高精度航向 航向精度好，对陀螺要求高

在实际的弹载系统中，我们通常的做法是：先用粗对准快速得到一个初始姿态，然后切换到精对准或罗经对准，在发射前完成高精度对准。如果时间紧迫，也可以只用粗对准结果直接发射，但命中精度会受影响。

好了，这一章的内容就到这里。下一章我们会讲导航解算的核心——姿态更新算法，到时候会涉及到四元数、等效旋转矢量这些硬核内容，大家做好准备。

← 上一章 📖 返回目录 下一章 →