## Robust Control Toolbox |

This example shows how to use mu-analysis and synthesis tools in the Robust Control Toolbox™. It describes the design of a robust controller for the lateral-directional axis of an aircraft during powered approach to landing. The linearized model of the aircraft is obtained for an angle-of-attack of 10.5 degrees and airspeed of 140 knots.

The illustration below shows a block diagram of the closed-loop system. The diagram includes the nominal aircraft model, the controller `K`, as well as elements capturing the model uncertainty and performance objectives (see next sections for details).

**Figure 1:** Robust Control Design for Aircraft Lateral Axis

The design goal is to make the airplane respond effectively to the pilot's lateral stick and rudder pedal inputs. The performance specifications include:

Decoupled responses from lateral stick

`p_cmd`to roll rate`p`and from rudder pedals`beta_cmd`to side-slip angle`beta`. The lateral stick and rudder pedals have a maximum deflection of +/- 1 inch.

The aircraft handling quality (HQ) response from lateral stick to roll rate

`p`should match the first-order response

```
HQ_p = 5.0 * tf(2.0,[1 2.0]);
step(HQ_p), title('Desired response from lateral stick to roll rate (Handling Quality)')
```

**Figure 2:** Desired response from lateral stick to roll rate.

The aircraft handling quality response from the rudder pedals to the side-slip angle

`beta`should match the damped second-order response.

```
HQ_beta = -2.5 * tf(1.25^2,[1 2.5 1.25^2]);
step(HQ_beta), title('Desired response from rudder pedal to side-slip angle (Handling Quality)')
```

**Figure 3:** Desired response from rudder pedal to side-slip angle.

The stabilizer actuators have +/- 20 deg and +/- 50 deg/s limits on their deflection angle and deflection rate. The rudder actuators have +/- 30 deg and +/-60 deg/s deflection angle and rate limits.

The three measurement signals ( roll rate

`p`, yaw rate`r`, and lateral acceleration`yac`) are filtered through second-order anti-aliasing filters:

freq = 12.5 * (2*pi); % 12.5 Hz zeta = 0.5; yaw_filt = tf(freq^2,[1 2*zeta*freq freq^2]); lat_filt = tf(freq^2,[1 2*zeta*freq freq^2]); freq = 4.1 * (2*pi); % 4.1 Hz zeta = 0.7; roll_filt = tf(freq^2,[1 2*zeta*freq freq^2]); AAFilters = append(roll_filt,yaw_filt,lat_filt);

**From Specs to Weighting Functions**

H-infinity design algorithms seek to minimize the largest closed-loop gain across frequency (H-infinity norm). To apply these tools, we must first recast the design specifications as constraints on the closed-loop gains. We use **weighting functions** to "normalize" the specifications across frequency and to equally weight each requirement.

We can express the design specs in terms of weighting functions as follows:

To capture the limits on the actuator deflection magnitude and rate, pick a diagonal, constant weight

`W_act`, corresponding to the stabilizer and rudder deflection rate and deflection angle limits.

W_act = ss(diag([1/50,1/20,1/60,1/30]));

Use a 3x3 diagonal, high-pass filter

`W_n`to model the frequency content of the sensor noise in the roll rate, yaw rate, and lateral acceleration channels.

```
W_n = append(0.025,tf(0.0125*[1 1],[1 100]),0.025);
clf, bodemag(W_n(2,2)), title('Sensor noise power as a function of frequency')
```

**Figure 4:** Sensor noise power as a function of frequency

The response from lateral stick to

`p`and from rudder pedal to`beta`should match the handling quality targets`HQ_p`and`HQ_beta`. This is a model-matching objective: to minimize the difference (peak gain) between the desired and actual closed-loop transfer functions. Performance is limited due to a right-half plane zero in the model at 0.002 rad/s, so accurate tracking of sinusoids below 0.002 rad/s is not possible. Accordingly, we'll weight the first handling quality spec with a bandpass filter`W_p`that emphasizes the frequency range between 0.06 and 30 rad/sec.

```
W_p = tf([0.05 2.9 105.93 6.17 0.16],[1 9.19 30.80 18.83 3.95]);
clf, bodemag(W_p), title('Weight on Handling Quality spec')
```

**Figure 5:** Weight on handling quality spec.

Similarly, pick

`W_beta=2*W_p`for the second handling quality spec

W_beta = 2*W_p;

Here we scaled the weights `W_act`, `W_n`, `W_p`, and `W_beta` so the closed-loop gain between all external inputs and all weighted outputs is less than 1 at all frequencies.

A pilot can command the lateral-directional response of the aircraft with the lateral stick and rudder pedals. The aircraft has the following characteristics:

Two control inputs: differential stabilizer deflection

`delta_stab`in degrees, and rudder deflection`delta_rud`in degrees.Three measured outputs: roll rate

`p`in deg/s, yaw rate`r`in deg/s, and lateral acceleration`yac`in g's.One calculated output: side-slip angle

`beta`.

The nominal lateral directional model `LateralAxis` has four states:

Lateral velocity

`v`Yaw rate

`r`Roll rate

`p`Roll angle

`phi`

These variables are related by the state space equations:

where `x = [v; r; p; phi]`, `u = [delta_stab; delta_rud]`, and `y = [beta; p; r; yac]`.

```
load LateralAxisModel
LateralAxis
```

LateralAxis = a = v r p phi v -0.116 -227.3 43.02 31.63 r 0.00265 -0.259 -0.1445 0 p -0.02114 0.6703 -1.365 0 phi 0 0.1853 1 0 b = delta_stab delta_rud v 0.0622 0.1013 r -0.005252 -0.01121 p -0.04666 0.003644 phi 0 0 c = v r p phi beta 0.2469 0 0 0 p 0 0 57.3 0 r 0 57.3 0 0 yac -0.002827 -0.007877 0.05106 0 d = delta_stab delta_rud beta 0 0 p 0 0 r 0 0 yac 0.002886 0.002273 Continuous-time state-space model.

The complete airframe model also includes actuators models `A_S` and `A_R`. The actuator outputs are their respective deflection rates and angles. The actuator rates are used to penalize the actuation effort.

A_S = [tf([25 0],[1 25]); tf(25,[1 25])]; A_S.OutputName = {'stab_rate','stab_angle'}; A_R = A_S; A_R.OutputName = {'rud_rate','rud_angle'};

**Accounting for Modeling Errors**

The nominal model only approximates true airplane behavior. To account for unmodeled dynamics, you can introduce a relative term or multiplicative uncertainty `W_in*Delta_G` at the plant input, where the error dynamics `Delta_G` have gain less than 1 across frequencies, and the weighting function `W_in` reflects the frequency ranges in which the model is more or less accurate. There are typically more modeling errors at high frequencies so `W_in` is high pass.

% Normalized error dynamics Delta_G = ultidyn('Delta_G',[2 2],'Bound',1.0); % Frequency shaping of error dynamics w_1 = tf(2.0*[1 4],[1 160]); w_2 = tf(1.5*[1 20],[1 200]); W_in = append(w_1,w_2); bodemag(w_1,'-',w_2,'--') title('Relative error on nominal model as a function of frequency') legend('stabilizer','rudder','Location','NorthWest');

**Figure 6:** Relative error on nominal aircraft model as a function of frequency.

**Building an Uncertain Model of the Aircraft Dynamics**

Now that we have quantified modeling errors, we can build an uncertain model of the aircraft dynamics corresponding to the dashed box in the Figure 7 (same as Figure 1):

**Figure 7:** Aircraft dynamics.

Use the `connect` function to combine the nominal airframe model `LateralAxis`, the actuator models `A_S` and `A_R`, and the modeling error description `W_in*Delta_G` into a single uncertain model `Plant_unc` mapping `[delta_stab; delta_rud]` to the actuator and plant outputs:

% Actuator model with modeling uncertainty Act_unc = append(A_S,A_R) * (eye(2) + W_in*Delta_G); Act_unc.InputName = {'delta_stab','delta_rud'}; % Nominal aircraft dynamics Plant_nom = LateralAxis; Plant_nom.InputName = {'stab_angle','rud_angle'}; % Connect the two subsystems Inputs = {'delta_stab','delta_rud'}; Outputs = [A_S.y ; A_R.y ; Plant_nom.y]; Plant_unc = connect(Plant_nom,Act_unc,Inputs,Outputs);

This produces an uncertain state-space (USS) model `Plant_unc` of the aircraft:

Plant_unc

Plant_unc = Uncertain continuous-time state-space model with 8 outputs, 2 inputs, 8 states. The model uncertainty consists of the following blocks: Delta_G: Uncertain 2x2 LTI, peak gain = 1, 1 occurrences Type "Plant_unc.NominalValue" to see the nominal value, "get(Plant_unc)" to see all properties, and "Plant_unc.Uncertainty" to interact with the uncertain elements.

**Analyzing How Modeling Errors Affect Open-Loop Responses**

We can analyze the effect of modeling uncertainty by picking random samples of the unmodeled dynamics `Delta_G` and plotting the nominal and perturbed time responses (Monte Carlo analysis). For example, for the differential stabilizer channel, the uncertainty weight `w_1` implies a 5% modeling error at low frequency, increasing to 100% after 93 rad/sec, as confirmed by the Bode diagram below.

% Pick 10 random samples Plant_unc_sampl = usample(Plant_unc,10); % Look at response from differential stabilizer to beta figure('Position',[100,100,560,500]) subplot(211), step(Plant_unc.Nominal(5,1),'r+',Plant_unc_sampl(5,1),'b-',10) legend('Nominal','Perturbed') subplot(212), bodemag(Plant_unc.Nominal(5,1),'r+',Plant_unc_sampl(5,1),'b-',{0.001,1e3}) legend('Nominal','Perturbed')

**Figure 8:** Step response and Bode diagram.

**Designing the Lateral-Axis Controller**

Proceed with designing a controller that robustly achieves the specifications, where robustly means for any perturbed aircraft model consistent with the modeling error bounds `W_in`.

First we build an open-loop model `OLIC` mapping the external input signals to the performance-related outputs as shown below.

**Figure 9:** Open-loop model mapping external input signals to performance-related outputs.

To build this model, start with the block diagram of the closed-loop system, remove the controller block K, and use `connect` to compute the desired model. As before, the connectivity is specified by labeling the inputs and outputs of each block.

**Figure 10:** Block diagram for building open-loop model.

% Label block I/Os AAFilters.u = {'p','r','yac'}; AAFilters.y = 'AAFilt'; W_n.u = 'noise'; W_n.y = 'Wn'; HQ_p.u = 'p_cmd'; HQ_p.y = 'HQ_p'; HQ_beta.u = 'beta_cmd'; HQ_beta.y = 'HQ_beta'; W_p.u = 'e_p'; W_p.y = 'z_p'; W_beta.u = 'e_beta'; W_beta.y = 'z_beta'; W_act.u = [A_S.y ; A_R.y]; W_act.y = 'z_act'; % Specify summing junctions Sum1 = sumblk('%meas = AAFilt + Wn',{'p_meas','r_meas','yac_meas'}); Sum2 = sumblk('e_p = HQ_p - p'); Sum3 = sumblk('e_beta = HQ_beta - beta'); % Connect everything OLIC = connect(Plant_unc,AAFilters,W_n,HQ_p,HQ_beta,... W_p,W_beta,W_act,Sum1,Sum2,Sum3,... {'noise','p_cmd','beta_cmd','delta_stab','delta_rud'},... {'z_p','z_beta','z_act','p_cmd','beta_cmd','p_meas','r_meas','yac_meas'});

This produces the uncertain state-space model

OLIC

OLIC = Uncertain continuous-time state-space model with 11 outputs, 7 inputs, 26 states. The model uncertainty consists of the following blocks: Delta_G: Uncertain 2x2 LTI, peak gain = 1, 1 occurrences Type "OLIC.NominalValue" to see the nominal value, "get(OLIC)" to see all properties, and "OLIC.Uncertainty" to interact with the uncertain elements.

Recall that by construction of the weighting functions, a controller meets the specs whenever the closed-loop gain is less than 1 at all frequencies and for all I/O directions. First design an H-infinity controller that minimizes the closed-loop gain for the nominal aircraft model:

nmeas = 5; % number of measurements nctrls = 2; % number of controls [kinf,~,gammainf] = hinfsyn(OLIC.NominalValue,nmeas,nctrls); gammainf

gammainf = 0.9676

Here `hinfsyn` computed a controller `kinf` that keeps the closed-loop gain below 1 so the specs can be met for the nominal aircraft model.

Next, perform a mu-synthesis to see if the specs can be met robustly when taking into account the modeling errors (uncertainty `Delta_G`). Use the command `dksyn` to perform the synthesis and use `dksynOptions` to set the frequency grid used for mu-analysis and the number of D-K iterations.

fmu = logspace(-2,2,60); opt = dksynOptions('FrequencyVector',fmu,'NumberofAutoIterations',5); [kmu,~,bnd] = dksyn(OLIC,nmeas,nctrls,opt); bnd

bnd = 1.2349

Here the best controller `kmu` cannot keep the closed-loop gain below 1 for the specified model uncertainty, indicating that the specs can be nearly but not fully met for the family of aircraft models under consideration.

**Frequency-Domain Comparison of Controllers**

Compare the performance and robustness of the H-infinity controller `kinf` and mu controller `kmu`. Recall that the performance specs are achieved when the closed loop gain is less than 1 for every frequency.

First use the `lft` function to close the loop around each controller:

clinf = lft(OLIC,kinf); clmu = lft(OLIC,kmu);

To facilitate the analysis, we sample the frequency response of the uncertain closed-loop model over the frequency grid `fmu`, thus creating an **uncertain frequency response** or UFRD:

clinfg = ufrd(clinf,fmu); clmug = ufrd(clmu,fmu);

What is the worst-case performance (in terms of closed-loop gain) of each controller for modeling errors bounded by `W_in`? The `wcgain` command helps you answer this difficult question directly without need for extensive gridding and simulation.

opt = wcgainOptions('MaxOverFrequency','off'); % options for WCGAIN % Compute worst-case gain (as a function of frequency) for kinf [mginf,wcuinf] = wcgain(clinfg,opt); % Compute worst-case gain for kmu [mgmu,wcumu,infomu] = wcgain(clmug,opt);

You can now compare the nominal and worst-case performance for each controller:

clf subplot(211) semilogx(fnorm(clinfg.NominalValue),'r',mginf.UpperBound,'b'); title('Performance analysis for kinf') xlabel('Frequency (rad/sec)') ylabel('Closed-loop gain'); legend('Nominal Plant','Worst-Case','Location','NorthWest'); subplot(212) semilogx(fnorm(clmug.NominalValue),'r',mgmu.UpperBound,'b'); title('Performance analysis for kmu') xlabel('Frequency (rad/sec)') ylabel('Closed-loop gain'); legend('Nominal Plant','Worst-Case','Location','SouthWest');

The first plot shows that while the H-infinity controller `kinf` meets the performance specs for the nominal plant model, its performance can sharply deteriorate (peak gain near 15) for some perturbed model within our modeling error bounds.

In contrast, the mu controller `kmu` has slightly worse performance for the nominal plant when compared to `kinf`, but it maintains this performance consistently for all perturbed models (worst-case gain near 1.25). The mu controller is therefore more **robust** to modeling errors.

**Time-Domain Validation of the Robust Controller**

To further test the robustness of the mu controller `kmu` in the time domain, you can compare the time responses of the nominal and worst-case closed-loop models with the ideal "Handling Quality" response. To do this, first construct the "true" closed-loop model `CLSIM` where all weighting functions and HQ reference models have been removed:

kmu.u = {'p_cmd','beta_cmd','p_meas','r_meas','yac_meas'}; kmu.y = {'delta_stab','delta_rud'}; AAFilters.y = {'p_meas','r_meas','yac_meas'}; CLSIM = connect(Plant_unc(5:end,:),AAFilters,kmu,{'p_cmd','beta_cmd'},{'p','beta'});

Next, create the test signals `u_stick` and `u_pedal` shown below

time = 0:0.02:15; u_stick = (time>=9 & time<12); u_pedal = (time>=1 & time<4) - (time>=4 & time<7); clf subplot(211), plot(time,u_stick), axis([0 14 -2 2]), title('Lateral stick command') subplot(212), plot(time,u_pedal), axis([0 14 -2 2]), title('Rudder pedal command')

You can now compute and plot the ideal, nominal, and worst-case responses to the test commands u_stick and u_pedal

% Ideal behavior IdealResp = append(HQ_p,HQ_beta); IdealResp.y = {'p','beta'}; % Worst-case response WCResp = usubs(CLSIM,wcumu); % Compare responses clf lsim(IdealResp,'g',CLSIM.NominalValue,'r',WCResp,'b:',[u_stick ; u_pedal],time) legend('ideal','nominal','perturbed','Location','SouthEast'); title('Closed-loop responses with mu controller KMU')

The closed-loop response is nearly identical for the nominal and worst-case closed-loop systems. Note that the roll-rate response of the aircraft tracks the roll-rate command well initially and then departs from this command. This is due to a right-half plane zero in the aircraft model at 0.024 rad/sec.