Galil DMC-2X00 用户手册
140
• Chapter 10 Theory of Operation
DMC-2X00
For example, if the filter parameters of the DMC-2x00 are
KP = 4
KD
=
36
KI = 2
PL
=
0.75
T = 0.001 s
the digital filter coefficients are
K
=
160
A
=
0.9
C = 1
a = 250 rad/s
and the equivalent continuous filter, G(s), is
G(s) = [16 + 0.144s + 1000/s}
∗ 250/ (s+250)
The notch filter has two complex zeros, Z and z, and two complex poles, P and p.
The effect of the notch filter is to cancel the resonance affect by placing the complex zeros on top of
the resonance poles. The notch poles, P and p, are programmable and are selected to have sufficient
damping. It is best to select the notch parameters by the frequency terms. The poles and zeros have a
frequency in Hz, selected by the command NF. The real part of the poles is set by NB and the real part
of the zeros is set by NZ.
the resonance poles. The notch poles, P and p, are programmable and are selected to have sufficient
damping. It is best to select the notch parameters by the frequency terms. The poles and zeros have a
frequency in Hz, selected by the command NF. The real part of the poles is set by NB and the real part
of the zeros is set by NZ.
The simplest procedure for setting the notch filter is to identify the resonance frequency and set NF to
the same value. Set NB to about one half of NF and set NZ to a low value between zero and 5.
the same value. Set NB to about one half of NF and set NZ to a low value between zero and 5.
ZOH
The ZOH, or zero-order-hold, represents the effect of the sampling process, where the motor command
is updated once per sampling period. The effect of the ZOH can be modeled by the transfer function
is updated once per sampling period. The effect of the ZOH can be modeled by the transfer function
H(s)
=
1/(1+sT/2)
If the sampling period is T = 0.001, for example, H(s) becomes:
H(s)
=
2000/(s+2000)
However, in most applications, H(s) may be approximated as one.
This completes the modeling of the system elements. Next, we discuss the system analysis.