AAE 666 - Final Presentation Backstepping Based Flight Control Asif Hossain February 24, 2005 1 Overview February 24, 2005 Modern Aircraft Configuration Aircraft Dynamics Force, Moment and Attitude Equations Current Approaches to Flight Control Design Backstepping Approaches to Flight Control Design Backstepping Backstepping Design for Flight Control Flight Control Laws Simulation 2 Modern Aircraft Configuration February 24, 2005 3 Aircraft Dynamics P ( p N p E h) T , Aircraft position expressed in an Earth-fixed coordinate system; V (u v w) , The velocity vector expressed in T the body-axis coordinate system; Φ ( ) T , The Euler angles describing the orientation of the aircraft relative to the Earth-fixed coordinate system; ω ( p q r) T , The angular velocity of the aircraft expressed in the body axes coordinate system; February 24, 2005 4 Aerodynamics Forces and Moments Body axis coordinate system February 24, 2005 5 Force Equations (Body-axes) 1 u rv qw g sin ( X FT ) m 1 v pw ru g sin cos Y m 1 qu pv g cos cos Z w m Rewrite the force equations in terms of , and VT w u v arcsin VT arctan VT February 24, 2005 u 2 v 2 w2 u VT cos cos v VT sin w VT sin cos 6 Force Equations (wind-axes) 1 VT D FT cos cos mg1 m 1 q ( p cos r sin ) tan ( L FT sin mg 2 ) mVT cos 1 p sin r cos (Y FT cos sin mg 3 ) mVT Where the contributions due to gravity are given by, g1 g ( cos cos sin sin cos sin sin cos cos cos ) g 2 g (cos cos cos sin sin ) g 3 g (cos cos sin sin cos sin sin sin cos cos ) February 24, 2005 7 Moment and Attitude Equations Moment Equations: p (c1 r c 2 p )q c3 L c 4 N q c5 pr c6 ( p 2 r 2 ) c7 ( M FT Z TP ) r (c8 p c 2 r )q c 4 L c9 N Attitude Equations: p tan ( q sin r cos ) q cos r sin q sin r cos cos February 24, 2005 8 Current Approaches to Flight Control Design Gain Scheduling Dynamic Inversion (feedback linearization) February 24, 2005 Divide and conquer approach is tedious since controller must be designed for each flight envelope. Stability is guaranteed only for low angles of attack and low angular rates. Cancels valuable nonlinear dynamics. Relies on precise knowledge of the aerodynamic coefficients 9 Backstepping based flight control design February 24, 2005 Constructive (systematic) control design for nonlinear systems. Lyapunov based control design method Avoid cancellation of “useful nonlinearities” (unlike feedback linearization). Stability is guaranteed for all angles of attack (unlike gain scheduling). Different flavors: Adaptive, robust and observer backstepping. 10 LaSalle-Yoshizawa Theory The time-invariant system, x f (x) Let V (x ) be a scalar continuously differentiable function of the state x such that V (x ) is positive definite V (x ) is radially unbounded Va( x ) V f ( x) W ( x ) where W ( x) is positive semi definite. x Then, all solutions satisfy lim W ( x (t )) 0 t In addition, if W (x ) is positive definite, then the equilibrium x 0 is Globally Asymptotically Stable (GAS). February 24, 2005 11 Control Lyapunov Function (clf) The time-invariant system, x f ( x, u ) A smooth, positive definite, radially unbounded function V (x ) is called a control Lyapunov function (clf) for the system if for all x 0 , V ( x) V x ( x) f ( x, u ) 0 for some u Given a clf for the system, we can thus find a globally stabilizing control law. In fact, the existence of a globally stabilizing control law is equivalent to the existence of a clf, and vice versa. February 24, 2005 12 Backstepping Consider the system x f ( x, ) u n Where x R , R are state variables and is u R the control input. Assume a virtual control law des (x) is known such that 0 is GAS equilibrium of the system. February 24, 2005 13 Backstepping Let, W (x ) be a clf for the subsystem x f ( x, ) such that W | des Wx ( x) f ( x, des ( x)) 0, x 0 Then, the clf for the augmented system is given by 1 V ( x, ) W ( x) ( des ( x)) 2 2 Moreover, a globally stabilizing control law, satisfying des des 2 V Wx ( x) f ( x, ( x)) ( ( x)) is given by des ( x) f ( x, ) f ( x, des ( x)) des u f ( x, ) Wx ( x) ( x) des x ( x) February 24, 2005 14 Strict Feedback System By recursive applying backstepping, globally stabilizing control laws can be constructed for systems of the following lower triangular form: f ( x, 1 ) x 1 g 1 ( x, 1 , 2 ) i g i ( x, 1 , , i , i 1 ) m g m ( x, 1 , , m , u ) February 24, 2005 15 Backstepping design for flight control Controlled variables: General maneuvering February 24, 2005 16 Control Objectives February 24, 2005 17 Assumptions: Control surface deflections only produce aerodynamic moments, and not forces. The speed, altitude and orientation of the aircraft vary slowly compared to the controlled variables. Therefore, their time derivatives can be neglected. Longitudinal and lateral commands are assumed not to be applied simultaneously. The control surface actuator dynamics are assumed to be fast enough to be disregarded. February 24, 2005 18 Backstepping design for flight control The roll rate to be controlled, p s , is expressed in the stability axes coordinate system. T The stability axes angular velocity, ω s ( p s q s rs ) ,is related to the body axes angular velocity, ω ( p q r ) T , through the transformation: s Rsb where cos 0 sin Rsb 0 1 0 - sin 0 cos 1 T Note that the transformation matrix Rsb satisfies Rsb Rsb Introducing: February 24, 2005 u (u1 u 2 u 3 ) T s 19 Aircraft Dynamics Revisited p s u1 q s p s tan q s u 2 1 1 ( L( ) FT sin mg 2 ) mVT cos 2 3 1 rs (Y ( ) FT cos sin mg 3 ) mVT rs u 3 4 5 Roll rate dynamics: Equation 1 Angle of attack dynamics: Equation 2-3 Sideslip dynamics: Equation 4-5 February 24, 2005 20 The nonlinear control problem The angle of attack dynamics and the sideslip dynamics can be written as w 1 f ( w1 , y ) w2 w 2 u For notational convenience it is favorable to make the origin the desired equilibrium. Let, w1 is the desired equilibrium. x1 w1 x 2 w2 f (, y ) ( x1 ) f ( x1 , y ) f (, y ) February 24, 2005 21 The nonlinear control problem The dynamics become x1 ( x1 ) x 2 x 2 u We will use backstepping to construct a globally stabilizing feedback control laws for the system assuming general nonlinearity . February 24, 2005 22 The nonlinear control problem Assume there exists a constant, , such that ( x1 ) for all x1 0 x1 Then a globally stabilizing control law can be given by u k ( x2 ( x1 )) where, (( x1 ) ( x1 )) x1 0, x1 0 and 0 ( x1 ) k February 24, 2005 23 Block Diagram The nonlinear system is globally stabilized through a cascaded control structure February 24, 2005 24 Aircraft Application f ( , y ) p s tan f ( , y ) February 24, 2005 1 ( L( ) FT sin mg 2 ) mVT cos 1 (Y ( ) FT cos sin mg 3 ) mVT 25 Flight Control Laws Angle of attack control u2 k ,2 (qs k ,1 ( ref ) f ( ref , y )) Sideslip regulation 1 u 3 k , 2 (rs k ,1 g cos sin ) VT Stability axis roll control u1 k ps ( psref ps ) February 24, 2005 26 Gain Selection, k p , k ,1 , k ,2 , k ,1 and k ,2 s How should the control law parameters be selected? February 24, 2005 For control, linearize the angle of attack dynamics around a suitable operating point and then select to achieve some desired linear closed behavior locally around the operating point. For regulation, can be selected by choosing some desired closed loop behavior using linearization of the sideslip dynamics. 27 Roll rate demand, p February 24, 2005 ref s 150 / sec 0 28 Angle of attack demand, February 24, 2005 ref 15 0 29 Questions Polygonia interrogationis known as Question Mark February 24, 2005 30
© Copyright 2026 Paperzz