User:Margav06/sandbox/Click here to continue/Applications of Linear systems/LMI for Attitude Control of Nonrotating Missiles, Yaw/Roll Channel

LMI for Attitude Control of Nonrotating Missles, Yaw/Roll Channel

Deriving the exact dynamic modeling of a missile is a very complicated procedure. Thus, a simplified model is used to model the missile dynamics. To do so, we consider a simplified attitude system model for the yaw/roll channel of the system. We aim to achieve a non-rotating motion of missiles. Note that the attitude control design for the yaw/roll channel and the pitch channel can be solved exactly in the same way except for different representing matrices of the system.

The System
The state-space representation for the yaw/roll channel can be written as follows:

$$ \begin{align} \dot{x}(t) &= A(t)x(t) + B_{1}(t)u(t) + B_{2}(t)d(t) \\ y(t) &= C(t)x(t) + D_{1}(t)u(t) + D_{2}(t)d(t) \end{align} $$

where $$ x = [\beta \quad w_{y} \quad w_{x} \quad \delta_{x} \quad \delta_{y}]^{\text{T}}$$, $$ u = [\delta_{xc} \quad \delta_{yc} ]^{\text{T}} $$, $$ y = [n_{z} \quad w_{x}]^{\text{T}}$$, and $$ d = \delta_{z}$$ are the state variable, control input, output, and disturbance vectors, respectively. The paprameters $$ \alpha $$, $$ w_{z} $$, $$ \delta_{z} $$, $$ \delta_{zc} $$, $$ n_{y} $$, $$ \beta $$, and $$ w_{y} $$ stand for the attack angle, pitch angular velocity, the elevator deflection, the input actuator deflection, the overload on the side direction, the sideslip angle, and the yaw angular velocity, respectively.

The Data
In the aforementioned yaw/roll channel system, the matrices $$ A(t), B_{1}(t), B_{2}(t), C(t), D_{1}(t),$$ and $$D_{2}(t)$$ are given as:

$$ \begin{align} A(t) = \begin{bmatrix} A_{11}(t) & A_{12}(t)\\ 0    & A_{22}(t) \end{bmatrix} \end{align} $$

where

$$ \begin{align} A_{11}(t) = \begin{bmatrix} -b_{4}(t) & 1 & \frac{\alpha(t)}{57.3} \\ -\acute{b}_{1}(t)b_{4}(t) - b_{2}(t) & -\acute{b}_{1}(t) - \acute{b}_{1}(t) & \frac{J_{y}-J_{z}}{57.3J_{x}}{w}_{z}(t) - \frac{\acute{b}_{1}\alpha(t)}{57.3}\\ c_{2}(t) & \frac{J_{y}-J_{z}}{57.3J_{x}}{w}_{z}(t) & -c_{1}(t) \end{bmatrix} \end{align} $$

$$ \begin{align} A_{12}(t) = \begin{bmatrix} 0 & -b_{5}(t)\\ 0 & -\acute{b}_{1}(t)\acute{b}_{5} - b_{3}(t) \\ -c_{3}(t) & c_{4}(t) \end{bmatrix} \end{align} $$

$$ \begin{align} A_{22}(t) = -\frac{1}{\tau_{x}\tau_{y}} \begin{bmatrix} \tau_{y} & 0\\ 0 & \tau_{x} \end{bmatrix} \end{align} $$

and

$$ \begin{align} B_{1}(t) = \begin{bmatrix} 0 & 0\\ 0 & 0\\ 0 & 0\\ \frac{1}{\tau_{x}} & 0\\ 0 & \frac{1}{\tau_{y}} \end{bmatrix}, \quad B_{2}(t) = \begin{bmatrix} a_{6}(t) \\ -\acute{b}_{1}(t)a_{6}(t) \\ 0\\ 0 \\ 0 \end{bmatrix} \end{align} $$

$$ \begin{align} C(t) = -\frac{1}{57.3g} \begin{bmatrix} V(t)b_{4}(t) & 0 & 0 & 0 & V(t)b_{5}(t)\\ 0 & 0 & -57.3g & 0 & 0 \end{bmatrix} \end{align} $$

$$ \begin{align} D_{1}(t) = 0, \quad D_{2}(t) = -\frac{V(t)}{57.3g} \begin{bmatrix} b_{6}(t) \\ 0 \end{bmatrix} \end{align} $$

where $$ a_{1}(t) \sim a_{6}(t), \quad b_{1}(t) \sim b_{7}(t), \acute{a}_{1}(t), \acute{b}_{1}(t) $$ and $$ c_{1}(t) \sim c_{4}(t) $$ are the system parameters. Moreover, $$ V $$ is the speed of the missle and $$J_{x}$$, $$J_{y}$$, and $$J_{z}$$ are the rotary inertia of the missle corresponding to the body coordinates.

The Optimization Problem
The optimization problem is to find a state feedback control law $$ u= Kx$$ such that:

1. The closed-loop system:

$$ \begin{align} \dot{x} &= (A+B_{1}K)x + B_{2}d \\ z &= (C + D_{1}K)x + D_{2}d \end{align} $$

is stable.

2. The $$ H_{\infty} $$ norm of the transfer function:

$$G_{zd}(s) = (C + D_{1}K)(sI-(A+B_{1}K))^{-1}B_{2} + D_{2}$$

is less than a positive scalar value, $$ \gamma $$. Thus:

$$ ||G_{zd}(s)||_{\infty} < \gamma $$

The LMI: LMI for non-rotating missle attitude control
Using Theorem 8.1 in [1], the problem can be equivalently expressed in the following form:

$$ \begin{align} &\text{min} \quad \gamma \\ &\text{s.t.} \quad X > 0 \\ &\begin{bmatrix} (AX+B_{1}W)^{T} + AX+B_{1}W & B_{2} & (CX+D_{1}W)^{T} \\ B_{2}^{T} & -\gamma I & D_{2}^{T} \\ CX + D_{1}W & D_{2} & -\gamma I \end{bmatrix} < 0 \end{align}$$

Conclusion:
As mentioned, the aim is to attenuate the disturbance on the performance of the missile. The parameter $$ \gamma $$ is the disturbance attenuation level. When the matrices $$ W $$ and $$ X $$ are determined in the optimization problem, the controller gain matrix can be computed by:

$$ K = WX^{-1} $$

Implementation
A link to Matlab codes for this problem in the Github repository:

https://github.com/asalimil/LMI-for-Attitude-Control-Nonrotating-Missle-Yaw-Roll-Channel

Related LMIs
LMI for Attitude Control of Nonrotating Missles, Pitch Channel

Return to Main Page
LMIs in Control/Tools