Geometrically Constrained Trajectory Optimization for Multicopters

by   Zhepei Wang, et al.

We present an optimization-based framework for multicopter trajectory planning subject to geometrical spatial constraints and user-defined dynamic constraints. The basis of the framework is a novel trajectory representation built upon our novel optimality conditions for unconstrained control effort minimization. We design linear-complexity operations on this representation to conduct spatial-temporal deformation under various planning requirements. Smooth maps are utilized to exactly eliminate geometrical constraints in a lightweight fashion. A wide range of state-input constraints are supported by the decoupling of dense constraint evaluation from sparse parameterization, and backward differentiation of flatness map. As a result, the proposed framework transforms a generally constrained multicopter planning problem into an unconstrained optimization that can be solved reliably and efficiently. Our framework bridges the gaps among solution quality, planning frequency and constraint fidelity for a multicopter with limited resources and maneuvering capability. Its generality and robustness are both demonstrated by applications and experiments for different tasks. Extensive simulations and benchmarks are also conducted to show its capability of generating high-quality solutions while retaining the computation speed against other specialized methods by orders of magnitudes. Details and source code of our framework will be freely available at:


page 16

page 18

page 19

page 20

page 21

page 22

page 23


Decentralized Spatial-Temporal Trajectory Planning for Multicopter Swarms

Multicopter swarms with decentralized structure possess the nature of fl...

Alternating Minimization Based Trajectory Generation for Quadrotor Aggressive Flight

With much research has been conducted into trajectory planning for quadr...

Robust Trajectory Planning for Spatial-Temporal Multi-Drone Coordination in Large Scenes

In this paper, we describe a robust multi-drone planning framework for h...

CALIPSO: A Differentiable Solver for Trajectory Optimization with Conic and Complementarity Constraints

We present a new solver for non-convex trajectory optimization problems ...

Star-Convex Constrained Optimization for Visibility Planning with Application to Aerial Inspection

The visible capability is critical in many robot applications, such as i...

Trajectory Optimization with Optimization-Based Dynamics

We present a framework for bi-level trajectory optimization in which a s...

Stability Constrained Mobile Manipulation Planning on Rough Terrain

This paper presents a framework that allows online dynamic-stability-con...

Code Repositories


A General-Purpose Trajectory Optimizer for Multicopters

view repo