Cascaded Nonlinear Control of a Duocopter with Disturbance Compensation by an Unscented Kalman Filter

Abstract A cascaded control strategy for an innovative Duocopter test rig - a helicopter with two rotors combined with a guiding mechanism - is presented in this paper. The guiding mechanism consists of a rocker arm with a sliding carriage that enforces a planar workspace of the Duocopter. The Duocopter is attached to the carriage by a rotary joint and offers 3 degrees of freedom. The derived system model has similarities with a PVTOL and a planar model of a quadrocopter but involves additional terms due to the guiding mechanism. In the paper, a model-based cascaded control strategy is proposed: in the outer MIMO control loop, sliding mode techniques are employed to control both the horizontal and the vertical Duocopter position. The rotation angle of the Duocopter is controlled in a linear inner control loop using flatness-based techniques. An additional feedforward control takes into account known parts of the coupling forces between the carriage and the rocker. The control structure is extended by an Unscented Kalman Filter (UKF) that provides estimates for the state vector and, moreover, estimates for remaining errors concerning the feedforward coupling forces. The sum of the feedforward part and the estimated part can be used to accurately compensate for the impact of the guiding mechanism on the motion of the Duocopter frame. Thereby, an excellent tracking performance in vertical and horizontal direction can be achieved. The efficiency of the proposed control strategy is demonstrated by experiments.

[1]  Rudolph van der Merwe,et al.  Sigma-point kalman filters for probabilistic inference in dynamic state-space models , 2004 .

[2]  Harald Aschemann,et al.  Cascaded flatness-based control of a Duocopter subject to unknown disturbances , 2014, 2014 19th International Conference on Methods and Models in Automation and Robotics (MMAR).

[3]  R. Lozano,et al.  Global Stabilization of the PVTOL: Real-Time Application to A Mini-Aircraft , 2004 .

[4]  R. Olfati-Saber,et al.  Global configuration stabilization for the VTOL aircraft with strong input coupling , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[5]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[6]  Johann Reger,et al.  On algebraic time-derivative estimation and deadbeat state reconstruction , 2007, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[7]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[8]  Andreas Rauh,et al.  Feedforward control design for a four-rotor UAV using direct and indirect methods , 2012, 2012 17th International Conference on Methods & Models in Automation & Robotics (MMAR).