The invention discloses an unmanned cluster
trajectory planning method based on a Tangent Bug
algorithm and a real-time virtual pipeline, and belongs to the field of unmanned cluster cooperative control and
trajectory planning. According to the method, switching of three navigation
modes is managed through a state
machine. After the environment is sensed in real time, if a
narrow channel is recognized, entering a special mode, aligning the
central line of the pipeline with the central axis of the channel and shrinking the
radius, and guiding the cluster in the
central line direction; and if the
narrow channel is not identified, switching between a boundary following mode and a target approaching mode is carried out, an
obstacle avoidance tangent direction or a direct approaching direction is calculated based on a Tangent Bug
algorithm, and the
radius of the pipeline is kept at a standard value. And finally, by taking the dynamically constructed virtual pipeline as a unified space reference, calculating the motion trail of each unit in real time according to a preset formation configuration, and outputting the motion trail. According to the method, the problems of fixed pipeline
radius, low passing efficiency of a
narrow channel and insufficient formation
collaboration in an existing method are effectively solved, and safe, efficient and collaborative movement of the unmanned cluster in a complex environment is realized.