4D Radar-Camera Vector Map SLAM with Dynamic Object Removal Mask and Two-Stage Loop Detection

초록

A vector map containing lane information is essential to perform global or local path planning for autonomous driving. Vector maps, also termed as HD maps, are typically developed using high-cost LiDAR or a combination of cameras and deep learning. In this paper, the first complete real-time vector map SLAM system using the emerging 4D radar and low-cost cameras is proposed. First, a Dynamic Object Removal Mask (DORM)-based visual-4D radar odometry is proposed, which incorporates a velocity-adaptive and distance-dependent radius function to ensure robust performance in dynamic urban environments. By considering both the object’s absolute velocity and its distance from the sensor, our method effectively suppresses dynamic features while preserving distant static landmarks. The experimental results indicate that the proposed method outperforms state-of-the-art LiDAR SLAM and other techniques in dynamic scenarios. Second, a two-stage loop detection method is suggested using the vector map generated by the inverse perspective mapping (IPM) and the 4D radar Z projection image. Experimental validation demonstrates that odometry drift is reduced through pose graph optimization-based loop closure. © 1963-2012 IEEE.

키워드