Robust and Efficient Trajectory Planning for Formation Flight in Dense Environments
Authors:
- Lun QuanLQLun Quan
- Longji YinLYLongji Yin
- Tingrui ZhangTZTingrui Zhang
- Mingyang WangMWMingyang Wang
- Ruilin WangRWRuilin Wang
- Sheng ZhongSZSheng Zhong
- Zhou XinZXZhou Xin
- Yanjun CaoYCYanjun Cao
- Chao XuCXChao Xu
- Fei GaoFGFei Gao
Preprint
Abstract
Formation flight has a vast potential for aerial robot swarms in various applications. However, existing methods lack the capability to achieve fully autonomous large-scale formation flight in dense environments. To bridge the gap, we present a complete formation flight system that effectively integrates real-world constraints into aerial formation navigation. This paper proposes a differentiable graph-based metric to quantify the overall similarity error between formations. This metric is invariant to rotation, translation, and scaling, providing more freedom for formation coordination. We design a distributed trajectory optimization framework that considers formation similarity, obstacle avoidance, and dynamic feasibility. The optimization is decoupled to make large-scale formation flights computationally feasible. To improve the elasticity of formation navigation in highly constrained scenes, we present a swarm reorganization method that adaptively adjusts the formation parameters and task assignments by generating local navigation goals. A novel swarm agreement strategy called global-remap-local-replan and a formation-level path planner is proposed in this work to coordinate the global planning and local trajectory optimizations. To validate the proposed method, we design comprehensive benchmarks and simulations with other cutting-edge works in terms of adaptability, predictability, elasticity, resilience, and efficiency. Finally, integrated with palm-sized swarm platforms with onboard computers and sensors, the proposed method demonstrates its efficiency and robustness by achieving the largest scale formation flight in dense outdoor environments.Keywords
All Related Versions
This publication has 31 references indexed in Scilit:
- Communicating Multi-UAV System for Cooperative SLAM-based ExplorationJournal of Intelligent & Robotic Systems, 2019
- Intelligent bidirectional rapidly-exploring random trees for optimal motion planning in complex cluttered environmentsRobotics and Autonomous Systems, 2015
- A survey of multi-agent formation controlAutomatica, 2015
- Local formation control strategies with undetermined and determined formation scales for co-leader vehicle networks2013
- Leader–follower formation via complex LaplacianAutomatica, 2013
- Trajectory design and control for aggressive formation flight with quadrotorsAutonomous Robots, 2012
- Stabilisation of infinitesimally rigid formations of multi-robot networksInternational Journal of Control, 2009
- Behavior-based formation control for multirobot teamsIEEE Transactions on Robotics and Automation, 1998
- High Precision Formation Control of Mobile Robots Using Virtual StructuresAutonomous Robots, 1997
- A computational algorithm for functional inequality constrained optimization problemsAutomatica, 1990