The localization and navigation of underground parking lots presents a ‘last mile’ problem for intelligent vehicles. To address the issues of poor localization and navigation efficiency caused by the lack of global navigation satellite system signals in this scenario, this study presents a low-cost and computationally efficient real-time localization and navigation algorithm. The algorithm begins by constructing a node fingerprint based on the characteristics of underground parking lot intersections and proposes an intersection fingerprint roadmap (IRM). To address the problem of difficult initial position computation during navigation, a node-level localization method based on scene matching and pose calculation is proposed and then combined with the IRM. Finally, the IRM is used to search for routes on the scene plan and perform path smoothing to obtain a globally feasible driving route. The algorithm proposed in this study can achieve fast vehicle localization and real-time navigation with low computational power, and the proposed localization method can be applied not only to underground parking lots but also to other outdoor scenes. The method is evaluated on datasets collected from different environments, and the experimental results show that the algorithm has an average localization error of approximately 20 cm and provides faster navigation speed and smoother navigation in comparison with other algorithms.
Read full abstract