PID Loop Shaping Design Goals Slope in the Crossover Region

advertisement
PID Loop Shaping Design Goals
• -20 dB/dec Slope in the Crossover
Region
• High Gain at Low Frequencies
• Continued Decrease in Magnitude after
the Crossover
– we will discuss this issue at a later date
• Open-loop Crossover Equals (almost)
Closed-Loop Bandwidth, ω BW
High Gain at Low Frequencies
• Allows output to closely follow (“track”)
the desired input at low frequencies
• The higher the gain is the lower the
error is, and therefore the tighter the
closed-loop transfer function (CLTF)
holds to a magnitude ratio of one (0 dB).
Slope in the Crossover Region
• If the slope is –20 dB/dec in the region near
the crossover, then the open-loop transfer
function phase should be around –90 deg.
– Gives ~ 90 degree phase margin, good stability
• Schinstock’s rule of thumb for safe designs
is
– “–20 dB/dec for two decades; one before the
crossover and one after.”
CLTF and Error TF
xc
+
e
xc
T ( s) =
xc
x
G (s)
G( s) = x / e = OLTF
_
x
G (s)
1 + G (s)
e
S ( s) =
1
1 + G( s )
S ( s) ≅
T ( s ) = x / xc = CLTF
S ( s) = e / x c = ErrorTF
1
for G ( s) large
G ( s)
T ( s) ≅ G ( s) for G( s) small
op
Lo
en
Op
slope in region near
crossover should
be -20 dB/dec
Freq
p
Loo
sed
Clo
Err
or
h
hig t low
a ’
in eq
ga fr
Magnitude Ratio
PID Loop Shaping Design Goals
continued
decrease
in mag’
after
crossover
Likely Design Steps
1.Choose desired bandwidth (crossover)
frequency.
2.Choose “compensation” (the poles and
zeros of the controller) to achieve the
desirable shape.
3.Choose the “gain” to obtain the correct
crossover.
bandwidth of
CLTF is near
crossover of OLTF
1
Precision ….????
Simplified Model
PWM
Amplifier
Voice coil is similar to a
DC motor - linear force is
proportional to the current
Shuttle
DSP &
Laser Cards
F=k f i
Voice
Coil
X-Slide Scale &
Spindle Encoder
m
k
Ic
s
Closed-Loop
Amplifier
Dynamics
PID
Controller
xc
- 20
Coil
Current
ms 2 + bs + k
Plant
x
kf
I
m
F
b
(desired x = R)
-
1
2
ms + bs
Freq
Significant
High Freq’
Dynamics
(e.g. Amplifier)
• High low-frequency gain of the openloop system (for good tracking)
• Closed-loop bandwidth ω BW of 50 Hz
• Phase margin of at least 70 degrees
(actual x = C)
F
dB
/d
ec
Design Goals
x
b = 0.6 lbf-sec/in
PID
z1 , z 2
k/ m
ω bw
Example Problem
m = 2 lbf-sec2/in
zeros
from
controller
- 20
ms 2 + bs + k
s
R(s) +
breakpoint
from plant
dB
/d
ec
x
kf
I
Coil
Current
k d s 2 + k p s + ki
Plant
ec
/d
dB
-60
k d s 2 + k p s + ki
Open-Loop Transfer Function
OLTF Magnitude
Current
Command
PID
Controller
b
Interferometer
System Transfer Functions
xc
x
C(s)
PID ⇒
k d s 2 + k p s + ki
s
k ( s + z1 )( s + z 2 )
= d
s
2
Desired Open-Loop TF
Desired Open-Loop TF
120
120
100
100
80
80
System pole ~ 0.3 rad/sec
-60 dB
decade
Magnitude, dB
Magnitude, dB
decade
60
-40 dB
40
decade
20
-20 dB
0
-60
1.0E-01
1.0E+00
1.0E+01
1.0E+02
1.0E+03
-40 dB
40
decade
20
Arbitrarily
set z 1 ~ 3 rad/sec
-20
ωBW ~ 314 rad/sec
-40
decade
0
Set z 2 ~ 31.4 rad/sec
-20
60
ωBW ~ 314 rad/sec
-40
-60
1.0E-01
1.0E+04
-20 dB
1.0E+00
1.0E+01
Frequency, rad/sec
1.0E+02
1.0E+03
1.0E+04
Frequency, rad/sec
Finish the PID Controller
Desired Open-Loop TF #2
120
-
1
k d (s + 3)(s + 31 .4) F
2
s
2s + 0.6 s
C(s)
System pole ~ 0.3 rad/sec
100
80
decade
Magnitude, dB
R(s) +
• Find the value of kd that gives the
desired bandwidth of ~50 Hz
• What is the phase margin for this
controller?
60
-40 dB
40
20
0
Arbitrarily
set z 1 ~ 0.3 rad/sec
decade
-20 dB
-20
ωBW ~ 314 rad/sec
-40
-60
1.0E-01
1.0E+00
1.0E+01
1.0E+02
1.0E+03
1.0E+04
Frequency, rad/sec
PID Controller #2
R(s) +
-
k d (s + 0. 3)(s + 31 .4 )
s
F
Questions
1
2s 2 + 0.6 s
• Find the value of kd that gives the
desired bandwidth of ~50 Hz
• What is the phase margin for this
controller?
C(s)
• If the “force amplifier” saturated at 100
lb, what is the largest step input that will
no cause saturation?
• Plot the response of the system to ±0.01
inch sine waves at
– 1 Hz (6.28 rad/sec)
– 5 Hz
– 10 Hz
– 25 Hz
What is the max tracking
error in each case?
3
Download