Abstract-This paper presents a distributed method for navigating a team of robots in formation in 2D and 3D environments with static and dynamic obstacles. The robots are assumed to have a reduced communication and visibility radius and share information with their neighbors. Via distributed consensus the robots compute (a) the convex hull of the robot positions and (b) the largest convex region within free space. The robots then compute, via sequential convex programming, the locally optimal parameters for the formation within this convex neighborhood of the robots. Reconfiguration is allowed, when required, by considering a set of target formations. The robots navigate towards the target collision-free formation with individual local planners that account for their dynamics. The approach is efficient and scalable with the number of robots and performs well in simulations with up to sixteen quadrotors.
I. INTRODUCTIONMuti-robot teams can be employed for various tasks, such as surveillance, inspection, or automated factories. In these scenarios, robots may be required to navigate in formation, for example for maintaining a communication network, for collaboratively handling an object, for surveilling an area or to improve navigation.Multi-robot navigation in formation has received extensive attention in the past, with many works considering obstaclefree scenarios. In [1] we leveraged efficient optimization techniques, namely quadratic programming, semi-definite programming and (non-linear) sequential quadratic programming to devise a centralized method for local navigation in formation. These techniques provided good computational efficiency, local guarantees and generality, and were employed at different stages of the method for local motion planning in formation among static and dynamic obstacles, albeit centralized.In this work we combine the optimization concepts presented in [1] with distributed consensus and geometric reasoning to achieve similar results in a distributed schema, where robots are no more centrally controlled, but instead have a limited field of view, and communicate with their immediate neighbors.