Tao Hongtao, Zhao Wen, Zhao Li, Wang Junlong
School of Mechanical Engineering, University of Science and Technology Beijing, Beijing 100083, China.
School of Civil Aviation, Northwestern Polytechnical University, Xi'an 710072, China.
Sensors (Basel). 2025 Aug 12;25(16):4988. doi: 10.3390/s25164988.
The primary challenge that robots face in disaster rescue is to precisely and efficiently construct disaster maps and achieve autonomous navigation. This paper proposes a method for air-ground collaborative map construction. It utilizes the flight capability of an unmanned aerial vehicle (UAV) to achieve rapid three-dimensional space coverage and complex terrain crossing for rapid and efficient map construction. Meanwhile, it utilizes the stable operation capability of an unmanned ground vehicle (UGV) and the ground detail survey capability to achieve precise map construction. The maps constructed by the two are accurately integrated to obtain precise disaster environment maps. Among them, the map construction and positioning technology is based on the FAST LiDAR-inertial odometry 2 (FAST-LIO2) framework, enabling the robot to achieve precise positioning even in complex environments, thereby obtaining more accurate point cloud maps. Before conducting map fusion, the point cloud is preprocessed first to reduce the density of the point cloud and also minimize the interference of noise and outliers. Subsequently, the coarse and fine registrations of the point clouds are carried out in sequence. The coarse registration is used to reduce the initial pose difference of the two point clouds, which is conducive to the subsequent rapid and efficient fine registration. The coarse registration uses the improved sample consensus initial alignment (SAC-IA) algorithm, which significantly reduces the registration time compared with the traditional SAC-IA algorithm. The precise registration uses the voxelized generalized iterative closest point (VGICP) algorithm. It has a faster registration speed compared with the generalized iterative closest point (GICP) algorithm while ensuring accuracy. In reinforcement learning navigation, we adopted the deep deterministic policy gradient (DDPG) path planning algorithm. Compared with the deep Q-network (DQN) algorithm and the A* algorithm, the DDPG algorithm is more conducive to the robot choosing a better route in a complex and unknown environment, and at the same time, the motion trajectory is smoother. This paper adopts Gazebo simulation. Compared with physical robot operation, it provides a safe, controllable, and cost-effective environment, supports efficient large-scale experiments and algorithm debugging, and also supports flexible sensor simulation and automated verification, thereby optimizing the overall testing process.
机器人在灾难救援中面临的主要挑战是精确高效地构建灾难地图并实现自主导航。本文提出了一种空地协同地图构建方法。它利用无人机(UAV)的飞行能力实现快速三维空间覆盖和复杂地形穿越,以进行快速高效的地图构建。同时,利用无人地面车辆(UGV)的稳定运行能力和地面细节勘测能力实现精确地图构建。将两者构建的地图精确融合以获得精确的灾难环境地图。其中,地图构建与定位技术基于快速激光雷达惯性里程计2(FAST-LIO2)框架,使机器人即使在复杂环境中也能实现精确定位,从而获得更准确的点云地图。在进行地图融合之前,先对点云进行预处理,以降低点云密度,同时尽量减少噪声和离群值的干扰。随后,依次进行点云的粗配准和精配准。粗配准用于减小两个点云的初始位姿差异,有利于后续快速高效的精配准。粗配准采用改进的样本一致性初始对齐(SAC-IA)算法,与传统SAC-IA算法相比,显著减少了配准时间。精配准采用体素化广义迭代最近点(VGICP)算法。与广义迭代最近点(GICP)算法相比,它在确保精度的同时具有更快的配准速度。在强化学习导航中,我们采用了深度确定性策略梯度(DDPG)路径规划算法。与深度Q网络(DQN)算法和A*算法相比,DDPG算法更有利于机器人在复杂未知环境中选择更好的路线,同时运动轨迹更平滑。本文采用Gazebo仿真。与物理机器人操作相比,它提供了一个安全、可控且经济高效的环境,支持高效的大规模实验和算法调试,还支持灵活的传感器仿真和自动验证,从而优化了整体测试过程。