Abstract:This paper presents a scalable online algorithm to generate safe and kinematically feasible trajectories for quadrotor swarms. Existing approaches rely on linearizing Euclidean distance-based collision constraints and on axis-wise decoupling of kinematic constraints to reduce the trajectory optimization problem for each quadrotor to a quadratic program (QP). This conservative approximation often fails to find a solution in cluttered environments. We present a novel alternative that handles collision constraints without linearization and kinematic constraints in their quadratic form while still retaining the QP form. We achieve this by reformulating the constraints in a polar form and applying an Alternating Minimization algorithm to the resulting problem. Through extensive simulation results, we demonstrate that, as compared to Sequential Convex Programming (SCP) baselines, our approach achieves on average a 72% improvement in success rate, a 36% reduction in mission time, and a 42 times faster per-agent computation time. We also show that collision constraints derived from discrete-time barrier functions (BF) can be incorporated, leading to different safety behaviours without significant computational overhead. Moreover, our optimizer outperforms the state-of-the-art optimal control solver ACADO in handling BF constraints with a 31 times faster per-agent computation time and a 44% reduction in mission time on average. We experimentally validated our approach on a Crazyflie quadrotor swarm of up to 12 quadrotors. The code with supplementary material and video are released for reference.

A Set-based Motion Planning Algorithm for Aerial Vehicles in the Presence of Obstacles Exhibiting Hybrid Dynamics

Whole-Body Real-Time Motion Planning for Multicopters

Internal and External Disturbances Aware Motion Planning and Control for Quadrotors

3D Path Planning of Quadrotor Aerial Robots Using Numerical Optimization

Alternating Minimization Based Trajectory Generation for Quadrotor Aggressive Flight

Real-time Motion Planning and Trajectory Tracking in Complex Environments Based on Bézier Curves and Nonlinear MPC Controller

AMSwarm: An Alternating Minimization Approach for Safe Motion Planning of Quadrotor Swarms in Cluttered Environments

PE-Planner: A Performance-Enhanced Quadrotor Motion Planner for Autonomous Flight in Complex and Dynamic Environments

Motion Planning for Aerial Pick-and-Place based on Geometric Feasibility Constraints

A Safer Vision-based Autonomous Planning System for Quadrotor UAVs with Dynamic Obstacle Trajectory Prediction and Its Application with LLMs

Search-based Path Planning and Receding Horizon Based Trajectory Generation for Quadrotor Motion Planning

Risk-aware Trajectory Sampling for Quadrotor Obstacle Avoidance in Dynamic Environments

Search-based Motion Planning for Aggressive Flight in SE(3)

Kinodynamic Motion Planning for Autonomous Vehicles

Motion Planning and Control of A Morphing Quadrotor in Restricted Scenarios

A Reinforcement Learning Based Motion Planner for Quadrotor Autonomous Flight in Dense Environment

Safe Interval Motion Planning for Quadrotors in Dynamic Environments

A Model Predictive Path Integral Method for Fast, Proactive, and Uncertainty-Aware UAV Planning in Cluttered Environments

Dynamic Free-Space Roadmap for Safe Quadrotor Motion Planning

Computationally Efficient Trajectory Planning for High Speed Obstacle Avoidance of a Quadrotor with Active Sensing.

Trajectory Planning with Collision Avoidance for Multiple Quadrotor UAVs Using DMPC