The invention discloses a complex
terrain-oriented tracked vehicle energy efficiency optimization path
planning method and
system, and the method comprises the steps: firstly constructing a joint
energy consumption model on a rasterized three-dimensional
terrain, and superposing the straight
rolling resistance, gradient and steering equivalent resistance moment
energy consumption to obtain node cost; then, under the framework of a weighted A * function, the product of
Euclidean distance and
energy consumption rate is used as a
heuristic function, and rapid rough search is achieved; halton sampling is carried out on the coarse path nodes, an environment vector is calculated based on the distance between a sample and the center and the gradient difference, offsets are carried out, impassable samples are removed, secondary search is carried out after a probability road network is reconstructed, and the local path quality is improved; and finally,
smoothing the broken line by using a three-dimensional fourth-order B spline, eliminating the conflict with the impassable area by densifying nodes, and outputting an
executable track with continuous curvature.
Simulation shows that compared with A *, Dijkstra and PRM algorithms in complex terrains, the method saves energy by 5.2%-12% on average, and the energy saving performance of the tracked vehicle is achieved.