Coordinated Trajectory Control Algorithm for Quadcopter Motion along a Smooth Spatial Trajectory

Abstract

A complete model of the motion of a quadcopter along a smooth spatial trajectory is presented. Based on the model, a robust algorithm is proposed for controlling a quadcopter using measurements of linear coordinates and yaw angle. By introducing additional integrators, a dynamic control algorithm with a simplified controller tuning methodology is obtained. The control law is synthesized within the geometric approach, and its stability is proven. A realizable output-feedback version using an extended observer is also given. The results enable coordinated trajectory following in three-dimensional space despite unmeasured disturbances and incomplete state information.