1 Derivation of Zero Vibration (ZV) input shaper University of Technology System and Control...
Transcript of 1 Derivation of Zero Vibration (ZV) input shaper University of Technology System and Control...
Toyohashi University of Technology System and Control Laboratory
1 Derivation of Zero Vibration (ZV) input shaper
Denote G is a second order system, ω and ζ are natural frequency and damping ratio of G respectively.The time response of G to an impulse, whose amplitude and time location are Ai and ti, is given as
yi(t) =
[Aiω√1− ζ2
e−ζω(t−ti)
]sin(ω√
1− ζ2(t− ti)). (1)
Based on the superposition law for linear system, the response of system G to a series of n impulses isgiven as follows
yΣ(t) =
n∑i=1
[Aiω√1− ζ2
e−ζω(t−ti)
]sin(ω√
1− ζ2(t− ti)). (2)
By using following trigonometric identity
n∑i=1
Bi sin(ωt+ Φi) = AΣ sin(ωt+ ψ), where AΣ =
√√√√( n∑i=1
Bi cos Φi
)2
+
(n∑i=1
Bi sin Φi
)2
, (3)
we can obtain the magnitude of yΣ(t) as follows
AΣ(t) =ωe−ζωt√
1− ζ2
√√√√[ n∑i=1
Aieζωti sin(ω√
1− ζ2ti
)]2
+
[n∑i=1
Aieζωti cos(ω√
1− ζ2ti
)]2
(4)
The vibration percentage of magnitude response between the impulse sequence and an unity impulsewhich is applied at t = 0 is given as
V (ω, ζ) =AΣ
A↑
=
ωe−ζωt√1− ζ2
√[∑ni=1Aie
ζωti sin(ω√
1− ζ2ti
)]2+[∑n
i=1Aieζωti cos
(ω√
1− ζ2ti
)]2
ωe−ζωt√1− ζ2
∆=√V 2
1 (ζ, ω) + V 22 (ζ, ω), (5)
where V1(ω, ζ) =
n∑i=1
Aieζωti sin(ω
√1− ζ2ti) and V2(ω, ζ) =
n∑i=1
Aieζωti cos(ω
√1− ζ2ti). Note that the
ratio V (ω, ζ) represents the vibration percentage between input shaping to that without input shaping.
The ZV input shaper can be obtained by letting V (ω, ζ) = 0, which yields in{V1(ω, ζ) = 0
V2(ω, ζ) = 0⇒
{ ∑ni=1Aie
ζωti sin(ω√
1− ζ2ti) = 0∑ni=1Aie
ζωti cos(ω√
1− ζ2ti) = 0(6)
Without lost of generality, assume there has two impulses in the sequence and the first impulse is appliedat t = 0 (i.e. t1 = 0), hence
A2eζωt2 sin
(ω√
1− ζ2t2
)= 0
A1 +A2eζωt2 cos
(ω√
1− ζ2t2
)= 0
(7)
(8)
From (7), we have sin(ω√
1− ζ2t2) = 0, therefore ω√
1− ζ2t2 = kπ (k ∈ Z+) thus t2 = kπ
ω√
1−ζ2. The
minimum time of t2 is chosen as t2 = π
ω√
1−ζ2. Substituting t2 into (8), we have A1 = A2e
ζπ√1−ζ2 . In
practice, in order to preserve the response of original command, following constraint should be hold
2∑i=1
Ai = 1. (9)
1
Toyohashi University of Technology System and Control Laboratory
Therefore, A1 +A2 = 1
A1 = A2expζπ√1− ζ2
⇒
A1 =
1
1 +K
A2 =K
1 +K,
(10)
where K = e
−ζπ√1− ζ2
. In conclusion, ZV input shaper is given asAiti
=
1
1 +K
K
1 +K
0π
ω√
1− ζ2
. (11)
2 Derivation of Zero Vibration Derivative (ZVD) input shaper
In order to improve the robustness of ZV input shaper with respect to the uncertainty of natural frequency,following constraint should be added
dV
dω
∣∣∣∣ω=ωn
= 0, (12)
where ωn is modeled natural frequency whilst ω denotes the actual natural frequency of the system. We
have V (ω, ζ) =√V 2
1 (ω, ζ) + V 22 (ω, ζ), therefore
dV
dω=
(∂V
∂V1
dV1
dω+∂V
∂V2
dV2
dω
), (13)
By choosingdV1
dω
∣∣∣∣ω=ωn
= 0 anddV2
dω
∣∣∣∣ω=ωn
= 0, (13) can be fulfilled. We have
V1 =n∑i=1
Aieζωti sin
(ω√
1− ζ2ti
)⇒ dV1
dω=
n∑i=1
Aitieζωti
[ζ sin
(ω√
1− ζ2ti
)+√
1− ζ2 cos(ω√
1− ζ2ti
)]. (14)
By using following identity
a sinx+ b cosx = c sin(x+ φ), where c =√a2 + b2 and φ = atan(b, a), (15)
the (14) can be further written as
dV1
dω=
n∑i=1
Aitieζωti sin
[ω√
1− ζ2ti + atan
(√1− ζ2
ζ
)]. (16)
In the same manner, it can be obtained that
dV2
dω=
n∑i=1
Aitieζωti cos
[ω√
1− ζ2ti + atan
(√1− ζ2
ζ
)]. (17)
It is recognized that two equations (16) and (17) are added, therefore it needs two more unknowns. Thiscan be satisfied if one more impulse is appended, thus ZVD input shaper will have 3 impulses in thesequence, and is governed by
V1(ωn, ζ) = 0
V2(ωn, ζ) = 0
dV1
dω
∣∣∣∣ω=ωn
= 0
dV2
dω
∣∣∣∣ω=ωn
= 0.
⇒
∑3i=1Aie
ζωnti sin(ωn√
1− ζ2ti
)= 0
∑3i=1Aie
ζωnti cos(ωn√
1− ζ2ti
)= 0
∑3i=1Aitie
ζωnti sin
[ωn√
1− ζ2ti + atan
(√1− ζ2
ζ
)]= 0
∑3i=1Aitie
ζωnti cos
[ωn√
1− ζ2ti + atan
(√1− ζ2
ζ
)]= 0.
(18)
2
Toyohashi University of Technology System and Control Laboratory
Without lost of generality, assume t1 = 0 and A1 = 1 (normalization will be carried out later), hence wehave
A2eζωnt2 sin
(ωn√
1− ζ2t2
)+A3e
ζωnt3 sin(ωn√
1− ζ2t3
)= 0
1 +A2eζωnt2 cos
(ωn√
1− ζ2t2
)+A3e
ζωnt3 cos(ωn√
1− ζ2t3
)= 0
A2t2eζωnt2 sin
[ωn√
1− ζ2t2 + atan
(√1− ζ2
ζ
)]+A3t3e
ζωnt3 sin
[ωn√
1− ζ2t3 + atan
(√1− ζ2
ζ
)]= 0
A2t2eζωnt2 cos
[ωn√
1− ζ2t2 + atan
(√1− ζ2
ζ
)]+A3t3e
ζωnt3 cos
[ωn√
1− ζ2t3 + atan
(√1− ζ2
ζ
)]= 0.
(19)
(20)
(21)
(22)
Square sum of (19) and (20) yields
A22e
2ζωnt2 +A23e
2ζωnt3 + 2A2A3eζωnt2eζωnt3 cos
[ωn√
1− ζ2 (t3 − t2)]
= 1. (23)
By choosing
cos[ωn√
1− ζ2(t3 − t2)]
= −1, (24)
we obtain
A2eζωnt2 −A3e
ζωnt3 = 1
⇒ −A3 +A2e−ζωn(t3−t2) = e−ζωnt3 . (25)
From (24), we have ωn√
1− ζ2(t3− t2) = π thus t3− t2 =π
ωn√
1− ζ2. Substituting t3 = t2 +
π
ωn√
1− ζ2
into (19) and also multiple e−ζωnt3 both sides, we have
A2e−ζ(t3−t2)ωn sin(t2ωn
√1− ζ2) +A3 sin
[(t2 +
π
ωn√
1− ζ2
)ωn√
1− ζ2
]= 0
⇒ A2e−ζ(t3−t2)ωn sin(t2ωn
√1− ζ2) +A3 sin
(t2ωn
√1− ζ2 + π
)= 0
⇒(A2e
−ζ(t3−t2)ωn −A3
)sin(t2ωn
√1− ζ2
)= 0
⇒ e−ζωnt3 sin(t2ωn√
1− ζ2) = 0
⇒ sin(t2ωn
√1− ζ2
)= 0. (26)
From (26), it can be obtained that t2ωn√
1− ζ2 = π thus t2 =π
ωn√
1− ζ2, which also results in
t3 =2π
ωn√
1− ζ2.
Now, square sum of (21) and (22) yields
A22t
22e
2ζωnt2 +A33t
23e
2ζωnt3 + 2A2A3t2t3eζωnt2eζωnt3 cos
(ωn√
1− ζ2(t3 − t2))
= 0. (27)
But cos[ωn√
1− ζ2(t3 − t2)]
= −1 (as in (24)), thus(A2t2e
ζωnt2 −A3t3eζωnt3
)2= 0. (28)
The amplitude of A2 and A3 can be solved by adjoining (25) and (28) A2t2eζωnt2 = A3t3e
ζωnt3
A3 = A2e−ζωn(t3−t2) − e−ζωnt3 .
(29)
Substituting t2 =π
ωn√
1− ζ2and t3 =
2π
ωn√
1− ζ2into (29) and solving A2, A3. The result is easily
derived as A2 = 2e
−ζπ√1− ζ2
A3 = e
−2ζπ√1− ζ2
,
, or
A2 = 2K
A3 = K2,, where K = e
−ζπ√1− ζ2
.
3
Toyohashi University of Technology System and Control Laboratory
Normalizing A1, A2, and A3 such that
3∑i=1
Ai = 1, the ZVD input shaper is given as follows
Aiti
=
1
K2 + 2K + 1
2K
K2 + 2K + 1
K2
K2 + 2K + 1
0π
ωn√
1− ζ2
2π
ωn√
1− ζ2.
(30)
3 Derivation of multi-mode input shaper
Suppose the system has two modes, e.g. multi-body system with two distinct natural frequencies ω1,ω2, and damping ratios ζ1, ζ2. In this case, input shaping sequence can be obtained by convolving twoimpulse sequences designed for each mode. The procedure is illustrated in Fig. 1, where “ * ” notationdenotes the convolution operator.
1
11KK
1
11 K
time
2
21KK
2
11 K
time0 1T 0 2T
time
1A
2A3A
4A
1T 2T 1 2T T0
* (a) (b) (c)
Figure 1: (a) ZV impulse sequence for the first mode, (b) ZV impulse sequence for the second mode, (c)ZV impulse sequence for the multi-mode.
In Fig. 1, the convolution process gives
A1 =1
(1 +K1)(1 +K2)
A2 =K2
(1 +K1)(1 +K2)
A3 =K1
(1 +K1)(1 +K2)
A4 =K1K2
(1 +K1)(1 +K2)
. (31)
4