Fast Path Planning for On-Water Automatic Rescue Intelligent Robot Based on Constant Thrust Artificial Fluid Method

摘要

In this paper, fast path planning of on-water automatic rescue intelligent robot is studied based on the constant thrust artificial fluid method. First, a three-dimensional environment model is established, and then the kinematics equation of the robot is given. The constant thrust artificial fluid method based on the isochronous interpolation method is proposed, and a novel algorithm of constant thrust fitting is researched through the impulse compensation. The effect of obstacles on original fluid field is quantified by the perturbation matrix, and the streamlines can be regarded as the planned path. Simulation results demonstrate the effectiveness of this method by comparing with A-star algorithm and ant colony algorithm. It is proved that the planned path can avoid all obstacles smoothly and swiftly and reach the destination eventually.