将低层控制器动态纳入非线性模型预测控制,提升无人机高速飞行时的轨迹跟踪精度。
LoL-NMPC: Low-Level Dynamics Integration in Nonlinear Model Predictive Control for Unmanned Aerial Vehicles
- 显式建模低层控制器与电机动态,改进传统NMPC对执行器约束的处理
- 实测在98.57 km/h速度、3.5 g加速度下误差降低21.97%
- 可在嵌入式ARM设备上以100 Hz实时运行,适合高动态无人机系统
本文针对无人飞行器(UAV)高速敏捷轨迹跟踪问题,提出一种新型非线性模型预测控制方法(LoL-NMPC),显式整合低层飞行控制器(如常见飞控中的PID)和电机动力学,以减少因模型失准导致的跟踪误差。通过利用低层动态中的线性约束,本方法天然满足执行器约束,无需额外约束重分配策略。在仿真与真实实验中验证,该方法在速度达98.57 km/h、加速度达3.5 g条件下显著提升跟踪精度与鲁棒性。相比标准NMPC,平均轨迹跟踪误差降低21.97%,且在基于ARM的嵌入式飞控上实现100 Hz实时可行性。
原文摘要 · Abstract (English)
[Accepted to IROS 2025] In this paper, we address the problem of tracking high-speed agile trajectories for Unmanned Aerial Vehicles(UAVs), where model inaccuracies can lead to large tracking errors. Existing Nonlinear Model Predictive Controller(NMPC) methods typically neglect the dynamics of the low-level flight controllers such as underlying PID controller present in many flight stacks, and this results in sub-optimal tracking performance at high speeds and accelerations. To this end, we propose a novel NMPC formulation, LoL-NMPC, which explicitly incorporates low-level controller dynamics and motor dynamics in order to minimize trajectory tracking errors while maintaining computational efficiency. By leveraging linear constraints inside low-level dynamics, our approach inherently accounts for actuator constraints without requiring additional reallocation strategies. The proposed method is validated in both simulation and real-world experiments, demonstrating improved tracking accuracy and robustness at speeds up to 98.57 km/h and accelerations of 3.5 g. Our results show an average 21.97 % reduction in trajectory tracking error over standard NMPC formulation, with LoL-NMPC maintaining real-time feasibility at 100 Hz on an embedded ARM-based flight computer.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。