B. Control Design & Implementation (Week 2)

Controller Design

Background

Linear State-Space Representation

Given the linear state-space equations: $\dot{x}=Ax+Bu$ and $y=Cx+Du$ , we define the state for the Quanser Aero Experiment as

x=\begin{bmatrix} \theta(t), & \psi (t), & \dot{\theta}(t), & \dot\psi(t) \end{bmatrix}^T \tag{38}

the output vector as y= \begin{bmatrix} \theta(t), & \psi(t), & \dot{\theta}(t), & \dot{\psi}(t) \end{bmatrix}^T \tag{39}

and the control variables as

u=\begin{bmatrix} V_\theta & V_\psi\end{bmatrix}^T \tag{40}

where $\theta$ and $\psi$ are the pitch and yaw angles, respectively, and $V_\theta$ and $V_\psi$ are the motor voltages applied to the pitch and yaw rotors (i.e. the main and tail rotors). Using the equations of motion in Equations (1) and (2), the state-space matrices are

A=\begin{bmatrix} 0&0&1&0\\ 0 &0&0&1\\ -K_{\theta}/J_\theta & 0& -D_\theta/J_\theta& 0 \\ 0 &0 &0&-D_\psi/J_\psi \end{bmatrix} \tag{41.a}

B=\begin{bmatrix} 0& 0\\ 0&0\\ K_{\theta\theta}/J_\theta & K_{\theta\psi}/J_\theta \\ K_{\psi\theta}/J_{\psi} & K_{\psi\psi}/J_\psi \end{bmatrix} \tag{41.b}

C=\begin{bmatrix} 1&0&0&0\\ 0&1&0&0 \\ 0&0&1&0 \\ 0&0&0&1\end{bmatrix} \tag{41.c}

D=\begin{bmatrix} 0&0\\ 0&0 \\ 0&0\\ 0 & 0\end{bmatrix} \tag{41.d}

In this section, a state-feedback controller is designed to regulate the pitch and yaw angles of the Quanser Aero Experiment to desired angles. Using the previous state-space model, we can find a control gain $K$ based on the coupled dynamics to stabilize the system. The control gains are computed using Linear-Quadratic Regulator (LQR) theory. The general state-feedback control is illustrated in Figure 11. The state-feedback controller is defined

u=K(x_d-x) \tag{42}

where $x$ is the state defined in Equation (38)

x_d=\begin{bmatrix}\theta_d, & \psi_d, & 0,&0\end{bmatrix} ^ T\tag{43}

is the reference command (or setpoint) state with the desired pitch and yaw angles, $\theta_d$ and $\psi_d$ , and

u=\begin{bmatrix} V_\theta&V_\psi\end{bmatrix} ^ T\tag{44}

is the control input where $V_\theta$ is the front/pitch motor voltage and $V_\psi$ is the tail/yaw motor voltage.

Linear Quadratic Regulator (LQR) optimization can be used for finding the control gain parameters of the Quanser Aero Experiment flight control. Given the state-space representation, the LQR algorithm computes a control law $u$ to minimize the performance criterion or cost function:J=\int_0^\infty(x_{\rm ref}-x(t))^TQ(x_{\rm ref}-x(t))+u(t)^TRu(t)dt. \tag{45}

The design matrices $Q$ and $R$ hold the penalties on the deviations of state variables from their setpoint and the control actions, respectively. When an element of $Q$ is increased, therefore, the cost function increases the penalty associated with any deviations from the desired setpoint of that state variable, and thus the specific control gain will be larger. When the values of the $R$ matrix are increased, a larger penalty is applied to the aggressiveness of the control action, and the control gains are uniformly decreased.

Since there are four states , $Q\in \mathbb{R}^{4\times 4}$ , and two control variables, $R\in\mathbb{R}^{2\times 2}$ . The setpoint, $x_d$ (Equation 43) is given above the control strategy used to minimize cost function J is thus given by

u=K(x_d-x)=k_{p,\theta}(\theta_d-\theta)+k_{p,\psi}(\psi_d-\psi)-k_{d,\theta}\dot\theta-k_{d,\psi}\dot\psi \tag{46}

Designing an LQR Controller

Various control software already has LQR optimization routines that can be used to generate the state feedback control gain $K$ . In order for the closed-loop response to satisfy certain time-domain specifications, the closed-loop system is typically simulated using its dynamic model, in software, first. This is an iterative process. By adjusting the weighting matrices $Q$ and $R$ and then running the simulation, we can find a control that satisfies the user's requirements. Further, we must ensure that the control signal $u$ is smooth (i.e. does not chatter) and does not surpass the limits of the actuator.

LQR Control Design and Simulation

LQR is used to find the state-feedback control gain $K$ ( $K$ is $2\times 4$ matrix) that will stabilize the Quanser Aero Experiment to the user's desired pitch and yaw angles. Our desired closed-loop response should match the following specifications. Use MATLAB command K = lqr(A,B,Q,R) to obtain gain, $K$ , matrix.

Desired closed-loop response specifications for pitch

Steady-state error: pitch $e_{\rm ss}$ ≤ 2 $\deg$ , yaw $e_{\rm ss}$ ≤ 2 $\deg$ .
Peak time: $t_{\rm p}$ ≤ 2 s.
Percent Overshoot: $\rm PO$ ≤ 7.5%.
No actuator saturation: $|V_\psi|$ ≤ 24V and $|V_\theta|$ ≤ 24V .

The state-space matrices derived in Equation (41) are entered in the State-Space block in SIMULINK and the control gain is set to the MATLAB variable K.

Running the closed-loop state-feedback LQR simulation

Using parameters from Part A, obtain state-space matrices of the system neglecting coupling effect.
Design $Q,R$ , and $K$ . To start with try with following $Q$ , $R$ and $K$ . Q = diag([200 75 0 0 ]); R = 0.01*eye(2,2); K = lqr(A,B,Q,R)
Build the SIMULINK model of the system
Simulate the closed-loop response of the system with pitch-only command: $\theta_d=10\space \deg$ . (Make sure to change deg to rad in SIMULINK)
Simulate the closed-loop response of the system with yaw only command: $\psi_d=45 \space \deg$ . (Make sure to change deg to rad in SIMULINK)
Simulate the closed-loop response of the system with pitch and yaw command: $\theta_d= 10\space \deg$ and $\psi_d = 45 \space \rm deg$ . (Make sure to change deg to rad in SIMULINK)
Check whether your controller meets the desired specifications.
If it fails to meet the specifications, tune $Q$ and/or $R$ to meet the specifications
Save the data and plot the closed-loop system response for pitch and yaw
Now, use system matrices with coupling effect and use the controller without coupling
Repeat steps 4-6
The closed-loop response in this step does not have to meet the desired specifications
Now, design $Q,R$ , and $K$ with the coupling effect
Build the SIMULINK model of the system
Repeat steps 4-6
Check whether your controller meets the desired specifications.
If it fails to meet the specifications, tune $Q$ and/or $R$ to meet the specifications
Save the data and plot the closed-loop system response for pitch and yaw

Things to check

Results from part A
System matrices neglecting the coupling effect
System response of the system neglecting coupling effect (pitch & yaw)
System matrices with coupling effect
System response of the system with coupling effect (pitch & yaw)

Analysis

What happened when you neglect the coupling effect?
Is there any systematic way to design $Q$ and $R$ ?

Controller Implementation

In this section, the state-feedback control is implemented on the Quanser Aero Experiment using the q_aero_2dof_lqr_control SIMULINK diagram shown in Figure 12 with QUARC.

Download the file into the quanser_aero folder that was used for Week 1.

Desired Closed-Loop Response Specifications

Steady-state error: pitch $e_{\rm ss}$ ≤ 2 $\deg$ , yaw $e_{\rm ss}$ ≤ 2 $\deg$ .
Peak time: $t_{\rm p}$ ≤ 2 s.
Percent Overshoot: $PO$ ≤ 7.5%.
No actuator saturation: $|V_\psi|$ ≤ 24V and $|V_\theta|$ ≤ 24V .

Running the closed-loop state-feedback LQR simulation

Neglecting Coupling Effect

Pitch Command Only

Unlock both pitch and yaw axes to enable the full 2 DOF motion.
Open q_aero_2dof_lqr_control SIMULINK file.
Use the gain $K$ obtained in Part B. neglecting the coupling effect.
Use pitch command (10 deg) only by changing Amp_y to zero.
Copy aerolqrrsp.mat to your own folder and rename it as nocouple_pitch_only.
Examine the obtained closed-loop response and see if it matches the desired specifications.

Yaw Command Only

Use a yaw command (45 deg) only by changing Amp_p to zero.
Run SIMULINK
Copy aero_lqr_rsp.mat to your own folder and rename it as nocouple_yaw_only.
Examine the obtained closed-loop response and see if it matches the desired specifications

Both Yaw and Pitch

Use both pitch and yaw command
Run SIMULINK
Copy aerolqrrsp.mat to your own folder and rename it as nocouple_pitch_yaw.
Examine the obtained closed-loop response and see if it matches the desired specifications

With Coupling Effect

Use the gain $K$ obtained in Part B. with the coupling effect.
Repeat above Pitch Only, Yaw Only and both Yaw and Pitch runs and rename the files as couple_####_###.
Close the Simulink. DO NOT SAVE THE CHANGE!

Analysis Question

Did your controller successfully meet the specs? If not, why?
How does the coupling affect the performance of the controller?
How can we improve the controller?

PreviousA. System Identification (Week 1) last check NextRotary Gyro

Last updated 2 years ago

Was this helpful?

B. Control Design & Implementation (Week 2)

Controller Design

Background

Linear State-Space Representation

Given the linear state-space equations: $\dot{x}=Ax+Bu$ and $y=Cx+Du$ , we define the state for the Quanser Aero Experiment as

x=\begin{bmatrix} \theta(t), & \psi (t), & \dot{\theta}(t), & \dot\psi(t) \end{bmatrix}^T \tag{38}

the output vector as y= \begin{bmatrix} \theta(t), & \psi(t), & \dot{\theta}(t), & \dot{\psi}(t) \end{bmatrix}^T \tag{39}

and the control variables as

u=\begin{bmatrix} V_\theta & V_\psi\end{bmatrix}^T \tag{40}

A=\begin{bmatrix} 0&0&1&0\\ 0 &0&0&1\\ -K_{\theta}/J_\theta & 0& -D_\theta/J_\theta& 0 \\ 0 &0 &0&-D_\psi/J_\psi \end{bmatrix} \tag{41.a}

B=\begin{bmatrix} 0& 0\\ 0&0\\ K_{\theta\theta}/J_\theta & K_{\theta\psi}/J_\theta \\ K_{\psi\theta}/J_{\psi} & K_{\psi\psi}/J_\psi \end{bmatrix} \tag{41.b}

C=\begin{bmatrix} 1&0&0&0\\ 0&1&0&0 \\ 0&0&1&0 \\ 0&0&0&1\end{bmatrix} \tag{41.c}

D=\begin{bmatrix} 0&0\\ 0&0 \\ 0&0\\ 0 & 0\end{bmatrix} \tag{41.d}

u=K(x_d-x) \tag{42}

where $x$ is the state defined in Equation (38)

x_d=\begin{bmatrix}\theta_d, & \psi_d, & 0,&0\end{bmatrix} ^ T\tag{43}

is the reference command (or setpoint) state with the desired pitch and yaw angles, $\theta_d$ and $\psi_d$ , and

u=\begin{bmatrix} V_\theta&V_\psi\end{bmatrix} ^ T\tag{44}

is the control input where $V_\theta$ is the front/pitch motor voltage and $V_\psi$ is the tail/yaw motor voltage.

u=K(x_d-x)=k_{p,\theta}(\theta_d-\theta)+k_{p,\psi}(\psi_d-\psi)-k_{d,\theta}\dot\theta-k_{d,\psi}\dot\psi \tag{46}

Designing an LQR Controller

LQR Control Design and Simulation

Desired closed-loop response specifications for pitch

Steady-state error: pitch $e_{\rm ss}$ ≤ 2 $\deg$ , yaw $e_{\rm ss}$ ≤ 2 $\deg$ .
Peak time: $t_{\rm p}$ ≤ 2 s.
Percent Overshoot: $\rm PO$ ≤ 7.5%.
No actuator saturation: $|V_\psi|$ ≤ 24V and $|V_\theta|$ ≤ 24V .

The state-space matrices derived in Equation (41) are entered in the State-Space block in SIMULINK and the control gain is set to the MATLAB variable K.

Running the closed-loop state-feedback LQR simulation

Using parameters from Part A, obtain state-space matrices of the system neglecting coupling effect.
Design $Q,R$ , and $K$ . To start with try with following $Q$ , $R$ and $K$ . Q = diag([200 75 0 0 ]); R = 0.01*eye(2,2); K = lqr(A,B,Q,R)
Build the SIMULINK model of the system
Simulate the closed-loop response of the system with pitch-only command: $\theta_d=10\space \deg$ . (Make sure to change deg to rad in SIMULINK)
Simulate the closed-loop response of the system with yaw only command: $\psi_d=45 \space \deg$ . (Make sure to change deg to rad in SIMULINK)
Simulate the closed-loop response of the system with pitch and yaw command: $\theta_d= 10\space \deg$ and $\psi_d = 45 \space \rm deg$ . (Make sure to change deg to rad in SIMULINK)
Check whether your controller meets the desired specifications.
If it fails to meet the specifications, tune $Q$ and/or $R$ to meet the specifications
Save the data and plot the closed-loop system response for pitch and yaw
Now, use system matrices with coupling effect and use the controller without coupling
Repeat steps 4-6
The closed-loop response in this step does not have to meet the desired specifications
Now, design $Q,R$ , and $K$ with the coupling effect
Build the SIMULINK model of the system
Repeat steps 4-6
Check whether your controller meets the desired specifications.
If it fails to meet the specifications, tune $Q$ and/or $R$ to meet the specifications
Save the data and plot the closed-loop system response for pitch and yaw

Things to check

Results from part A
System matrices neglecting the coupling effect
System response of the system neglecting coupling effect (pitch & yaw)
System matrices with coupling effect
System response of the system with coupling effect (pitch & yaw)

Analysis

What happened when you neglect the coupling effect?
Is there any systematic way to design $Q$ and $R$ ?

Controller Implementation

In this section, the state-feedback control is implemented on the Quanser Aero Experiment using the q_aero_2dof_lqr_control SIMULINK diagram shown in Figure 12 with QUARC.

Download the file into the quanser_aero folder that was used for Week 1.

22KB

q_aero_2dof_lqr_control.slx

Desired Closed-Loop Response Specifications

Steady-state error: pitch $e_{\rm ss}$ ≤ 2 $\deg$ , yaw $e_{\rm ss}$ ≤ 2 $\deg$ .
Peak time: $t_{\rm p}$ ≤ 2 s.
Percent Overshoot: $PO$ ≤ 7.5%.
No actuator saturation: $|V_\psi|$ ≤ 24V and $|V_\theta|$ ≤ 24V .

Running the closed-loop state-feedback LQR simulation

Neglecting Coupling Effect

Pitch Command Only

Unlock both pitch and yaw axes to enable the full 2 DOF motion.
Open q_aero_2dof_lqr_control SIMULINK file.
Use the gain $K$ obtained in Part B. neglecting the coupling effect.
Use pitch command (10 deg) only by changing Amp_y to zero.
To build the model, click the down arrow on Monitor & Tune under the Hardware tab and then click Build for monitoring . This generates the controller code.
Click Connect button under Monitor & Tune and then run SIMULINK by clicking Start .
Copy aerolqrrsp.mat to your own folder and rename it as nocouple_pitch_only.
Examine the obtained closed-loop response and see if it matches the desired specifications.

Yaw Command Only

Use a yaw command (45 deg) only by changing Amp_p to zero.
Run SIMULINK
Copy aero_lqr_rsp.mat to your own folder and rename it as nocouple_yaw_only.
Examine the obtained closed-loop response and see if it matches the desired specifications

Both Yaw and Pitch

Use both pitch and yaw command
Run SIMULINK
Copy aerolqrrsp.mat to your own folder and rename it as nocouple_pitch_yaw.
Examine the obtained closed-loop response and see if it matches the desired specifications

With Coupling Effect

Use the gain $K$ obtained in Part B. with the coupling effect.
Repeat above Pitch Only, Yaw Only and both Yaw and Pitch runs and rename the files as couple_####_###.
Close the Simulink. DO NOT SAVE THE CHANGE!

Analysis Question

Did your controller successfully meet the specs? If not, why?
How does the coupling affect the performance of the controller?
How can we improve the controller?

PreviousA. System Identification (Week 1) last check NextRotary Gyro

Last updated 2 years ago

Was this helpful?