Pose Prediction of Autonomous Full Tracked Vehicle Based on 3D Sensor

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.