Unifying Quadrotor Motion Planning and Control by Chaining Different Fidelity Models

Fuente: arXiv
Salvato in:
Dettagli Bibliografici
Autori principali: Reiter, Rudolf, Qin, Chao, Bauersfeld, Leonard, Scaramuzza, Davide
Natura: Preprint
Pubblicazione: 2025
Soggetti:
Accesso online:
Tags: Aggiungi Tag
Nessun Tag, puoi essere il primo ad aggiungerne!!
_version_ 1866914200595464192
author Reiter, Rudolf
Qin, Chao
Bauersfeld, Leonard
Scaramuzza, Davide
author_facet Reiter, Rudolf
Qin, Chao
Bauersfeld, Leonard
Scaramuzza, Davide
contents Many aerial tasks involving quadrotors demand both instant reactivity and long-horizon planning. High-fidelity models enable accurate control but are too slow for long horizons; low-fidelity planners scale but degrade closed-loop performance. We present Unique, a unified MPC that cascades models of different fidelity within a single optimization: a short-horizon, high-fidelity model for accurate control, and a long-horizon, low-fidelity model for planning. We align costs across horizons, derive feasibility-preserving thrust and body-rate constraints for the point-mass model, and introduce transition constraints that match the different states, thrust-induced acceleration, and jerk-body-rate relations. To prevent local minima emerging from nonsmooth clutter, we propose a 3D progressive smoothing schedule that morphs norm-based obstacles along the horizon. In addition, we deploy parallel randomly initialized MPC solvers to discover lower-cost local minima on the long, low-fidelity horizon. In simulation and real flights, under equal computational budgets, Unique improves closed-loop position or velocity tracking by up to 75% compared with standard MPC and hierarchical planner-tracker baselines. Ablations and Pareto analyses confirm robust gains across horizon variations, constraint approximations, and smoothing schedules.
format Preprint
id arxiv_https___arxiv_org_abs_2512_12427
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle Unifying Quadrotor Motion Planning and Control by Chaining Different Fidelity Models
Reiter, Rudolf
Qin, Chao
Bauersfeld, Leonard
Scaramuzza, Davide
Robotics
Systems and Control
Many aerial tasks involving quadrotors demand both instant reactivity and long-horizon planning. High-fidelity models enable accurate control but are too slow for long horizons; low-fidelity planners scale but degrade closed-loop performance. We present Unique, a unified MPC that cascades models of different fidelity within a single optimization: a short-horizon, high-fidelity model for accurate control, and a long-horizon, low-fidelity model for planning. We align costs across horizons, derive feasibility-preserving thrust and body-rate constraints for the point-mass model, and introduce transition constraints that match the different states, thrust-induced acceleration, and jerk-body-rate relations. To prevent local minima emerging from nonsmooth clutter, we propose a 3D progressive smoothing schedule that morphs norm-based obstacles along the horizon. In addition, we deploy parallel randomly initialized MPC solvers to discover lower-cost local minima on the long, low-fidelity horizon. In simulation and real flights, under equal computational budgets, Unique improves closed-loop position or velocity tracking by up to 75% compared with standard MPC and hierarchical planner-tracker baselines. Ablations and Pareto analyses confirm robust gains across horizon variations, constraint approximations, and smoothing schedules.
title Unifying Quadrotor Motion Planning and Control by Chaining Different Fidelity Models
topic Robotics
Systems and Control
url https://arxiv.org/abs/2512.12427