An improved A* algorithm for generating four-track trajectory planning to adapt to longitudinal rugged terrain

Abstract

Abstract A four-wheeled robot can stride through longitudinal trenches to adapt to terrain challenges and effectively reach the target position in unstructured space, thus achieving navigation in rough terrain. Establishing a trajectory planning method to plan four paths simultaneously is necessary. Firstly, a grid map is based on the longitudinal trench terrain. Secondly, according to the robot’s four-wheel size and chassis height, the robot can safely stand in the grid sequence. Finally, the minimum chassis and road height and the maximum roll Angle are added to the objective cost function of the traditional A* algorithm. An improved A* algorithm plans a four-wheel straddling path through the longitudinal ditch in the safe standing sequence. Simulation experiments prove that proposed method can effectively plan the four-wheel path on complex terrain. The planned path can be changed according to the adjustment of the weight values corresponding to the distance to the target, the minimum distance from the chassis to the ground, and the roll Angle. Such changes prove that the proposed method can effectively plan the path according to the actual situation, focusing on the speed (whether the path planning can be carried out) and the safety (whether the bottom dragging and rollover can be considered). The actual experiment proves that the robot can cross the longitudinal ditch in the form of left and right wheels. When the distance is about 10.5 m, the robot can pass through the longitudinal ditch quickly and safely in 19.8 s at a speed of 0.53 m/s, keeping the robot’s tilt angle less than 20°.

Keywords

• Improved A* algorithm
• Longitudinal rugged terrain
• Four-wheel track
• Path planning