Autonomous vehicles can achieve accurate localization and real-time road information perception using sensors such as global navigation satellite systems (GNSSs), light detection and ranging (LiDAR), and inertial measurement units (IMUs). With road information, vehicles can navigate autonomously to a given position without traffic accidents. However, most of the research on autonomous vehicles has paid little attention to road profile information, which is a significant reference for vehicles driving on uneven terrain. Most vehicles experience violent vibrations when driving on uneven terrain, which reduce the accuracy and stability of data obtained by LiDAR and IMUs. Vehicles with an active suspension system, on the other hand, can maintain stability on uneven roads, which further guarantees sensor accuracy. In this paper, we propose a novel method for road profile estimation using LiDAR and vehicles with an active suspension system. In the former, 3D laser scanners, IMU, and GPS were used to obtain accurate pose information and real-time cloud data points, which were added to an elevation map. In the latter, the elevation map was further processed by a Kalman filter algorithm to fuse multiple cloud data points at the same cell of the map. The model predictive control (MPC) method is proposed to control the active suspension system to maintain vehicle stability, thus further reducing drifts of LiDAR and IMU data. The proposed method was carried out in outdoor environments, and the experiment results demonstrated its accuracy and effectiveness.

Autonomous vehicles can obtain real-time road information using 3D sensors. With road information, vehicles avoid obstacles through real-time path planning to improve their safety and stability. However, most of the research on driverless vehicles have been carried out on urban even driveways, with little consideration of uneven terrain. For an autonomous full tracked vehicle (FTV), the uneven terrain has a great impact on the stability and safety. In this paper, we proposed a method to predict the pose of the FTV based on accurate road elevation information obtained by 3D sensors. If we could predict the pose of the FTV traveling on uneven terrain, we would not only control the active suspension system but also change the driving trajectory to improve the safety and stability. In the first, 3D laser scanners were used to get real-time cloud data points of the terrain for extracting the elevation information of the terrain. Inertial measurement units (IMUs) and GPS are essential to get accurate attitude angle and position information. Then, the dynamics model of the FTV was established to calculate the vehicle’s pose. Finally, the Kalman filter was used to improve the accuracy of the predicted pose. Compared to the traditional method of driverless vehicles, the proposed approach was more suitable for autonomous FTV. The real-world experimental result demonstrated the accuracy and effectiveness of our approach.