← All research

BYU MAGICC Lab · Feb 2026 – Present

COAST: Corridor-Optimized Aerially-Safe Trajectories

A real-time path and trajectory planner for UAVs that keeps the obstacle-avoidance guarantees of safe flight corridors while running fast enough to replan in flight.

Alejandro Pelaez & Randal W. Beard · Submitted to the 2027 American Control Conference (ACC) · 2nd Place, SHPE 2026 National Poster Competition

RViz view of a quadrotor in a forest of cylinders, with LiDAR returns in green, safe flight corridors in red and the planned trajectory in blue
COAST in a dense environment. LiDAR returns (green) are used to build dynamically sized safe flight corridors (red), and a minimum-snap B-spline trajectory (blue) is optimized inside them.

Motivation

An online trajectory planner decides how an aircraft physically gets from A to B using only its onboard sensors. Existing planners tend to pick one side of a trade-off: some give mathematical guarantees at the expense of computation time, while others are fast but give up those guarantees. COAST is built to get both: a highly efficient planner that provably respects obstacle boundaries.

Approach

Current B-spline planners either keep hard corridor guarantees and pay for it in computation, or swap them for soft penalties to run in real time. COAST splits the problem into two stages to keep both:

A chain of rectangular corridors of different widths and heights wrapping around obstacles
Dynamically sized corridors: nearby obstacles set each prism's width and height.
Comparison of B-spline and MINVO control points around the same trajectory
B-spline (orange) vs. MINVO (red) control points. MINVO gives a much tighter hull around the trajectory.
A quadrotor trajectory passing through four corridors, colored by one-second time intervals
A time-parameterized trajectory threading four corridors, colored by second.

The planner's core trajectory-generation code lives in the MAGICC Lab's Minimum-Snap-Trajectories C++ library. The ROScopter and ROSflight repositories integrate it with the autopilot and simulator.

Pipeline

InputsLiDAR map, start/goal, velocity and acceleration limits, spline degree, aircraft radius
→
Path searchA* on a voxelized map with obstacle expansion (Dubins A* for fixed-wing turn limits)
→
CorridorsSafe flight corridors sized to the path, with control points allotted by corridor length
→
OptimizerSnap-minimizing QP with corridor and MINVO velocity/acceleration constraints
→
OutputAn obstacle-free, time-parameterized trajectory that respects the aircraft's limits

Multirotors use dynamically resized corridors for cluttered and indoor flight. Fixed-wing aircraft use fixed-size corridors with obstacles expanded to account for turn radius.

Results

Validated in high-fidelity simulation: the quadrotor's physics and low-level control run in ROSflight, with ROScopter as the autopilot tracking COAST's trajectories, through forests of randomly placed obstacles fed by simulated LiDAR. Ten independent trials were run at each obstacle density.

5% obstacle density (video: MAGICC Lab)
10% obstacle density (video: MAGICC Lab)
DensitySuccessOptimize (ms)Replan (ms) Travel time (s)Path length (m)Jerk (m/s³)Vel. / accel. violations
5%100%0.892.4647.48109.7964.580% / 0%
10%90%1.104.2550.16119.68129.200% / 0%

The QP solves in about 1 ms and full end-to-end replanning averages under 5 ms. Not one commanded setpoint violated the velocity or acceleration limits at either density, which validates the MINVO bounds end to end. COAST reached the goal without contact in 10/10 trials at 5% density and 9/10 at 10%, where the one failure was a stall.

Poster

Presented at the 2026 SHPE National Convention in Indianapolis, where it placed 2nd in the national undergraduate research poster competition. BYU's Electrical & Computer Engineering department wrote about the award ↗.

COAST research poster: trajectory planning motivation, mathematical formulation, architecture, simulation results and future work
Click to open the full-resolution poster.

Next steps

← Back to all research