A Hybrid Motion Planning Algorithm for Multi-Mobile Robot Formation Planning

摘要

This paper addresses the problem of relative position-based formation planning for a leader–follower multi-robot setup, where the robots adjust the formation parameters, such as size and three-dimensional orientation, to avoid collisions and progress toward their goal. Specifically, we develop a virtual sub-target-based obstacle avoidance method, which involves a transitional virtual sub-target that guides the robots to avoid obstacles according to obstacle information, target, and boundary. Moreover, we develop a changing formation strategy to determine the necessity to avoid collisions and a priority-based model to determine which robots move, thus dynamically adjusting the relative distance between the followers and the leader. The backstepping-based sliding motion controller guarantees that the trajectory and velocity tracking errors converge to zero. The proposed robot navigation method can be employed in various environments and types of obstacles, allowing for a formation change. Furthermore, it is efficient and scalable under various numbers of robots. The approach is experimentally verified using three real mobile robots and up to five mobile robots in simulated scenarios.