Open Advanced Search
Get 20M+ Full-Text Papers For Less Than $1.50/day.
Start a 14-Day Trial for You or Your Team.
Learn More →
Incremental Nonlinear Fault-Tolerant Control of a Quadrotor with Complete Loss of Two Opposing Rotors
Incremental Nonlinear Fault-Tolerant Control of a Quadrotor with Complete Loss of Two Opposing...
Sun, Sihao;Wang, Xuerui;Chu, Qiping;de Visser, Coen
IEEE TRANSACTIONS ON ROBOTICS. PREPRINT VERSION. DOI: 10.1109/TRO.2020.3010626. © 2020 IEEE 1 Incremental Nonlinear Fault-Tolerant Control of a Quadrotor with Complete Loss of Two Opposing Rotors Sihao Sun, Xuerui Wang, Qiping Chu, and Coen de Visser Abstract—In order to further expand the ﬂight envelope of quadrotors under actuator failures, we design a nonlinear sensor-based fault-tolerant controller to stabilize a quadrotor with failure of two opposing rotors in the high-speed ﬂight condition (> 8m/s). The incremental nonlinear dynamic inversion (INDI) approach which excels in handling model uncertainties is adopted to compensate for the signiﬁcant unknown aerodynamic eﬀects. The internal dynamics of such an underactuated system have been analyzed, and subsequently stabilized by re-deﬁning the control output. The proposed method can be generalized to control a quadrotor under single-rotor-failure and nominal Fig. 1: Snapshot of the tested Bebop2 subjected to failures of conditions. For validation, ﬂight tests have been carried out in rotor 1 & 3 (upper row), and subjected to failure of rotor 3 a large-scale open jet wind tunnel. The position of a damaged (bottom row). quadrotor can be controlled in the presence of signiﬁcant wind disturbances. A linear quadratic regulator (LQR) approach from the literature has been compared to demonstrate the advantages of the proposed nonlinear method in the windy and high-speed ﬂight condition. Index Terms—Air safety, Fault tolerant control, Nonlinear control systems, Unmanned aerial vehicles I. INTRODUCTION Multi-rotor drones have demonstrated their ability in a large variety of applications such as surveillance, delivery, and recreation. Due to the potential growth of the drone market in the coming decades, safety issues are of critical concern. Apart from sensor redundancies, and improving operational Fig. 2: Snapshot of the tested quadrotor in the wind tunnel, regulations, fault-tolerant control (FTC) is a key to improving with removal of rotor 1 and 3. The ﬂight video can be found safety in the face of unexpected structural and actuator failures. via https://youtu.be/-4rXX4D5HlA Among diﬀerent types of multi-rotor drones, quadrotors excel in their structural simplicity. However, they suﬀer more from actuator damages due to a lack of actuator redundancy. proposed by  indicates that the hovering ﬂight of a Partial damage on the rotors could result in the reduction quadrotor is possible with a loss of up to three rotors. With a of control eﬀectiveness, which has been extensively studied specially designed conﬁguration, a vehicle with only a single in the literature (e.g., , , , ). A more challenging rotor is tested using LQR with actuator saturations taken into problem is the complete loss of one or more rotors (Fig. 1). account  . Various control methodologies addressing this problem have The aforementioned literature assumes that the drone is been proposed and validated in simulations (e.g., , , , operated around the hovering condition and only limited aero- , , ). dynamic eﬀects are considered such as the rotational damp- In-ﬂight validations have been achieved by several pieces of ing , . However, in out-door applications, signiﬁcant research where linear control methods were mostly adopted, aerodynamic forces/moments on the quadrotor are present due such as linear quadratic regulator (LQR) , proportional- to fast cruising speed and large wind disturbances , . integral-derivative (PID) control  and linear parameter The system nonlinearity also becomes more signiﬁcant due varying (LPV) control . The relaxed hovering solution to the complex variation of rotor aerodynamic characteristics The authors are with Control and Simulation Section, Faculty in high-speed conditions. Therefore, designing a high-speed of Aerospace Engineering, Delft University of Technology, 2629 HS capable robust nonlinear controller is essential for expanding Delft, The Netherlands (e-mail: firstname.lastname@example.org; email@example.com; firstname.lastname@example.org; email@example.com) the ﬂight envelope of a quadrotor subjected to rotor failures, arXiv:2002.07837v2 [cs.RO] 26 Oct 2020 IEEE TRANSACTIONS ON ROBOTICS. PREPRINT VERSION. DOI: 10.1109/TRO.2020.3010626. © 2020 IEEE 2 and increasing its robustness against wind disturbances. II. Problem Formulation Incremental nonlinear dynamic inversion (INDI) is a sensor- A. Quadrotor Kinematic and Dynamic Model based nonlinear control approach that makes use of sen- There are two coordinate systems considered in this work. sor measurements to reduce its model dependency, thereby The inertial frame F =f𝑂 𝒙 𝒚 𝒛 g, is ﬁxed to the ground, I 𝐼 𝐼 𝐼 improving its robustness against model uncertainties. This with 𝒙 , 𝒚 and 𝒛 pointing to the north, east and aligning 𝐼 𝐼 approach has been adopted by the aviation industry in several with the local gravity. The body frame F =f𝑂 𝒙 𝒚 𝒛 g B 𝐵 𝐵 𝐵 applications, such as the control of ﬁxed-wing aircraft , is ﬁxed to the vehicle, with the origin located at the center spacecrafts , helicopters  and multi-rotor drones , of mass. As Fig. 1 shows, we assume the quadrotor has a , . In , we made use of the INDI controller symmetric fuselage, which is a common conﬁguration for to control a quadrotor with a single rotor failure in the many commercially available quadrotors. As a convention, we wind tunnel. The control method has shown its advantage in deﬁne 𝒙 points forward, 𝒛 points downwards such that the 𝐵 𝐵 providing robustness to large aerodynamic disturbances while drone inertia is symmetric with respect to the 𝒙 𝒛 plane, 𝐵 𝐵 simplifying gain tuning, and eliminating the need to calculate and 𝒛 is parallel with the thrust direction. 𝒚 thus points an equilibrium for linear controller design. rightwards to render F a right-handed coordinate system. In 𝐼 𝐵 However, the INDI controller relies on a dynamic inversion the following context, the superscript »¼ and »¼ indicate step. This step requires the number of inputs to be no less the coordinate system in which a vector is expressed. than the number of outputs. For a quadrotor with only two The equations of motion of a quadrotor are formulated as opposing rotors remain, the attitude control problem becomes follows: under-actuated where the direct inversion is inapplicable. For 𝑷 = 𝑽 (1) this reason, we need to redesign the original control outputs of 𝐼 𝐵 𝑚 𝑽 = 𝑚 g ¸ 𝑹𝑭 (2) a quadrotor such as the thrust and attitudes. This subsequently 𝑣 𝑣 results in several internal dynamics of which the stability needs 𝑹 = 𝑹𝛀 (3) to be guaranteed. The selection of the outputs ensuring stable internal dynamics has been addressed on some under-actuated 𝐵 𝐵 𝐵 𝑰 𝛀 = 𝛀 𝑰 𝛀 ¸ 𝑴 (4) 𝒗 𝒗 control problems, e.g., wheeled mobile robots , quadrotor 𝐼 𝐼 𝑇 𝑇 where 𝑷 = »𝑋 𝑌 𝑍¼ and 𝑽 = »𝑉 𝑉 𝑉 ¼ represent position control , and the attitude control of space aircraft 𝑥 𝑦 𝑧 the position and the velocity of the center of mass in F ; 𝑚 . I 𝑣 is the vehicle gross mass and 𝑰 denotes the inertia matrix The main theoretical contributions of this research are of the vehicle including rotors. 𝒈 is the local gravity vector. twofold: (1) A detailed analysis of the internal dynamics of 𝑹2 SO¹3º indicates the transformation matrix from F to F . B I quadrotors with complete loss of two opposing rotors; (2) A 𝐵 𝑇 The angular velocity is expressed as 𝛀 = »𝑝 𝑞 𝑟¼ where 𝑝, subsequent novel robust fault-tolerant control method imple- 𝑞 and 𝑟 denote pitch rate, roll rate and yaw rate respectively. menting the INDI approach. The controlled quadrotor thereby 𝛀 is the skew symmetric matrix such that 𝛀 𝒂 = 𝛀 𝒂 for suﬀers less from model uncertainties caused by signiﬁcant any vector 𝒂 2 R . aerodynamic eﬀects during high-speed ﬂight. 𝐵 𝐵 The variables 𝑭 and 𝑴 denote the resultant force and To validate the proposed controller, ﬂight tests of a quadro- moment on the center of mass respectively, projected on F . tor with failure of two opposing rotors have been performed For a quadrotor with thrust parallel to the 𝒛 axis and rotor in an open jet wind tunnel (Fig. 2). With limited information directions shown in Fig. 3, we have on the model, the controller is able to stabilize the damaged quadrotor in wind of over 8 m/s, which is more than half of 2 3 6 7 its nominal maximum ﬂight speed. This could signiﬁcantly 𝐵 6 7 𝑭 = 0 ¸ 𝑭 (5) 6 7 increase the safety of quadrotors by expanding the ﬂight enve- 4 6 7 𝘅 ¯ 𝜔 4 𝑖=1 𝑖 5 lope under actuator failure conditions. With slight adaptation, 2 3 the same control scheme can be used on a quadrotor with a 2 3 6 7 𝑏 sin𝛽 𝑏 sin𝛽 𝑏 sin𝛽 𝑏 sin𝛽 6 7 6 7 single rotor failure for which the internal dynamics are proved 6 7 6 2 7 𝑏 cos𝛽 𝑏 cos𝛽 𝑏 cos𝛽 𝑏 cos𝛽 𝑴 = 𝘅 ¯ 6 7 6 7 to be inherently stable. A benchmark approach (LQR) has 6 7 6 3 7 𝜎 𝜎 𝜎 𝜎 been compared to demonstrate the advantage of the proposed 4 5 6 2 7 4 4 5 controller in the high-speed and windy ﬂight conditions. 2 3 2 3 𝐼 𝑞¹𝜔 𝜔 ¸𝜔 𝜔 º 0 𝑝 1 2 3 4 6 7 6 7 6 7 6 7 This paper is organized as follows. Section II provides ¸ 𝐼 𝑝¹𝜔 𝜔 ¸𝜔 𝜔 º ¸ 0 ¸ 𝑴 𝑝 1 2 3 4 6 7 6 7 6 7 6 7 information on the quadrotor model and the reduced attitude 𝐼 ¹𝜔¤ 𝜔¤ ¸𝜔¤ 𝜔¤ º 𝛾𝑟 𝑝 1 2 3 4 4 5 4 5 control. Section III introduces the INDI controller and Sec- (6) tion IV directly provides the detailed controller design for where 𝘅 ¯ is a thrust coeﬃcient valid in the hovering condition; a quadrotor with failure of two opposing rotors. Section V 𝜎 is a constant ratio between the thrust coeﬃcient and drag elaborates on the selection of control outputs and the stability coeﬃcient of the rotor; 𝑏 and 𝛽 are geometry parameters as of internal dynamics. Section VI generalizes the proposed Fig. 3 shows. Note that 𝛽 2 ¹0 𝜋2º for a quadrotor. 𝝎 = method to the single-rotor-failure and the nominal conditions. »0 0 𝜔 ¼ is the angular speed of the 𝑖-th rotor with respect Finally, Sections VII and VIII demonstrate the ﬂight test results to the body. 𝐼 denotes the moment of inertia of each rotor in low-speed and high-speed ﬂight conditions respectively. about the rotational axis. Note that this model assumes that IEEE TRANSACTIONS ON ROBOTICS. PREPRINT VERSION. DOI: 10.1109/TRO.2020.3010626. © 2020 IEEE 3 The other selections of 𝒏 may be considered for the case with single rotor failure, which has been discussed in , . The challenge of the problem is conducting relaxed attitude control of a quadrotor with only two opposing rotors remain in the presence of signiﬁcant model uncertainties 𝑭 and 𝑴 , 𝑎 𝑎 for instance, in high-speed ﬂight conditions where signiﬁcant aerodynamic eﬀects become apparent. To achieve this goal, we employ a sensor-based nonlinear control method to be described in Sec. III. The detailed implementation of this method will be provided in Sec. IV. Fig. 3: Deﬁnition of geometry parameters, rotor index and directions, and the body frame F . III. Methodology Incremental nonlinear dynamic inversion (INDI) is a sensor- jj𝛀jj jj𝝎 jj, thus the magnitude of rotor angular speed with based nonlinear control approach. The approach stems from respect to the air is approximated by 𝜔 . Symbol jjjj is deﬁned the nonlinear dynamic inversion (NDI) control. INDI reduces as the 𝐿 norm of a vector. 𝛾 in (6) indicates the aerodynamic the model dependencies of NDI by replacing non-input related yaw damping coeﬃcient , . model terms with direct sensor measurements, or sensor In the high-speed ﬂight condition, there are signiﬁcant measurement derived quantities, thereby greatly improving aerodynamic eﬀects such as thrust variation , rotor in- robustness against model uncertainties. plane force , rotor moment and airframe aerodynamic . For aircraft systems, including nominal quadrotors, each These additional aerodynamic related forces and moments are sub-problem (e.g., the attitude and rate control loops) is fully then expressed as 𝑭 and 𝑴 in (5) and (6). They are regarded 𝑎 𝑎 actuated without internal dynamics to be analyzed , , as model uncertainties that need to be compensated for by the . However, for a quadrotor with failure of two opposing robustness of the control method. rotors, the number of control inputs is less than the required output in a conventional cascaded control setup, yielding B. Reduced Attitude Control internal dynamics that have to be stabilized. In the following context, the generalized INDI control considering internal The concept of reduced attitude control  has been dynamics will be brieﬂy reviewed. Readers may refer to  adopted by  in the quadrotor fault tolerant control problem. and  for further details. We hereby brieﬂy introduce the concept. For a quadrotor with complete rotor failures, the full state Consider a nonlinear input-aﬃne system equilibrium becomes unattainable. This is due to the incapacity 𝒙¤ = 𝒇¹𝒙º¸ 𝑮¹𝒙º𝒖 of the remaining rotors to generate zero yaw moment while (9) 𝒚 = 𝒉¹𝒙º producing necessary thrust. As a consequence, the vehicle spins around the yaw axis. And the attitude control is reduced 𝑛 𝑛 𝑛 𝑙 where 𝒇 : R ! R and 𝒉 : R ! R are smooth vector ﬁelds. to a thrust vector pointing problem without considering the 𝑛 𝑛𝑚 𝑮 : R ! R is a function mapping with smooth vector yaw angle. ﬁelds as columns. The number of outputs is not larger than Deﬁne a unit vector 𝒏 ﬁxed to F where 𝒏 = the number of inputs (i.e., 𝑙 𝑚). There exists a nonlinear 𝐵 𝐵 𝐵 𝑇 »𝑛 𝑛 𝑛 ¼ . For a quadrotor with failure of two opposing 𝑥 𝑦 𝑧 𝑛 𝑛 transformation 𝑻 : R ! R such that the states 𝒙 can be 𝐵 𝑇 rotors, choosing 𝒏 = »0 0 1¼ is most energy-eﬃcient transformed to the normal form including internal states 𝜼 and  where 𝒏 aligns with the instantaneous thrust direction. external states 𝝃: Deﬁne another unit vector 𝒏 as the reference of 𝒏, which is calculated by the position controller or remotely provide by 𝜼 𝝓¹𝒙º = = 𝑻¹𝒙º (10) a pilot. Then aligning 𝒏 with 𝒏 (or vise versa) becomes the 𝝃 𝜽¹𝒙º primary task of the attitude controller. Therefore, we introduce where the following relaxed attitude kinematic equation:  𝜽¹𝒙º = »𝜽 ¹𝒙º 𝜽 ¹𝒙º 𝜽 ¹𝒙º¼ (11) 1 2 𝑙 𝐵 𝐵 𝑇 𝐼 ¤ ¤ 𝒏 = 𝛀 𝒏 ¸ 𝑹 𝒏 (7) 𝑑 𝑑 𝑑 with 𝐵 𝑇 𝑇 𝐼 With the expressions 𝒏 = »ℎ ℎ ℎ ¼ and 𝑹 𝒏¤ = 1 2 3 𝑑 𝑑 𝑇 𝜌 1 »𝘆 𝘆 𝘆 ¼ , the expanded formula of (7) can be given as: 1 2 3 𝜽 ¹𝒙º = »ℎ ¹𝒙º 𝐿 ℎ ¹𝒙º 𝐿 ℎ ¹𝒙º¼ 𝑖 = 1 2𝑙 (12) 𝑖 𝑖 𝑓 𝑖 𝑖 2 ¤ 3 2 3 2 3 2 3 ℎ 0 𝑟 𝑞 ℎ 𝘆 1 1 1 6 7 6 7 6 7 6 7 where ℎ ¹𝒙º indicates the 𝑖th element in the vector ﬁeld 𝒉. 6 ¤ 7 6 7 6 7 6 7 ℎ = 𝑟 0 𝑝 ℎ ¸ 𝘆 (8) 𝜌 2 2 2 6 7 6 7 6 7 6 7 The notation 𝐿 ℎ ¹𝒙º indicates the 𝜌 th order Lie derivative 𝑖 𝑖 6 ¤ 7 6 7 6 7 6 7 ℎ 𝑞 𝑝 0 ℎ 𝘆 3 3 3 4 5 4 5 4 5 4 5 of the function ℎ with respect to the vector ﬁelds 𝒇¹𝒙º . To align 𝒏 with 𝒏 , we can control ℎ and ℎ to track 𝜌 indicates the relative degree of the 𝑖th output 𝑦 . 𝑑 1 2 𝑖 𝑖 𝐵 𝐵 𝑛 and 𝑛 respectively. To be speciﬁc, with the selection of By deﬁning 𝜌 ¯ = Σ 𝜌 as the sum of relative degrees 𝑥 𝑦 𝑖 𝐵 𝑇 𝒏 = »0 0 1¼ , ℎ and ℎ need to be stabilized to zero. of each output, one can deﬁne the transformation 𝝓¹𝒙º = 1 2 IEEE TRANSACTIONS ON ROBOTICS. PREPRINT VERSION. DOI: 10.1109/TRO.2020.3010626. © 2020 IEEE 4 »𝜙 ¹𝒙º 𝜙 ¹𝒙º 𝜙 ¹𝒙º¼. The selection of 𝝓¹𝒙º is not 1 2 𝑛