Post

Frequency Domain Analysis of MIMO System Part 2. Multi-variable Nyquist Theorem

In this post, we show how to analysis robustness of a MIMO system with Multi-variable Nyquist Theorem.

Determinant of Return Difference

The determinant of return difference matrix could be express as

\[\det[RD] = \det\begin{bmatrix}I + L(s)\end{bmatrix} = k \cdot \frac{\phi_{cl}(s)}{\phi_{ol}(s)}\]

where $\phi_{ol}(s) ,\phi_{cl}(s)$ is open-loop and closed-loop polynomial respectively.

Proof:

The open-loop poles are given by:

\[\phi_{ol}(s)=\det(sI-A)\]

The closed-loop poles are given by:

\[\phi_{cl}(s) = \det(sI-A_{cl})= \det(sI-A+B(I+D)^{-1}C)\]

Schur’s determinant lemma states that:

When $A$,respectively $D$ is invertible, then one has

\[\begin{aligned} \det \begin{bmatrix}A&B\\C&D\end{bmatrix}&=\det(A)\cdot\det (D-CA^{-1}B)\\ & = \det(D)\cdot\det(A-BD^{-1}C) \end{aligned}\]

define

\[M = \begin{bmatrix}sI-A &B\\-C & I+D\end{bmatrix}\]

apply Schur’s determinant lemma, we have:

\[\begin{aligned} \det(M) &= \det(sI-A)\cdot\det(I+D+C(sI-A)^{-1}B) \\ &=\det(sI-A)\cdot\det(I+L) \\ &=\phi_{ol}(s)\cdot\det(I+L)\\ \\ \det(M) &= \det(I+D)\cdot\det(sI-A+B(I+D)^{-1}C) \\ &=\det(I+D)\cdot\phi_{cl}(s) \end{aligned}\]

Therefore

\[det(I+L) =det(I+D)\cdot \frac{\phi_{cl}(s)}{\phi_{ol}(s)} = k\cdot \frac{\phi_{cl}(s)}{\phi_{ol}(s)}\]

Hence proved

Suppose $D$ is zero matrix, we have

\[det(I+L) = \frac{\phi_{cl}(s)}{\phi_{ol}(s)}\]

Multi-variable Nyquist Theorem

Multi-variable Nyquist criterion is derived from Cauchy’s argument principle, it gives a ‘yes or no’ answer to the stability question of closed-loop MIMO system.

It states:

The control system will be closed-loop stable( $\phi_{cl}(s)$ has no RHP zeros) IFF,

$\forall R $ sufficiently large,

\[N(0,\det[I+L(s)],D_R) = -P_{ol}\]

or equivalently

\[N(-1,-1+\det[I+L(s)],D_R) = -P_{ol}\]

where $N$ is number of encirclements,$D_R$ is Nyquist Contour, $P_{ol}$ is number of open loop unstable poles.

Proof:

Using argument principle, it’s easy to show:

If $f(s)$ is factored where $f(s) = f_1(s)\cdot f_2(s) $ ,then

\[\begin{aligned} N(0,f(s),D_R)&=N(0,f_1(s),D_R)+N(0,f_2(s),D_R)\\ &=(Z_1-P_1) +(Z_2-P_2)=Z-P \end{aligned}\]

Suppose a zero $D$ matrix, we have

\[det(I+L) = \frac{\phi_{cl}(s)}{\phi_{ol}(s)}\]

Therefore

\[N(0,\phi_{cl}(s),D_R)=N(0,\phi_{ol}(s),D_R)+N(0,\det[I+L],D_R)\]

If closed-loop MIMO system is stable, then

\[N(0,\phi_{cl}(s),D_R)=0\]

From equation above, the stability of $\phi_{cl}(s)$ requires that

\[N(0,\det[I+L],D_R)=-N(0,\phi_{ol}(s),D_R)=-P_{ol}\]

Hence proved

IMPORTANT: Fundamental to this approach is the assumption that the nominal closed-loop system is stable.

Apply to Lateral Control Problem

Since the plant model and controller model is non-square in lateral control problem, so stability analysis should be conducted at the loop break of minimum dimension. In this case, plant input is selected as the loop break point.

How time delay affect closed-loop stability?

A significant deterioration in both gain and phase margin could be observed!

nyquist_1 Comparison between stability of nominal closed-loop system and system with delay

How much pure delay will destabilized the closed-loop system?

Max delay acceptable by closed-loop system could be found where encirclement change as we increase delay time.

Model Velocity (m/s)Nyquist PlotMax Delay (s)
1nyquist_v14.5
2nyquist_v22.4
4nyquist_v41.2
8nyquist_v80.7
12nyquist_v120.6
16nyquist_v160.5
20nyquist_v200.4
25nyquist_v250.4
30nyquist_v300.35

How actuator dynamics affect closed-loop system?

First, construct a actuator model from road test data

The actuator model I used in analysis is a pure delay + second order system:

\[f(s) = e^{-t_ds}\cdot\frac{w_n^2}{s^2+2\eta w_n s + w_n^2}\]

where

\[\begin{cases} t_d &= 0.1\;s\\ w_n &= 6.0 \;rad/s\\ \eta &= 1.0\\ \end{cases}\]

Step response comparison between real system and simulation system:

act_model

Then, we add actuator dynamics into plant model, reconnect it with controller and analysis frequency response of closed-loop system. Here’s what we get:

Model Velocity (m/s)Nyquist PlotGain Crossover Frequency (Hz)Gain Margin (dB)Phase Margin (deg)Extra Max Delay (s)
1nyquist_act10.0525.964.24.3
5nyquist_act50.1912.640.30.6
10nyquist_act100.297.2123.60.2
15nyquist_act150.344.8715.50.14
20nyquist_act200.382.607.980.06
25nyquist_act250.391.915.550.04
30nyquist_act30unstableunstableunstableunstable

Summary

The Multi-variable Nyquist Criterion gives a ‘yes or no’ answer to the stability question of a MIMO system. Understanding it leads to important understanding of the robustness analysis tests used to analyze model uncertainties. In addition, stability margins for MIMO systems can be derived using the MNT by assuming that controller $K(s)$ stabilizes the nominal plant $G(s)$ and that gain and phase uncertainties are large enough to change the number of encirclements made by the determinant of the return difference matrix locus.

This post is licensed under CC BY 4.0 by the author.