COAST: Safe Flight Corridor Planner for Fast and Robust Snap Minimized Trajectories
Organizations: ∗1 Multiple Agent Intelligent Coordination and Control (MAGICC) Laboratory, Brigham Young University, Provo, UT, USA.
Abstract
Current B-Spline trajectory planners face a critical trade-off: they either sacrifice computational speed to maintain strict Safe Flight Corridor (SFC) guarantees, or they abandon hard safety bounds in favor of soft-constraint penalties to achieve real-time performance. We present COAST (Corridor-Optimized Aerially-Safe Trajectories), a B-Spline based, online trajectory planner capable of formulating snap minimized trajectories with SFC guarantees. COAST divides the problem into two stages: an A* based front-end that generates geometrically simple SFCs (represented as a chain of rectangular prisms), and a quadratic programming back-end for control point optimization. To handle the non-convexity of SFC intersections, we leverage the finite support property of B-Splines, to ensure the spline never exits SFC boundaries. The control point optimization incorporates MINVO transforms for kinodynamic bounding, allowing COAST to design non-conservative, dynamically feasible trajectories, while a snap minimization matrix calculation provides flight smoothness. This formulation provides a formal geometric containment guarantee, while ensuring mean trajectory computation times under 5 ms for real-time deployment. We validate our results through high-fidelity simulation experiments. The source code can be found at: https://github.com/byu-magicc/Minimum-Snap-Trajectories
Figures & tables
| Mission Outcomes | Computational Timing [ms] | Trajectory & Planner | |||||
|---|---|---|---|---|---|---|---|
| Success rate [%] | 81.9 | Replan, mean | 3.12 | First-attempt solves [%] | 91.0 | ||
| Stalled [%] | 17.8 | Replan, med | 1.76 | Control points | 8.66 1.47 | ||
| Collided [%] | 0.3 | OSQP, mean | 0.67 | Single-corridor plans [%] | 59.4 | ||
| Median progress [%] | 97.5 | OSQP, med | 0.32 | Plan-mean speed [m/s] | 2.59 0.24 | ||
| Density | Success | Comp. Time | Performance | Constraint Viol. | ||||
|---|---|---|---|---|---|---|---|---|
| [%] | [ms] | [ms] | [s] | [m] | [m/s 2 ] | [%] | [%] | |
| 5% | 100.0 | 0.89 | 2.46 | 47.48 | 109.79 | 64.58 | 0.00 | 0.00 |
| 10% | 90.0 | 1.10 | 4.25 | 50.16 | 119.68 | 129.20 | 0.00 | 0.00 |
Trajectory Generation
Trajectory generation creates plausible, goal-directed paths and motion sequences for people, vehicles, and robots.
See all 190 papers