授業/制御工学特論2022

Advanced Automation 2022†

[lecture #1] 2022.9.8 outline of the lecture, review of classical and modern control theory (1/3)†

outline of this lecture
- syllabus([https://vos-lc-web01.nagaokaut.ac.jp/])
- evaluation
  - mini report #1 ... 10%
  - mini exam #1 ... 10%
  - mini report #2 ... 10%
  - mini exam #2 ... 10%
  - final report ... 60%
- schedule2022 (tentative)
- map map_v1.1.pdf for review map_v1.1_review.pdf

review : stabilization of SISO unstable plant by classical and modern control theory
- transfer functions / differential equations
- poles / eigenvalues
- impulse response / initial value response
- ...

%-- 2022/09/08 13:45 --%
s = tf('s')
P = 1/(s-1)
pole(P)
impulse(P)
t = 0:0.01:3
y
y = exp(t)
hold on
plot(t, y, 'r--')
help impulse
impulse(P, 3)
plot(t, y, 'r--')
impulse(P, 3)
hold on
plot(t, y, 'r--')
P
K = 2
help step
Tyr = K/(s-1+K)
step(Tyr)
K = 20
Tyr = K/(s-1+K)
step(Tyr)

Q: 思っていた以上に忘れていることがあったため，有意義な学習ができました．
A: それは良かったです。

↑

[lecture #2] 2022.9.15 review of classical and modern control theory (2/3) with introduction of Matlab/Simulink†

introduction of Matlab and Simulink text_fixed.pdf Basic usage of MATLAB and Simulink used for 情報処理演習及び考究II/Consideration and Practice of Information Processing II: Advanced Course of MATLAB
- interactive system (no compilation, no variable definition)
- m file
system representation: Transfer Function(TF) / State-Space Representation (SSR)
- example: mass-spring-damper system
- definition of SSR
- from SSR to TF
- from TF to SSR: controllable canonical form
open-loop characteristic
- open-loop stability: poles and eigenvalues
- Bode plot and frequency response ex0915_1.m mod0915_1.mdl
  - cut off frequency; DC gain; -40dB/dec; variation of c
  - relation between P(jw) and steady-state response
closed-loop stability
- Nyquist stability criterion (for L(s):stable)
- Nyquist plot ex0915_2.m mod0915_2.mdl
  - Gain Margin(GM); Phase Margin(PM)

%-- 2022/09/15 13:02 --%
a = 3
b = 5
a + b
ex0915_1
sqrt(k/m)
sqrt(k/m)/(2*pi)
ex0915_1
ex0915_2

[lecture #3] 2022.9.22 review of classical and modern control theory (3/3)†

LQR problem
- controllability
- cost function J >= 0
- positive (semi-)definite matrices
- solution of LQR problem
- example ex0922_1.m mod0922_1.mdl
ARE and quadratic equation
- scalar case (solve by hand)
- matrix case lqr.pdf ≒ proof4.pdf (from B3「動的システムの解析と制御」)

%-- 2022/09/22 13:49 --%
ex0922_1
A
B
[B, A*B]
Uc
det(Uc)
J
J(end)
Jmin
F
F = [0 0]
ex0922_1
F
A'
A'*P + P*A + Q - P*B/R*B'*P
P
eig(P)

[lecture #4] 2022.9.29 relation between LQR and H infinity control problem (1/2)†

GOAL: to learn difference in concepts between LQR problem and H infinity control problem

a simple example relating LQR and H infinity control problems
- For given plant G \[ G = \left[\begin{array}{c|c:c} a & 1 & b \\ \hline \sqrt{q} & 0 & 0 \\ 0 & 0 & \sqrt{r} \\ \hdashline 1 & 0 & 0 \end{array} \right] = \left\{ \begin{array}{l} \dot x = ax + bu + w\\ z = \left[ \begin{array}{c} \sqrt{q} x \\ \sqrt{r} u \end{array}\right] \\ x = x \end{array}\right. \] with zero initial state value x(0) = 0, find a state-feedback controller \[ u = -f x \] such that \begin{eqnarray} (i) &&\quad \mbox{closed loop is stable} \\ (ii) &&\quad \mbox{minimize} \left\{\begin{array}{l} \| z \|_2 \mbox{ for } w(t) = \delta(t) \quad \mbox{(LQR)} \\ \| T_{zw} \|_\infty \mbox{($H_\infty$ control problem)}\end{array}\right. \end{eqnarray}
- comparison of norms in (ii) (for a = -1, b = 1, q = 1, r = 1) \[ \begin{array}{|c||c|c|}\hline & \mbox{LQR}: f=-1+\sqrt{2} & \quad \quad H_\infty: f=1\quad\quad \\ \hline\hline J=\|z\|_2^2 & & \\ \hline \|T_{zw}\|_\infty & & \\ \hline \end{array} \]
an alternative description to LQR problem
1. J = (L2 norm of z)^2
2. impulse resp. with zero initial value = initial value resp. with zero disturbance

definition of H infinity norm (SISO)

s = tf('s');
G1 = 1/(s+1);
bode(G1);
norm(G1, 'inf')
G2 = 1/(s^2 + 0.1*s + 1);
bode(G2);
norm(G2, 'inf')

definition of H infinity norm (SIMO)
solve the problem by hand
solve the problem by tool(hinfsyn) ex0929_1.m

%-- 2022/09/29 14:00 --%
s = tf('s');
G1 = 1/(s+1);
bode(G1);
norm(G1, 'inf')
G1d = s/(s+1);
bode(G1d);
norm(G1d, 'inf')
G2 = 1/(s^2 + 0.1*s + 1);
bode(G2);
norm(G2, 'inf')
grid on

[lecture #5] 2022.10.06 relation between LQR and H infinity control problem (2/2)†

cont.
- solve the problem by hand
- solve the problem by tool(hinfsyn) ex0929_1.m
complete the table in simple example
confirm the cost function J for both controllers by simulation mod1006.mdl
- block diagram in the simulink model
- how to approximate impulse disturbance with a step function
- (unit) impulse disturbance resp. with zero initial condition = (unit) initial condition resp. with zero disturbance
confirm the closed-loop H infinity norm for both controllers by simulation
- H infinity norm = L2 induced norm
- review: steady-state response for sinusoidal input signal; how to choose the frequency such that the output amplitude is maximized ?
- the worst-case disturbance w(t) for the simple example ?
general state-feedback case: hinf.pdf
- includes the simple example as a special case
- LQR lqr.pdf is included as a special case in which gamma -> infinity, w(t) = 0, B2 -> B, and non-zero x(0) are considered

%-- 2022/10/06 13:14 --%
ex0929_1
clp
sqrt(2-sqrt(2))
format long e
sqrt(2-sqrt(2))
format long f
format f
sqrt(2-sqrt(2))
mod1006
h = 0.01
f = -1+sqrt(2)
x0 = 0
zz
zz(end)
f
f = 1
zz(end)
h
x0
x0 = 1
zz(end)
h = 100
x0 = 0
f
sqrt(zz(end)/ww(end))
f = -1+sqrt(2)
sqrt(zz(end)/ww(end))

whiteboard #1

whiteboard #2

↑

[lecture #6] 2022.10.13 Mixed sensitivity problem 1/3†

outline: map_v1.1_mixedsens1.pdf
- sensitivity function S and complementary sensitivity function T
H infinity control problem (general case)
- with generalized plant G
- including the state-feedback case
reference tracking problem
- how to translate the condition (ii) into one with H infinity norm ?
- corresponding generalized plant G ?
- introduction of weighting function for sensitivity function in (ii)
design example ex1013_1.m ex1013_2.m
the small gain theorem
- proof: Nyquist stability criterion

%-- 2022/10/13 13:54 --%
ex1013_1
P
eig(P)
ex1013_2
ex1013_1
ex1013_2
K_hinf
eig(K_hinf)
G
eig(K_hinf)

[lecture #7] 2022.10.20 Mixed sensitivity problem 2/3†

outline: from point to set map_v1.1_mixedsens2.pdf
the small gain theorem ... robust stability = H infinity norm condition
normalized uncertainty Delta
uncertainty model
simple example of plant set
- given plant P tilde
  - frequency response of plant with perturbation ex1020_1.m
- how to determine P0 and WT ?
  - frequency response based procedure for P0 and WT ex1020_2.m
robust stabilization problem and equivalent problem
- design example and simulation ex1020_3.m mod1020.mdl

%-- 2022/10/20 13:31 --%
ex1020_1
ex1020_2
ctrlpref
ex1020_1
ex1020_2

[lecture #8] 2022.10.27 Mixed sensitivity problem 3/3†

review: map_v1.1_mixedsens2.pdf (1)performance optimization and (2)robust stabilization
outline:
1. how to design controllers considering both conditions in (1) and (2)
2. gap between NP(nominal performance) and RP(robust performance)

mixed sensitivity problem => (1) and (2) : proof
generalized plant for mixed senstivity problem
design example ex1027_1.m minimize gamma by hand
gamma iteration by bisection method ex1027_2.m
intro. to RP: weak point of mixed sensitivity problem(problem of NP) ex1027_3.m

%-- 2022/10/27 13:01 --%
ex1020_3
ex1020_1
ex1020_2
ex1020_3
pwd
mod1020
c
c = 0.8
c = 1.3
c = 2
ex1027_1
gam
ex1027_1
ex1027_2
gam
20*log10(gam)
ex1027_2
ex1027_3
ex1027_2
ex1027_3

[lecture #9] 2022.11.10 robust performance problem 1/3†

schedule2022

review
- mixed sensitivity problem : N.P. but not R.P.
robust performance problem (R.P.), but can not be solved by tool
an equivalent robust stability (R.S.) problem to R.P.
- (i) introduction of a fictitious uncertainty Delta_p (for performance)
- (ii) for 2-by-2 uncertainty block Delta hat which includes Delta and Delta_p
definition of H infinity norm for general case (MIMO)
- definition of singular values and the maximum singular value
```
M = [1i, 0; 1i, 1]
M'
eig(M'*M)
svd(M)
```
- mini report #1 report1.pdf ... You will have a mini exam #1 related to this report
proof of ||Delta hat||_inf <= 1
design example: ex1110_1.m
- robust performance is achieved but large gap
- non structured uncertainty is considered ... the design problem is too conservative

%-- 2022/11/10 14:16 --%
M = [1i, 0; 1i, 1]
M'
eig(M'*M)
svd(M)
sqrt((3+sqrt(2))/2)
sqrt((3+sqrt(5))/2)
ex1110_1

[lecture #10] 2022.11.17 Robust performance problem (2/3)†

return of mini report #1
SVD: singular value decomposition
- definition
- meaning of the largest singular value (a property and proof)
- 2 norm of vectors (Euclidean norm)
- SVD for 2-by-2 real matrix ex1117_1.m

%-- 2022/11/17 13:12 --%
M  = [1, 1; 1i/sqrt(2), -1i/sqrt(2)]
svd(M)
[U, S, V] = svd(M)
U'
U'*U
format long e
U'*U
U*U'
format short
U*U'
V*V'
ex1117_1
rand(1)
help rand
ex1117_1

whiteboard #1

whiteboard #2

↑

[lecture #11] 2022.11.24 Robust performance problem (3/3)†

review : R.S. problems for structured and unstructured uncertainty
scaled H infinity control problem
relation between three problems
how to determine structure of scaling matrix

design example

ex1124_1.m

ex1110_1
gam2 = gam_opt
ex1124_1
gam_opt

mini exam #1 (10 min.)

%-- 2022/11/24 13:04 --%
ex1110_1
gam_opt
gam2 = gam_opt
ex1124_1
gam_opt
gam2
ex1124_1

whiteboard #1

whiteboard #2

↑

[lecture #12] 2022.12.1 Robust performance problem (3/3) (cont.), Control system design for practical system (1/3)†

return of mini exam #1
review of scaling ex1201_1.m
mini report #2 report2.pdf
introduction of a practical system: Speed control of two inertia system with servo motors
- experimental setup
  setup_fixed.pdf
  photo.jpg
- objective of control system = disturbance attenuation control problem: to drive the drive-side servomotor by generating proper driving signal u (T_M) using drive-side speed y (\omega_M) such that the driven-side speed z (\omega_L) is maintained at constant against the disturbance torque input w (T_L)
- frequency response experiment and physical model of speed control system
  ex1201_2.m
  servo1.dat servo2.dat
- room 374 @ Dept. Mech. Bldg. 2

%-- 2022/12/01 13:12 --%
pwd
ex1201_1
ex1124_1
ex1110_1
ex1124_1
%-- 2022/12/01 13:22 --%
pwd
ex1110_1
ex1124_1
ex1201_1
ex1201_2
ctrlpref
ex1201_2

whiteboard #1

whiteboard #2

↑

[lecture #13] 2022.12.8 Control system design for practical system (2/3)†

return of mini report #2; ... You will have a mini exam #2 related to this report next week
- schedule2022
review of the experimental system
- closed-loop system of 2-by-2 plant G and controller K
- closed-loop gain is desired to be minimized for constant speed operation
- frequency response data of G can be used; how to handle modeling error of G ?
design example (modeling error for Gyu is only considered for simplicity)
- frequency response experiment data
  servo1.dat
  servo2.dat
- determination of plant model(nominal plant and multiplicative uncertainty weight)
  nominal.m
  weight.m
- configuration of generalized plant and controller design by scaled H infinity control problem using one-dimensional search on the scaling d
  cont.m
- comparison of closed-loop gain characteristics with and without control
  compare.m
- result of control experiment and evaluation
  result.dat
  perf.m
final report and remote experimental system
1. design your controller(s) so that the system performance is improved compared with the design example
2. Draw the following figures and explain the difference between two control systems (your controller and the design example):
  1. bode diagram of controllers
  2. gain characteristic of closed-loop system from w to z
  3. time response of control experiment
3. Why is the performance of your system improved(or unfortunately deteriorated)?
- due date: 4th(Wed) Jan 17:00
- submit your report(pdf file) by e-mail to kobayasi@nagaokaut.ac.jp
- You can use Japanese
- maximum controller order is 20
- submit your controller.dat, controller_order.dat, and controller.mat at this page:participant list2022(download is also possible) not later than 27th(Wed) Dec
- the system will be started until next lecture
- You can send up to 10 controllers
- control experimental results will be uploaded here
- freqresp ... frequency response will be measured and uploaded everyday
how to improve the performance ?
- accuracy of the nominal(physical) model
- weighting for robust stability

specifications of the experimental system

program sources for frequency response experiment

freqresp.h
freqresp_module.c
freqresp_app.c

format of servo1.dat (w is used instead of u for servo2.dat)

1st column ... frequency (Hz)
2nd column ... gain from u(Nm) to y(rad/s)
3rd column ... phase (deg) from u to y
4th column ... gain from u to z
5th column ... phase (deg) from u to z

program sources for control experiment

hinf.h
hinf_module.c
hinf_app.c

format of result.dat

1st column: time (s)
2nd column: y (rad/s)
3rd column: z (rad/s)
4th column: u (Nm)
5th column: w (Nm)

configuration of control experiment

disturbance signal w is specified as described in hinf.h and hinf_module.c:

w = 0; // disturbance torque for driven motor                       
if((t > 2)&&(t < 3)){
  w = RATED_TORQ * -0.15;
}
if((t > 4)&&(t < 5)){
  w = RATED_TORQ * -0.1 * sin(2*M_PI*5.0 * (t-4.0));
}
da_conv(torq_volt_conv_1(w), 1);

control signal u is limited as specified in hinf.h and hinf_module.c:
```
#define U_MAX (RATED_TORQ / 3.0)

if(u > U_MAX) u = U_MAX;
if(u < -U_MAX) u = -U_MAX;
```
u is generated by PI control for t < 1(s). Your designed controller is started at t = 1(s).

calculation of rotational speed

The rotational speed is approximately calculated by using difference for one sampling period in hinf_module.c and freqresp_module.c like:

theta_rad[0] = (double)read_theta(0) / (double)Pn212 * 2.0 * M_PI;
theta_rad[1] = (double)read_theta(1) / (double)Pn212 * 2.0 * M_PI;
y = (theta_rad[0] - theta_rad_before[0]) / msg->sampling_period;
z = (theta_rad[1] - theta_rad_before[1]) / msg->sampling_period;
theta_rad_before[0] = theta_rad[0];
theta_rad_before[1] = theta_rad[1];

where the sampling period is given as 0.25 ms.

%-- 2022/12/08 13:25 --%
nominal
pwd
cd ..
nominal
weight
cont
compare
perf
pwd
cd ..
perf
weight

whiteboard #1

↑

[lecture #14] 2022.12.16 Control system design for practical system (3/3)†

web based remote experiment system
- usage; how to upload controller's
- powered by prof. Takebe, National Institute of Technology, Nagaoka College
supplemental explanations
- room temperature is displayed and stored in temp.txt (Bosch Sensortec BME280 is used)
- c2d() is used to discretize the resultant continuous-time controller in cont.m
- You can send up to 10 controllers (don't fall into trial and error; think always about the reason)
- no strict control objective is given ( there is a freedom to define what is good performance; a frequency dependent weighting function can be introduced to evaluate the performance )
preparation of your own controller(s) by using the remote experiment system
mini exam #2

↑