A. Perumusan Masalah
Adapun permasalahan yang akan dibahas adalah sebagai berikut :
ATME
GA 16
PWM
Driver
Motor
Motor
Potensiometer
Motor
Potensiometer
Motor
Potensiometer
Motor
Potensiometer
Motor
Potensiometer
ADC
Lengan Robot
+5V
VR
ADC
Kontrole
r
Masukkan
input awal
Masukkan Pada
Rumus :
P, I, dan D
Input=Output(
Sensor posisi)
Y
Gambar 4. USB to Serial Converter[7]
End
Tx
Rx
GND
Start
Inisialisasi Awal
Robot Berada Pada Posisi
Awal yang telah ditentukan
Gambar 5. MAX232[7]
B. PERENCANAAN SOFTWARE
1). Kontroler PID pada Robot Gripper
Kp
ref
0-5V
Motor
DC
Potensiometer
ref
0-5V
s. Kd
Tampilkan posisi
lengan robot pada
Visual Basic
4
4,5
5
2,2
2
1,8
0,44
0,4
0,36
409,09
450
500
kecepatan
500,00
400,00
300,00
200,00
100,00
0,00
0,0
2,0
4,0
6,0
tegangan
ref
e(t)
Out=K.e(t)
500
-500
V=out20.69/105.57
data = read_adc(0);
vin=((float)data2*0.00488);
Teta_feedback =vin*36;
error =fabs(Teta_ref-Teta_feedback);
output= (ku*error)*2000;
if(output>=500)output=500;
tegangan= (output-20.69)/105.57;
Output kontroller =tegangan*51;
=V.51
start
Input Teta_ref
Read Teta_feedback
Error=teta_ref-teta_feedback
Output=(ku*error)*2000
end
Sudut
4
14
18
25
31
38
42
39
37
42
41
37
39
42
38
38
41
39
38
42
39
Error
36
26
22
15
9
2
-2
1
3
-2
-1
3
1
-2
2
2
-1
1
2
-2
1
Waktu
9
14
15
18
20
23
25
28
30
33
35
38
40
43
45
48
50
53
55
58
60
Sudut (Derajat)
Nilai Kp :
Kp = 0.6x1=0.6
Nilai Ti :
Ti = 1.2x(1/0.008)= 150
Ki= Kp/Ti=0.6/150=0.004
Nilai Td :
Td = 0.125x0.008=0.001
Kd =Kp.Td=0.6x0.001= 0.0006
Jadi parameter yang didapat dari hasil perhitungan yaitu :
Kp=0.6 Ki=0.004 Kd=0.0006
Waktu(detik)
DAFTAR PUSTAKA
[1] Ikuo Yamano, Kenjiro Takemura, Takashi Maeno :
Development of a Robot Finger For Five-Fingered Hand
Using Ultrasonic Motors, Proceedings of the 2003
IEEE/RSJ
[2] Kiyoshi Hoshino, Ichiro Kawabhuci :Pinching at
Fingertips for Humanoid Robot Hand,Journal Robotics
and Mechatronics Vol. 17 No.6,2005
[3] Jeffrey E. Erickson, Kathryn J. DeLaurentis, Mourad
Bouzit : A Novel Single Digit Manipulator for Prosthetic
Hand Applications
[4] Oghata Katsuhiko,2002.Modern Control Engineering,
Practice Hall Internasional.
[5] Pitowarno, Endra.2004.Desain Kontrol dan Kecerdasan
Buatan.Andi, Jogyakarta.
[6] Sigit, Riyanto, 2007.Robotika, Sensor dan Aktuator,
Graha Ilmu, Surabaya.
[7] http://www.alldatasheet.com
[8] http://id.wikipedia.org/wiki/servo
[9] Ario Suryo Kusumo, 2002.Buku Latihan Microsoft
Visual Basic 6.0,Elek Media Komputindo,Jakarta.
[10] Prasetya, Eka, ,2004.Interfacing port pararel dan
port serial computer dengan VB 6.0,Andi Jogyakarta.
[11] http://www.pncl.co.uk