Beruflich Dokumente
Kultur Dokumente
Servo Trainer
Trainer (1
(1 )
Basic Tests and Transducer Calibration
Name:
__________________________________
ID #:
__________________________________
Section #:
__________________________________
Due Date:
__________________________________
Instructor
__________________________________
1.
INTRODUCTION
A Servo is a small device that has an output shaft. This shaft can be positioned to
specific angular positions by sending the servo a coded signal. As long as the coded
signal exists on the input line, the servo will maintain the angular position of the
shaft. As the coded signal changes, the angular position of the shaft changes. In
practice, servos are used in radio controlled airplanes to position control surfaces like
the elevators and rudders. They are also used in radio controlled cars, puppets, and
of course, robots, Reference [1].
Figure 1
Servos are extremely useful in robotics. The motors are small, have built in control
circuitry, and are extremely powerful for their size. A standard servo such as the
Futaba S-148 has 42 oz/inches of torque, which is pretty strong for its size. It also
draws power proportional to the mechanical load. A lightly loaded servo, therefore,
Servo Trainer (1): Basic Tests and Transducer Calibration
doesn't consume much energy. The guts of a servo motor are shown in Figure 2. You
can see the control circuitry, the motor, a set of gears, and the case. You can also
see the 3 wires that connect to the outside world. One is for power (+5volts),
ground, and the white wire is the control wire, Reference [1].
Figure 2
So, how does a servo work? The servo motor has some control circuits and a
potentiometer (a variable resistor, aka pot) that is connected to the output shaft. In
Figure 2, the pot can be seen on the right side of the circuit board. This pot allows
the control circuitry to monitor the current angle of the servo motor. If the shaft is at
the correct angle, then the motor shuts off. If the circuit finds that the angle is not
correct, it will turn the motor the correct direction until the angle is correct. The
output shaft of the servo is capable of traveling somewhere around 180o. Usually, it
is somewhere in the 210o range, but it varies by manufacturer. A normal servo is
used to control an angular motion of between 0o and 180o. A normal servo is
mechanically not capable of turning any farther due to a mechanical stop built on to
the main output gear, Reference [1].
A servo system is one of the most important and widely used forms of control
systems. Any machine or piece of equipment that has rotating parts will contain one
or more servo control systems. The job of the control system may include:
2.
Maintaining the speed of a motor within certain limits, even when load output
of the motor might vary. This is called regulation.
Varying the speed of a motor and load according to an externally set program
of values. This is called set point (or reference) tracking.
Initially, consider the servo control system with the clutch disengaged. In this
configuration the system is a speed control process which can be represented as
shown in Figure 3.
The system model is determined by relating the torque supplied by the motor
Tm
to
that required to drive the load generator, the flywheel and frictional losses. This can
be expressed by applying Newtons second law
v ( t)
vl (t )
Figure 3
=I
(1)
dt
or
Tm = b + Kl vl + I
where
(2)
dt
Kl
The motor electrical circuit is governed by the equation (Apply Kirshhoof Voltage
Law)
v (t ) = Ri + L
where
v (t )
di
+ vbemf
dt
(3)
vbemf
is
The back emf and the motor torque can be written in terms of the motor constant
K m , thus
vbemf = K m
Tm = K m i
(4)
Combining Equations (2), (3) and (4) by taking Laplace transforms and eliminating
variables yields the transfer function relating the output speed (s ) to the input
voltage V (s ) and the load voltage Vl (s )
(s ) =
Km
K l (sL + R )
(s ) +
V
V (s )
(sI + b ) (sL + R ) + K m2
(sI + b ) (sL + R ) + K m2 l
(5)
The transfer function simplifies if the inductance L of the armature circuit assumed
to be small compared with the inertia of the flywheel. This gives the first order
transfer function
(s )
K m'
K l'
(
)
=
V s +
Vl (s )
s + 1
s + 1
(6)
where
IR
bR + K m2
Km
K m' =
bR + K m2
Kl R
K l' =
bR + K m2
=
(7)
Frequently, we will consider the situation when the servo-control system only has an
inertial load. In this case Vl (s ) = 0 and Equation (6) simplifies to
(s )
3.
K m'
=
V (s )
s + 1
(8)
With the electric clutch engaged, the gearbox and output position shaft are
connected to the main shaft as shown in Figure 4.
The output shaft position
(s ) =
where
(s )
and
(s )
1
(s )
30s
by
(9)
(t )
and
(t ) ,
respectively.
The constant 30 is associated with the 30:1 reduction in speed through the gearbox.
Note that the addition of the gearbox load will also change the gain and time
constant characteristics of Equations (6), (7) and (8).
Equations (6), (7) and (8) are used together to provide the system model for the
servo-control system dynamics.
Shaft
Bearings
Position
output
shaft
Gearbox
Load
Generator
Angular
Velocity,
Figure 4
4.
30:1
Motor
vl (t )
v (t )
Angular
Position,
When the servo-control system is used as a feedback control system the motor
speed, (s ) , is controlled (or actuated) by adjusting the applied voltage to the
motor drive amplifier, V (s ) . Likewise, the shaft speed and angular position are
sensed by transducers which produce output voltages Y (s ) and Y (s ) which are
proportional to the shaft velocity, (s ) , and position, (s ) , respectively. The
overall system may be represented schematically as shown in Figure 5.
(s )
V(s)
1
3 0s
Y (s)
(s )
Y(s)
Figure 5
The motor voltage, v , and the shaft speed, , are related by a steady state
actuator characteristic which assumed to be linear. The velocity sensor and angular
position sensor also have linear characteristics, as shown in Figures 6, 7,and 8.
If
Ki , K
and
are the motor, velocity sensor and angle sensor gain constants
respectively, then
= Ki v
y = K
(10)
y = K
Figure 6
y
Sl
op
Sensor
output
Shaft
Speed,
Figure 7
y
Sl
op
e
Sensor
output
Shaft
position,
Figure 8
Notice that
Ki
K m'
from
Equation (6), obtained for the modeling part. Taking Laplace Transforms of Equation
(10) and combining the resulted equations with (8) gives the standard first order
system transfer function
Y (s ) =
where
G1
V (s )
s + 1
(11)
G1 = K i K , is the steady state gain for the transfer function from the input
drive voltage,
V (s )
V (s )
Y (s ) .
Y (s )
is
shown in Figure 9.
V(s)
G 1
s + 1
Y(s)
Figure 9
In addition, the sensed output shaft position Y (s ) is related to the sensed velocity
Y (s )
by
Y (s ) =
G2
Y (s )
s
(12)
where
1 K
G 2 =
30 K
(12)
The overall transfer function for the servo-control system can be drawn as in Figure
10 and written thus:
Y (s ) =
V(s)
Figure 10
G1
s + 1
GG
1 2
V (s )
s ( s + 1)
Y (s)
G2
s
(13)
Y (s)
5.
EXPERIMENT
APPARATUS
Important Notice
Access is gained to the inertial load of the CE110 servo trainer, by a door to the
rear left of the front panel. When operating the equipment you should ensure
that the selected inertial load is firmly secured by the knurled nut provided and
the access door is firmly closed. The access door has a micro-switch that
prevents the motor turning when the door is open. It is important therefore when
closing the door to ensure the door is firmly shut and the micro-switch is
engaged.
PROCEDURE
Part 1:
Connections
Connect the equipment as shown in Figure 11(E1.1).
CE 120 Controller
Steps:
Figure 11(E1.1)
10
Important Notice
Avoid running the Servo Trainer at high speed for prolonged periods with the
clutch engaged, as this may cause excessive wear of the gearbox.
Motor Speed
(rpm)
0
0
Motor Drive
Voltage (V)
(Negative)
0
Dead-Zone Size
-1
-2
-3
-4
-5
-6
-7
-8
-9
-10
Motor Speed
(rpm)
0
Motor Speed
(rpm)
0
0
Motor Drive
Voltage (V)
(Negative)
0
Dead-Zone Size
-1
-2
-3
-4
-5
-6
-7
-8
-9
-10
Motor Speed
(rpm)
0
11
Part 2:
Connections
Connect the equipment as shown in Figure 12(E1.2)
Figure 12(E1.2)
Clutch disengaged.
Rear access panel firmly closed.
Smallest inertial load installed (No additional discs).
12
CE 120 Controller
Steps:
Part 3:
Speed Sensor
Output
(V)
1
2
3
4
5
6
7
8
9
Motor Speed
(rpm)
(Negative)
Speed Sensor
Output
(V)
1
2
3
4
5
6
7
8
9
Connections
Connect the equipment as shown in Figure 13(E1.3)
Clutch engaged.
Rear access panel firmly closed.
Smallest inertial load installed (No additional discs).
CE 120 Controller
13
Figure 13(E1.3)
Steps:
14
15
REQUIREMENTS
1. Complete all tables. (i.e., Table E1.1, Table E1.2, Table E1.3, Table E1.4).
2. Plot the characteristic results from all tables (i.e., Table E1.1, Table E1.2,
Table E1.3, and Table E1.4).
3. Are the above characteristic plots linear? If yes find the slope of each one of
them.
4. Comment on the characteristics plots and discuss why the motor drive
characteristic differs with the clutch engaged and disengaged.
References
[1]
[2]
16
CE120 Controller
17
18
19
20
1.2
21
22
23
24
25
26
27
28
29