Learning Pugachevs Cobra Maneuver for Tail-sitter UAVs Using Acceleration Model

The Pugachev's cobra maneuver is a dramatic and demanding maneuver requiring the aircraft to fly at extremely high Angle of Attacks (AOA) where stalling occurs. This paper considers this maneuver on tail-sitter UAVs. We present a simple yet very effe…

Authors: Wei Xu, Fu Zhang

Learning Pugachevs Cobra Maneuver for Tail-sitter UAVs Using   Acceleration Model
IEEE R OBO TICS AND A UTOMA TION LETTERS. PREPRINT VERSION. A CCEPTED FEBR U AR Y , 2020 1 Lear ning Pugache v’ s Cobra Maneuver f or T ail-sitter U A Vs Using Acceleration Model W ei Xu 1 , Fu Zhang 1 Abstract —The Pugachev’ s cobra maneuver is a dramatic and demanding maneuver requiring the aircraft to fly at extremely high Angle of Attacks (A O A) where stalling occurs. This paper considers this maneuver on tail-sitter U A Vs. W e present a simple yet very effective feedback-iterativ e learning position control structure to regulate the altitude error and lateral displacement during the maneuver . Both the feedback controller and the iterative lear ning controller ar e based on the aircraft accel- eration model, which is directly measurable by the onboard accelerometer . Moreover , the acceleration model leads to an extremely simple dynamic model that does not require any model identification in designing the position controller , greatly simplifying the implementation of the iterative learning control. Real-world outdoor flight experiments on the “Hong Hu” U A V , an aerobatic yet efficient quadrotor tail-sitter U A V of small-size, are provided to show the effectiveness of the proposed controller . I . I N T R O D UC T I O N V ER TICAL takeoff and landing (VTOL) UA Vs hav e caught increasing attention these years due to their unique ability to take off and land vertically like a rotorcraft and achieve efficient long-range level flight like a fixed-wing aircraft [1]. Se veral VT OL U A Vs, including tilt-rotor [2], tilt-wing [3] and tail-sitter [4], are proposed and researched. Among those configurations, the tail-sitter VTOL has probably the most concise structure that contains no tilting mechanism [5]. Moreov er , with the optimal design of its aerodynamics and propulsion systems [6], a tail-sitter UA V achiev es superior flight efficienc y . These features make a tail-sitter UA V ideally suitable for almost all field applications where maneuv erability and flight range are two indispensable elements. The Pugache v’ s Cobra maneuver is a long-existing maneu- ver in fix ed-wing aircraft, where the aircraft flying at high speed suddenly rises its nose momentarily to the v ertical orientation and then drops it back to the normal angle, as shown in Fig. 1. Achieving the Pugachev’ s Cobra maneuvers for small-size tail-sitter UA Vs has many practical benefits. For example, in a surv eying task, it is usually preferable if the U A V could slow down at a particular location of interests, capturing more data (e.g., images), and then accelerate to the next one. Unlike the Pugachev’ s Cobra maneuvers for fighter jets, where slight altitude increment is not of concern, or e ven preferable (Fig. 1), it is usually required for a tail-sitter VTOL UA V of civilian-use to constantly maintain its altitude, to av oid any collision with the en vironments. Manuscript received September 9, 2019; revised December 19, 2019; accepted February 10, 2020. This paper was recommended for publication by Editor Jonathan Roberts upon ev aluation of the Associate Editor and Revie wers’ comment. This work was supported in part by a DJI donation and in part by a HKU seed fund for ne w staff. 1 authors are with the Mechatronics and Robotic Systems (MaRS) Lab- oratory , Department of Mechanical Engineering, University of Hong Kong, China. { xuweii, fuzhang } @hku.hk Digital Object Identifier (DOI): see top of this page. 2 https://en.wikipedia.org/wiki/Pugache v Fig. 1. The Pugache v’ s Cobra Maneuver 2 . Although there are a few prior work on the control of fixed- wing U A Vs in post-stall maneuvers, such as [7]–[9], none of them directly cope with the Pugache v manuever . Another way is to view this maneuver as a backward transition (from le vel flight to vertical flight) immediately followed by a forward transition (from vertical flight to level flight). For the control of the transition flight, a large number of researches could be found. In [10], three transition controllers were in vestigated and compared on a model Conv air XFY -1 Pogo. They are a simple controller based on a vector-thrust model, a feed- back linearization controller, and a model reference adaptiv e controller (MRA C), respecti vely . All three controllers did not consider the lateral motion. Pucci et al . [11] proposed an equiv alent transformation from the original system dynamics to the one that is independent of the aircraft’ s attitude, enabling the controller to separately compute the thrust and orien- tation, which will considerably reduce the controller design complexity . In [12], the minimum time and minimum energy optimization problems of VTOL transition were presented and solved numerically . Oosedo et al . [13] discussed three transi- tion strategies: standard PID feedback control, minimizing the transition time, minimizing the transition time while regulating the altitude. The latter two strategies are designed based on the aerodynamic model from the wind tunnel test. Ritz et al . [14] proposed a global controller for a dual-rotor tail-sitter based on the coordinate flight assumption and also did not focus on the accurate altitude control. Smear et al . [15] implemented an incremental nonlinear dynamic in version controller for the attitude and position control, which has an altitude error of 2 m in outdoor flight test. In these mentioned works, the altitude change of the tail-sitter UA V in a transition is usually not satisfactory . The best of them [13] has an altitude change of around 40 cm . Moreover , these methods usually require to know an accurate aerodynamic model of the U A V , and one needs to conduct costly wind tunnel tests. Furthermore, all these methods are designed for a single transition while the performance of the Cobra maneuver in volving two consecutiv e quick transitions could worsen. W e consider the direct control of Pugachev’ s Cobra maneu- ver with tail-sitter U A Vs. Our contributions are threefold: (1) A complete position control system consisting of both altitude control and lateral control, which was usually neglected in the prior work [10]–[13, 16]; The key idea is the use of the acceleration model, which hides the underlying U A V dynamics 2 IEEE ROBO TICS AND A UTOMA TION LETTERS. PREPRINT VERSION. ACCEPTED FEBRU ARY , 2020 Fig. 2. The Hong Hu quadrotor tail-sitter U A V . (e.g., motor delay , flexible modes) from the position controller design by using the U A V attitude and body-X acceleration as the virtual control. These virtual control are then tracked by underlying attitude and acceleration controllers in [17]. (2) An iterativ e learning controller (ILC) that improves the Cobra ma- neuver’ s altitude accuracy through past iterations. Compared to existing ILC methods [18]–[20] and transition controllers of tail-sitters [11, 13, 21], a notable advantage of our method is that it builds on the acceleration model used in the baseline position controller and does not require to identify any of the aircraft model parameters (e.g., aerodynamic coefficients), greatly simplifying its design and implementation on actual systems; (3) Implementation of the whole algorithm on actual tail-sitter U A Vs (see Fig. 2) and accomplishment of the lowest altitude change (e.g., less than 30 cm , which is within the noise lev el of typical altitude measurement) reported in the literature so far . The remainder of this paper is organized as follows. Section II will introduce the platform and the acceleration model. The detailed design of the controller will be described in section III. The iterati ve learning control algorithm will be described in section IV . Experimental results are provided in section IV . Finally , section V draws the conclusion. I I . S Y S T E M C O N FI G U R A T I O N Our tail-sitter U A V is called “Hong Hu” U A V , which con- sists of a trapezoidal wing with MH-115 airfoil for improv ed aerodynamic efficiency , a fuselage containing most of the avionics, and four landing gears with four rotors. Unlike con ventional fixed-wing aircraft, the UA V does not hav e any aileron or elevator , making the propeller differential thrusts the only source of control moments. The lack of control flaps and associated servo motors bring se veral benefits, such as reduction of dead weight, an increase of flight efficienc y due to the remo val of gaps between wing and flaps, and simplified controller design without carefully allocating the actuation among rotors and ailerons. The Hong Hu U A V is manufactured with carbon fiber, which leads to improved stiffness and strength of the structure. The flight tests show that the high-speed level flight of the Hong Hu UA V is fi ve times more efficient than that in hovering [6], while still being very portable with a 0 . 9 m wingspan. The full specifications of “Hong Hu” U A V are specified in the T able I. All the flight controller software is running on a Pixhawk 4 Mini controller board [22]. The flight sensors include an onboard inertial measurement unit (IMU), a GPS/GNSS module, and a pitot tube airspeed sensor [23]. All the sensor T ABLE I A I RC R A F T S P EC I FI C A T I O N Battery 5000 mAh W ingspan 0 . 90 m Cruise Speed 19 m/s Payload 0 . 2 kg W eight (with payload) 1 . 8 kg Range (with payload) 30 km data are fused within an extended Kalman filter [24] to produce the position, attitude, and velocity estimates. A. Definition of Coor dinate F rames The inertial frame ( x I y I z I ) 3 is defined in Fig. 3, the axis x I , y I and z I points to the North, East and Down (NED), respectiv ely . For the body frame, the axis x B points to the aircraft’ s nose, and y B points to the right of the body , then z B is defined by right-hand rule. Fig. 3. Definations of the body and inertial frames. B. Acceleration Model The position of the aircraft is denoted as p I =  p I x , p I y , p I z  T . The angular velocity vector represented in the body frame is ω B . The total mass of the aircraft is m . Based on the rigid body assumption and the Newton’ s second law of motion, translational dynamics of the aircraft can be modeled as follows ¨ p I = a I g + Ra B (1) where a I g = [0 , 0 , g ] T is the gravity acceleration, the a B =  a B x , a B y , a B z  T is the specific acceleration that comprises of the motor thrusts and all the aerodynamic forces. It should be noticed that the specific acceleration is directly measurable by an accelerometer in IMU [25]. The R is the rotation matrix from body frame to inertial frame. W ithout loss of generality , assume that the desired flight path of the Cobra maneuver is along x I direction, which is also the initial direction of z B of the aircraft (Fig.3). Therefore the initial attitude R 0 is as follow: R 0 =   0 0 1 0 1 0 − 1 0 0   (2) During the Cobra maneuver , the U A V transits to level flight by rotating along its body-Y axis by angle θ . In this process, the U A V may deviate from the disired path due to disturbances in the environment (e.g., wind). T o correct this de viation, the UA V rotates along its body-Z axis ( z B pointing to the aircraft belly) by angle η , such that the propeller thrust is 3 Throughout the text the superscript I and B will be used to denote the inertial and body frame, respectively . XU et al. : LEARNING PUGA CHEV’S COBRA MANEUVER FOR T AIL-SITTER U A VS USING A CCELERA TION MODEL 3 D e s i r e d P a t h ζ l η p ld θ p ld (a) (b) Fig. 4. (a) Body-X acceleration a B x and its two orthogonal components: a xp and a l . It should be noted that a l is perpendicular to three vectors: the desired path (as a l should maximally suppress the lateral deviation), the z I axis (as a l is in the horizontal plane), and the z B (as a l is the component of a B x perpendicular to the plane of o - z B - z I ). a xp is the component of a B x within the plane o - z B - z I . This component will affect the U A V altitude. (b) The accelerations of the UA V in the o - z B - z I plane. a B z is the acceleration in body-Z axis, a xp is the component of a B x , the acceleration in body-X axis, projected to the o - z B - z I plane, and a I g is the gravity . projected to the lateral direction to compensate the lateral deviation. As a consequence, the UA V rotation matrix is naturally parameterized by two consecutive rotations R y ( θ ) , and R z ( η ) after the initial attitude R 0 : R = R 0 R y ( θ ) R z ( η ) =   − sin( θ ) cos( η ) − sin( θ ) sin( η ) cos( θ ) sin( η ) cos( η ) 0 − cos( θ ) cos( η ) cos( θ ) sin( η ) − sin( θ )   (3) Putting (3) into (1) leads to: ¨ p I y = a B x sin( η ) + a B y cos( η ) ¨ p I z = g − a B x cos( θ ) cos( η ) + a B y cos( θ ) sin( η ) − a B z sin( θ ) (4) where the dynamics in inertial X direction is omitted (see section III. A). It is clearly seen from (4) that, the component a l = a B x sin( η ) solely af fects the lateral motion and the component a xp = a B x cos( η ) solely affects the altitude. These two acceleration components will be used as the virtual control action for the lateral and altitude controllers, respectively , as detailed in the next section. The relation between a B x , a l , and a xp are illustrated in Fig.4. Using the new notations, the aircraft model is re written as: ¨ p I y = a l + a B y cos( η ) ¨ p I z = g − a xp cos( θ ) + a B y cos( θ ) sin( η ) − a B z sin( θ ) (5) Equation (5) is the acceleration model used for the lateral controller and altitude controller design. There are sev eral benefits of this acceleration model: 1) W ith the acceleration model, the UA V translation dynamics are linear to the two virtual control action a xp and a l , and does not depend on any model parameters (e.g., aerodynamic coefficients, etc.). This greatly simplifies the controller design; 2) The acceleration is easily measurable by IMU sensors, which are almost always av ailable for any U A Vs; 3) The body-X acceleration is inde- pendently controlled by the collective thrust of the four rotors. I I I . F E E D B AC K C O N T R O L L E R D E S I G N A. Contr oller Structur e The controller structure for the Pugachev’ s Cobra maneuver is sho wn in Fig. 5. The navigation module generates the desired altitude p z d , which is a constant value for a Pugache v’ s Cobra maneuver , and the desired flight path p ld , which is a straight line in the horizontal plane (see Fig. 4). It also directly sends the desired pitch angle θ d according to a prescribed tra- jectory . Linearly decreasing/increasing pitch profiles are used to test the designed controllers albeit smoother trajectories could lead to better tracking peformance. In cases where precise forward position (i.e., range) needs to be activ ely controlled, an additional feedback controller viewing the pitch angle as virtual control action could be employed, which is not considered in this work though. Navi gat ion Module L a t e r a l C ont r ol l e r Al t i t ud e C ont r ol l e r At t i t ud e C o nt r ol l e r B ody- X Ac c e l e r a t i on C o nt r ol l e r Ta il - si tte r Pla n t η d = a rc t a n ( a ld a xpd ) a x d Β = √ a x p d 2 + a l d 2 τ d Fig. 5. The proposed controller structure. The altitude controller (section III. B) and lateral controller (section III. C) will respectiv ely use the a xp and a l as their virtual control actions (see Equation (5)) and compute their desired values, a xpd and a ld , the detail of each controller will follow in next subsections. With the desired value of the two orthogonal components, a xpd and a ld , the total specific acceleration along body-X axis, a B x , and the angle η are expected to be: a B xd = q a 2 xpd + a 2 ld (6) η d = arctan  a ld a xpd  (7) The desired body-X acceleration, a B xd , is then fed to a lower lev el acceleration controller (section III. D) which computes the collective throttles of the four rotors. The desired rotation angle η d , together with the desired pitch angle θ d , are used to compute the desired attitude: R d = R 0 R y ( θ d ) R z ( η d ) , which is then sent to a lower-le vel attitude controller (section III.D) for attitude tracking. B. Altitude Contr oller Based on the altitude dynamics in (5), the proposed altitude controller consists of a feedforward controller compensating any exogenous input and a feedback controller stabilizing the altitude error (see Fig. 6). The total control action for the altitude controller is: F ee d - F orw ard + - F ee d - B ac k B ody- X Ac c e l e r a t i on C o nt r ol l e r Ta il-sit te r P l ant a x d Β = √ a x p d 2 + a l d 2 A t t i t ude C o nt r ol l e r η d = a r c t a n ( a ld a xpd ) τ d A lt i tu d e C o nt r o ll e r Fig. 6. The structure of altitude controller . a xpd = a f f + a f b cos( θ ) (8) 4 IEEE ROBO TICS AND A UTOMA TION LETTERS. PREPRINT VERSION. ACCEPTED FEBRU ARY , 2020 where, a f f = − ¨ p I z d + g − a B z sin( θ ) + a B y cos( θ ) sin( η ) (9) a f b = k p ξ p + k v ξ v (10) where the p I z d is the desired altitude; ξ p = p I z d − p I z and ξ v = ˙ p I z d − v I z is the altitude error and vertical velocity error, respectiv ely; k p and k v are the proportional and deriv ativ e gains of the feedback controller . W e analyze the stability of the designed controller in the frequency domain [26]. Assume the transient response of the acceleration controller is denoted as a transfer function G ( s ) , then: a xp ( s ) = G ( s ) a xpd ( s ) (11) where a xp ( s ) and a xpd ( s ) is the Laplace transform of a xp and a xpd . Putting (11) back into the acceleration model (5) yields: s 2 ξ p ( s ) = (1 − G ( s )) a f f − G ( s ) C ( s ) ξ p ( s ) (12) where C ( s ) = k p + k v s is the transfer function of the feedback controller in (10); The loop transfer function of the system is therefore as follow: H ( s ) = C ( s ) s 2 G ( s ) (13) T o analyze the stability of this system, we in vestigate the nominal loop transfer function H n ( s ) = C ( s ) /s 2 . As shown in the Bode plot of H n ( s ) in Fig. 7, the designed controller has 0 . 24 H z bandwidth and a phase margin of 81 ◦ , meaning that the position control loop is stable even when adding an up to 0 . 9 s pure delay into the G ( s ) . This pure delay margin is much higher than needed, sho wing the sufficient robustness margin of our position controller . Readers may refer to [26] for more details on the frequency-domain based stability analysis. - 50 0 50 Ma g n i t u d e (d B ) 10 - 2 10 - 1 10 0 10 1 - 270 - 225 - 180 - 135 - 90 - 45 0 P h a s e (d e g ) F req u en c y ( H z ) - 50 0 50 Ma g n i t u d e (d B ) 10 - 2 10 - 1 10 0 10 1 - 270 - 225 - 180 - 135 - 90 - 45 0 P h a s e (d e g ) F req u en c y ( H z ) - 50 0 50 Ma g n i t u d e (d B ) 10 - 2 10 - 1 10 0 10 1 - 270 - 225 - 180 - 135 - 90 - 45 0 P h a s e (d e g ) F req u en c y ( H z ) Fig. 7. Bode plot of the nominal loop transfer function of the altitude control loop C. Lateral Contr oller Based on the lateral dynamics in (5), we propose the following proportional controller: a ld = k l ξ l (14) where ξ l is the lateral error , k l is the gain of lateral con- troller . This proportional controller acting on the U A V lateral dynamics with the inherent aerodynamic damping effect [27] ( a B y = k a v ˙ ξ l ; k a v > 0 ) forms a second order system, whose stability in the presence of transient response of the lower- lev el acceleration controllers can be shown following the same procedures as that in the altitude control loop. D. The Attitude and Body-X Acceleration Controller s The desired attitude R d and acceleration a B xd computed by the position controllers are tracked by two lower -lev el controllers, respectiv ely . T o achiev e this task, we directly use the method in [17]. The attitude controller is a dual-loop control structure where the outer loop is a quaternion-based attitude controller that operates in the full Special Orthogonal group S O (3) . The inner loop consists of three independent angular rate controllers that are designed with loop-shaping techniques. The detailed structure and stability analysis of the attitude controller can be found in [17]. The body-X acceleration controller is also detailed in [17]. Its main structure is shown in Fig.8, where the low pass filter is used to suppress the noise that is prev alent in IMU measure- ments. The PI controller is used to make sure the command tracking performance. The P denotes the plant dynamic from thrust command u T to actual body-X acceleration. P P I L ow - P as s Fig. 8. The structure of body-X axis acceleration controller . It should be noted that although the attitude controller and body-X acceleration controller in volves much model identifi- cation in the frequency domain, as shown in [17], they do not affect the position controller (both the baseline controller in section. III and the ILC controller in section. IV). I V . I T E R A T I V E L E A R N I N G S T R A T E G Y The attitude controller designed in the pre vious section, ev en with the feedforward corrections, usually cannot track the constant altitude command with satisfactory performance due to en vironmental disturbances and the transient response of the lower level acceleration controller (i.e., G ( s ) ). T o track the desired path precisely , an iterative learning feedforward controller is further utilized to the altitude controller , as shown in Fig.9. F ee d - F orw ar d + - F ee d - B ack B ody- X Ac c e l e r a t i on C o nt r ol l e r Tai l-sit ter P l ant a xd Β = √ a xpd 2 + a ld 2 At t i t ude C o nt r ol l e r η d = a rc t a n ( a ld a xpd ) τ d I LC + Fig. 9. Adding the ILC correction to the altitude controller . A. Lifted Domain Model The first step of using the iterative learning algorithm is obtaining a lifted domain model near the desired trajectory . In this paper , the altitude error ξ p and the vertical velocity ξ v in the inertial frame are chosen to compose the state vector x : x = [ ξ p , ξ v ] T , y = ξ p (15) When the iterati ve learning correction u I LC is added to the altitude controller , (8) is re written as: a xpd = a f f + a f d + u I LC cos( θ ) (16) XU et al. : LEARNING PUGA CHEV’S COBRA MANEUVER FOR T AIL-SITTER U A VS USING A CCELERA TION MODEL 5 As shown in [19], an ILC uses a nominal model of the closed-loop system to estimate the external disturbances. The error due to the model mismatch is lumpped into disturbances and will be attenuated via iterations. In our design, the nominal model is obtained by neglecting the transient response (i.e., G ( s ) = 1 ) in (13). As a result, ˙ x = Ax + B u I LC y = C x A =  0 1 − k p − k v  , B =  0 1  , C = [1 , 0] (17) The corresponding closed-loop state equation in discrete time domain is: x ( k + 1) = A d x ( k ) + B d u I LC ( k ) y ( k + 1) = C d x ( k ) (18) where k ∈ { 0 , 1 , ..., N } is the discrete-time index, ∆ t is the sampling time, A d = I + A ∆ t , B d = B ∆ t and C d = C . In the actual flight, the lifted domain [20] input vector is de- noted as U =  u I LC (0) , ..., u I LC ( N − 1)  T ∈ U ⊂ R N , the state vector is denoted as X =  x (0) T , ..., x ( N − 1) T  T ∈ U ⊂ R 2 N , the output vector is denoted as Y = [ y (0) , ..., y ( N − 1)] T ∈ U ⊂ R N . The desired trajectory is denoted as the desired trajectory  U des , X des , Y des  . For the ideal Pugachev’ s Cobra, Y des = 0 N × 1 . The initial trajectory where no iterativ e control input is used (i.e. u I LC ( k ) = 0 , k = 1 , 2 , ..., N ) is denoted as  U init = 0 N × 1 , X init , Y init  . These lifted domain notations allows us capture the dynamic relation between input, state, and output by a simple linear mapping: Y = F U + d (19) where the F is computed by (20), d is the unknown repetitiv e disturbance along the trajectory , which is primarily caused by unmodeled dynamics (e.g., transient response of the lower - lev el acceleration controller) and steady en vironmental distur- bances (e.g., wind, etc.). F =      0 ... 0 0 C d A d B d ... 0 0 . . . . . . . . . . . . C d A N − 1 d B d ... C d A d B d 0      (20) It should be noticed that the model in (20) is exactly known, in volving no aerodynamic parameters that require additional effort (e.g., costly wind tunnel test, model identification by flight experiments). This will considerably simplify the fol- lowing iterativ e learning controller design, which is a major advantage of our method using the acceleration model. B. Disturbance Estimation and Input Update An iteration domain Kalman filter is applied to calculate the estimate b d i +1 of the disturbance vector d in (19) after each iteration as (21), i indicates the i -th execution of the Pugache v’ s Cobra maneuver . b d i +1 = b d i + K i  Y i − F U i − b d i  (21) where the K i is the Kalman gain of which the details can be found in [19]. Then based on the estimated disturbance (21), the iterative learning control input to be applied at the next iteration b U i +1 should minimize the altitude tracking error predicted by the model (19), i.e., U i +1 is solved from the following optimization problem. min U i +1    F U i +1 + b d i +1 − Y des    2 + α   U i +1   2 s.t. U i +1  c max (22) where the first term stands for the 2-norm of the predicted tracking error , and the second one is the penalty term to the iterativ e learning control input with the weight α ; The lifted vector c max denotes the maximally allo wed U i +1 . W ith the known constant matrix F and disturbance estimate vector b d i +1 , the problem described by (22) is a conv ex optimization problem [28], which can be solved by software tool such as the CVX toolbox of Python. V . E X P E R I M E N T S V E R I FI C A T I O N This section presents the experimental results of the pro- posed controller design and learning scheme applied to the Hong Hu tail-sitter U A V described in section II. A. Body-X Acceleration Controller T o examine the stability and robustness of the body-X acceleration controller , Fig.10 shows the loop transfer function L = P C in the frequency domain, where P is the actual plant identified from frequency sweeping experiment [17], the C is our designed PI controller with a low-pass filter . The PI controller is used to increase the low-frequenc y gain of L , which compensates for any low-frequenc y disturbance from the environment or the aircraft itself. The lo w-pass filter is used to decrease the influence of high-frequency noise, which mainly comes from the propeller disturbance and IMU measurement noise. The bias of the accelerometer is estimated by an EKF with GPS measurements [24]. Based on the loop-shaping technique, which is discussed in detail in our prior work [17], the corner frequency of PI controller and low-pass filter is set to 0 . 9 H z and 14 H z , re- spectiv ely . As shown by the loop transfer function L ( s ) in Fig. 10, the acceleration control loop is stable with a phase margin up to 54 ◦ , which is in the desired range for typical aircraft systems to ensure sufficient robustness margin. Furthermore, the bandwidth of the acceleration control loop is as high as 7 . 2 H z , leading to a phase delay of G ( s ) = L ( s ) / (1 + L ( s )) nearly zero at 0 . 24 H z , the crossover frequency of the loop transfer function of the outer-loop position control (see Fig. 7). This nearly zero phase delay is well below the 81 ◦ phase margin of the outer-loop position control and hence guarantees the stability of the designed position controller in section III. B. 6 IEEE ROBO TICS AND A UTOMA TION LETTERS. PREPRINT VERSION. ACCEPTED FEBRU ARY , 2020 - 20 0 20 M ag n i tude ( dB ) 10 - 1 10 0 10 1 10 2 - 540 - 360 - 180 0 P has e ( de g ) P C L = P C F r e que nc y ( H z ) - 20 0 20 M ag n i tude ( dB ) 10 - 1 10 0 10 1 10 2 - 540 - 360 - 180 0 P has e ( de g ) P C L = P C F r e que nc y ( H z ) - 20 0 20 M ag n i tude ( dB ) 10 - 1 10 0 10 1 10 2 - 540 - 360 - 180 0 P has e ( de g ) P C L = P C F r e que nc y ( H z ) Fig. 10. Plant transfer function, controller transfer function, and the loop transfer function of the acceleration loop B. Lateral Contr oller For the controller validation experiments, the desired pitch angle in Pugache v’ s Cobra maneuver is sho wn in Fig. 11. The aircraft will head up to 0 ◦ after the first forward transition. Fig. 11 also shows the attitude response and lateral movement. It is apparent that the actual θ tracks the prescribed trajectory θ d very well and does not performs the . Moreov er , with the designed lateral controller , the deviation from the flight path is below 1 m. 0 1 2 3 4 5 6 80 60 40 20 0 Rotation Angle ( ) d 0 1 2 3 4 5 6 Time ( s ) 1.0 0.5 0.0 0.5 1.0 Lateral Movement ( m ) Ref l Fig. 11. The attitude response and lateral movement. C. Altitude Contr oller W e test our control methods on three Cobra maneuvers of different pitch profiles. As shown in Fig. 12, the three pitch profiles differ in the head-up angle (i.e., 80 ◦ , 70 ◦ , and 50 ◦ ), all in the post-stalling region. Fig.13, 14 and 15 show the altitude error and the ILC control actions for each iteration of the ILC algorithm. As can be seen, in all these three maneuvers, the ILC conv erges in four or five iterations. At con vergence, the altitude error root mean square (r .m.s.) are as small as 10 cm , 23 cm and 23 cm , respectively . These results show that our proposed control methods can effecti vely attenuate the altitude error in Cobra maneuver with different pitch angle profiles. Furthermore, for all these three maneuvers, we conduct a comparison study with a recent method in [21]. Like our method, this method, referred to as Smeur’ s method , also uses acceleration measurements as feedback and does not need to identify the aircraft aerodynamic force coef ficient, so a comparison against which w ould be much fair . The flight experiment results are sho wn in Fig. 15, where we can see that our control method based on the acceleration model surpasses the Smeur’ s method substantially in all these three 0 1 2 3 4 5 6 Time ( s ) 80 60 40 20 0 Pitch Angle ( ) head-up angle 80 head-up angle 70 head-up angle 50 Fig. 12. Three different profiles of desired pitch angle implemented in the experiments 0 1 2 3 4 5 6 4 2 0 2 4 Altitude Error ( m ) 0 1 2 3 4 5 Smeur Ref 0 1 2 3 4 5 6 Time (s) 1.0 0.5 0.0 0.5 1.0 1.5 2.0 ILC Input ( m / s 2 ) 1 2 3 4 5 Fig. 13. Altitude error and ILC input during each iteration when the head-up angle is 80 ◦ . The index 0 stands for the initial trajectory; “Ref” stands for the constant altitude setpoint; “Smeur” stands for the experiment using the method from [21]. Cobra maneuvers. Even without ILC, our baseline controller achiev es an altitude change of 1 . 12 m (versus 1 . 74 m , 35 . 63 % improv ement), 1 . 51 m (versus 2 . 21 m , 31 . 67 % improvement), 1 . 22 m (versus 1 . 68 m , 27 . 38 % improv ement), respectively . The video of the final Pugachev’ s Cobra maneuver at con- ver gence when the head-up angle is 80 ◦ can be found at https://youtu.be/zUJEqgDy0RA. V I . C O N C L U S I O N A N D F U T U R E W O R K T o best exploit the maneuverability of tail-sitter U A Vs, the Pugache v’ s Cobra maneuver is considered in this paper . For this maneuver , a complete control system has been proposed, which consists of two parts, a lateral controller and a feedback- feedforward altitude controller . Both are designed based on the U A V acceleration model. T o compensate for the en vironmental disturbance and unmodeled dynamics, an iterati ve learning control algorithm is proposed. A big advantage of the acceler- ation based iterati ve learning control is that it does not require to identify the U A V aerodynamic parameters, eliminating the use of costly wind tunnel tests while achieving state-of-the- art control performance. The proposed control methods are verified by real-world outdoor flight experiments. A limitation of the proposed method is the singularity at 90 ◦ pitch angle. Although our tail-sitter UA V normally flies with 8 ◦ angle of attack (pitch angle − 82 ◦ ) for the best aerodynamic efficienc y and no singularity takes place in the Pugache v’ s Cobra maneuver . It prev ents the tail-sitter UA V from further pitching down to achie ve higher speed (at the cost of lower efficiency). Our future work will focus on extending this acceleration model-based control technique to the general XU et al. : LEARNING PUGA CHEV’S COBRA MANEUVER FOR T AIL-SITTER U A VS USING A CCELERA TION MODEL 7 0 1 2 3 4 5 6 4 2 0 2 4 6 Altitude Error ( m ) 0 1 2 3 4 5 6 Smeur Ref 0 1 2 3 4 5 6 Time (s) 3 2 1 0 1 2 3 4 ILC Input ( m / s 2 ) 1 2 3 4 5 6 Fig. 14. Altitude error and ILC input during each iteration when the head-up angle is 70 ◦ . 0 1 2 3 4 5 6 4 2 0 2 4 Altitude Error ( m ) 0 1 2 3 4 5 Smeur Ref 0 1 2 3 4 5 6 Time (s) 4 2 0 2 4 ILC Input ( m / s 2 ) 1 2 3 4 5 Fig. 15. Altitude error and ILC input during each iteration when the head-up angle is 50 ◦ . control of tail-sitter U A V , which eliminates the need to model the U A V aerodynamics accurately . R E F E R E N C E S [1] M. S. Gandhi, L. Whitcher , E. Theodorou, and E. N. Johnson, “Practical system identification for small vtol unmanned aerial vehicle, ” in AIAA Scitech 2019 F orum , 2019, p. 1982. [2] Y . Chen, J. Zheng, Z. Shen, P . Xiao, M. T ong, L. Guo, and Y . Xin, “Design, analysis and tests of a tri–tiltrotor aircraft, ” in AIAA Aviation 2019 F orum , 2019, p. 2883. [3] D. Rohr , T . Stastny , S. V erling, and R. Siegwart, “ Attitude and cruise control of a vtol tiltwing uav , ” IEEE Robotics and Automation Letters , vol. 4, no. 3, pp. 2683–2690, 2019. [4] X. L yu, H. Gu, Y . W ang, Z. Li, S. Shen, and F . Zhang, “Design and implementation of a quadrotor tail-sitter vtol uav , ” in Robotics and Automation (ICRA), 2017 IEEE International Conference on . IEEE, 2017, pp. 3924–3930. [5] B. W . McCormick, Aerodynamics of V/STOL flight . Courier Corpora- tion, 1999. [6] H. Gu, X. Cai, J. Zhou, Z. Li, S. Shen, and F . Zhang, “ A coordinate descent method for multidisciplinary design optimization of electric- powered winged uavs, ” in 2018 International Conference on Unmanned Air craft Systems (ICUAS) . IEEE, 2018, pp. 1189–1198. [7] J. M. Levin, M. Nahon, and A. A. Paranjape, “ Aggressiv e turn-around manoeuvres with an agile fixed-wing uav , ” IF A C-P apersOnLine , vol. 49, no. 17, pp. 242–247, 2016. [8] F . Sobolic and J. How , “Nonlinear agile control test bed for a fixed wing aircraft in a constrained en vironment, ” in AIAA Infotech@ Aerospace Confer ence and AIAA Unmanned... Unlimited Confer ence , 2009, p. 1927. [9] T . Matsumoto, A. Konno, R. Suzuki, A. Oosedo, K. Go, and M. Uchiyama, “ Agile turnaround using post-stall maneuvers for tail- sitter vtol uavs, ” in 2010 IEEE/RSJ International Conference on Intel- ligent Robots and Systems . IEEE, 2010, pp. 1612–1617. 0 1 2 3 4 5 6 Iteration Index 0.0 0.5 1.0 1.5 2.0 Root Mean Square Error ( m ) Our method (80 ) Our method (70 ) Our method (50 ) Smeur`s method (80 ) Smeur`s method (70 ) Smeur`s method (50 ) Fig. 16. Root mean square error of altitude. The Smeur’ s method does not learn from iterations. So the same root mean square error is used for all iterations. [10] N. Knoebel, S. Osborne, D. Snyder , T . Mclain, R. Beard, and A. El- dredge, “Preliminary modeling, control, and trajectory design for minia- ture autonomous tailsitters, ” in AIAA Guidance, Navigation, and Control Confer ence and Exhibit , 2006, p. 6713. [11] D. Pucci, T . Hamel, P . Morin, and C. Samson, “Nonlinear control of pvtol vehicles subjected to drag and lift, ” in 2011 50th IEEE Conference on Decision and Contr ol and European Contr ol Confer ence . IEEE, 2011, pp. 6177–6183. [12] R. Naldi and L. Marconi, “Optimal transition maneuvers for a class of v/stol aircraft, ” Automatica , vol. 47, no. 5, pp. 870–879, 2011. [13] A. Oosedo, S. Abiko, A. K onno, and M. Uchiyama, “Optimal transition from hovering to level-flight of a quadrotor tail-sitter uav , ” Autonomous Robots , vol. 41, no. 5, pp. 1143–1159, 2017. [14] R. Ritz and R. D’Andrea, “ A global controller for flying wing tailsitter vehicles, ” in Robotics and Automation (ICRA), 2017 IEEE International Confer ence on . IEEE, 2017, pp. 2731–2738. [15] E. J. Smeur , M. Bronz, and G. De Croon, “Incremental control and guidance of hybrid aircraft applied to the cyclone tailsitter uav , ” arXiv pr eprint arXiv:1802.00714 , 2018. [16] R. H. Stone, “Control architecture for a tail-sitter unmanned air vehicle, ” in 2004 5th Asian Contr ol Confer ence (IEEE Cat. No. 04EX904) , vol. 2. IEEE, 2004, pp. 736–744. [17] W . Xu, H. Gu, Y . Qin, J. Lin, and F . Zhang, “Full attitude control of an efficient quadrotor tail-sitter vtol uav with flexible modes, ” in International Conference on Unmanned Aerial Systems (ICUAS) , 2019. [18] O. Purwin and R. D’Andrea, “Performing aggressive maneuvers using iterativ e learning control, ” in 2009 IEEE international confer ence on r obotics and automation . IEEE, 2009, pp. 1731–1736. [19] A. Sch ¨ ollig and R. D’Andrea, “Optimization-based iterative learning control for trajectory tracking, ” in 2009 European Control Conference (ECC) . IEEE, 2009, pp. 1505–1510. [20] F . L. Mueller , A. P . Schoellig, and R. D’Andrea, “Iterativ e learning of feed-forward corrections for high-performance tracking, ” in 2012 IEEE/RSJ International Confer ence on Intelligent Robots and Systems . IEEE, 2012, pp. 3276–3281. [21] E. J. Smeur , M. Bronz, and G. C. de Croon, “Incremental control and guidance of hybrid aircraft applied to a tailsitter unmanned air vehicle, ” AIAA Journal of Guidance, Control, and Dynamics , pp. 1–14, 2019. [22] P . Autopilot, “Pixhawk community . ” [23] X. L yu, H. Gu, J. Zhou, Z. Li, S. Shen, and F . Zhang, “ A hierarchical control approach for a quadrotor tail-sitter vtol uav and experimental verification, ” 2017. [24] L. Meier , P . T anskanen, L. Heng, G. H. Lee, F . Fraundorfer, and M. Pollefeys, “Pixhawk: A micro aerial vehicle design for autonomous flight using onboard computer vision, ” Autonomous Robots , vol. 33, no. 1-2, pp. 21–39, 2012. [25] P . D. Groves, Principles of GNSS, inertial, and multisensor integr ated navigation systems . Artech house, 2013. [26] E. F . Camacho, M. Berenguel, and F . R. Rubio, F r equency Domain Contr ol and Robust Optimal Control . Springer London, 1997. [27] J. Katz and R. MASKEW , “Unsteady low-speed aerodynamic model for complete aircraft configurations, ” Journal of Aircraft , vol. 25, no. 4, pp. 302–310, 1988. [28] S. Bubeck et al. , “Conve x optimization: Algorithms and complexity , ” F oundations and T r ends® in Machine Learning , vol. 8, no. 3-4, pp. 231–357, 2015.

Original Paper

Loading high-quality paper...

Comments & Academic Discussion

Loading comments...

Leave a Comment