车载惯性导航:穿越城市峡谷与隧道的“隐形地图”
想象一下,你正驾驶着一辆具备高级辅助驾驶功能的汽车,驶入一座由摩天大楼构成的现代都市核心区。手机上的导航地图突然变得迟疑,代表你位置的小圆点开始在十字路口附近“飘移”,甚至在你明明沿着直线行驶时,画出一条诡异的折线。紧接着,车辆驶入一条漫长的地下隧道,屏幕上的GPS信号图标彻底灰暗,导航系统仿佛瞬间“失明”。这种场景,对于任何依赖卫星定位的现代出行者而言,都绝不陌生。然而,对于正在向高阶自动驾驶迈进的技术而言,这不仅仅是用户体验上的小瑕疵,更是关乎行车安全的核心挑战。
城市峡谷和隧道,正是全球导航卫星系统(GNSS)信号的“天敌”。高楼大厦的反射与遮挡导致多路径效应和信号衰减,而隧道则完全阻断了卫星信号的传播。在这些场景下,单纯依靠GNSS的定位系统其精度会急剧下降,甚至完全失效。此时,一种不依赖外部信号、完全自主工作的技术便成为了关键的“备份大脑”——这就是惯性导航系统。它通过测量载体自身的加速度和角速度,经过积分运算来推算位置、速度和姿态,就像蒙上眼睛的人,仅凭感受身体的加速、转弯和上下坡,也能大致推断出自己走了多远、转向何方。本文将深入剖析车载惯性导航系统如何成为破解城市复杂环境定位难题的“定海神针”,并结合前沿产品与技术趋势,展示其从理论到实战的完整图景。
1. 惯性导航原理:不依赖外界的“内在感知”
要理解惯性导航如何弥补GNSS的不足,首先得抛开“卫星”这个外部参照物,转向对车辆自身运动的感知。惯性导航的核心思想,源于经典力学中的惯性原理。
1.1 核心传感器:IMU的“五官”
惯性导航的硬件基石是惯性测量单元,它如同系统的“内耳”和“平衡器官”。一个典型的IMU包含两类核心传感器:
- 三轴加速度计:用于测量载体在前后(X轴)、左右(Y轴)、上下(Z轴)三个方向上的线加速度。需要注意的是,它测量的是包括重力加速度在内的“比力”。通过复杂的算法将重力分量剥离,才能得到载体真实的运动加速度。
- 三轴陀螺仪:用于测量载体绕这三个轴旋转的角速度,即俯仰(Pitch)、横滚(Roll)和偏航(Yaw)的变化率。
这两种传感器协同工作,为系统提供了描述车辆在三维空间中运动状态的原始数据。IMU的性能等级直接决定了整个导航系统的精度上限。根据应用需求和成本,IMU可分为几个主要等级:
| 性能等级 | 陀螺零偏稳定性(典型值) | 加速度计零偏稳定性(典型值) | 主要应用场景 | 成本水平 |
|---|---|---|---|---|
| 消费级 | >10 °/h | >1 mg | 智能手机、游戏设备、消费级无人机 | 低 |
| 战术级 | 1-10 °/h | 0.1-1 mg | 工业无人机、农业机械、中端车载导航 | 中 |
| 导航级 | 0.01-1 °/h | 10-100 μg | 高端自动驾驶、航空航海、精密测绘 | 高 |
| 战略级 | <0.001 °/h | <1 μg | 航天器、洲际导弹、核潜艇 | 极高 |
提示:对于车载应用,尤其是L3及以上级别的自动驾驶,通常需要战术级或导航级的IMU,以确保在GNSS信号中断期间,位置推算误差的增长速度足够慢,满足安全冗余的要求。
1.2 航位推算:从加速度到位置的数学之旅
仅有加速度和角速度的瞬时值还不够,我们需要知道车辆的位置变化。这个过程称为航位推算。其基本原理是牛顿运动定律的连续应用:
- 一次积分:对去除重力影响后的比力加速度进行时间积分,得到速度的变化量。
# 概念性代码,展示积分思想 delta_velocity_x = integrate(acceleration_x, dt) # 对X轴加速度积分得到速度增量 current_velocity_x = last_velocity_x + delta_velocity_x # 更新当前速度 - 二次积分:对得到的速度再次进行时间积分,即可得到位置的位移量。
delta_position_x = integrate(current_velocity_x, dt) # 对速度积分得到位置增量 current_position_x = last_position_x + delta_position_x # 更新当前位置 - 姿态更新:同时,对角速度进行积分,可以更新载体的姿态角(俯仰、横滚、偏航)。
这个过程听起来简单,但却是误差的“放大器”。传感器微小的零偏误差,经过两次积分后,会导致位置误差随时间呈二次方增长。例如,一个常值10 μg的加速度计零偏,在纯惯性推算1分钟后,可能导致约18米的位置误差。因此,纯惯性导航无法长时间独立工作,必须与其他信息源进行融合校正。
1.3 组合导航的必然性:INS与GNSS的“最佳拍档”
正因为纯惯性导航存在累积误差,现代工程实践中几乎不会让其单独工作。惯性导航系统与全球导航卫星系统的组合,构成了优势互补的黄金标准。
- GNSS的优势与短板:提供绝对、无漂移的经纬高位置信息,但信号易受遮挡,更新频率较低(通常1-10 Hz),且在信号恢复时可能存在“跳变”。
- INS的优势与短板:完全自主、高频输出(可达200 Hz以上)、短期精度高,但存在累积误差。
通过卡尔曼滤波器等数据融合算法,将两者深度融合,可以实现“1+1远大于2”的效果:
- GNSS信号良好时:用GNSS的高精度绝对位置来持续校正INS的累积误差,并估计出传感器的误差参数(如零偏),实现在线标定。
- GNSS信号丢失时:利用已标定的INS进行高精度的航位推算,平滑地“桥接”信号中断期,避免定位中断或跳变。
- GNSS信号恢复时:INS可以提供高动态的测量,帮助GNSS接收机快速重新捕获和锁定信号,并平滑过渡。
这种深耦合的组合导航系统,正是应对城市峡谷和隧道挑战的技术核心。
2. 挑战场景深度剖析:城市峡谷与隧道的“信号迷宫”
理解了基本原理后,我们再来具体看看,在城市峡谷和隧道中,定位系统究竟面临哪些魔鬼般的细节。
2.1 城市峡谷:多路径效应与信号衰减的“双重奏”
城市峡谷并非指真正的峡谷,而是由密集的高层建筑形成的街道环境。在这里,GNSS信号接收面临两大主要问题:
- 直射信号遮挡与衰减:卫星信号被建筑物部分或完全遮挡,导致接收到的信号功率大幅下降,信噪比恶化,使得接收机难以准确跟踪和解码。
- 多路径效应:这是城市环境中最棘手的问题。卫星信号并非只通过直线路径到达接收机天线,还会经建筑物玻璃幕墙、地面等反射后,通过多条路径到达。这些反射信号与直射信号叠加,会严重干扰接收机对信号传播时间的测量,而时间是计算距离的关键,从而引入可达数十米甚至上百米的定位误差。
我曾参与一个在深圳福田中心区的测试项目,在东西向的狭窄街道上,单纯GNSS的定位轨迹就像喝醉了酒一样,在道路两侧的人行道和车道上反复横跳,完全无法反映车辆的真实车道级位置。
2.2 隧道与地下车库:绝对的“信号真空”
与城市峡谷中尚有零星且畸变的信号不同,隧道和地下车库是GNSS信号的完全禁区。车辆进入后,GNSS接收机立即失去所有卫星跟踪。此时,系统完全依赖于INS的航位推算能力。挑战在于:
- 推算时长:隧道越长,INS需要独立工作的时间就越长,对IMU的精度和稳定性要求也越高。
- 动态复杂性:隧道内可能有弯道、坡度变化,这些运动都会增加姿态和位置推算的复杂度。
- 出口“重捕获”:驶出隧道的瞬间,GNSS需要快速重新定位。如果INS在隧道内累积误差过大,给出的初始位置估计偏差太远,会导致GNSS重捕获时间变长,甚至出现短暂的定位“迷失”。
2.3 组合导航系统的应对策略
面对这些挑战,现代车载组合导航系统并非被动承受,而是通过一系列增强策略来主动提升鲁棒性:
- 多频多系统GNSS接收机:支持GPS、北斗、GLONASS、Galileo等多个卫星系统,以及L1、L2、L5等多个频点。更多卫星和频点增加了可用信号源,并能利用不同频率信号受电离层延迟影响不同的特性进行校正,提升城市环境下的定位可用性和精度。
- RTK/PPP高精度定位:通过接收地面基准站的差分校正信号(RTK)或利用精密星历与钟差产品(PPP),可以将GNSS定位精度从米级提升至厘米级或分米级。这在自动驾驶的车道级定位中至关重要。
- 车辆运动约束:这是一个非常有效的辅助信息。汽车的运动在正常情况下符合“非完整约束”,即不能像螃蟹一样横向平移。在滤波器中引入这一约束,可以显著抑制垂直于车身方向的虚假速度估计,尤其在低速或静止时,能有效改善航向精度。
- 轮速里程计信息:通过车辆CAN总线获取高精度的轮速脉冲信息,可以作为比IMU更准确的速度观测源,极大改善在GNSS失效期间,沿车辆前进方向的位置推算精度。这是汽车推算区别于非汽车推算的一个关键优势。
3. 实战案例与产品解析:从实验室到真实道路
理论最终需要接受实践的检验。我们来看看市场上的一些代表性产品,以及它们在实际场景中是如何表现的。
3.1 高端方案代表:SBG Systems的Ekinox系列
SBG Systems的Ekinox系列INS,以其小巧的体积和导航级的性能,在测绘和自动驾驶领域备受关注。以Ekinox-D为例,它是一款内置双天线GNSS接收机的一体化INS。
其技术特点鲜明:
- 双天线设计:直接测量载体的真北航向角,不依赖于磁力计,避免了城市环境中强烈的磁场干扰,航向精度可达0.05°。这对于确定车辆是直行还是略微偏转至关重要。
- 高更新率与低延迟:组合导航输出可达200 Hz,为高速行驶的车辆控制提供了极其及时的位置和姿态反馈。
- 强大的后处理软件:配套的Qinertia软件支持后处理,可以利用更精确的星历和基准站数据,对采集的原始GNSS和IMU数据进行离线融合解算,获得比实时结果更高的精度,常用于高精度地图采集等场景。
在实际的隧道测试中,装备Ekinox-D的测试车,其轨迹能清晰地反映出隧道内的弯道,出隧道后与GNSS轨迹的衔接平滑,位置偏差通常在分米级以内,充分证明了其在信号完全遮蔽环境下的持续导航能力。
3.2 本土化量产先锋:导远电子的INS570D
在国内自动驾驶供应链中,导远电子是车载高精度组合定位领域的头部企业。其INS570D产品已在小鹏P7、P5等多款量产车上得到应用,实现了超过10万套的交付量。
INS570D的成功,体现了对量产车需求的深度理解:
- 车规级设计与功能安全:产品通过了ISO 26262 ASIL B功能安全认证,从硬件到软件流程都满足汽车电子严苛的可靠性、耐久性和安全要求。这是实现前装量产的前提。
- 深度耦合车辆信号:除了GNSS/INS深耦合,还深度集成车辆CAN信号,如轮速、档位、转向角等,构建了更适应汽车运动模型的滤波器。
- 成本与性能的平衡:面向大规模量产,在保证满足L2+/L3级自动驾驶定位需求的前提下,对传感器选型和算法进行了深度优化,控制了成本。
从公开的测试数据看,在高速隧道场景下,INS570D的组合定位轨迹(蓝色)能够精确地描绘出车辆在隧道内的真实路径,与卫星定位(红色)在隧道内假设的直线路径形成鲜明对比,且出隧道后能无缝对齐到GNSS轨迹上。这种表现,正是量产车能够依赖的“安全感”来源。
3.3 技术演进趋势:芯片化与深耦合
未来的车载惯性导航,正朝着更集成、更智能、更经济的方向发展。
芯片级组合导航方案正在兴起。如一些厂商推出的双天线多频GNSS SOC芯片,内部集成了高性能的MEMS IMU和强大的融合算法处理器。这种方案将整个组合导航系统浓缩到一颗芯片上,极大降低了体积、功耗和成本,为在更多车型上普及高精度定位提供了可能。这类芯片通常提供丰富的接口,方便接入轮速等车辆信息,实现深耦合。
这里所说的“深耦合”,比常见的“松耦合”、“紧耦合”更进一步。在深耦合架构中,GNSS接收机的原始信号跟踪环路(如锁相环)会接受INS提供的辅助信息(如精确的多普勒频率预测)。这样,即使在信号非常微弱的情况下(如城市峡谷),接收机也能保持对卫星信号的跟踪,显著提升了恶劣环境下的GNSS可用性,从而反过来为INS提供更持续、更优质的校正信号,形成正向循环。
4. 开发与测试实践:构建可靠的定位系统
对于自动驾驶工程师而言,选择或开发一套车载组合导航系统,远不止是采购一个硬件盒子那么简单。它涉及从需求分析、选型集成、测试验证到持续优化的完整闭环。
4.1 明确需求与选型关键指标
首先,必须根据自动驾驶功能等级(如L2 ADAS、L3 HWP、L4 Robotaxi)来定义定位系统的性能需求。关键指标包括:
- 精度:横向/纵向定位精度(厘米级?分米级?)、航向精度、姿态精度。
- 可用性:在特定场景(如最长3分钟隧道)下,GNSS失效期间的位置保持精度。
- 更新率与延迟:输出频率(100 Hz?200 Hz?),从传感器数据采集到输出结果的时间延迟。
- 完好性与可靠性:系统能否自我诊断并输出置信度?MTBF(平均无故障时间)如何?
- 环境适应性:工作温度范围、抗振动冲击能力、电磁兼容性。
4.2 系统集成与标定注意事项
将INS集成到车辆上时,有几个容易踩坑的细节:
- 安装位置与刚性:INS应尽量安装在车辆重心附近,并确保与车体刚性连接,以减少因车架形变引入的额外运动测量误差。避免安装在悬架以上振动剧烈的区域。
- 杆臂补偿:如果INS的IMU中心与GNSS天线相位中心不重合,存在空间偏移(杆臂),在车辆转弯时会产生额外的离心加速度。必须在软件中准确测量并补偿这个杆臂值,否则会引入速度和平移误差。
- 初始对准:INS启动后,需要一段时间进行初始对准,以确定其初始姿态(主要是航向)。在开阔天空下,双天线INS可以快速确定航向;单天线INS则通常需要车辆进行一段距离的直线运动,通过GNSS速度矢量来估计航向。对准期间的车辆运动需遵循设备要求。
4.3 测试验证:真值系统与场景库
验证定位系统的性能,离不开高精度的“真值”参考系统。通常采用更高级别的INS(如光纤陀螺INS)与RTK GNSS组成的测量级系统作为基准。测试需要覆盖全面的场景库:
- 典型城市道路:包含不同宽度、不同楼宇密度的街道。
- 特长隧道与桥梁。
- 多层立交与匝道。
- 林荫道与高架下。
- 动态性能测试:急加速、急刹车、高速过弯等。
测试中不仅要看定位轨迹的贴合度,更要分析误差随时间/距离的累积情况。例如,在进入隧道时记录一个位置真值,在隧道中每隔一段时间或距离记录一次INS的推算位置,计算其与通过里程计等推算出的真值之间的偏差,绘制误差增长曲线,这是评估INS核心性能的直接方式。
4.4 数据融合的下一站:多传感器融合定位
在自动驾驶的感知层面,定位正在从单一的GNSS/INS组合,迈向与激光雷达、摄像头、高精度地图进行融合的多传感器融合定位时代。
INS在其中扮演着不可替代的角色:
- 时间同步与传感器对齐:INS提供的高精度、高频率的时间戳和位姿信息,是统一所有传感器数据时空基准的“节拍器”。可以将不同时刻、不同位置的激光雷达点云或图像,准确地转换到同一时刻的车辆坐标系下。
- 点云去畸变与图像稳定:在激光雷达扫描一帧的过程中,车辆自身也在运动,这会导致点云发生“运动畸变”。利用INS提供的连续高频率位姿,可以对点云进行去畸变处理,获得更清晰、准确的场景图像。同样,INS数据也可用于电子图像防抖。
- 视觉/激光SLAM的初始化与约束:在基于视觉或激光的即时定位与地图构建中,INS可以提供可靠的初始位置和运动预测,加速算法收敛,并在特征缺失或重复的场景(如长直隧道、白墙)中,提供至关重要的运动约束,防止SLAM算法发散。
因此,一个高性能的INS,不仅是GNSS失效时的“救命稻草”,更是构建整个自动驾驶多传感器融合感知体系的基石。它的输出质量,直接影响了环境感知、决策规划的可靠性与舒适性。

187

被折叠的 条评论
为什么被折叠?



