Simultaneous localization and mapping (SLAM) has been investigated in the field of robotics for two decades, as it is considered to be an effective method for solving the positioning and mapping problem in a single framework. In the SLAM community, the Extended Kalman Filter (EKF) based SLAM and particle filter SLAM are the most mature technologies. After years of development, graph-based SLAM is becoming the most promising technology and a lot of progress has been made recently with respect to accuracy and efficiency. No matter which SLAM method is used, loop closure is a vital part for overcoming the accumulated errors. However, in 2D Light Detection and Ranging (LiDAR) SLAM, on one hand, it is relatively difficult to extract distinctive features in LiDAR scans for loop closure detection, as 2D LiDAR scans encode much less information than images; on the other hand, there is also some special mapping scenery, where no loop closure exists. Thereby, in this paper, instead of loop closure detection, we first propose the method to introduce extra control network constraint (CNC) to the back-end optimization of graph-based SLAM, by aligning the LiDAR scan center with the control vertex of the presurveyed control network to optimize all the poses of scans and submaps. Field tests were carried out in a typical urban Global Navigation Satellite System (GNSS) weak outdoor area. The results prove that the position Root Mean Square (RMS) error of the selected key points is 0.3614 m, evaluated with a reference map produced by Terrestrial Laser Scanner (TLS). Mapping accuracy is significantly improved, compared to the mapping RMS of 1.6462 m without control network constraint. Adding distance constraints of the control network to the back-end optimization is an effective and practical method to solve the drift accumulation of LiDAR front-end scan matching.

The precision of railway map is becoming a significant issue for autonomous train scheduling, monitoring and maintenance, related location-based service (LBS), and further ensuring travel safety. Mobile 3D laser scanning is an efficient method for making relative high-precision railway track maps, particularly during the night period of railway maintenance, for light detection and ranging (LiDAR) can work without ambient light. In this paper, we propose an efficient and accurate railway track vectorization method based on the LiDAR point clouds from the self-built train Mobile Laser Scanning (MLS) system. Our method takes full use of railway track geometry and reflection intensity feature of LiDAR, without any trajectory prior information. Firstly, clear track points are filtered by intensity; then, a K-means clustering fused Region-Grow Fitting algorithm is applied. It can not only extract the line vector of railway track, but also can tell the track branches apart, especially on bends and turnout. Experiments were carried on using point clouds with an average density of 490 points per square meter. The experimental results show that the method not only can quickly extract linear objects such as railway track and catenary, but also can detect the railways even in complex real-world topologies such as at bends and turnouts. The precision of the detection area in bends and turnouts are 90.32% and 81.31% respectively, the sensitivity is 83.27% and 83.33%, respectively. Moreover, it can identify the track networks.

High-precision and robust localization in GNSS-denied areas is crucial for autonomous vehicles and robots. Most state-of-the-art localization methods are based on simultaneous localization and mapping (SLAM) with a camera or light detection and ranging (LiDAR). However, SLAM will suffer from drift during long-term running without loop closure or prior constraints. Lightweight, high-precision environmental maps have gradually become an indispensable part of future autonomous driving. In order to solve the problem of real-time global localization for autonomous vehicles and robots, we propose a precise and robust LiDAR localization system based on a pre-built, occupied high-definition (HD) map called the Extended QuadTree (EQT) map. It makes use of a planar quadtree for block division and a Z-sequence index structure within the block cells. Then, a four-level occupancy probability cell value model is adopted. It will save about eight times the storage space compared with Google Cartographer, and the EQT map can be extended to store other information. For efficient scan-to-map matching with our specialized EQT map, the Bursa linearized model is used in the Gauss–Newton iteration of our algorithm, which makes the calculation of partial derivatives fast. All the above improvements lead to optimal storage and efficient querying for real-time scan-to-map matching localization. Field tests in an industrial park and road environment prove that positioning accuracy of about 6–13 cm and attitude accuracy of about 0.15° were achieved using a VLP-16 LiDAR. They also show that the method proposed in this paper is significantly better than the NDT method. For the long and narrow environment of an underground mine tunnel, high-resolution maps are also helpful for accurate and robust localization.

Indoor mobile mapping techniques are important for indoor navigation and indoor modeling. As an efficient method, Simultaneous Localization and Mapping (SLAM) based on Light Detection and Ranging (LiDAR) has been applied for fast indoor mobile mapping. It can quickly construct high-precision indoor maps in a certain small region. However, with the expansion of the mapping area, SLAM-based mapping methods face many difficulties, such as loop closure detection, large amounts of calculation, large memory occupation, and limited mapping precision. In this paper, we propose a distributed indoor mapping scheme based on control-network-aided SLAM to solve the problem of mapping for large-scale environments. Its effectiveness is analyzed from the relative accuracy and absolute accuracy of the mapping results. The experimental results show that the relative accuracy can reach 0.08 m, an improvement of 49.8% compared to the mapping result without loop closure. The absolute accuracy can reach 0.13 m, which proves the method’s feasibility for distributed mapping. The accuracies under different numbers of control points are also compared to find the suitable structure of the control network.