Tuesday, October 30, 2012

Perancangan Robot KRCI “Wall Following”- ROBOT MOBIL Basic Design (CAVR Source Code)


   Perancangan Robot KRCI “Wall Following”- ROBOT MOBIL Basic Design (CAVR Source Code)   

   1.   Design Body Robot Robot KRCI


  
   

    2.  Diagram Sistem Hardware Robot KRCI



     3. Diagram Blok Sistem Kontrol Robot KRCI


 



     4. Konfigurasi Sensor Ultrasonic Robot KRCI

 
  
  

     5. Pengolahan Data Sensor Ultrasonic  dalam Sistem Navigasi Robot KRCI


Pengolahan data sensor bertujuan untuk memberikan sinyal perintah gerak.
Teknik Pengolahan data Sensor  sangat mempengaruhi tingkat ketelitian Robot
dalam pengambilan keputusan.

Perancangan sistem kontrol eksternal robot untuk berjalan mengikuti dinding, dibagi menjadi 2(dua), yaitu :
1.       ROBOT berjalan mengikuti dinding sebelah kiri, artinya robot akan bergerak dengan bereferensi pada jarak dinding disebelah kiri robot. Selanjutnya secara teknis kita sebut SCAN DINDING KIRI.
2.       ROBOT berjalan mengikuti dinding sebelah kanan, artinya robot akan bergerak dengan bereferensi pada jarak dinding disebelah kiri robot. Selanjutnya secara teknis kita sebut SCAN DINDING KANAN.

Scan Dinding Kiri 


 
Sensor yang digunakan untuk mengukur jarak Dinding adalah : us2, us4 dan us6
Jika Lside adalah jarak aktual, maka da ta sensor ultrasonic dapat kita olah sebagai berikut :
Lside=((us2*5)+us4+(us6/4))/3;
Persamaan diatas BUKAN bersifat MUTLAK, dibutuhkan pengujian dan pengukuran untuk menetukan metode pendekatan.
Tingkat Linearitas perubahan data sensor akan mempengaruhi kinerja ROBOT

PERHATIKAN KEMBALI GAMBAR DIAGRAM BLOK SISTEM KONTROL ….!
jika nilai error dinyatakan sebagai haluan_ki, maka dapat dinyatakan sebagai berikut :
haluan_ki = Set_Jarak – Lside
Dimana,
haluan_ki            = nilai error
Set_Jarak            = setting jarak yang dikehendaki antara robot dan dinding
Lside                     = perhitungan nilai rata-rata pembacaan data sensor   ultrasonic(Jarak_Aktual).


PERINTAH GERAK
Perintah gerak adalah pemodelan gerak robot berdasarkan pembagian selisih  kecepatan
antara Roda Kiri dan Roda Kanan.
Pemilihan model gerak ROBOT dapat dinyatakan sebagai berikut :
If (persyaratan) then
                                begin
                                                perintah-perintah
                                end
                else
                                begin
                                                perintah-perintah
                                end;
Untuk persyaratan-persyaratan dalam pernyataan perintah program diperoleh berdasarkan data hasil pengukuran di lapangan.

Sub Routine Scan Dinding Kiri

void scan_kiri()
 {
   jarak=(us3+us6+us7)/3;
    lside=((us2*5)+us4+(us6/4))/3; //sisi kiri(rata-rata ultrasonik samping kiri)
    haluan_ki=20-lside;            //haluan=seting - side kanan
        if (jarak>=12)
           {
                if ((haluan_ki>=-5)&&(haluan_ki<=5))
                   { maju(); rpwm=30; lpwm=30;}
                if ((haluan_ki>5)&&(haluan_ki<=10))
                   { maju(); rpwm=25; lpwm=30;}
                if ((haluan_ki>10)&&(haluan_ki<=15))
                   { maju(); rpwm=20; lpwm=30;}
                if ((haluan_ki>15)&&(haluan_ki<=18))
                   { maju(); rpwm=15; lpwm=30;}
                if (haluan_ki>18)
                   { kanan(); rpwm=20; lpwm=20;}
                if ((haluan_ki<-5)&&(haluan_ki>=-10))
                   { maju(); rpwm=30; lpwm=25;}
                if ((haluan_ki<-10)&&(haluan_ki>=-15))
                   { maju(); rpwm=30; lpwm=20;}
                if (haluan_ki<-15)
                   { maju(); rpwm=40; lpwm=17;}
                //=================================
                if (us4>40)     { maju();   rpwm=40; lpwm=17;}
                if (us6<=15)    { kanan();  rpwm=20; lpwm=20;}
                if (us3<=12)    { kanan();  rpwm=20; lpwm=20;}
           }
        else {
                if (us4>40)     { maju();   rpwm=40; lpwm=17;}
                if (us6<=15)    { kanan();  rpwm=20; lpwm=20;}
                if (us3<=12)    { kanan();  rpwm=20; lpwm=20;}
                else{ kanan(); rpwm=20; lpwm=20;}
                }
 }


Catatan :
Nilai-nilai yang terdapat didalam listing program ditentukan berdasarkan data hasil pengukururan sensor.


 
Scan Dinding Kanan




 ANALISA  DAN PROSEDUR PERANCANGAN SISTEM KENDALI 
UNTUK  SCAN DINDING KANAN

Tidak jauh beda dengan scan dinding kiri. Silakan analisa sendiri 
jika ada kendala boleh kontak ke email : jhons_ryo@yahoo.com


Movie dokumentasi uji coba Robot J_Land th 2009 : 
diperankan oleh "Pelaku ASLI"--> Farid Zakaria  (Ketua Team KRCI "J_Land" th 2009)
lokasi : Lab. Elektro UBHARA - Surabaya










SOURCE CODE :
                Program CAVR Robot KRCI 2009 & KRCI 2010 :              
                DOWNLOAD HERE :
                                   http://uploading.com/files/7d92328m/JLand14-5-2009%25281.24%2529.rar/
                                   http://uploading.com/files/m8f64c3a/GhenJland19062010.rar/
                    
Baca Artikel Selanjutnya :

Mapping Robot KRCI dan Download Source Code-nya GRATIS

1 comment:

OPINI KU said...

Maap kang saya sedang ada proyek menggunakan wall follower 3pi. kira2 ada gak kode yang menggunakan bahasa C dan kompilernya memakai Atmel, saya dapat robot dari Pololu.com, saya cari dan saya copy kode dari pololu ternyata tidak jalan. tolong pencerahannya kang dan bantuannya kalau ada! tolong kirim ke email suparman.1091@gmail.com
atau suparman_1091@yahoo.com
terima kasih banyak ya kang