To address the problems of state estimation bias, dynamic threat response lag, and insufficient safety margin in formation coordination caused by the mismatch between the three-dimensional continuous motion model and the discrete sampling characteristics of sensors in UAV multi-aircraft collaborative inspection missions under complex dynamic environments, this paper studies a trajectory planning method that integrates model predictive control and multi-constraint optimization. By constructing a three-dimensional continuous motion model of the UAV and discretizing it using the Euler integral method, the mapping deviation between the continuous motion characteristics and the discrete working mechanism of the airborne system is solved. Based on the model predictive control method, a patrol trajectory tracking planning model is designed, and state increment and integral augmentation strategies are introduced to transform global reference trajectory tracking into a constrained quadratic programming problem in the rolling time domain, achieving high-precision closed-loop tracking. Furthermore, a dynamic environment model coupling static terrain height field and sudden spherical threat is constructed to systematically characterize the static obstacles and random dynamic threats faced by the UAV in complex scenarios such as mountains and hills. On this basis, multiple constraints such as flight altitude, pitch angle, horizontal turning angle, terrain safety margin, and multi-aircraft collision avoidance are integrated to establish a comprehensive objective function that includes range cost, attitude penalty, and safety cost. Through a collaborative mechanism of global optimization and local online correction, a reference trajectory that meets the requirements of formation safety and flight efficiency is generated and used as the input command for the tracking planning model, forming a closed-loop architecture of global optimization generation, local closed-loop tracking, and dynamic real-time correction for trajectory planning. Experimental results show that the success rate of dynamic obstacle avoidance in complex dynamic environments is always higher than 99.9%, and the mean square error of trajectory tracking is stable in the range of 0.02–0.04 km, which verifies its significant advantages in dynamic adaptability, tracking accuracy and formation safety.
Pang et al. (Fri,) studied this question.