Académique Documents
Professionnel Documents
Culture Documents
1570210923
2015 International
Symposium (IES)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
60
61
62
63
64
65
I. INTRODUCTION
100
(1)
(2)
(3)
(4)
(5)
C. PID Controller
PID is a controller to determine the precision of
instrumentation system with feedback characteristics. PID
control component consist of three types: Proportional,
Integrative, and Derivative. If interpreted in terms of time: P
constants depends on the value of the current error, I constant
is the accumulation of previous error value, while the D
constant is the future prediction error, based on the changes
rate [13]. Three of them can be used together or individually
depends on the response wanted for a plant.
Based on [14], if is the discrete time of
discrete equation of PID is:
then the
(6)
Where
: Controller output.
:
: Proportional constant gain.
: Integral constant gain.
: Derivative constant gain.
Heading
Feedback
Distance
Feedback
Distance
Setpoint
Distance PD
Controller
+
-
Center of
Balance
Constant
(7)
D. Motion Driver
Heading
Setpoint
+
+
Balancing
PID
Controller
Heading PD
Controller
Left
Wheel
Balancing
Robot
Right
Wheel
Tilt
Feedback
101
Where:
:
:
:
:
:
(9)
B. Distance PD Control
In this research distance is used as a parameter for
movement, forward or backward. Output of this control affect
the robots tilt error by being an input for the angle PID
control. According to [18], distance can be calculated as:
Where:
Overall balance error.
Angle error of center of balance.
Center of balance constant.
Actual robots body angle.
Angle offset, an output of distance PD control.
(13)
Left
Wheel
Distance
Setpoint
Heading PD
Controller
+ +
Balancing PID
Controller
Block
Right
Wheel
Balancing
Robot
(14)
1
Rotary
Encoder
Balancing PID
Controller Block
Distance PD
Controller
Heading
Setpoint
(10)
Rotary
Encoder
Distance
Feedback
A. Steering PD Control
In order to control the robots maneuver, steering control
is needed. Therefore, in this case a PD control is used to
control the orientation of the robot. Orientation data is taken
from rotary encoder which will count the pulses generated by
the wheel. According to [18], robot orientation can be
calculated as:
Heading
Feedback
Heading error.
Desired heading.
Actual heading.
Proportional constant for heading PD control.
Derivative constant for heading PD control.
(8)
:
:
:
:
:
(12)
(15)
Where:
:
:
:
:
:
:
Left
Wheel
Balancing
Robot
Right
Wheel
Distance error.
Desired distance / position.
Actual distance.
Proportional constant for distance PD control.
Derivative constant for distance PD control.
Angle offset, distance PD control output.
102
Tilt Angle
Feedback
+
-
Center of
Balancing
Constant
Balancing
Controller
Heading PID
Controller Block
+
+
Degree
IMU
Left
Wheel
Balancing
Robot
Total Error ()
uDistance ()
8
6
4
2
0
-2
-4
-6
-8
0
20
Right
Wheel
40
60
t (20ms)
80
100
80
100
Actual Speed
3
1
-1
-3
(17)
20
40
t (20ms)
60
Where:
Motor speed.
Desired distance / position.
Actual distance.
Proportional constant for distance PD control.
Derivative constant for distance PD control.
Centimeter
:
:
:
:
:
9
7
5
0
20
40
60
t (20ms)
80
100
IV. RESULT
103
Total Error ()
670
Degree
30
20
10
0
-10
-20
-30
-40
1250
1400
Heading Value
1350
870
1350
1400
Actual Distance
397
197
1350
770
t (20ms)
820
870
D. Climbing Response
In this experiment, a sloping board with 30 degrees
inclination from the ground is prepared. The robot will be
driven to the top of the sloping board and then stops. The goal
is to find how the robot responses and how the robot corrects
its body inclination while moving on slope surfaces. There
are five data taken for this experiment, speed input, distance
control output, angle control output and the overall error.
t (20ms)
720
1300
-100
From the Fig. 12, at t = 711, the full turn is started and the
response of the robot is shown. The robot starts to oscillate
bigger up to 3.75 degree. While at the uDistance () is shown
that the robot changes the center of gravity automatically
because its body shifted and caused the output of distance
control to change.
Actual Speed
t (20ms)
100
1300
Orientation
670
Centimeter
820
Centimeter
770
-3
1250
720
t (20ms)
t (20ms)
-3
1250
Total Error ()
Degree
10
8
6
4
2
0
-2
-4
-6
-8
-10
Angle Error ()
uDistance ()
1400
In the graph shown by Fig. 16, it can be seen that the robot
starts to change its balance point at t = 335. The angle error
shows that its going far from zero means that the balance
point is already changed while the robot trying to climb up
the slope.
C. Steering Response
This experiment measure the response of the robots
stability while fully turning right without changing the speed.
The orientation data at Fig. 15 shows the actual value of
orientation measured from the rotary encoder and calculated
using Eq. 13.
104
Degree
40
30
20
10
0
-10
-20
-30
-40
Total Error ()
ACKNOWLEDGMENT
200
250
300
350
400
450
t (20ms)
REFERENCES
Centimeter
10
[3]
5
0
[4]
-5
200
250
300
t (20ms)
350
400
450
[5]
[6]
Centimeter
Actual Distance
400
200
[8]
0
200
250
300
350
400
450
[9]
t (20ms)
Fig. 16 Climb up Distance Response
[10]
[11]
[12]
[13]
V. CONCLUSIONS
[14]
[15]
[16]
[17]
[18]
105