4、惯性导航系统（INS）：加速度计与陀螺仪原理、捷联惯导系统、INS误差特性与漂移
各位好，咱们今天聊聊惯性导航系统。说实话，在轨道交通的定位技术里，INS是个又爱又恨的角色。爱它，是因为它完全不依赖外部信号，隧道里、高架下、甚至电磁干扰强的区域，它都能工作。恨它，是因为它有个天生的毛病——漂移。你让它跑十分钟，它可能还准；跑一小时，误差就让你头疼了。
我个人习惯把INS比作一个「盲人走路」。它不知道自己在哪里，但它知道自己每一步走了多远、拐了几个弯。只要初始位置给对了，它就能一路推算下去。但问题在于，每一步的误差都会累积。嗯，这就是INS的核心矛盾。
4.1 加速度计与陀螺仪：INS的两只眼睛
INS的核心传感器就两个：加速度计和陀螺仪。一个测线运动，一个测角运动。
加速度计，说白了就是测量物体受到的比力。你把它平放在桌上，它测到的是1g的重力加速度。你把它竖起来，它测到的是0。在列车里，加速度计负责测量三个轴向的加速度：前进方向、横向、垂向。
我记得有一次在现场调试，发现列车静止时加速度计的输出居然有0.05m/s²的波动。排查了半天，原来是安装基座的振动没处理好。所以啊，加速度计的安装刚度非常关键。
陀螺仪呢，测量的是角速度。列车转弯时，它告诉你转了多少度每秒。陀螺仪的原理有很多种，轨道交通里常用的是光纤陀螺和微机电陀螺。
这里有个避坑指南：我曾经遇到过一台陀螺仪，零偏稳定性标称0.1°/h，但实际跑起来，温度一变化，零偏直接漂到0.5°/h。后来我们加了个温控模块，才把问题压住。所以，选陀螺仪不能只看数据手册，得看实际工况下的表现。
核心参数对比：
| 传感器 | 测量量 | 典型精度（轨交级） | 主要误差源 |
|---|---|---|---|
| 加速度计 | 比力（m/s²） | 0.01 ~ 0.1 m/s² | 零偏、刻度因子、安装误差 |
| 陀螺仪 | 角速度（°/s） | 0.01 ~ 0.1 °/s | 零偏漂移、随机游走、温度效应 |
4.2 捷联惯导系统：把传感器「焊」在车体上
早期的惯导系统是平台式的，传感器装在一个物理平台上，平台通过伺服电机保持水平。现在呢，主流是捷联惯导。说白了，就是把加速度计和陀螺仪直接固定在车体上，用计算机来「虚拟」一个平台。
为什么叫「捷联」？因为传感器和载体是「捷」速「联」接的。没有物理平台，全靠算法。
捷联惯导的核心是姿态解算。你想想看，列车在转弯、爬坡、颠簸，车体坐标系一直在变。加速度计测到的比力是在车体坐标系下的，但我们需要的是导航坐标系（比如北东地）下的加速度。怎么转换？靠姿态矩阵。
姿态矩阵的更新，用的是陀螺仪测到的角速度。这里有个经典的微分方程：
// 姿态更新（四元数法）
// q 为四元数，w 为角速度向量
dq/dt = 0.5 * q ⊗ w
// 离散化实现（一阶龙格-库塔）
q_new = q_old + dt * 0.5 * q_old ⊗ w代码看着简单，但实际工程里坑很多。比如四元数的归一化，你每步都得做，否则数值误差会累积，姿态就飘了。我见过一个团队，忘了做归一化，跑了十分钟后，姿态角误差直接到了十几度。
捷联惯导的另一个关键步骤是比力分解。把加速度计测到的比力，通过姿态矩阵投影到导航坐标系，然后扣除重力，再积分得到速度和位置。
个人经验： 捷联惯导的初始化阶段，一定要做「静基座对准」。列车静止时，利用加速度计测重力方向、陀螺仪测地球自转角速度，来初始确定姿态。这个过程至少需要1-2分钟。我曾经为了赶时间缩短对准时长，结果后续定位误差大了三倍。别省这个时间。
4.3 INS误差特性：为什么它一定会漂？
INS的误差，说白了就是「积分误差」。加速度计有零偏，积分一次变成速度误差，再积分一次变成位置误差。陀螺仪的角速度误差，积分一次变成姿态误差，姿态误差又会导致比力分解错误，进一步放大位置误差。
咱们来拆解一下主要的误差源：
- 零偏误差：传感器在零输入时的输出不为零。加速度计零偏会导致速度误差随时间线性增长，位置误差随时间平方增长。陀螺仪零偏会导致姿态误差随时间线性增长。
- 刻度因子误差：传感器的输出与真实输入的比例不准确。列车高速运行时，这个误差会被放大。
- 随机游走：传感器噪声的积分效应。说白了，就是白噪声积分后变成了随机游走，导致位置误差呈现布朗运动特性。
- 安装误差：传感器坐标系与车体坐标系不重合。这个误差是常值，但会耦合到姿态解算中。
为什么会这样？我给你算一笔账。假设加速度计零偏为0.01 m/s²（这已经算不错的了），列车运行10分钟：
速度误差 = 0.01 * 600 = 6 m/s
位置误差 = 0.5 * 0.01 * 600² = 1800 米看到了吗？10分钟就能漂出1.8公里。这还只是加速度计零偏一项。再加上陀螺仪的误差，实际漂移只会更大。
警告： 纯INS在轨道交通中，单独使用的时间通常不超过30秒。超过这个时间，位置误差就会超过列车安全运行的要求。所以，INS必须和其他传感器（比如里程计、信标、GNSS）组合使用。
4.4 漂移补偿：我们能做什么？
既然漂移不可避免，那我们就得想办法补偿。常用的方法有几种：
- 零速修正：列车进站停车时，我们知道速度为零。利用这个信息，可以修正INS的速度误差和部分姿态误差。我习惯在每次停车时做一次零速修正，能有效抑制漂移。
- 航向约束：轨道交通的特点是列车沿着轨道运行，横向和垂向的速度基本为零。把这个约束加到INS里，可以抑制横向和垂向的漂移。
- 组合导航：用卡尔曼滤波器把INS和其他传感器的信息融合起来。INS提供高频的位置和姿态，其他传感器提供低频的修正。这是目前最主流的方法。
我记得在某个地铁项目里，我们用了INS+里程计+信标的组合方案。INS负责100Hz的高频输出，里程计每10cm输出一个脉冲用来修正速度，信标每500米提供一个绝对位置修正。这样组合下来，定位误差能控制在5米以内。
最后说一句，INS的误差特性决定了它不能单独使用，但它的高频输出和抗干扰能力，让它成为组合导航系统中不可或缺的一环。你想想看，在隧道里GNSS信号全无，里程计又可能打滑，这时候INS就是最后的救命稻草。
下一章，咱们聊聊里程计和轮速传感器，看看它们怎么和INS配合，把定位精度再提一个台阶。