想象一下,一个机器人被蒙住眼睛,手持旋转激光扫描仪和运动传感器(就像你手机里的那种),试图穿过迷宫。它的唯一任务是:在不查看地图或使用 GPS 的情况下,精确判断自己在哪里以及要去哪里。这被称为激光惯性里程计(LIO)。
问题在于,大多数机器人就像只为某一次特定考试而学习的学生。如果你训练一个机器人在安静的办公楼里导航,它可能会在杂乱的森林或狭窄蜿蜒的楼梯间彻底迷路。它需要一个“万能”的大脑,能够瞬间适应它所看到的任何环境。
于是,EllipseLIO 登场了,这是一个旨在成为这种适应性大脑的新系统。以下是其工作原理,分解为几个简单概念:
1. “智能变焦”相机(自适应滤波)
大多数机器人会将世界的激光扫描数据切割成网格,就像将照片像素化一样。它们通常在全局使用相同大小的“像素”。
- 问题所在: 如果像素太大,你会丢失近处墙壁的细节;如果像素太小,机器人会被远处的大量数据淹没,导致速度变慢。这就像试图阅读一本书,无论文字离你的鼻子只有几厘米还是远在 50 英尺之外,字体大小都完全一样。
- EllipseLIO 的解决方案: 它使用智能变焦。
- 当机器人观察近处的物体时,它使用微小、高细节的“像素”来捕捉每一道裂缝和角落。
- 当它观察远处的物体时,它使用更大、更粗犷的“像素”,因为细节不再那么重要,同时还能节省计算资源。
- 结果: 无论机器人距离物体多远,它总能获得恰到好处的细节量。
2. “变形”匹配器(椭球配准)
为了知道自己在哪里,机器人必须将其当前的激光扫描结果与正在构建的地图进行匹配。它需要找到对应的点(例如,“我扫描中的这个角落对应地图上的那个角落”)。
- 问题所在: 大多数机器人假设世界是由平面(墙壁)或直线构成的。这在拥有摩天大楼的城市里效果很好,但在充满圆形树木或凹凸岩石的森林中却会彻底失败。这就像试图把方形的木桩塞进圆形的洞里。
- EllipseLIO 的解决方案: 它将地图中的每个点视为一个3D 鸡蛋(椭球体)。
- 如果机器人看到一面平坦的墙,这个“鸡蛋”就会像煎饼一样被压扁。
- 如果它看到一根柱子,这个“鸡蛋”就会像长香肠一样被拉长。
- 如果它看到一块巨石,这个“鸡蛋”就会像球一样保持圆润。
- 结果: 在匹配点时,机器人不仅仅是猜测;它会观察“鸡蛋”的形状。如果是煎饼,它就进行平面对平面的匹配;如果是香肠,它就进行线对线的匹配。这使得它能够以同样的自信导航城市街道和荒野森林。
3. “时间旅行”漂移校正器
随着机器人移动,它会犯下微小的错误。随着时间的推移,这些错误会累积,导致机器人认为自己所在的位置与实际位置不同。这被称为“漂移”。
- 问题所在: 当机器人绕回之前访问过的地方时,由于内部地图已经发生漂移,它往往无法意识到自己回到了原地。
- EllipseLIO 的解决方案: 它使用记忆加权系统。
- 当机器人看到一个曾经访问过的地点时,它会查看距离上次造访已经过了多久。
- 如果已经过了很长时间(意味着机器人很可能已经发生了大量漂移),它会给予那个旧的匹配额外的权重,就像在说:“我更相信这个旧记忆,而不是我现在摇摇欲坠的猜测。”
- 结果: 它将机器人的位置自动拉回现实,校正漂移,而无需人类按下“重置”按钮。
宏大实验
作者在五个截然不同的数据集上测试了该系统:
- 结构化城市(高楼大厦、直线)。
- 非结构化公园(树木、灌木、不平坦的地面)。
- 空中视角(向下飞行的无人机)。
- 水上视角(在水面上移动的船只)。
- 狭窄空间(狭窄的楼梯和隧道)。
最终裁决:
当其他顶级机器人在至少一种场景中失败、陷入困惑或“发散”(完全放弃)时,EllipseLIO 从未失败过。它是唯一能够成功导航所有环境而无需重新调整的机器人。平均而言,它的准确度比排名第二的机器人高出38%。
简而言之,EllipseLIO 是首个不需要为每间新进入的房间提供特定操作手册的机器人导航系统;它只需观察世界的形状,调整焦点,并即时自行解决问题。
技术摘要:EllipseLIO
问题陈述
激光雷达惯性里程计(LIO)对于在无外部定位(如 GPS)条件下导航的移动机器人至关重要。虽然现有的 LIO 方法在特定且经过调优的场景中能够提供精确的里程计,但它们往往无法在无人工干预的情况下泛化到异构环境和传感器配置中。当前方法通常存在两个主要局限性:
- 静态扫描滤波:大多数方法将激光雷达扫描下采样为固定分辨率,忽略了传感器分辨率和测量范围。这导致要么产生几何保真度不足、无法进行精确配准的稀疏扫描,要么产生计算量过大、无法进行实时处理的密集扫描。
- 刚性配准度量:许多配准方法依赖于固定的误差度量(如点到平面),并假设表面几何为平面。这些假设在平面假设无效的非结构化环境中会降低性能,导致精度下降或系统发散。
因此,需要一种 LIO 方法,能够在线适应传感器能力和环境结构,从而在无需针对特定场景调优的情况下,在多样化场景中保持鲁棒的里程计。
方法论
EllipseLIO 通过一个包含自适应预处理、基于椭球的配准框架以及集成漂移校正的实时流水线来解决这些挑战。该系统利用迭代扩展卡尔曼滤波(iEKF)进行状态估计,将激光雷达和 IMU 数据紧密耦合。
1. 自适应基于距离的滤波
EllipseLIO 采用基于距离的滤波方法,根据与传感器的距离调整下采样分辨率,而非均匀下采样。
- 机制:将激光雷达扫描分割为 1 米径向分箱。第 i 个分箱的下采样分辨率 vi 基于该距离处的垂直视场角(θ)和扫描线数量(β)计算:
vi=β−1(i+1)θ
- 实现:每个分箱内的点被插入到 iOctree 结构中,每个被占用的体素保留一个点。这确保了沿扫描线的点分布相对于给定距离处的线间距是均匀的,从而在所有距离上保持几何保真度,同时维持计算效率。
2. 基于椭球的扫描配准
核心创新是一种配准方法,它根据由椭球表示的局部表面几何,为每个点匹配自适应调整误差度量。
- 椭球估计:地图点与使用张量投票(TV)方法导出的椭球相关联。局部表面几何被分解为三个几何基元:
- 线:具有单一主导变化轴的表面(例如杆)。
- 平面:沿单一轴(表面法线)变化最小的表面。
- 球:沿所有轴变化相似的表面。
- 自适应误差度量:对于每个匹配到地图点的扫描点,目标点被计算为投影到这些基元上的加权和。权重由从局部张量特征值导出的显著性得分(gline,gplane,gball)确定。
- 线基元使用点到线度量。
- 平面基元使用点到平面度量。
- 球基元使用点到点度量。
- 结果:这使得系统能够利用最适合特定局部环境(无论是结构化还是非结构化)的几何约束。
3. 自适应漂移校正
漂移校正直接集成到扫描配准流水线中,无需单独的闭环检测。
- 加权策略:点匹配根据自捕获地图点以来行驶的轨迹长度进行自适应加权。涉及较旧地图点(表明返回先前访问过的位置)的匹配被分配更高的权重,以校正累积漂移。
- 退化处理:为防止在几何退化环境(如封闭空间)中发散,系统估计平移和旋转状态的可观测性。如果环境提供的约束较差,则按比例降低匹配权重,从而降低发散风险。
主要贡献
本文提出了三个主要贡献:
- 自适应扫描滤波:一种方法,通过根据传感器分辨率和不同距离处的视场角变化下采样分辨率,在保留足够测量值以进行精确配准的同时保持计算效率。
- 基于椭球的配准:一种配准方法,为每个点匹配自适应调整误差度量以考虑局部表面几何(线、平面或球),从而在多样化环境中提供可靠的估计。
- 集成漂移校正:一种方法,通过自适应加权点匹配,优先处理重访位置中较旧的地图点,从而在不使用单独闭环模块的情况下校正漂移。
实验结果
EllipseLIO 在五个多样化的数据集(Newer College、Oxford Spires、Botanic Garden、GRACO 和 GEODE)上进行了评估,涵盖了结构化城市场景、非结构化公园、航拍视角以及带有各种传感器(Ouster、Velodyne)和平台(手持、轮式、空中、水上)的室内/室外混合环境。
- 性能:EllipseLIO 实现了最佳的整体性能,在所有序列中达到了最低或次低的里程计误差。与第二佳方法(iG-LIO)相比,其平均绝对位姿误差(APE)平均降低了38%。
- 鲁棒性:EllipseLIO 是唯一在所有实验中均未发散的方法。竞争方法在大规模开放环境(如航拍序列)或狭窄封闭环境(如楼梯)中经常发散,这通常是由于不合适的点密度或刚性的几何假设所致。
- 效率:在 parkland-mound 序列上,EllipseLIO 以实时速度运行(35 毫秒),内存占用为 2.4 GB,生成了高分辨率地图(0.1 米),同时使用的内存少于 DLIO(0.1 米分辨率),并显著少于其他竞争者。
意义与主张
本文主张,EllipseLIO 代表了迈向可泛化自主导航的重要一步。通过在线适应传感器能力和环境结构,它消除了对人工、特定场景调优的需求。作者强调,该系统在高度异构数据集(最先进的方法在此类数据集中失败或需要重新调优)中保持一致性能的能力,证明了自适应滤波和几何感知配准的有效性。代码的开源发布旨在促进关于鲁棒、通用 LIO 的进一步研究。未来的工作 noted 将侧重于集成视觉信息,以处理 LIO 单独可能失效的具有显著几何退化的环境。
每周获取最佳 computer science 论文。
受到斯坦福、剑桥和法国科学院研究人员的信赖。
请查收邮箱确认订阅。
出了点问题,再试一次?
无垃圾邮件,随时退订。