# Real-Time Fixed-Order LateralH2 Controller for Micro Air Vehicle

Authors: Meenakshi M.; M. Seetharama Bhat
Journal: Journal of Control Science and Engineering
 (2011)

---

## Abstract

This paper presents the design and development of a fixed low-order, robustH2 controller for a micro air vehicle (MAV) named Sarika-2. The controller synthesis uses strengthened discrete optimal projection equations and frequency-dependent performance index to achieve robust performance and stability. A single fixed gain low-order dynamic controller provides simultaneous stabilization, disturbance rejection, and sensor noise attenuation over the entire flight speed range of 16 m/sec to 26 m/sec. Comparative study indicates that the low-order H2-controller achieves robust performance levels similar to that of full order controller. Subsequently, the controller is implemented on a digital signal processor-based flight computer and is validated through the real time hardware in loop simulation. The responses obtained with hardware in loop simulation compares well with those obtained from the offline simulation.


---

## Body

## 1.  Introduction

A Low-cost, remotely piloted MAV named Sarika-2 [1, 2] is designed and built at the Indian Institute of Science, Bangalore, India, for validating modern robust optimal control algorithms. Sarika-2 (shown in Figure 1) is a lightweight (less than 2 kg at take off) and low inertia vehicle. The radio controlled flying of such a low inertia vehicle through joystick-driven manual command is difficult, if not impossible, even under moderate gusty conditions. The radio-controlled flying becomes easier with the fast damped response of a controlled airframe [3].Figure 1
Microair vehicle: Sarika-2.Though conventional flight control design methods have been in practice for a long time, such methods suffer from known limitations. They are time consuming. Controller tuning for multi-input multi-output (MIMO) systems is also not straightforward. Another serious limitation of a conventional controller is its poor robustness against model uncertainty. The quest for robust controllers in the last three decades resulted in controllers [4–7] which robustly stabilize the system, leaving the impression that such methods lean too heavily on robustness and sacrifice an adequate view of performance. The H2 performance level of a plant is often a more realistic indication of its real-life performance [8–10] as compared to the more conservative H∞-norm [4–7]. Robust H2 controllers as well as other robust controllers like μ [11] and H∞ [4–7] provide systematic procedures for obtaining controllers that meet performance objectives and guaranteed robustness against model uncertainty and unmeasured disturbances. In μ synthesis, H2 and H∞ loop shaping, the designer specifies frequency-dependent weights [4] to reflect the desired performance and robustness objectives. However, these techniques give controllers, order of which is normally higher than that of a given plant. Hence, real-time controller implementation is hard if not impossible. Implementation of large-order controllers may create undesirable time delays. Therefore, a robust fixed-order H2 control is an attractive option among the several robust multivariable methods for controller design, since the H2 norm is the more intuitive measure of the performance [8, 10]. Fixed low-order H2 controller can be synthesized in one step in contrast to the other multivariable robust controller design methods involving two-step designs [12]. A single-step procedure guarantees the stability robustness and optimality [13].RobustH2 optimal controller problem can be posed as H2 optimal control problem, where in the model uncertainties are accommodated in the design. Thus in contrast to the LQG design, where the estimation of performance and robustness of the closed-loop system is posterior of the controller design and the performance and robustness specifications are included in H2 controller at the design stage itself. A standard robust H2 optimization problem can be represented as shown in Figure 2 [3], where attenuation system is subjected to noise and disturbances. The configuration shown in Figure 2 contains a generalized plant that is used for robust stability analysis and controller design.Figure 2
Standard representation forH2 design and analysis.The signals “w” and “z” are exogenous inputs and performance variables respectively. “y” is the measured variable, and “u” is the control input. Pg is the generalized plant representing the actual plant and all weighting functions. K1 represents the sensor dynamics including preamplifier gains, and K is the controller to be designed. Δ is the set of all possible uncertainties, grouped in to a single block-diagonal finite dimensional linear time invariant system. The diagram in Figure 2 is also referred to as a standard LFT formulation with lower linear fractional transformation (LLFT) on K, where PgK1 is the coefficient matrix of the LLFT and upper linear fractional transformation (ULFT) on Δ, where Pg is the coefficient matrix of the ULFT. LLFT is used in the controller design stage, and ULFT is used during the robust performance analysis stage.The generalized plant, Figure2 can be represented in frequency domain as follows:(1a)[z(z)y(z)]=Pg(z)[w(z)u(z)]=[Pg11(z)Pg12(z)Pg21(z)Pg22(z)][w(z)u(z)],
where the closed-loop transfer matrix from w to z can be given by
(1b)z=Tzw⋅w,(1c)Tzw=Pg11+Pg12K1K(I-Pg22K1K)-1.The minimization of the H2 norm of the transfer function from w to z, that is, Tzw over all realizable controllers K(z), constitutes the H2 control problem. The elements of the generalized plant Pg are obtained by augmenting the frequency-dependent weighting functions and corresponding output vector z into lower LFT form.The present paper is concerned solely with the design, analysis, and validation of robust fixed-orderH2 controller by real-time hardware in the loop simulation for the lateral dynamics of Sarika-2. The controller design is based on the combination of strengthened discrete optimal projection equations (SDOPEs) [14], which are the modified version of the pioneering work of Bernstein et al. [15] on fixed-order controllers and frequency-shaped design techniques. In this paper, the time-domain weighting matrices of state and control variables [14] are changed to frequency-dependent weighting matrices. This enables the designer to shape the responses tighter in prespecified frequency ranges by giving them larger weights, clearly at the expense of larger errors at other frequency ranges that are of less importance. A good controller is the result of systematic tradeoffs between output sensitivity So, complementary sensitivity function T, and control sensitivity SiK (Si: input sensitivity function) of the closed-loop system. Since Sarika-2 is very small in size, the flow over the wing, where the velocity measuring pitot static probe is mounted, becomes turbulent at low Reynolds number flow regime. Also, light weight pressure sensors have poor sensitivity and stability in measurements. Further nonlinear relation between air speed and the dynamic pressure (total pressure-static pressure) makes such a device less preferred, since onboard correction for all above mentioned cants is not viable in Sarika 2 class of vehicles. Therefore, Sarika 2 does not have sensors to measure true or indicated air speed and hence, gain/controller scheduling over its flight speed range of 16–26 m/sec is not feasible. Therefore, a single discrete dynamic controller is designed at the central operating point (20 m/sec of flight speed) of the vehicle to achieve simultaneous stabilization, disturbance rejection, and sensor noise attenuation over the entire flight envelope of 16 m/sec–26 m/sec.


## 2. Lateral Dynamics of Sarika-2

Sarika-2 is a remote controlled small flying vehicle with a sweptback delta wing of 0.6 m span and planform area of 0.195 m2. It has a square fuselage of width 0.06 m and a length of 0.8 m. It weights around 1.75 kg at take off. Control is achieved through independent actuation of outboard elevator, inboard aileron, and rudder. Sarika-2 has no horizontal tail. The power plant is a 4 cc propeller engine (OSMAX-LA 25), which uses methanol plus castor oil as fuel, with 10–15% nitromethane to boost the engine power.Linearized state space models of lateral dynamics are developed in the stability axis [16], by assuming level flight at a constant altitude of 1000 m above the sea level (i.e., 100 m above the ground level at Bangalore) and trimming at six different operating speeds (i.e., at 16, 18, 20, 22, 24, and 26 m/sec). The state variables, x∈R4 that describe lateral dynamics are sideslip angle β, roll rate p, yaw rate r, and bank angle ϕ. Static derivatives from the wind tunnel tests [1] are combined with the dynamic derivatives from the theoretical computation [17, 18] to provide complete set of stability derivatives [3] of the lateral dynamics of Sarika-2. Control surfaces are actuated by miniature electromechanical servo systems. Experimentally measured dynamics of the servo actuator (Futaba S3101 Micro Servo) is given by (2)δ̇i=-9.5δi-6.37ui,
where, i=a and r for aileron and rudder respectively. δi is the aileron or rudder deflections in radians, and ui is the width of the pulse width modulated (PWM) command input in milliseconds. The continuous state space model is discretized at 50 Hz (to synchronize with the command PWM input received at the vehicle from radio/pilot command from ground station). The final linearized model used for the controller synthesis includes two sampling period delay states to account for computational time requirements. Hence, the final model of the plant consists of eight states (four for MAV airframe, two for actuator and two for computational delay), two control inputs, wind disturbance input, and three sensor outputs from accelerometer and rate gyros. Discretized state space model of the lateral dynamics of Sarika-2, at the central operating condition of 20 m/sec is given by [3](3a)xp(k+1)=Apxp(k)+Bp1u(k)+Bp2vg(k),(3b)y(k)=Cpxp(k)+Dp1u(k)+Dp2vg(k),
where vg is the wind gust component in the lateral direction, xp=[βprϕδaδr]T, u(k)=[δacδrc]T, and y=[aypr]T measured with respect to the aircraft body axis (ay is the lateral acceleration), and (3c)Ap=[0.97780.0002-0.01940.0097-0.0036-0.047-0.0002-0.0028-1.81280.96640.0264-0.009-3.5364-0.0676-0.2578-0.0061.0465-0.00410.96140.00520.15033.42760.01080.2501-0.01830.01970.00020.9999-0.0367-0.0009-0.002-0.000100000.82700.09550000000.82700.09550000000.1353000000000.1353],(3d)Bp1=[0.0000.00010.00450.0001-0.0002-0.00440.00010.00000.0029000.00290.1383000.1383],Bp2=[0.04889-0.09060.05233-0.000920000],(3e)Cp=[-11.7970.0127-19.8789.81-41.626-258.0820001.0000000000001.000000000],(3f)Dp1=[000000],Dp2=[-0.589900].The stability augmentation system (SAS) is based on the feedback signals defined with respect to the stability axes. Hence, the measured variables are transformed from the body axes to stability axis using the following transformation: (4)[psaysrs]=[cos⁡α0sin⁡α010-sin⁡α0cos⁡α][pbaybrb],
where α is the trim angle of attack for a level flight at design speed of the nominal plant.


## 3. Design Specifications

The closed-loop design specifications for the lateral dynamics are determined from its expected responses [19] to pilot inputs sent from the aileron and rudder joystick. The main requirement of SAS is the improvement of handling qualities summarized as in Section 3.1.


### 3.1. Level 1 Flying Quality Requirements [19]

Dutch roll damping ratio ≥ 0.5.Roll subsidence time constant < 1 sec.Spiral mode - minimum time to double the amplitude > 12 sec.Note from Table1 that the specifications for the spiral and roll modes are satisfied at all flight speeds. However, the dutch-roll response is fast with poor damping, leading to large settling time. Consequently, the closed-loop specifications are to increase the dutch-roll damping to a minimum of 0.5.Table 1
Plant poles at different operating points.
SpeedPoles inw-domainDampingFrequency, Rad/secMode16 m/sec-0.138±5.92i0.02335.92Dutch Roll−2.2712.27Roll Subsidence−0.43610.436Spiral18 m/sec-0.27±6.63i0.04326.63Dutch-roll−2.4012.40Roll Subsidence−0.41510.415Spiral20 m/sec-0.394±7.35i0.0567.36Dutch-roll−2.5512.55Roll Subsidence−0.3930.393Spiral22 m/sec-0.51±8.07i0.06578.08Dutch-roll−2.7112.71Roll Subsidence−0.3710.37Spiral24 m/sec-0.622±8.8i0.07318.81Dutch-roll−2.881−2.88Roll Subsidence−0.34810.348Spiral26 m/sec-0.728±9.53i0.07899.55Dutch-roll−3.0613.06Roll Subsidence−0.32810.328Spiral


### 3.2. Disturbance Rejection Specification

The standard turbulence parameters,Lv and σv [20] of the side wind gust, are modified to Lv=3 m and σv=5.5 m/sec2 to take into account the worst case scenario, which occurs when all the dynamic modes of Sarika-2 are excited. The gust spectral density is evaluated as a function of cruise speed from 16 m/sec to 26 m/sec, and it is found that [3] the spectral bandwidth of gust increases with increase in speed (9.55 rad/sec at 26 m/sec). Hence, the disturbance rejection specification is as follows: minimize the sensitivity function below 0 dB for ω<10 rad/sec.


### 3.3. Sensor Noise Attenuation Specification

Experimentally, it is found that low cost sensors like rate gyros (Micro Gyro 100) and accelerometers (TAA-3804-100) have high-frequency noise content concentrated above 15 rad/sec. Therefore, to achieve high-frequency noise attenuation the specifications are as follows: obtain −40 dB/decade roll-off of the flight parameters above frequency of 15 rad/sec.


### 3.4. Robustness Specification

The controller designed at the central operating condition should be robust against the varying flight conditions in order to use a single controller at different operating points, which avoids gain/controller scheduling. The controller should also be robust against the structured real-valued parameter uncertainty within the context of state space models and unstructured multiplicative uncertainties on actuator inputs at all flight conditions. Larger uncertainty levels are placed on dynamic derivatives (50%), which are obtained analytically using DATCOM [17, 18], since the static derivatives (20%) obtained from the wind tunnel data are more reliable than those calculated using analytical approach.Apart from the above specifications, closed-loop system should also be robust against the maximum expected time delays that may arise due to nonlinearity and computational complexity. In addition, the control surface deflections should not exceed its full-scale deflection of ±16 degrees (±0.4 milliseconds with respect to the neutral value of 1.5 ms of PWM input).


## 3.1. Level 1 Flying Quality Requirements [19]

Dutch roll damping ratio ≥ 0.5.Roll subsidence time constant < 1 sec.Spiral mode - minimum time to double the amplitude > 12 sec.Note from Table1 that the specifications for the spiral and roll modes are satisfied at all flight speeds. However, the dutch-roll response is fast with poor damping, leading to large settling time. Consequently, the closed-loop specifications are to increase the dutch-roll damping to a minimum of 0.5.Table 1
Plant poles at different operating points.
SpeedPoles inw-domainDampingFrequency, Rad/secMode16 m/sec-0.138±5.92i0.02335.92Dutch Roll−2.2712.27Roll Subsidence−0.43610.436Spiral18 m/sec-0.27±6.63i0.04326.63Dutch-roll−2.4012.40Roll Subsidence−0.41510.415Spiral20 m/sec-0.394±7.35i0.0567.36Dutch-roll−2.5512.55Roll Subsidence−0.3930.393Spiral22 m/sec-0.51±8.07i0.06578.08Dutch-roll−2.7112.71Roll Subsidence−0.3710.37Spiral24 m/sec-0.622±8.8i0.07318.81Dutch-roll−2.881−2.88Roll Subsidence−0.34810.348Spiral26 m/sec-0.728±9.53i0.07899.55Dutch-roll−3.0613.06Roll Subsidence−0.32810.328Spiral


## 3.2. Disturbance Rejection Specification

The standard turbulence parameters,Lv and σv [20] of the side wind gust, are modified to Lv=3 m and σv=5.5 m/sec2 to take into account the worst case scenario, which occurs when all the dynamic modes of Sarika-2 are excited. The gust spectral density is evaluated as a function of cruise speed from 16 m/sec to 26 m/sec, and it is found that [3] the spectral bandwidth of gust increases with increase in speed (9.55 rad/sec at 26 m/sec). Hence, the disturbance rejection specification is as follows: minimize the sensitivity function below 0 dB for ω<10 rad/sec.


## 3.3. Sensor Noise Attenuation Specification

Experimentally, it is found that low cost sensors like rate gyros (Micro Gyro 100) and accelerometers (TAA-3804-100) have high-frequency noise content concentrated above 15 rad/sec. Therefore, to achieve high-frequency noise attenuation the specifications are as follows: obtain −40 dB/decade roll-off of the flight parameters above frequency of 15 rad/sec.


## 3.4. Robustness Specification

The controller designed at the central operating condition should be robust against the varying flight conditions in order to use a single controller at different operating points, which avoids gain/controller scheduling. The controller should also be robust against the structured real-valued parameter uncertainty within the context of state space models and unstructured multiplicative uncertainties on actuator inputs at all flight conditions. Larger uncertainty levels are placed on dynamic derivatives (50%), which are obtained analytically using DATCOM [17, 18], since the static derivatives (20%) obtained from the wind tunnel data are more reliable than those calculated using analytical approach.Apart from the above specifications, closed-loop system should also be robust against the maximum expected time delays that may arise due to nonlinearity and computational complexity. In addition, the control surface deflections should not exceed its full-scale deflection of ±16 degrees (±0.4 milliseconds with respect to the neutral value of 1.5 ms of PWM input).


## 4.H2 Optimal Control Formulation

Figure3 represents the standard H2 control formulation given in the form of general configuration known as linear fractional transformation (LFT), or two-port block diagram. Generalized plant Pg is obtained by augmenting the actual plant Gp with the weighting matrices. In Figure 3, K1=diag([0.051.27211.2721]) represents the sensor sensitivity matrix including the preamplifier gains and K is the controller to be designed. The set of all possible uncertainties Δ is grouped in to a single block-diagonal finite dimensional linear time invariant system. The input signal vector w consists of all exogenous inputs comprising plant disturbances (d,vg), sensor noise (n), and command input (r). The output of the controller is u, and y is a vector of measurement signals that are available for online control purpose. W1(z),W2(z), and W3(z) are frequency dependent weighting functions on So, T, and SiK, respectively, whose outputs are represented in a vector form, z=[z1z2z3]T. Let Tzw denote the resulting closed-loop transfer function from w to z.Figure 3
StandardH2 control formulation.The objective ofH2 design is to find a fixed-order, discrete, optimal dynamic controller amongst all admissible controllers that yield internally stable closed-loop system so as to minimize the norm-2 of Tzw; that is, (5)‖Tzw(z)‖2=‖[W1(z)So(z)W2(z)T(z)W3(z)Si(z)K(z)]‖2,
where
(6)So=(I+K1GK)-1;Si=(I+KK1G)-1,T=K1G(z)K(z)I+K1G(z)K(z),So is the transfer function between the external disturbance and the output and is a good measure of disturbance rejection, which is a low-frequency phenomenon. T, on the other hand, is a good measure of high-frequency noise attenuation, defined as the closed-loop transfer function between the input and output of the plant. Thus, W1 is chosen as a low-pass filter and W2 as a high-pass filter. Control-input constraint function is akin to putting penalty on actuator usage. The weighting function W3 determines the robustness characteristics of the closed-loop system to unstructured additive uncertainties; that is, W3-1 acts as the upper bound on the controller gains (SiK). However, the crossover frequencies of So and SiK or T (SiK/T) are critical for both robustness and performance properties, since in the crossover frequency region of robustness and performance (So and SiK/T) measures, neither So nor the T functions are small [21]. Choosing the performance weights to optimize the desired closed-loop performance, while maintaining the robust stability in the cross over frequency region is difficult [22].Considering the state space representation of the plant and weights as,(7)Gp=[ApBp1Bp2CpDp1Dp2],W1=[Aw1Bw1Cw1Dw1],W2=[Aw2Bw2Cw2Dw2],W3=[Aw3Bw3Cw3Dw3],
and using the LFT theory [8], the closed-loop system with weighted cost functions are reformulated as(8)[z(z)y(z)]=Pg(z)[w(z)u(z)]=[Pg11(z)Pg12(z)Pg21(z)Pg22(z)][w(z)u(z)],
which yields the following state-space equations:(9)x(k+1)=Φx(k)+B1w(k)+Γu(k),y(k)=Cx(k)+D1w(k)+Du(k),z(k)=E1x(k)+E3w(k)+E2u(k),
where x(k)∈Rn, w(k)∈Rm2, z(k)∈Rp2, u(k)∈Rm1, and y(k)∈Rp1, In addition, (Φ,Γ) is stabilizable, (Φ,C) is detectable, and the feed-forward matrix E3=0 and E2 and D1 are full column and row rank matrix, respectively. Equation (9) can be rewritten in the expanded form as (10)[x(k+1)zy]=[Ap000000Bp2Bp1-Bw1K1CpAw100Bw1-Bw1K1-Bw1-Bw1K1Dp2-Bw1K1Dp1Bw2K1Cp0Aw200Bw2K10-Bw2K1Dp2Bw2K1Dp1000Aw30000Bw3-Dw1K1CpCw100Dw1-Dw1K1-Dw1-Dw1K1Dp2-Dw1K1Dp1Dw2K1Cp0Cw200Dw2K10Dw2K1Dp2Dw2K1Dp1000Cw30000Dw3-K1Cp000I-K1I-K1Dp2-K1Dp1][xrdnβgu].The goal of the fixed-order controller design is to find anncth order dynamic compensator K(z) for the unknown Ac, Bc, Cc, and Dc(11)xc(k+1)=Acxc(k)+Bcy(k),u(k)=Ccxc(k)+Dcy(k),
so as to satisfy the following two design criteria.(1) The closed-loop system corresponding to (10)-(11) given by(12)xCL(k+1)=ACLxCL(k)+DCLw(k),z(k)=ECLxCL,
where
(13)xCL=[xxc],ACL=[Φ+ΓDcCΓCcBcCAc],DCL=[ΓDcD1BcD1],ECL=[E1E2Cc]
is asymptotically stable.(2) The norm-2 of the closed-loop transfer function matrix(14)Tzw=ECL(zI-ACL)-1DCL
is minimized. Objective 2 leads to the steady state quadratic performance criterion(15)J(Ac,Bc,Cc,Dc)=lim⁡N→∞1N{∑k=1NTzw*(ejωk)Tzw(ejωk)}=lim⁡N→∞1N{∑k=1Ns(x*(ejωk)Q(ejωk)x(ejωk)+u*(ejωk)R(ejωk)u(ejωk))∑k=1Ns(x*(ejωk)Q(ejωk)x(ejωk)},Q(z) and R(z) (i.e., Q(ejωk) and R(ejωk)) are obtained from the weighting matrices W1(z), W2(z), and W3(z) [3]. The controller parameters (Ac,Bc,Cc,andDc) which minimizes the objective function J (15) are obtained by iteratively solving the following set of four coupled modified Riccati and Lyaponv equations known as SDOPEs [3, 14]:(16)P=ΦPΦT-∑P1+V+τ⊥ΨS,P̂,P1τ⊥T,S=ΦTSΦ-∑S2+Q+τ⊥TΨP,Ŝ,S2τ⊥,P̂=12[τΨS,P̂,P1+ΨS,P̂,P1τT],Ŝ=12[τTΨP,Ŝ,S2+ΨP,Ŝ,S2τ],
provided P, S, P̂,  and Ŝ are nonnegative symmetric n×n matrices, rank(P̂) = rank(Ŝ) = rank(P̂Ŝ) = nc, and τ2=τ=(P̂Ŝ)(P̂Ŝ)# (idempotent matrix) with
(17)∑p1=KpWpKpT,∑s2=LsTRsLs,Φp1=Φ-KpC,Φs2=Φ-ΓLs,ΨS,P̂,P1=ΦS2P̂(ΦS2)T+∑P1,ΨP,Ŝ,S2=(ΦP1)TŜΦP1+∑S2,τ⊥=In-τ,Wp=W+CPCT,Rs=R+ΓTSΓ,Kp=ΦPCTWp-1,Ls=Rs-1ΓTSΦ.
The optimality exists if the steady state cost functional J,(18)J(Ac,Bc,Cc,Dc)∞=J(Ac,Bc,Cc,Dc)Q,R=J(Ac,Bc,Cc,Dc)V,W,
where
(19)J(Ac,Bc,Cc,Dc)Q,R=tr⁡⌊QP+(Q+LSTRSLS)P̂⌋,J(Ac,Bc,Cc,Dc)V,W=tr⁡⌊VS+(V+KPWPKPT)Ŝ⌋.
The controller then can be computed as:(20)Ac=H[Φ-KpC-ΓLs]GT;Bc=HKp,Cc=LsGT;Dc=0,
for some projective factorization (G,M,H) of (P̂Ŝ).


## 5. Results and Discussions

The controller is designed at the central operating point of Sarika-2 (i.e., at 20 m/sec) and is used for all flight conditions. The weighting matricesW1 and W2 need to be strictly proper in order to make the feed through term, E3 zero. Following the guidelines [23] to select the weighting matrices, the final choice of the weighting matrices, W1, W2 and W3  (in discrete domain) are(21)W1(z)=[0.89(z-0.99)(z-0.25)(z-0.67)0001.19(z-0.99)(z-0.45)(z-0.74)0000.02(z-0.99)(z-0.82)(z-0.99)],W2(z)=[0.38(z-0.99)(z-0.14)2000(z-0.82)(z-0.37)20004.12(z-0.82)(z-0.14)2],W3(z)=[1.6(z-0.98)(z-0.25)002.2(z-0.98)(z-0.25)].The weighting matrixW1 minimizes the sensitivity function, which is a low-frequency signal. Hence, the cutoff frequency of W1, a low-pass filter, is selected to minimize the sensitivity within the range of the operating frequency of Sarika-2 (10 rad/sec). Weighting matrix W2 is chosen to reduce the effect of measurement noise, which results due to the reduction of cosensitivity outside the range of the operating frequency of the vehicle (above 10 rad/sec). W3 helps in minimizing the control effort at high-frequency region. So, it must be a high-pass filter, with a cutoff frequency of 10 rad/sec.With the choice of the weighting matrices as indicated in (21), the order (n) of the generalized plant is 24 (4 states for MAV airframe, 2 states for actuator, 2 states for delay units, and 16 states for weighting matrices W1,W2, and W3). Since the design of fixed low-order controller does not address optimal/minimal order of the controller that can meet design specifications, controllers of order 1 to 5 are designed separately and stability and performance characteristics of controllers of decreasing order are compared with the full (24th) order controller. The first column of Table 2 gives the order of controllers designed separately. Columns 2 and 3 contain the values of cost functions, J(Ac,Bc,Cc,Dc)Q,R and J(Ac,Bc,Cc,Dc)V,W computed using (19). The first-order necessary optimality conditions are satisfied in each case, which is illustrated by the fact that J(Ac,Bc,Cc,Dc)Q,R and J(Ac,Bc,Cc,Dc)V,W are nearly equal [14].Table 2
Simulation results.
ncJ(Ac,Bc,Cc,Dc)Q,RJ(Ac,Bc,Cc,Dc)V,W(SiK)-1Test forQuadratic stabilityRobust stability,tμ-upper bound242455.042455.011.2113.2%−1.12 × 10−41.4552455.052455.021.208114.14%−1.13 × 10−41.46742455.542455.471.25138.89%−7.27 × 10−31.95832455.672455.511.497125.01%−6.5 × 10−61.80222498.642506.260.62993.323%−0.0101931.37113397.223397.260.159UnstableUnstableUnstableThe cost function is almost constant (aroundJ=2455) for nc = 24 and 5 to 3, which implies that by increasing the order of the controller above 3, this does not significantly improve the performance of the closed-loop system. Similarly, increase in the cost function from J=2455 to J=2498 by reducing the order of the controller from nc=3 to nc=2 implies the performance deterioration of the closed-loop system. Hence, the minimal order of the controller is 3. Fourth column of Table 2 indicates that the robustness against the additive uncertainty (SiK)-1, remains at 1.497 and does not show any improvement by increasing the order of the controller above 3. Also, with third-order controller, the quadratic stability (Column 5 of Table 2) is assured around 125.01% of the parametric uncertainty levels in contrast to that of only 93.3%, which is obtained with second order controller. This implies that with third-order controller, the closed-loop system is capable of withstanding at least 125.0133% of the assumed plant uncertainty, without being destabilized. There exists a parameter-dependent Lyapunov function in each case, which is indicated by a negative t (for feasibility) in column 6 of Table 2. Existence of parameter-dependent Lyapunov function implies robust stability against the slowly varying uncertainties [24, 25].Figure4 shows the comparison of the frequency responses of third- and 24th-order controllers. The frequency response remains in close neighborhood for two controllers in the frequency range of 1 to 100 rad/sec. This further substantiates the selection of third-order controller.Frequency response of 3rd (—) and 24th (……) order controllers.
(a)(b)(c)(d)(e)(f)The six elements of transfer function matrix of the third order controllerK2×3 are given by  (22)K(z)=1Δ(z)[-0.48(z-0.85)(z-0.98)-0.58(z-0.85)(z-0.99)0.21(z-0.86)(z-0.98)-0.09(z-0.57)(z-0.98)-0.11(z-0.575)(z-0.99)0.04(z-0.57)(z-0.98)],where Δ(z)=(z-0.945)(z2-0.6687z+0.1265). The frequency responses of the transfer function from lateral acceleration ay, roll rate p, and yaw rate r to aileron and rudder input channels show wash out or lead filter characteristics. This implies that the control surfaces are active only during the transient and are unaffected when the outputs reach steady state, which is desirable. The phase lead of the controller helps in overcoming the phase lag of the low bandwidth and light weight actuator. The closed-loop dutch-roll damping is calculated at different flight conditions (using the controller designed at the flight speed of 20 m/sec). As per the design specifications, the dutch-roll damping remains above 0.5 at all the flight conditions.


## 6. Performance and Robustness Analysis

Plots of the singular values ofSo, SiK and T (6) with a third-order controller at three different flight speeds (16 m/sec, 20 m/sec and 26 m/sec) are shown in Figure 5.Singular values ofSo, SiK and T (16 m/s: dotted line, 20 m/s: bold line, 26 m/s: dash-dot line).
(a)(b)(c)Singular values ofSofor the lateral acceleration, roll rate, and yaw rate loops show slight deviation from one another at low frequencies (below 8 rad/sec), having a magnitude in the neighborhood of 0 dB in the negative side. Larger attenuation of the singular values of the yaw rate compared to that of the lateral acceleration and roll rate indicates that among the three outputs, yaw rate and hence beta response is least affected by the output disturbances. The nonminimum phase zeros of the open-loop system limits the lower bound of the sensitivity that can be achieved.Low values of SiK at low frequencies (up to 40 rad/sec) indicate very good stability robustness properties of the closed-loop system against the additive uncertainty, Δa. Though the upper bound of SiK increases in the frequency range beyond 40 rad/sec, it is well within the 0 dB, indicating positive gain margin. This property is preserved at all flight conditions. The singular values of T show an attenuation of −60 dB/decade beyond ω = 10 rad/sec, corroborating good noise attenuation by a factor of 1000, which is acceptable.Figure6 gives responses of the closed-loop system and plant (aircraft) due to atmospheric turbulence.Response to gust input.
(a)(b)(c)(d)Turbulence input is generated by passing a zero mean and variance of 0.01 m2/s, band limited white noise through a forming filter [3, 20]. Closed-loop responses (— lines) of ay, p, r, and β in Figure 6 show a significant reduction in magnitude compared to the corresponding plant responses (…… lines) (attenuation of 50% on ay response, 33% on β response). In other words, the variance of ay of the closed-loop system is reduced to 2.2558 m/sec2 from 8.6635 m/sec2. Similarly, the variances of p, r, and β of the closed-loop system reduce to 90.0325 deg/sec, 27.5604 deg/sec, and 0.3089 degrees from their corresponding values of plant response of 316.9422 deg/sec, 111.4768 deg/sec, and 1.0575 degrees respectively.


### 6.1. Perturbation Analysis

The robust stability and performance of the closed-loop system at all flight conditions (using a controller designed at the nominal flight speed of 20 m/sec) are further demonstrated by using LMI-based tests [24, 25]. For this, affine parameter-dependent plant models are developed by assuming structured real-valued parametric uncertainties (i.e., by perturbing the stability derivatives of the vehicle) at each of the flight conditions. At 20 m/sec of cruise speed, the quadratic stability of the closed-loop system is established with 125.0133% of the prescribed uncertain parameter box. Likewise, at 16 m/sec and 26 m/sec of cruise speeds, the quadratic stability of the closed-loop system is preserved with 103.185% and 101.861% of the uncertain parameter box, respectively. For the same uncertainty levels, μ upper bound is around 0.5549, 0.6454, and 0.6745 at cruise speeds of 20, 16 and 26 m/sec, respectively. Thus, largest amount of uncertainty Δ that can be tolerated without losing stability is 1.802, 1.549, and 1.483, which is greater than the required lower bound of 1.0.


### 6.2. Time Response Study

Roll rate command is applied to aileron control stick in the form of pulse width modulated signal given in the units of milliseconds (with respect to the neutral or bias value of 1.5 msec, which corresponds to the zero deflection of the aileron control surface). In the simulation study, a 20 msec delay is included at the input of the aileron and rudder, which accounts for the computational delays. A wideband sensor noise of zero-mean and variance of 0.005 volts is introduced in the simulation. At first, the aircraft is trimmed for straight and level flight at an altitude of 1000 m above the sea level (i.e., 100 m above the ground level at Bangalore). A positive pulse of two-second duration and an amplitude of 0.1 msec (with respect to the nominal value of 1.5 msec) corresponding to −3.84 degree aileron deflection is applied to the aileron channel att=1sec. This input is followed by a negative pulse of two second duration and amplitude of 0.1 msec, which corresponds to a 3.84 degree aileron deflection. This input pattern is equivalent of moving the aileron channel joystick from its neutral point to one side then to the other side and back to the neutral point. Simulation study is presented for the three models corresponding to the cruise speeds of 16, 20, and 26 m/sec.Figures7, 8, and 9 give the time responses of the closed-loop system to the above-mentioned command input. For the better appreciation of the performance robustness of the closed-loop system, the time responses are also simulated by perturbing the plant matrices (by 50% and 20% on dynamic and static stability derivatives, resp.). In Figures 7–9, the response plots up to 15 sec correspond to the unperturbed (nominal) plant whereas plots for time t>15sec correspond to the perturbed plant. Though the responses of the perturbed plant are highly oscillatory, the closed-loop system responses of both perturbed and nominal plants settle down relatively faster than that of uncontrolled aircraft responses. Clearly, the fixed gain controller robustly stabilizes all the nominal and perturbed plants at the three cruise speeds, whereas the perturbed plant response (at 16 m/sec of flight speed) diverges leading to instability. The instability of the perturbed plant is due to the shift of the aerodynamic centre ahead of the centre of gravity of the aircraft. In addition, gust disturbance and sensor noise are rejected at all flight conditions. The closed-loop system responses of both ay and β for nominal and perturbed plant are appreciably attenuated. Further, the closed-loop responses of p and r are well damped with a fast settling time of 7 sec. The fast settling and well-damped responses for both nominal and perturbed plant models at all flight conditions, with the fixed gain controller, demonstrate the robust performance against the parameter variation. Control surface deflections in Figure 9 show that deflections are well within its upper bounds of ±16 degrees when the PWM command signal reaches its maximum value of ±0.4 msec. For the given positive aileron deflection, note that the rudder deflections are negative by virtue of which rudder coordinates the turn avoiding adverse yaw effects.Responses ofay and p of the nominal and perturbed plant (solid line: closed-loop response, dotted line: plant response).
(a)(b)Responses ofr and β of the nominal and perturbed plant (solid line: closed-loop response, dotted line: plant response).
(a)(b)Responses ofδa and  δr of the nominal and perturbed plant (solid line: closed-loop response, dotted line: plant response).
(a)(b)


## 6.1. Perturbation Analysis

The robust stability and performance of the closed-loop system at all flight conditions (using a controller designed at the nominal flight speed of 20 m/sec) are further demonstrated by using LMI-based tests [24, 25]. For this, affine parameter-dependent plant models are developed by assuming structured real-valued parametric uncertainties (i.e., by perturbing the stability derivatives of the vehicle) at each of the flight conditions. At 20 m/sec of cruise speed, the quadratic stability of the closed-loop system is established with 125.0133% of the prescribed uncertain parameter box. Likewise, at 16 m/sec and 26 m/sec of cruise speeds, the quadratic stability of the closed-loop system is preserved with 103.185% and 101.861% of the uncertain parameter box, respectively. For the same uncertainty levels, μ upper bound is around 0.5549, 0.6454, and 0.6745 at cruise speeds of 20, 16 and 26 m/sec, respectively. Thus, largest amount of uncertainty Δ that can be tolerated without losing stability is 1.802, 1.549, and 1.483, which is greater than the required lower bound of 1.0.


## 6.2. Time Response Study

Roll rate command is applied to aileron control stick in the form of pulse width modulated signal given in the units of milliseconds (with respect to the neutral or bias value of 1.5 msec, which corresponds to the zero deflection of the aileron control surface). In the simulation study, a 20 msec delay is included at the input of the aileron and rudder, which accounts for the computational delays. A wideband sensor noise of zero-mean and variance of 0.005 volts is introduced in the simulation. At first, the aircraft is trimmed for straight and level flight at an altitude of 1000 m above the sea level (i.e., 100 m above the ground level at Bangalore). A positive pulse of two-second duration and an amplitude of 0.1 msec (with respect to the nominal value of 1.5 msec) corresponding to −3.84 degree aileron deflection is applied to the aileron channel att=1sec. This input is followed by a negative pulse of two second duration and amplitude of 0.1 msec, which corresponds to a 3.84 degree aileron deflection. This input pattern is equivalent of moving the aileron channel joystick from its neutral point to one side then to the other side and back to the neutral point. Simulation study is presented for the three models corresponding to the cruise speeds of 16, 20, and 26 m/sec.Figures7, 8, and 9 give the time responses of the closed-loop system to the above-mentioned command input. For the better appreciation of the performance robustness of the closed-loop system, the time responses are also simulated by perturbing the plant matrices (by 50% and 20% on dynamic and static stability derivatives, resp.). In Figures 7–9, the response plots up to 15 sec correspond to the unperturbed (nominal) plant whereas plots for time t>15sec correspond to the perturbed plant. Though the responses of the perturbed plant are highly oscillatory, the closed-loop system responses of both perturbed and nominal plants settle down relatively faster than that of uncontrolled aircraft responses. Clearly, the fixed gain controller robustly stabilizes all the nominal and perturbed plants at the three cruise speeds, whereas the perturbed plant response (at 16 m/sec of flight speed) diverges leading to instability. The instability of the perturbed plant is due to the shift of the aerodynamic centre ahead of the centre of gravity of the aircraft. In addition, gust disturbance and sensor noise are rejected at all flight conditions. The closed-loop system responses of both ay and β for nominal and perturbed plant are appreciably attenuated. Further, the closed-loop responses of p and r are well damped with a fast settling time of 7 sec. The fast settling and well-damped responses for both nominal and perturbed plant models at all flight conditions, with the fixed gain controller, demonstrate the robust performance against the parameter variation. Control surface deflections in Figure 9 show that deflections are well within its upper bounds of ±16 degrees when the PWM command signal reaches its maximum value of ±0.4 msec. For the given positive aileron deflection, note that the rudder deflections are negative by virtue of which rudder coordinates the turn avoiding adverse yaw effects.Responses ofay and p of the nominal and perturbed plant (solid line: closed-loop response, dotted line: plant response).
(a)(b)Responses ofr and β of the nominal and perturbed plant (solid line: closed-loop response, dotted line: plant response).
(a)(b)Responses ofδa and  δr of the nominal and perturbed plant (solid line: closed-loop response, dotted line: plant response).
(a)(b)


## 7. Real-Time Hardware-in-the-Loop-Validation of the Controller

Experimental setup of hardware-in-loop-simulation (HILS) includes a simulation computer and onboard computer named flight instrumentation computer (FIC) built with two digital signal processors (DSPs): TMS320LF2407 and TMS320VC33 from Texas Instruments, USA. Onboard computer hardware (of size 139.7 mm × 50.8 mm and weight 55 grams) has been developed in-house. The integration of an on board computer, capable of real-time implementation of flight control, within Sarika-2 is a technically challenging task owing to the stringent constraints on cost, size, weight, and power limitations. The FIC has additional onboard program (256 Kbytes) and data (4 Mbytes) memories. FIC is capable of acquiring data (with 10 Hz low-pass filter and necessary signal conditioning with a gain of 20 on rate channel and a unity gain on acceleration channel), internal data logging, executing multi-input multi-output discrete control logic in real time, and generation and capturing of PWM signals.The simulation computer is Pentium 4 PC (Windows 2000 OS) operating at 3.4 GHz with dSPACE DS1104RTI/RTW. The DS1104 is a complete real-time control system which is based on a Power PC 603 floating-point processor running at 250 MHz. The constitutive building blocks of the HILS facility or setup are given in Figure10. The lateral flight dynamic model, running on the desktop computer, calculates the vehicle’s roll rate, yaw rate, and lateral acceleration response, and DS1104 system subsequently generates the equivalent analog sensor signal in volts. Sensitivities of MEMS-based sensors used for Sarika-2 are (1) rate gyros: 1.11 mv/deg/s (with an offset voltage of 2.25 volts) and (2) Accelerometer: 500 mv/g (with a bias of 2.5 volts). Hence, the electrical output of sensors are simulated (sent out through digital to analog converter, DAC of DS1104), according to the relation,
(23)Veq(porr)=0.063603×(porr)+Voffset(porr),Veq(ay)=0.05×(ay)+Voffset(ay).Figure 10
Block diagram representation of HILS.


### 7.1. Controller Implementation and Validation

The control law realization on FIC comprises four main routines that is: (1) initialization routines (2) delay routine to erase the flash memory in order to store new set of flight data (3) sensor Calibration routines, and (4) interrupt routines. Owing to the requirement of updating the servos for every 20 msec, entire task scheduling (Figure11) is repeated for every 20 msec.Figure 11
Task scheduling for the control law implementation.In order to meet the critical requirement of updating servo position for every 20 msec, a software timer period interrupt, which sequences the four functions (data acquisition, PWM capture, control law calculation, and PWM generation), is enabled. Software capture interrupt is enabled so as to receive the latest pilot command inputs from the radio-controlled transmitter. An external hardware interrupt XINT2, which has the highest priority, is also enabled that can momentarily halt the control law calculation and data acquisition. XINT2 interrupt is used to retrieve the flight data from the flash memory to the personal computer. As shown in Figure11, processor completes the entire task in 8.18 msec and waits for the period interrupt to start the next cycle. Hence, there will not be any timing mismatch or clash between the PWM signals sent from the transmitter and from the controller.The control law coded on FIC is validated using HILS experimental setup, which provides a real flight environment to the controller. FIC receives the real-time hardware in the loop simulated sensor signals (given in (23)) from DAC unit of dSPACE1104 RTI/RTW and PWM signals (which is transmitted from joystick controller by the ground pilot) from the RF receiver, Futaba R136F. Since the inputs to the controller are in volts (from the sensors) and the outputs needs to be in milliseconds to drive the actuators, a relation (or conversion factor) between the voltage to PWM signal width is found experimentally as
(24)PWMsignalwidth=(Vsignal-Voffset)×1.18msec.
The FIC continuously receives the analog signals from dSPACE 1104 and converts it into an equivalent PWM signals. On the basis of these two inputs, controller outputs are generated and are feedback to the simulated actuators through the capture unit of dSPACE1104 RTI/RTW.The real-time command signals received by the radio frequency receiver and the emulated sensor signals from the HILS (corresponding to the flight speed of 20 m/sec) are plotted in Figure12. The aileron input is a doublet of −0.1 to 0.1 ms (with respect to the neutral value of 1.5 msec, i.e., ±3.84 degree aileron deflection). The rudder command is held at its neutral position. The aircraft response shows a roll rate varying from −0.04 volts (≈−36 degrees/sec) to 0.02 volts (≈18 degrees/sec). Therefore, the aileron input of −0.4 msec, with respect to the neutral position, corresponds to a maximum roll rate of −144 deg/sec, while a 0.4 msec aileron input corresponds to a maximum of 72 degrees/sec. Similarly, yaw rate response varies between a maximum of 0.01 volts (≈9 degrees/sec) to −0.004 volts (≈−4 degrees/sec). The lateral acceleration varies between ±0.16 volts (≈±0.3g), implying a maximum of 1.2 g excursion when the input is ±0.4ms with respect to the neutral position.Command input, controller output and HILS responses ofay, p, and r.
(a)(b)Comparison between the actual and expected output of the controller at 20 m/sec of cruise speed is shown in Figure13. The actual outputs are obtained from the FIC, and the expected outputs are obtained from the simulation using SIMULINK tools. A delay of 0.1 sec is noticed between the actual and expected output of the controller, which is due to the transportation delay unit introduced during simulation (in dSPACE 1104). However, this delay will not occur in reality. On the aileron channel, the actual output shows a small offset of ±0.01msec with respect to that of simulated output. On the other hand, the mismatch on rudder channel is almost zero. In real applications, a 0.01 msec of offset in PWM signal on the aileron channel gives a disparity of 0.4 degree of aileron deflection. However, since the controller is robust, this mismatch is acceptable.Comparison between the actual and expected output of the controller.
(a)(b)


## 7.1. Controller Implementation and Validation

The control law realization on FIC comprises four main routines that is: (1) initialization routines (2) delay routine to erase the flash memory in order to store new set of flight data (3) sensor Calibration routines, and (4) interrupt routines. Owing to the requirement of updating the servos for every 20 msec, entire task scheduling (Figure11) is repeated for every 20 msec.Figure 11
Task scheduling for the control law implementation.In order to meet the critical requirement of updating servo position for every 20 msec, a software timer period interrupt, which sequences the four functions (data acquisition, PWM capture, control law calculation, and PWM generation), is enabled. Software capture interrupt is enabled so as to receive the latest pilot command inputs from the radio-controlled transmitter. An external hardware interrupt XINT2, which has the highest priority, is also enabled that can momentarily halt the control law calculation and data acquisition. XINT2 interrupt is used to retrieve the flight data from the flash memory to the personal computer. As shown in Figure11, processor completes the entire task in 8.18 msec and waits for the period interrupt to start the next cycle. Hence, there will not be any timing mismatch or clash between the PWM signals sent from the transmitter and from the controller.The control law coded on FIC is validated using HILS experimental setup, which provides a real flight environment to the controller. FIC receives the real-time hardware in the loop simulated sensor signals (given in (23)) from DAC unit of dSPACE1104 RTI/RTW and PWM signals (which is transmitted from joystick controller by the ground pilot) from the RF receiver, Futaba R136F. Since the inputs to the controller are in volts (from the sensors) and the outputs needs to be in milliseconds to drive the actuators, a relation (or conversion factor) between the voltage to PWM signal width is found experimentally as
(24)PWMsignalwidth=(Vsignal-Voffset)×1.18msec.
The FIC continuously receives the analog signals from dSPACE 1104 and converts it into an equivalent PWM signals. On the basis of these two inputs, controller outputs are generated and are feedback to the simulated actuators through the capture unit of dSPACE1104 RTI/RTW.The real-time command signals received by the radio frequency receiver and the emulated sensor signals from the HILS (corresponding to the flight speed of 20 m/sec) are plotted in Figure12. The aileron input is a doublet of −0.1 to 0.1 ms (with respect to the neutral value of 1.5 msec, i.e., ±3.84 degree aileron deflection). The rudder command is held at its neutral position. The aircraft response shows a roll rate varying from −0.04 volts (≈−36 degrees/sec) to 0.02 volts (≈18 degrees/sec). Therefore, the aileron input of −0.4 msec, with respect to the neutral position, corresponds to a maximum roll rate of −144 deg/sec, while a 0.4 msec aileron input corresponds to a maximum of 72 degrees/sec. Similarly, yaw rate response varies between a maximum of 0.01 volts (≈9 degrees/sec) to −0.004 volts (≈−4 degrees/sec). The lateral acceleration varies between ±0.16 volts (≈±0.3g), implying a maximum of 1.2 g excursion when the input is ±0.4ms with respect to the neutral position.Command input, controller output and HILS responses ofay, p, and r.
(a)(b)Comparison between the actual and expected output of the controller at 20 m/sec of cruise speed is shown in Figure13. The actual outputs are obtained from the FIC, and the expected outputs are obtained from the simulation using SIMULINK tools. A delay of 0.1 sec is noticed between the actual and expected output of the controller, which is due to the transportation delay unit introduced during simulation (in dSPACE 1104). However, this delay will not occur in reality. On the aileron channel, the actual output shows a small offset of ±0.01msec with respect to that of simulated output. On the other hand, the mismatch on rudder channel is almost zero. In real applications, a 0.01 msec of offset in PWM signal on the aileron channel gives a disparity of 0.4 degree of aileron deflection. However, since the controller is robust, this mismatch is acceptable.Comparison between the actual and expected output of the controller.
(a)(b)


## 8. Conclusions

Design and development of a discrete fixed-order robustH2 flight stabilization system for microair vehicle, named Sarika-2, is presented. This paper illustrates the design of a robust fixed-order H2—optimal controller using frequency-dependent weighting functions, on the basis of strengthened discrete optimal projection equations. The reduced fixed-order H2 controller, designed by a direct single-step procedure, ensures both stability and optimality of the closed-loop system. The controller also imparts robust performance against 50% and 20% parametric uncertainties of the dynamic and static stability derivatives. The perturbation analysis also demonstrates that it is possible to stabilize an unstable perturbed plant by a controller designed for a single plant. The washout characteristic of feedback loops makes control activity zero during steady state operation. The controller allows the wing to autolevel immediately after execution of coordinated turn or withdrawal of side wind gust input, which is beneficial for reconnaissance missions. Time responses of the closed-loop simulation, using real-time hardware in the loop simulation experimental setup, match well with the responses of corresponding offline simulation. Thus, the robust fixed-order H2 controller implemented on flight instrumentation computer can be successfully used for the flight control of Sarika-2 microair vehicle.



---

*Source: 594086-2011-12-19.xml*