Extracting terrain elevation information in front of the vehicle based on vehicle-mounted LiDAR in dynamic environments

摘要

Abstract Point cloud maps constructed using 3D LiDAR, are widely used for robot navigation and localization. Few studies have utilized point cloud maps to extract terrain elevationinformation in front of a vehicle, which can be used as active suspension inputs to reduce vehicle bumps. In addition, the trajectories of dynamic objects in point cloud maps and global navigation satellite system (GNSS) data loss can affect the extraction of elevation information. To solve these problems, this paper proposes a framework for extracting terrain elevation information in front of the vehicle based on vehicle-mounted LiDAR in dynamic environments. The framework consists of two modules: point cloud map construction and vehicle front terrain elevation information extraction. In the point cloud map construction module, a system for simultaneous localization and mapping (SLAM) is proposed, which is capable of building point cloud maps without GNSS. Furthermore, a dynamic descriptor-based dynamic object filtering algorithm is proposed which is applied to SLAM. Therefore, the SLAM system overcomes the influence of dynamic objects on vehicle position and attitude estimation, and there are no trajectories of dynamic objects in the point cloud maps built by the system. In the vehicle front terrain elevation information extraction module, the unscented Kalman filter is utilized to predict the vehicle position at the next moment. Based on the geometric features of the tire-ground contact area, the terrain elevation information of the tire contact area at the predicted position on the point cloud map is extracted. Experiments show that the algorithm in this paper overcomes the effect of dynamic objects and builds a vehicle point cloud map without dynamic objects under GNSS data loss, which improves the accuracy of the extraction of terrain elevation information in front of the vehicle.