Advancing Simultaneous Localization and Mapping with Multi-Sensor Fusion and Point Cloud De-Distortion
Author:
Shao Haiyan1ORCID, Zhao Qingshuai1, Chen Hongtang1ORCID, Yang Weixin2, Chen Bin3, Feng Zhiquan4, Zhang Jinkai1, Teng Hao1
Affiliation:
1. School of Mechanical Engineering, University of Jinan, Jinan 250022, China 2. School of Electrical & Biomedical Engineering, University of Nevada, Reno, NV 89557, USA 3. Shandong Youbaote Intelligent Robotics Co., Ltd., Jinan 250098, China 4. School of Information Science and Engineering, University of Jinan, Jinan 250022, China
Abstract
This study addresses the challenges associated with incomplete or missing information in obstacle detection methods that employ a single sensor. Additionally, it tackles the issue of motion distortion in LiDAR point cloud data during synchronization and mapping in complex environments. The research introduces two significant contributions. Firstly, a novel obstacle detection method, named the point-map fusion (PMF) algorithm, was proposed. This method integrates point cloud data from the LiDAR, camera, and odometer, along with local grid maps. The PMF algorithm consists of two components: the point-fusion (PF) algorithm, which combines LiDAR point cloud data and camera laser-like point cloud data through a point cloud library (PCL) format conversion and concatenation, and selects the most proximate point cloud to the quadruped robot dog as the valid data; and the map-fusion (MF) algorithm, which incorporates local grid maps acquired using the Gmapping and OctoMap algorithms, leveraging Bayesian estimation theory. The local grid maps obtained by the Gmapping and OctoMap algorithms are denoted as map A and map B, respectively. This sophisticated methodology enables seamless map fusion, which significantly enhances the precision and reliability of the approach. Secondly, a motion distortion removal (MDR) method for LiDAR point cloud data based on odometer readings was proposed. The MDR method utilizes legged odometer data for linear data interpolation of the original distorted LiDAR point cloud data, facilitating the determination of the corresponding pose of the quadruped robot dog. Subsequently, the LiDAR point cloud data are then transformed to the quadruped robot dog coordinate system, efficiently mitigating motion distortion. Experimental results demonstrated that the proposed PMF algorithm achieved a 50% improvement in success rate compared to using only LiDAR or the PF algorithm in isolation, while the MDR algorithm enhanced mapping accuracy by 45.9% when motion distortion was taken into account. The effectiveness of the proposed methods was confirmed through rigorous experimentation.
Funder
Enterprise commissioned development project of Jinan Huibang Intelligent Technology Co., Ltd. Enterprise commissioned development project of Jinan Huibang Automatic Control Co., Ltd. Independent Innovation Team Project of Jinan City
Subject
Electrical and Electronic Engineering,Industrial and Manufacturing Engineering,Control and Optimization,Mechanical Engineering,Computer Science (miscellaneous),Control and Systems Engineering
Reference25 articles.
1. Jiang, G., Yin, L., Jin, S., Tian, C., Ma, X., and Ou, Y. (2019). A simultaneous localization and mapping (SLAM) framework for 2.5 D map building based on low-cost LiDAR and vision fusion. Appl. Sci., 9. 2. López, E., García, S., Barea, R., Bergasa, L.M., Molinos, E.J., Arroyo, R., Romera, E., and Pardo, S. (2017). A multi-sensorial simultaneous localization and mapping (SLAM) system for low-cost micro aerial vehicles in GPS-denied environments. Sensors, 17. 3. From big dog to spot mini: Evolution of boston powered quadruped robot;Liu;Robot Ind.,2018 4. Probabilistic Terrain Mapping for Mobile Robots With Uncertain Localization;Fankhauser;IEEE Robot. Autom. Lett.,2018 5. Development of quadruped walking robots: A review;Biswal;Ain Shams Eng. J.,2021
|
|