Professional Documents
Culture Documents
Servo Drive Systems - Chapter 3 - 2022
Servo Drive Systems - Chapter 3 - 2022
DC Servo Motors
@VLC-2021
1
3.1. Introduction
(Permanent Magnet Brushed) DC Servo Motor
𝐽𝑀
𝑇𝑀
𝑇𝐿 (s)
U(s) 1 I(s) 𝑇𝑀 (s) 1 (s)
Km
Ls + R Js + B
(s)
Ke
@VLC-2021
(s) Km
G (s) = =
U ( s ) ( Ls + R )( Js + B ) + K m 2
Km
(s) RB K
G (s) = = (3.1)
U (s) L J (Te s + 1)(Tm s + 1)
s + 1 s + 1
R B
where Te: electrical time constant
Tm: mechanical time constant
normally, 𝑇𝑚 ≫ 𝑇𝑒
Then we can approximate eq. (3.1) by a first order function
@VLC-2021
(s) K
G (s) = (3.2)
U (s) Tm s + 1
5
3.3. Mathematical Model of a Servo System
3.2.1. The 4th order model
d 2 M (t )
JM 2
= TM (t ) − TL (t ) (3.3)
dt
d 2 L (t ) d L (t )
JL 2
= N GTL (t ) − DL (3.4)
dt dt
K L ( M (t ) − N G L (t ) )
TL (t ) = (3.5)
NG 2
@VLC-2021
7
3.2.1 4th Order Model of One Axis
The transfer functions of the two mass model are:
TM (s) − TL (s)
M (s) = (3.6)
J M s2
NG
L ( s) = TL (s) (3.7)
J L s + DL s
2
K L ( M (s) − N G L (s) )
TL (s) = 2
(3.8)
NG
TM ( s ) = K vg K p (U ( s ) − M ( s ) ) − s M ( s ) (3.9)
8
3.2.1 4th Order Model of One Axis
The transfer function from the input U(s) to the output 𝜃(𝑠)
a0
G ( s) = (3.10)
N G ( s 4 + a3 s 3 + a2 s 2 + a 1s + a0 )
K L K P K vg DL K vg
a0 = ; a3 = +
JLJM JL JM
K L K vg DL K P K vg DL K L
a1 = + + 2
JLJM JLJM NG J L J M
K L DL K vg K P K vg KL
a2 = + + +
JL JLJM JM NG 2 J M
@VLC-2021
KL DL
n = ; L = (3.13)
JL 2 JLKL
10
3.2.2 Normalized 4th Order Model
K p = c p n
(3.14)
K v = cvn
@VLC-2021
11
3.2.2 Normalized 4th Order Model
The normalized 4th order model without dependence on
natural frequency is derived
b0
Gc ( s ) = (3.15)
N G ( s 4 + b3 s 3 + b2 s 2 + b1s + b0 )
b0 = (1 + N L )c p cv ; b3 = 2 L +(1 + N L )cv
b1 = (1 + N L )(cv + 2c p cv L ) + 2 N L L
b2 = (1 + N L )(1 + cv c p + 2cv L )
where
JL
NL =
@VLC-2021
NG 2 J M (3.16)
12
3.3 Parameters tuning method
3.3.1 Requirements for control performance
The response characteristic of an industrial servo system is
required to have fast response, no generation of
oscillation and overshoot.
In an industrial servo system, the following conditions are
used successfully
3 N L 10
(3.17)
0 L 0.02
Since the damping factor is usually very small, then we
@VLC-2021
can choose
L = 0
13
3.3.1 Requirements for control performance
The normalized model can be derived as follow
1
Gc ( s ) = (3.18)
s 4
s 3
(1 + c p cv ) s 2
s
NG + + + + 1
(1 + N L )c p cv c p c p cv cp
There are the following conditions for determination of servo
parameters satisfying the desired control performance
1. There are 2 real poles and one complex conjugate root (A)
2. The response of the complex one is smaller than the
response of the principal root (B)
@VLC-2021
14
3.3.2 Ramp response
Condition B
Condition C
17
@VLC-2021
3.3.4 Determination of servo parameters
19
3.4 Reduced order model
▪ The 1st order model for expressing the low speed
operation of the servo system (below 1/20 rated speed).
▪ The 2nd order model for expressing the middle speed
operation of the servo system (below 1/5 rated speed).
The structure standard of the reduced model is determined by
the following conditions based on the 4th order model
expressing by equation (3.15).
1. The steady-state velocity deviation between the 4th order
model and the reduced one are consistent.
2. The oscillation does not occur in the ramp response of
@VLC-2021
c p1 Independent of the
Gc1 ( s ) = load natural frequency (3.21)
s + c p1 (normalized)
(3.23)
s + K p1
22
3.4.1 Low speed 1st order model
c p1 = 0.24 (3.25)
@VLC-2021
23
3.4.2 Middle speed 2nd order model
The middle speed 2nd order model expressing properly the
industrial servo system from 1/20 to 1/5 of the rated speed
can be derived. The whole servo system is
dy 2 (t ) dy (t )
2
+ cv 2 + c p 2cv 2 y(t ) = c p 2cv 2u (t ) (3.26)
dt dt
Its model can be expressed by a transfer function
Independent of the
cv 2c p 2 load natural frequency
Gc 2 ( s ) = (normalized) (3.27)
s 2 + cv 2 s + cv 2c p 2
@VLC-2021
where K p 2 = c p 2L
(3.28)
K v 2 = cv 2L
24
3.4.2 Middle speed 2nd order model
(3.29)
s + Kv2s + Kv2 K p 2
2
25
3.4.2 Middle speed 2nd order model
2 2
Gc 2 ( s ) = 2 (3.31)
s + 2 22 s + 2 2
2
c p 2 =
2 2
c = 2
@VLC-2021
v2 2 2
cv 2 = 4c p 2 4c p (3.32)
c p 2 c p = 0.24
(3.33)
cv 2 4c p = 0.96
@VLC-2021
27
3.5 Control a DC servo motor
3.5.1 The structure of a controller
Power
Controller Saturation DC Motor
Amplifier
Encoder
H Bridge Circuit
Microcontroller
@VLC-2021
28
3.5.2 H-bridge
30
3.5.2 H-bridge
➢ H-Bridge Design
31
3.5.3 Encoder
❖ Quadrature Encoder
Rotary encoder is a sensor attached to a rotating object (such
as a shaft or motor) to measure rotation. By measuring
rotation we can determine any displacement, velocity,
acceleration, or the angle of a rotating object.
100 to 6,000
segments per
revolution
@VLC-2021
32
3.5.3 Encoder
➢ 1X Encoding
▪ When channel A leads
channel B, the
increment occurs on
the rising edge of
channel A.
➢ 2X Encoding
@VLC-2021
With 2X decoding
our 500 ppr encoder
can generate 1000 ppr
33
3.5.3 Encoder
➢ 4X Encoding
34
3.5.3 Encoder
▪ 4X encoding state transition and sample code
@VLC-2021
35
3.5.4 Measuring speed and position
The velocity and position calculation is performed in a
periodic interrupt. Using timer interrupt of a microcontroller,
declaring a interrupt interval T (s), we have the equation to
calculate the velocity of a motor as follow:
2 M 60 M
= (rad / s ) = (RPM) (3.34)
NT NT
Where,
M: is the number of pulses from the encoder during T (s)
N: is the resolution of the encoder depending on the
encoding mode (x1, x2 or x4) (CPR)
Based on the pulses counted from the encoder, we can
@VLC-2021
𝐾𝑝
𝐾𝐼 න 𝑒 𝑡 𝑑𝑡
de(t )
u (t ) = K p e(t ) + K D + K I e(t )dt (3.35)
37 dt
3.5.5 Digital PID controller
➢ Block diagram of a digital PID controller
d e ek Digital uk u û DC (rad/s)
Speed ZOH
PID servo
Ts
Setpoint Zero-order Saturation H-bridge and
(rad/s) hold Motor
39
▪ Backward rectangular rule (Fig. 3.12a)
3.5.5 Digital PID controller
N
uI (k ) = K I Ts e(k ) = u I (k − 1) + K I Ts e(k ) (3.39)
k =1
▪ Forward rectangular rule (Fig. 3.12b)
N
uI (k ) = K I Ts e(k − 1) = u I (k − 1) + K I Ts e(k − 1) (3.40)
k =1
40
3.5.5 PID controller
➢ Low pass filter: The derivative term with the first-order
filter is illustrated by the following figure:
𝐸(𝑠) 𝑈𝐷 (𝑠) 𝑓
1 𝑈𝐷 (𝑠)
𝐾𝐷 𝑠
𝑁𝑠 + 1
Filter
Fig 3.13 D-term with the low pass filter
K D sE ( s ) = (Ns + 1)U Df (s )
de(t ) du Df (t )
KD =N + u Df (t )
dt dt
e(k ) − e(k − 1) uDf (k ) − u Df (k − 1)
KD =N + u Df (k )
@VLC-2021
Ts Ts
N KD
u f (k ) =
D
u f (k − 1) +
D
( e(k ) − e(k − 1) ) (3.42)
41
N + Ts N + Ts
3.5.5 PID controller
uDf (k ) = (1 − )u Df (k − 1) + u D (k ) (3.43)
Ts
where, = (0 1)
N + Ts
uDf (k ) : Output of D-term after applying the filter
uD (k ) : Output of D-term without the filter
➢ Anti-windup:
𝑒
PID 𝑢 𝑢ො
𝑢𝐼
𝐾𝐼 න 𝑒𝑑𝑡
@VLC-2021
𝑒𝑟𝑒𝑠𝑒𝑡
𝐾𝑏
42
Fig 3.14 The anti-windup scheme for I-term
3.5.5 PID controller
From Fig. 3.14, we derive an equation to calculate I-term with
anti-windup structure.
t
u I (t ) = K I e( ) + K b ereset ( ) d (3.44)
0