Labsheet Translation Mechanical System
Labsheet Translation Mechanical System
DEPARTMENT OF MECHANICAL
ENGINEERING TECHNOLOGY
CONTROL LABORATORY
LAPORAN MAKMAL/LABORATORY REPORT
Kod M/Pelajaran/ ENGINEERING
BNJ 37301
Subject Code LABORATORY IV
Kod & Tajuk Ujikaji/
Code & Title of Experiment
Kod Kursus/ Seksyen /Section
Course Code
No. K.P / I.C No.
Kumpulan/Group
Nama Pelajar/Name of No. Matrik
Student
Lecturer/Instructor/Tutors 1.
Name 2.
Nama Ahli Kumpulan/ No.
Penilaian / Assesment
Group Members Matrik
1. Teori / Theory 10 %
Keputusan /
2. 15 %
Results
Pemerhatian
3. 20 %
/Observation
Pengiraan /
4. 10 %
Calculation
Perbincangan /
5. 25 %
Discussions
Tarikh Ujikaji / Kesimpulan /
15 %
Date of Experiment Conclusion
Tarikh Hantar / Rujukan /
5%
Date of Submission References
JUMLAH / TOTAL 100%
ULASAN PEMERIKSA/COMMENTS
COP DITERIMA/APPROVED
STAMP
UNIVERSITI TUN HUSSEIN ONN MALAYSIA
Faculty of Engineering Technology
COURSE INFORMATION
1. INTRODUCTION
2. OBJECTIVES
3. LEARNING OUTCOMES
Figure 1(a) shows the most general form of the two degree of freedom plant
where friction is idealized as being viscous. The transfer function for the 2DOF
plant model can be obtained analytically by using the Newton second law and the
free body diagram. A dynamic equation of m1 will be obtained by summing all
forces acting on it as shown in Figure 1(b):
m 1 x 1 + c1 x 1 + (k 1 + k 2 )x 1 - k 2 x 2 = F(t) (4.1)
m2 x 2 + c2 x 2 + (k 2 + k3 )x2 - k2 x 1 = 0 (4.2)
x 1 (s) m2 s 2 + c2 s + k 2 +k 3
=
F(s) D(s) (4.3)
x 2 (s) k
= 2
F(s) D(s) (4.4)
Where,
D(s) = m1 m2 s 4 + m1 c2 + m2 c1 s 3 + m1 (k 2 +k 3 )+ m2 (k 1 +k 2 ) + c1 c2 s 2
+ c1 (k 2 +k 3 )+ c2 (k 1 +k 23 ) s + k 1 k 2 + k 1 k 3 + k 2 k 3
(4.5)
The transfer functions may also be expressed in the general form as:
x 1 (s) K 1 s 2 + 2z z s + z2
=
F(s) s 2 + 2p1 p1 s +p 21 s 2 + 2p 2 p 2 s +p2 (4.6)
x 2 (s) K2
=
F(s) s 2 + 2p1 p 1 s + p21 s 2 + 2p 2 p 2 s + p22 (4.7)
Where the i's and i's are the natural frequencies and damping ratios
respectively, and the gains K1 & K2, are nominally equal to 1/m1 and k1/m1m2
(but often may be measured more directly).
5. APPARATUS
Figure 2 shows the equipment used for this experiment. The equipment consists
of:
a. Electromechanical plant
b. System interface software
c. Real-time controller & I/O
6. PROCEDURES
This section gives a procedure for identifying the plant parameters applicable to
Eq's (4.1 through 4.7). The approach will be to indirectly measure the mass,
spring, and damping parameters by making measurements of the plant while set
up in a pair of classical spring-mass configurations.
1. Clamp the second mass to put the mechanism in the configuration shown
in Figure 5a using a shim (e.g. 1/4 inch nut) between the stop tab and stop
bumper so as not to engage the limit switch. Verify that the medium
stiffness spring (nominally 400 N/m) is connecting the first and second
mass carriages.
2. Secure four 500g masses on the first and second mass carriages.
3. With the controller powered up, enter the Control Algorithm box via the
Set-up menu and set Ts = 0.00442. Enter the Command menu, go to
Trajectory and select Step, Set-up. Select Open Loop Step and input a
step size of 0 (zero), a duration of 3000 ms and 1 repetition. Exit to the
background screen by consecutively selecting OK. This puts the controller
in a mode for acquiring 6 sec of data on command but without driving the
actuator. This procedure may be repeated and the duration adjusted to
vary the data acquisition period.
1
You may zoom the plot via Axis Scaling for more precise measurement in various areas. For an
even greater precision, the data may be examined in tabular numerical form
(6.1)
where the "m11" subscript denotes mass #1, trial #1. (Close the graph
window by clicking on the left button in the upper right hand corner of the
graph. This will collapse the graph to icon form where it may later be
brought back up by double-clicking on it.)
8. Remove the four masses from the first mass carriage and repeat Steps 5
through 7 to obtain nm12 for the unloaded carriage. If necessary, repeat
Step 3 to reduce the execution (data sampling only in this case) duration.
9. Measure the initial cycle amplitude Xo and the last cycle amplitude Xn for
the n cycles measured in Step 8. Using relationships associated with the
logarithmic decrement:
(6.2)
find the damping ratio m12 and show that for this small value the
approximations of Eq's (6.1, 6.2) are valid.
10. Repeat Steps 5 through 9 for the second mass carriage. Here in Step 6 you
will need to remove Encoder #1 position and add Encoder #2 position to
the plot set-up. Hence obtain nm2 , nm22 and m22. How does this
damping ratio compare with that for the first mass? Be sure to save this
plotted data as it will be used in the next experiment.
11. Connect the mass carriage extension bracket and dashpot to the second
mass as shown in Figure 5c. Open the damping (air flow) adjustment knob
2.0 turns from the fully closed position. Repeat Steps 5, 6, and 9 with four
500 g masses on the second carriage and using only amplitudes 500
counts in your damping ratio calculation. Hence obtain d where the "d"
subscript denotes "dashpot".
12. Each brass weight has a mass of 500 10 g. (You may weigh the pieces if
a more precise value is desired.) Calling the mass of the four weights
combined mw, use the following relationships to solve for the unloaded
carriage mass mc2, and spring constant k.2
Now all dynamic parameters have been identified! Values for m1 and m2 for any
configuration of masses may be found by adding the calculated mass contribution
of the weights to that of the unloaded carriages5.
2
Note that the calculated masses mc1 and mc2 will include the reflected inertias of all connected
elements e.g. motor pinion and armature.
3
Step 12 may be done later, away from the laboratory, if necessary.
4
The resulting value for k should be very close to that measured when considering the second mass
case. You may use the average of the two for your identified k value.
5
In Model 210 configurations where the third mass is used, the inertia and damping parameters of
the third carriage may generally be assumed to be the same as for the second carriage. For more
precise results, steps 5 through 9 and 12 may be repeated for the third mass.
1. Remove the spring connecting the first and second masses and secure four
500 g masses on the first mass carriage. (You should label this particular
spring so that the identified parameter k2 will be consistent when used in
later experiments). Use the limit clamps to secure the second mass clear
from the first. Verify that the masses are secure and that the carriage slides
freely. Hook up the drive power to the mechanism. Position the first mass
approximately 3 cm to the left (negative x1 position) of its center of travel.
2. In the Trajectory window deselect Unidirectional moves (i.e. enabling
bi-directional inputs) select Step, Set-up. Choose Open Loop Step, and
input 2.00 Volts, 75 ms, 2 reps. Execute this open loop step via the
Execute menu. (This move may trip a software speed limit or motion
travel limit which disables the controller indicated by "Limit Exceeded" in
the Controller Status box in the "desk top". Again, to reset, simply
reselect Execute from the Execute menu.) Go to Set-up in the Plot
Data menu and select Encoder #1 velocity for plotting.
3. Plot this data and observe four velocity profile segments with nominal
shapes of: linear increase (constant acceleration), constant (zero
acceleration6), linear decrease (deceleration), and constant. Obtain the
acceleration, 2
1e (counts/s ) by carefully measuring the velocity
difference and dividing by the time difference (75 ms) through the
positive-sloped linear segment. 7,8 Repeat this for the negative-sloped
segment. Calculate the average magnitude of the positive and negative
accelerations for use in obtaining khw below.
4. Save any files or plots of interest. Exit the executive program and power
down the system.
6
Some small deceleration will exist due to friction.
7
For more precise measurement you may "zoom in" on this region of the plot using Axis Scaling in
the Plotting menu.
8
It is possible to read the accelerations directly by plotting Encoder #1 acceleration. This data,
obtained by double numerical differentiation, is typically somewhat noisy however. The student
may want to verify this by observing the acceleration plot
9
It contains software gain also. This software gain, ks is used to give higher controller-internal
numerical resolution and improves encoder pulse period measurement for very low rate estimates.
Where:
kc, the DAC gain, = 10V / 32,768 DAC counts
ka, the Servo Amp gain, = approx 2 (amp/V)
kt, the Servo Motor Torque constant = approx 0.1 (N-m/amp)
kmp, the Motor Pinion pitch radius inverse = 26.25 m-1
ke, the Encoder gain, = 16,000 pulses / 2 radians
kep, the Encoder Pinion pitch radius inverse = 89 m-1
ks, the Controller Software gain, = 32 (controller counts / encoder or ref
input counts)10
Use (6.6 through 6.8) to solve for khw using the specified values for ke and ks.For
control purposes it is generally desirable to put the transfer function in
denominator-monic form (leading term in D(s) has unity coefficient).
10
These are the counts that are actually operated on in the control algorithm. i.e. The system input
(trajectory) counts and encoder counts are multiplied by 32 prior to control law execution.
7. OBSERVATION
8. RESULT/CALCULATIONS
a. Plant parameters (f, dm11, m11 and nm11) of loaded masses in the first
mass carriage (Encoder #1)
b. Plant parameters (f, dm12, m12 and nm1) of unloaded masses in the
first mass carriage (Encoder #1)
c. Plant parameters (f, dm21, m21 and nm21) of loaded masses in the
second mass (Encoder #2)
d. Plant parameters (f, dm22, m22 and nm22) of unloaded masses in the
second carriage (Encoder #2)
a. Plant parameters (mc1, kmed stiffness and cm1) of first mass carriage
b. Plant parameters (mc2, kmed stiffness and cm2) of second mass carriage
b. Find the hardware gain, khw using the specified values for kc and ks.
8.5 Calculate the plant parameters (nm23, nm24, khigh stiffness, and klow
stiffness)
9. DISCUSSIONS
10. CONCLUSION
11. REFERENCES