最新TOP成果,深圳大学 李清泉院士团队提出复杂地形环境下四足机器人SLAM新框架及开源数据集

原文标题：Gait-Aware quadruped 3D mapping in challenging environments with complex terrain

作者：赵昕格，张星，倪一清，李清泉，曾文涛，冯海霞，周一博

来源：ISPRS Journal of Photogrammetry and Remote Sensing（影响因子12.2、中科院1区TOP期刊）

论文链接：

https://www.sciencedirect.com/science/article/abs/pii/S0924271626000614

DOI：10.1016/j.isprsjprs.2026.02.010

近期，深圳大学李清泉院士团队在摄影测量与遥感领域顶级期刊ISPRS Journal of Photogrammetry and Remote Sensing上在线发表了题为“Gait-Aware quadruped 3D mapping in challenging environments with complex terrain”的研究论文。论文第一作者为深圳大学和香港理工大学联合培养博士生赵昕格，深圳大学指导老师为李清泉院士和张星研究员，香港理工大学指导老师为倪一清教授。本研究提出复杂地形环境下四足机器人SLAM新框架，并构建蕴含多样化复杂地形场景和机器人运动状态的四足机器人SLAM开源数据集。

数据集已开源，欢迎下载和引用，数据集网址：

https://github.com/EN3D-Lab/Quadruped-SLAM-dataset

提出一种基于步态感知的腿式里程计（GA-ESKF），将状态分类与位姿估计解耦，结合运动学模型对腿间时空一致性和站立相位约束显式建模，以提升在异常运动事件（如机器人失去平衡）下里程计的稳定性。

提出一种基于顺序更新策略的复杂地形场景四足机器人LiDAR-Inertial-Leg SLAM，有效处理四足机器人运动中常见的瞬时运动变化，抑制短期IMU前向传播误差并减轻四足机器人运动造成的LiDAR点云失真，实现精确的点云配准、鲁棒的状态估计和高质量三维建图。

面向复杂地形和四足机器人灵活运动造成的高程漂移，提出了基于置信度感知的平面约束足端更新机制，将LiDAR建图结果作为约束更新足端高程，有效增强里程计位姿估计的鲁棒性，以及其与LiDAR建图结果之间的一致性。在机器人运动状态突变甚至出现异常的条件下，也能准确恢复高程信息并保持稳定的建图性能。

构建蕴含多样化复杂地形场景和机器人运动状态的四足机器人SLAM开源数据集（QuadSLAM Dataset），数据类型包括LiDAR点云、IMU数据以及四足机器人腿部运动学数据，如关节编码器与接触传感器数据等。场景覆盖陡峭和平缓的不平坦自然山坡、高软草、可变形的森林落叶层、刚性混凝土路面、斜坡、几何特征有限的楼梯间、地下停车场、狭窄走廊、长直马路和杂乱的半室外环境等（如图2所示）。四足机器人状态包括趴卧、行走、攀爬台阶、奔跑，以及不稳定的运动如脚打滑、失去平衡和恢复等。为促进复杂场景下四足机器人SLAM的相关研究，数据集已开源，欢迎下载和引用，下载地址：

https://github.com/EN3D-Lab/Quadruped-SLAM-dataset。

实验表明，本研究设计的腿式里程计GA-ESKF能在具有挑战性的机器人运动模式下显著提高状态估计的稳定性，轨迹定位误差相比4种开源里程计分别降低了81.1%、78.2%、60.5%和15.6%（如表1所示）。

本研究四足机器人SLAM框架在多种复杂地形环境和机器人运动状态下均能实现稳健状态估计与三维建图。相较于多种主流SLAM框架，状态估计误差分别降低88.8%、82.3%、75.9%、71.1%和44.9%（如表2所示）。在典型室内场景下，对比算法建图结果存在明显的错位重影和模糊问题，本研究算法的建图结果边界清晰、结构完整，未出现重影或错位（如图3所示）。

图3. 典型室内场景建图结果对比

在复杂地形场景三维建图任务中，四足机器人通常需要不断切换运动状态，甚至可能出现异常运动状态。为了进一步评估所提出SLAM框架的鲁棒性，本研究在四足机器人出现异常状态的条件下进行定位与建图测试，异常状态包括传感器数据丢失、剧烈的身体晃动、不规则的运动状态切换、爬楼梯以及跌倒并重新站立等。实验结果表明，本研究在四足机器人异常状态下也能够实现高质量三维建图。例如在机器人发生剧烈晃动时，对比算法的定位结果存在明显偏移失真，而本算法有效抑制了剧烈晃动状态对机器人定位结果的影响（如图4所示）。

针对复杂地形和灵活多样运动状态条件下四足机器人定位与建图问题，本研究提出了一种显式引入四足机器人步态感知与状态估计置信度更新的SLAM新框架，构建了包含多种场景和四足运动状态的SLAM开源数据集。实验表明，所提出框架的性能明显优于SOTA框架，能够在四足机器人灵活运动甚至异常运动状态下实现高质量稳健三维建图。数据集开源链接：

https://github.com/EN3D-Lab/Quadruped-SLAM-dataset。