Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
Contents
1 Summary
2 Results
2.1 Experiment 1
2.2 Experiment2 .
2.3 Experiment 3
2.4 Experiment 4
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
1
1
2
2
3
5
5
5
6
8
9
11
13
13
13
14
15
15
16
18
19
19
Summary
The main objective of this laboratory session was to design a controller for the Puma robot,
which rotates about the zaxis. The main design objective was to reduce the percentage
overshoot to a maximum of 10% and a maximum peak time of 0.8s. The main tasks of this
laboratory session were:
Find the values of T and km
Finding the potentiometer gain k3
Proportional controller
Velocity feedback controller
By following these tasks the design criterion was achieved.
2
2.1
Results
Experiment 1
Table 1: Results from first experiment.
Vi
[V]
0.780
1.902
2.866
4.829
7.829
+
0.976
2.049
2.976
5.073
8.049
Tacho Speed
[rpm]
8.4
19.8
29.3
50.2
80.5
+
7.9
18.8
28.3
48.8
78.6
m
[rad/s]
28.15
66.35
98.19
168.22
269.76
+
26.47
63.00
94.83
163.53
263.39
Vo
[V]
0.829
1.829
2.683
4.610
7.268
+
0.558
1.537
2.366
4.050
6.683
T
[s]
0.302
0.424
0.441
0.436
0.457
+
0.357
0.394
0.424
0.440
0.475
2.2
Experiment2
Table 2: Results obtained from second experiment.
p
2.3
[deg]
[rad]
[deg]
[rad]
V
[V]
20
40
60
80
100
120
0.35
0.70
1.05
1.40
1.75
2.09
19
38
58
78
100
112
0.33
0.66
1.01
1.36
1.75
1.95
0.951
2.207
3.208
4.415
5.817
6.56
Experiment 3
Table 3: Results obtained from third experiment.
P1
[%]
20
25
30
40
50
60
70
80
90
100
Tp
[s]
A
[V]
1.678 0.695
1.434 1.085
1.242 1.244
1.015 1.695
0.881 1.952
0.805 2.171
0.747 2.451
0.705 2.537
0.679 2.561
0.663 2.731
B
[V]
Overshoot
[%]
4.878
4.561
4.866
4.781
4.817
4.878
4.829
4.817
4.854
4.805
14.25
23.79
25.57
35.45
40.52
44.51
50.76
52.67
52.76
56.84
(a) P1 =0%
(b) P1 =20%
(c) P1 =25%
(d) P1 =30%
(e) P1 =40%
(f) P1 =50%
(g) P1 =60%
(h) P1 =70%
(i) P1 =80%
(j) P1 =90%
(k) P1 =100%
2.4
Experiment 4
3
3.1
For this derivation, the inertia of the motor will be I, the damping b and the torque Q. By
assuming the torque produced by the motor is proportional to the error signal . [1]
Q = k
dm
d2 m
= ID2 + bD m
+b
2
dt
dt
Where m is the motor output. By combing both equations 1 and 2 gives:
k = ID2 + bD m
Q=I
(1)
(2)
(3)
(4)
(5)
m
Dm
kD
=
=
2
Vi
Vi
ID + bD
(6)
m
k
=
Vi
ID + b
(7)
m
=
Vi
(8)
By dividing by b:
Therefore:
3.2
k
b
ID
b
+1
m
km
=
Vi
1 + TD
(9)
Time Constant
The time constant is a measure of how long it takes a systems output to reach 63.2% of its
peaktopeak value. Therefore by considering the maximum and minimum voltages of the
Tacho output, it is possible to calculate the time constant.
The graphs in figure 4 shows the way in which the output (blue curve) behaves to a square
wave voltage input (red curve). To calculate the time constant, the maximum and minimum
voltages had to be identified. So by looking at both (a) and (b) in figure 4, the maximum and
minimum values are 0.558V and -0.829V respectively. Therefore by considering the difference
between the maximum and minimum, it gives a value of 1.387V. Thus, the time constant has
5
(a) Positive
(b) Negative
3.3
Calculation of T , km and kg
By looking at table 1, the time constants for the input voltage are shown in the last column.
By taking an average of the time constants, T can be obtained. This has been shown in table
4.
By plotting a graph of output velocity m against the input voltage Vi the gain km can be
identified by the gradient of the line.
T=0.415s
3.4
Potentiometer Gain k3
By plotting a graph of change in output voltage against thirtytwo times the output motor
angle, the slope will give the gain k3 .
8
Figure 9: Graph of change in output voltage against thirtytwo time the output angle.
Therefore, by looking at figure 9 the gain k3 is shown to be 0.1069V/rad.
3.5
(10)
Vo [D (1 + T D) + 3.3P1 km k3 ] = 3.3P1 km k3 Vi
Vo
3.3P1 km k3
=
2
Vi
T D + D + 3.3P1 km k3
(11)
9
(12)
3.3P1 km k3 T1
Vo
= 2 1
Vi
D + T D + 3.3P1 km k3 T1
(13)
Also:
2n =
(14)
1
T
1
2T n
By using the expression from equation 14, equation 15 can be written as:
r
1
T
=
2T 3.3P1 km k3
=
1
=
2 3.3T P1 km k3
(15)
(16)
Since the expression for Tp is known, the derived terms in equations 14 and 16 can be substituted
to replace n and respectively:
Tp =
(17)
d
Tp = p
n 1 2
r
T
q
Tp =
3.3P1 km k3
1 13.2T P11 km k3
r
T
2 3.3T P1 km k3
Tp =
3.3P1 km k3
13.2T P1 km k3 1
Which gives:
Tp =
2T
13.2T P1 km k3 1
(18)
Overshoot = 100exp p
%
1 2
(19)
10
23.3T1P1 km k3
%
Overshoot = 100exp q
1
1 13.2T P1 km k3
Using the same simplification as used between equations 17 and 18 gives:
"
#
3.3T P1 km k3
2
2 3.3T P1 km k3
Overshoot = 100exp
%
13.2T P1 km k3 1
Which gives:
Overshoot = 100exp
%
13.2T P1 km k3 1
3.6
(20)
11
(a) Theoretical
(b) Experimental
12
(a) Theoretcial
(b) Experimental
3.7
3.7.1
Referring to equation 16, the theoretical P1 for the critical damping ratio can be calculated:
1
=
2 3.3T P1 km k3
Since the numerical values for , T , km and k3 are known, it gives:
1
1=
2 3.3 0.415 P1 33.461 0.1069
P1 =
3.7.2
1
= 0.051 5.1%
4 3.3 0.415 33.461 0.1069
Looking at figure 15, it can be seen that this graph has been extrapolated to the xaxis, this
is because the equation that was generated by the trend line was:
y = 4 1012 x6 2 109 x5 + 3 107 x4 3 105 x3 + 0.0014x2 0.0442x + 1.0044 (21)
Which implies that the yintercept is approximately 1.0044. This indicates that the critical
damping occurs at approximately 0% P1 value, which is not a true indication of when the
system is critically damped.
13
3.8
3.9
In this part of the laboratory session, it was required to see how the peak time Tp and percentage
overshoot varied with respect to both P1 and P2 . Graphs of the different combinations have
been shown in figure 2.
In reference to figure 2, the first observation that can be made is that by having P1 at 0%,
and changing P2 it has no effect on the behaviour on the system. However, with an increased
P1 , it can be seen that P2 helps reduce the percentage overshoot of the system. Whereas, P1
increases the percentage overshoot, but helps in reducing Tp of the system.
3.10
The graph shown in figure 3, shows the optimum combination that was supposed to meet the
design criteria. The P1 and P2 values selected were 100% and 70%, respectively. However, the
percentage overshoot calculated is approximately 10.5%, which shows that the design criteria
was missed by 5%. This was due to the lack of iterations conducted in the laboratory session.
Whereas, the time Tp produced is approximately 0.6s, which is under the required time.
15
3.11
Transfer function of Vi to Vo and derivation for Tp and percentage overshoot in terms of k3 , km , P1 , P2 , and T for velocity
feedback controller
Figure 18: Block diagram for the velocity feedback in a position control system.
Using the block diagram in figure 18, the overall transfer function can be obtained. The
equations that can initially be generated are:
A = Vi Vo
(22)
B =AE
(23)
C=
3.3P1 km
B
D (1 + T D)
(24)
E = P2 kg DC
(25)
Vo = Ck3
(26)
B = Vi Vo P2 kg DC
(27)
Vo
k3
D (1 + T D) Vo
3.3P1 km
k3
B = Vi Vo
P2 kg DVo
k3
(28)
(29)
= Vi Vo
3.3P1 km
k3
k3
16
D (1 + T D) P2 kg D
+
+ 1 Vo = Vi
3.3P1 km k3
k3
D (1 + T D) + 3.3P1 P2 km kg D + 3.3P1 km k3
Vo = Vi
3.3P1 km k3
Therefore:
3.3P1 km k3
Vo
=
Vi
D (1 + T D) + 3.3P1 P2 km kg D + 3.3P1 km k3
Vo
3.3P1 km k3
=
Vi
T D2 + (3.3P1 P2 km kg + 1) D + 3.3P1 km k3
(30)
Vo
=
Vi
D2 +
3.3P1 km k3
T
3.3P1 P2 km kg +1
D
T
Which shows:
r
n =
Also:
3.3P1 km k3
T
3.3P1 km k3
T
3.3P1 P2 km kg + 1
T
3.3P1 P2 km kg + 1
=
2T n
(31)
(32)
2n =
(33)
3.3P1 P2 km kg + 1
q
2T 3.3P1Tkm k3
3.3P1 P2 km kg + 1
2 3.3T P1 km k3
As seen in equation 17, it can be seen that Tp can be calculated by:
=
Tp =
(34)
p
n 1 2
r
Tp = q
h
i2
3.3P1 P2 km kg +1
3.3P1 km k3
T
2 3.3T P1 km k3
Tp =
Tp = q
3.3P1 km k3
T
1
4T 2
(3.3P1 P2 km kg + 1)2
17
(35)
Now obtaining an expression for the percentage overshoot, shown in equation 19:
"
#
Overshoot = 100exp p
%
1 2
Replacing :
Overshoot = 100exp
r
P k k +1
1 2 m g
3.3P
2 3.3T P1 km k3
3.3P1 P2 km kg +1
2 3.3T P1 km k3
2 3.3T P1 km k3
2 %
3.3P1 P2 km kg +1
2 3.3T P1 km k3
%
Overshoot = 100exp q
2
13.2T P1 km k3 (3.3P1 P2 km kg + 1)
(3.3P1 P2 km kg + 1)
%
Overshoot = 100exp q
2
13.2T P1 km k3 (3.3P1 P2 km kg + 1)
3.12
(36)
In subsection 3.8, the design objectives have been mentioned. In order to see how, the
time and percentage overshoot reacted to a change in P1 and P2 values inequalities had
formed.
2T
q
0.8
2
13.2T xkm k3 (3.3xykm kg + 1)
(3.3xykm kg + 1)
0.1
exp q
2
13.2T xkm k3 (3.3xykm kg + 1)
peak
been
(37)
(38)
18
3.13
Errors
The initial sources of errors caused in this experiment can be clearly seen in figures 5, 6 and
9. This is because a line of best fit had been taken of these values, which does not mean that
all the points lie on the line of best fit. Also, looking at figures 13 and 14, it can be seen that
both experimental curves are similar to the theoretical curves, but not still give a slight error.
Additionally the points in figure 14 (b) are not on the line resulting in a slight error to be
caused.
Now looking at figure 15, the extrapolated line for the damping ratio against P1 does not give
a suitable value for a critically damped system, thus taking more values in future experiments
would be advised. Additionally, no readings were repeated, so to ensure reliability it would be
best if readings were repeated.
Lastly, during the experiment, it was not clear whether the readings taken for the time constant,
peak time, initial peak and initial steady state value were accurate due to the noise in the
system. Therefore accumulating to the error caused in this experiment.
Conclusion
Overall, this experiment was a good insight to the operation of a Puma robot, and how the
velocity feedback controller ensures the design criteria to be achieved. As mentioned in subsection 3.8, the design specification could not be reached due to the inverse relation between
the peak time and overshoot produced. Thus, by adding a velocity feedback, it allowed for the
design requirements to be achieved.
19
References
[1] Dr A.R. Greig. Mech 2006 Dynamics & Control Linear Control Theory. University College
London.
[2] Dr A.R. Greig. Analogue Servo System. University College London.
20