Heteroscedastic Bayesian Optimization-Based Dynamic PID Tuning for Accurate and Robust UAV Trajectory Tracking

Fuqiang Gu, Jiangshan Ai, Xu Lu, Xianlei Long, Yan Li, Tao Jiang, Chao Chen, Huidong Liu* · 2025

Read Heteroscedastic Bayesian Optimization-Based Dynamic PID Tuning for Accurate and Robust UAV Trajectory Tracking by Fuqiang Gu, Jiangshan Ai, Xu Lu, Xianlei Long, Yan Li, Tao Jiang, Chao Chen, Huidong Liu* (2025) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2512-24249.txt.

Introduction

Fuqiang Gu and five colleagues tune drone controllers with Bayesian optimization. Quadrotors are hard to control well. They are underactuated, nonlinear, and tightly coupled. Classical PID controllers often track trajectories poorly as a result. The team's method keeps the PID structure. It tunes the parameters far more cleverly.

Their algorithm wraps the controller in a heteroscedastic Bayesian optimizer. The optimizer models noise that varies with the input. That makes it adapt better to dynamic, complex settings. A two-stage strategy speeds the search for good parameters. Simulation and real-world flights both tested the method. Position accuracy beat state-of-the-art rivals by wide margins. Angular accuracy improved even more strongly. The gains held across both test settings. Robust trajectory tracking is the practical payoff.

Catalog record

CREATORFuqiang Gu, Jiangshan Ai, Xu Lu, Xianlei Long, Yan Li, Tao Jiang, Chao Chen, Huidong Liu*
YEAR2025
COLLECTIONPAPERS
FORMATTXT
FILE SIZE35 KB
VERSION1.0
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2512-24249

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

Heteroscedastic Bayesian Optimization-Based Dynamic PID Tuning for Accurate and Robust UAV Trajectory Tracking Fuqiang Gu, Jiangshan Ai, Xu Lu, Xianlei Long, Yan Li, Tao Jiang, Chao Chen, Huidong Liu* Abstract Unmanned Aerial Vehicles (UAVs) play an important role in various applications, where precise trajectory tracking is crucial. However, conventional control algorithms for trajectory tracking often exhibit limited performance due to the underactuated, nonlinear, and highly coupled dynamics of quadrotor systems. To address these challenges, we propose HBO-PID, a novel control algorithm that integrates the Heteroscedastic Bayesian Optimization (HBO) framework with the classical PID controller to achieve accurate and robust trajectory tracking. By explicitly modeling input-dependent noise variance, the proposed method can better adapt to dynamic and complex environments, and therefore improve the accuracy and robustness of trajectory tracking. To accelerate the convergence of optimization, we adopt a two-stage optimization strategy that allow us to more efficiently find the optimal controller parameters. Through experiments in both simulation and real-world scenarios, we demonstrate that the proposed method significantly outperforms state-of-the-art (SOTA) methods. Compared to SOTA methods, it improves the position accuracy by 24.7% to 42.9%, and the angular accuracy by 40.9% to 78.4%. I Introduction Recently, UAVs have demonstrated significant potential in various fields, such as logistics [ 3 ] , environmental monitoring [ 15 ] , agricultural management [ 9 ] , disaster relief [ 5 ] , and infrastructure inspection [ 18 ] , due to their flexibility and efficiency. Among these applications, precise and robust trajectory tracking is crucial for UAVs to successfully accomplish their tasks [ 21 , 12 ] . However, as a typical underactuated system, the quadrotor UAV is characterized by highly nonlinear and strongly coupled dynamics, making it challenging to achieve accurate and arbitrary trajectory tracking. To address the above challenge, one needs to develop precise and robust UAV control algorithms. While the classical Proportional-Integral-Derivative (PID) control [ 13 ] is widely used for stabilizing UAV attitude and trajectory tracking due to its simplicity and efficiency, it often struggles with nonlinear dynamics and external disturbances. Besides, it requires manual tuning for optimal performance, which is challenging in dynamic environments. To improve the stability, precision, and robustness of UAV controllers under complex and dynamic environments, some researchers have turned to model-based controllers. For instance, Lindqvist et al. [ 11 ] proposed a novel Nonlinear Model Predictive Control (NMPC) method for UAV navigation and dynamic obstacle avoidance. Minařík et al. [ 14 ] introduced a real-time control architecture based on model predictive path integral (MPPI) control for agile UAVs, aiming to solve the problem of efficient flight in obstacle-rich environments. However, these methods are often computationally expensive, and rely heavily on accurate system models, limiting applicability in uncertain environments. In recent years, some learning-based control methods have been developed for trajectory tracking [ 19 , 8 ] , which can adapt to complex, unstructured environments and reduce dependency on explicit system model. For example, Han et al. [ 7 ] proposed a cascade flight control method for quadrotors based on deep reinforcement learning, which leveraged a layered control architecture to enhance stability, robustness, and trajectory tracking performance in dynamic environments. Through large-scale training, these methods demonstrate strong adaptability and robustness, making them increasingly effective in addressing complex control challenges. However, learning-based methods typically require substantial computational resources and are heavily dependent on a large amount of training data. This makes it difficult for them to quickly adapt to different trajectory requirements or environmental changes. To improve the efficiency and reduce the dependence on the huge training data, recent works have integrated traditional PID controllers with nonlinear dynamic compensation mechanisms. For instance, Noordin et al. [ 17 ] proposed an adaptive PID controller based on Sliding Mode Control (SMC) to address nonlinearity and parameter uncertainties in quadrotor UAV stabilization. Building on this, Berkenkamp et al. [ 1 ] introduced a PID parameter optimization method using BO with Gaussian Process (GP) modeling, significantly enhancing the control performance. To further improve adaptability, Zhao et al. [ 20 ] developed an enhanced BO algorithm that optimizes modeling efficiency, demonstrating greater robustness in dynamic environments. However, these methods depend heavily on modeling data heterogeneity, and their performance may degrade in scenarios with complex data distributions or high noise levels, posing a critical challenge for future research. In this study, we propose HBO-PID, a novel control method for trajectory tracking that integrates the classical PID controller with HBO. Compared to existing methods, HBO-PID features higher efficiency, lower pose error, better robustness, and adaptability to dynamic and complex environments. This is mainly attributed to the introduction of HBO, which extends traditional BO by explicitly modeling input-dependent noise variance (heteroscedasticity). Instead of assuming a constant noise level throughout the search space, HBO uses a surrogate model, often a GP, to estimate both the mean and the noise variance at each input point. This allows the algorithm to adapt to regions with varying uncertainty, capturing scenarios in which some areas of the search space are noisier than others. To accelerate the convergence and robustness of optimization, we utilize a two-stage optimization strategy. In the first phase, the algorithm focuses on large-scale error adjustment to help the system find a reasonable controller parameter range; while in the second phase, it further refines the optimization to reduce the remaining errors and enhance the robustness of the controller. In this way, HBO-PID can accurately and efficiently perform trajectory tracking even in dynamic and complex environments. In summary, the main contributions of this study are as follows: • We propose HBO-PID, a novel control method for accurate and robust trajectory tracking. Different existing methods, which either sacrifice computational cost or require a huge amount of training data, HBO-PID can accurately and robustly conduct trajectory tracking without pre-training. • We propose to use the HBO to better model the tracking noise regardless of inputs from dynamic and complex environments. This allows the UAV to adapt to noisy input and changing environments. • We adopt a two-stage optimization strategy, which avoids the computational cost of fine-tuning too early and ensures the optimal selection of controller parameters. This helps improve the accuracy and robustness of trajectory tracking. • We evaluate the proposed method through both simulation and real-world experiments. Experimental results show that HBO-PID significantly outperforms state-of-the-art methods in terms of pose error and robustness. II Problem Statement and Preliminary II-A Problem Statement Let us consider a UAV operating in a 3-dimensional bounded environment and moving along a trajectory. Its dynamic behavior is described using a discrete-time state-space model, which is expressed as the following equation: \mathbf{x}(t+1)=\mathbf{f}(\mathbf{x}(t),\mathbf{u}(t))+\mathbf{w}(t), (1) where \mathbf{x}(t) , \mathbf{u}(t) , and \mathbf{w}(t) are the state vector, control input vector, and heteroscedastic process noise of the quadrotor at time t , respectively, with the variance of \mathbf{w}(t) potentially varying over time or state. The objective of trajectory tracking is to design a control law \mathbf{u}(t) that stabilizes the quadrotor while minimizing the following cost function: J=\sum_{t=0}^{T}\left(\|\mathbf{x}(t)-\mathbf{x}^{*}(t)\|_{Q}^{2}+\|\mathbf{u}(t)\|_{R}^{2}\right), (2) where \mathrm{x}^{*}(t) is the desired state trajectory, Q\in\mathbb{R}^{n\times n} and R\in\mathbb{R}^{m\times m} are positive definite weighting matrices that penalize deviations from the desired state and excessive control effort, respectively. In this context, n and m denote the dimensions of the state vector and the

Read the complete text