Accurate Tracking of Aggressive Quadrotor Trajectories Using Incremental Nonlinear Dynamic Inversion and Differential Flatness

In this paper, we propose a novel control law for accurate tracking of aggressive (i.e., high-speed and high-acceleration) quadcopter trajectories. The proposed method tracks position and yaw angle with their derivatives of up to fourth order, specifically, the position, velocity, acceleration, jerk, and snap along with the yaw angle, yaw rate and yaw acceleration. Two key aspects of the proposed method are the following. First, the controller exploits the differential flatness of the quadcopter dynamics to generate feedforward inputs for attitude rate and attitude acceleration in order to track the jerk and snap references. The tracking is enabled by direct control of body torque using closed-loop control of all four propeller speeds based on optical encoders attached to the motors. Second, the controller utilizes the incremental nonlinear dynamic inversion (INDI) method for accurate tracking of linear and angular accelerations despite external disturbances. Hence, no prior modeling of aerodynamic effects is required. We evaluate the proposed control law in experiments under motion capture. Using a 1-kg quadcopter, we are able to track a complex 3D trajectory, reaching speeds up to 8.2 m/s and accelerations up to 2g, while keeping the root-mean-square tracking error down to 4.0 cm, in a flight volume that is roughly 6.5 m long, 6.5 m wide, and 1.5 m tall.