第四章 惯性导航基础(三):初始对准技术、误差传播与舒勒振荡
各位同学,欢迎来到惯性导航的第三讲。今天我们要聊的这几个话题,可以说是惯导系统从“冷启动”到“稳定工作”的核心环节。说白了,就是解决三个问题:怎么让系统知道它现在是什么姿态?、系统误差会怎么变化?、为什么惯导系统会有那种特殊的低频振荡?
我个人习惯把这一章看作是惯导的“性格分析”。你只有摸透了它的脾气,才能用好它。好,我们直接进入正题。
4.1 初始对准技术:让系统“找到北”
惯导系统刚上电的时候,它其实是个“睁眼瞎”。它不知道自己的姿态,也不知道自己的位置。初始对准,就是给它一个“初始姿态矩阵”,让它知道自己相对于地球坐标系是怎么摆放的。
4.1.1 静基座对准
静基座对准,就是载体不动的时候做对准。这是最经典、也是最可靠的方式。
基本原理:
说白了,就是利用地球自转角速度和重力矢量。你想想看,地球在转,重力方向是确定的。陀螺仪能测到地球自转的角速度(虽然很小,只有15度/小时),加速度计能测到重力加速度。通过这两个矢量,我们就能解算出载体的姿态。
具体步骤:
- 粗对准: 利用加速度计测得的重力方向,确定水平姿态(俯仰和横滚)。利用陀螺仪测得的东向分量,确定航向角。这个过程很快,几秒钟就能完成,但精度不高。
- 精对准: 在粗对准的基础上,利用卡尔曼滤波等算法,对陀螺和加速度计的零偏进行估计和补偿。这个过程需要几分钟,但精度很高。
避坑指南: 我曾经在项目里遇到过一个问题:在船上做静基座对准,明明船没动,但对准结果就是不对。后来发现,是船上的振动和低频晃动干扰了加速度计和陀螺仪的测量。所以,静基座对准对环境的“静”是有要求的。如果环境有低频扰动,一定要加滤波或者延长对准时间。
4.1.2 动基座对准
动基座对准,就是载体在运动过程中完成对准。这比静基座难得多,因为测量值里混入了运动加速度和角速度。
为什么难?
你想想看,载体在动,加速度计测到的不仅仅是重力,还有运动加速度。陀螺仪测到的也不仅仅是地球自转,还有载体的角运动。怎么把这些“干扰”剔除掉?
常用方法:
- 利用外部参考信息: 比如GPS提供的速度和位置信息。通过GPS的速度,可以反推出载体的运动加速度,然后从加速度计测量值中扣除。这就是我们后面要讲的“松组合”和“紧组合”的基础。
- 利用多天线GNSS测姿: 直接利用GPS载波相位差分技术,测量出载体的航向和姿态,作为对准的参考。
- 利用里程计/ DVL: 在陆地或水下,可以利用里程计或多普勒测速仪提供的速度信息,辅助对准。
我的经验: 动基座对准最怕的是“纯惯性”方式。我建议,只要条件允许,一定要引入外部辅助信息。哪怕是一个精度不高的GPS速度,也能让对准过程稳定很多。否则,纯惯性的动基座对准,误差会发散得很快。
4.2 惯性导航的误差传播特性
惯导系统不是完美的,它会有误差。而且这些误差会随着时间传播。理解误差传播特性,是设计组合导航滤波器的基础。
主要误差源:
- 陀螺仪误差: 零偏、刻度因子误差、安装误差、随机游走。
- 加速度计误差: 零偏、刻度因子误差、安装误差。
- 初始对准误差: 初始姿态、速度、位置误差。
- 计算误差: 量化误差、截断误差。
误差传播规律:
这里我直接说结论,不推公式了。你记住几个关键点:
- 位置误差: 随时间二次方增长。也就是说,时间越长,位置误差越大,而且增长得越来越快。
- 速度误差: 随时间线性增长。
- 姿态误差: 随时间线性增长(主要是航向误差),但水平姿态误差会受舒勒振荡调制。
| 误差源 | 对位置误差的影响 | 对速度误差的影响 | 对姿态误差的影响 |
|---|---|---|---|
| 陀螺零偏 | 随时间二次方增长 | 随时间线性增长 | 随时间线性增长 |
| 加速度计零偏 | 随时间二次方增长 | 随时间线性增长 | 受舒勒振荡影响 |
| 初始航向误差 | 随时间二次方增长 | 随时间线性增长 | 恒定 |
注意: 上面的规律是在纯惯性模式下。一旦引入GPS等外部信息进行组合导航,误差就会被“拉回来”,不再发散。这也是为什么组合导航如此重要的原因。
4.3 舒勒振荡
舒勒振荡是惯导系统的一个固有特性。我第一次接触它的时候,觉得这东西很神奇。它就像是一个“摆”,周期大约是84.4分钟。
为什么会这样?
你想想看,惯导系统在水平方向上有误差,比如加速度计零偏导致计算出的水平加速度有偏差。这个偏差会让系统计算出错误的速度和位置。但有趣的是,这个错误的位置又会反过来影响重力矢量的方向,从而产生一个“恢复力”,让系统往回摆。这个摆动的周期,就是舒勒周期。
舒勒周期的数学表达:
T_s = 2 * π * sqrt(R / g)
其中:
T_s = 舒勒周期 (约 84.4 分钟)
R = 地球半径 (约 6371 km)
g = 重力加速度 (约 9.8 m/s²)
舒勒振荡的影响:
- 水平姿态误差: 会以舒勒周期振荡,不会发散。
- 位置误差: 也会叠加舒勒振荡,但整体趋势还是发散的。
- 对组合导航的影响: 在设计组合导航滤波器时,需要考虑舒勒振荡的频率特性。如果滤波器的带宽设置不当,可能会放大或抑制舒勒振荡,影响导航精度。
我的理解: 舒勒振荡其实是惯导系统的一种“自稳定”机制。它让水平姿态误差不会无限增长,而是被限制在一个范围内。但代价是,位置误差会因此变得复杂。在实际工程中,我们通常不会去刻意消除舒勒振荡,而是通过组合导航来抑制它对位置和速度的影响。
知识体系总览
为了让你更直观地理解本章的知识结构,我画了一张图。你可以看到,初始对准是起点,误差传播是过程,舒勒振荡是其中的一个特殊现象。三者共同构成了惯导系统的基础特性。
好了,这一章的内容就到这里。初始对准是惯导系统工作的第一步,误差传播是理解系统行为的关键,舒勒振荡则是惯导系统的一个固有“脾气”。把这些搞清楚了,后面学习组合导航就会轻松很多。