Tampilkan postingan dengan label Robot-Coding. Tampilkan semua postingan
Tampilkan postingan dengan label Robot-Coding. Tampilkan semua postingan

Kamis, 18 Juni 2009

Sensor Garis ADC : Menentukan Nilai Error

.
Mendekati tahap akhir penggunaan Sensor Garis.
Bagian ini membahas cara menentukan nilai error dari sensor garis baik dengan menggunakan sensor garis On / Off maupun sensor garis ADC.
Ada banyak cara tergantung dari programer atau terserah anda.

Saya akan membahas salah satu cara yaitu dari 8 buah sensor (ada juga yang hanya 7 buah sensor) yang digunakan akan dibagi menjadi 2 bagian yaitu 4 buah nible atas sebagai sensor kanan dan 4 buah nible bawah sebagai sensor kiri.
Lebih jelasnya lihat gambar berikut.






Pada gambar 1, ada 8 buah Sensor yang terpasang berbaris dan di bagi 2 berdasarkan posisinya.
4 buah sensor kanan dan 4 buah sensor kiri.
  • Error terkecil yaitu sensor 1 dan sensor A (sisi dalam).
  • Error kecil yaitu sensor 2 dan sensor B.
  • Error besar yaitu sensor 3 dan sensor C.
  • Error terbesar yaitu sensor 4 dan sensor D (sisi luar).
Nilai error ini bisa anda definisikan sesukanya dan kemudian bisa anda gunakan sebagai input metode pengontrolan nantinya. Misal 1 dan A nilai errornya 0, 2 dan B nilai errornya 2, 3 dan C nilai errornya 4, 4 dan D nilai errornya 6. Kemudian aplikasikan dengan PID kontroller seperti di link ini http://www.ecircuitcenter.com/Circuits/pid1/pid1.htm.

Berikut Coding untuk menentukan nilai error.

Rabu, 17 Juni 2009

Sensor Garis ADC : ADCtoBoolean

.
Data sensor garis yang akan dibaca pada PORT ADC yaitu PORTA.0 hingga PORTA.7 akan bernilai antara 0 - 255 (ADC 8 bit) setiap PIN-nya dan belum bernilai logika 1 ataupun logika 0, padahal data yang dibutuhkan untuk mengolah nilai sensor garis nantinya adalah logika 0 / 1 setiap PIN-nya. Oleh sebab itu dibutuhkan fungsi yang akan mengubah nilai 0 - 255 menjadi logika 1 atau logika 0.

Salah satu caranya yaitu dengan menentukan nilai tengah (Sensor Garis ADC : Nilai Tengah Sensor Garis) antara nilai ADC untuk gelap (garis hitam) dengan nilai ADC untuk terang (garis putih), Misalkan saat gelap nilai ADC PORTA.0 = 230 sedangkan saat terang nilai ADC PORTA.0 = 80 maka nilai tengahnya yaitu (230 + 80) / 2 = 155, Artinya jika nilai ADC pada PORTA.0 di bawah 155 (ADC(0) kurang dari 155) maka berlogika 1 (putih = 1) sedangkan jika nilai ADC pada PORTA.0 diatas sama dengan 155 maka berlogika 0 (hitam = 0).

Berikut potongan program Konversi nilai ADC menjadi Logika 1 / 0 yaitu mambaca data pada PORTA dan menampilkan logikanya pada PORTB berupa LED.
- Konfigurasi CodeWizzardAVR (LCD tidak digunakan).
- Rangkaian Schematik Hardware.








Tambahan :
  • Konfigurasi lihat blog sebelumnya.
  • #define PORTLED PORTB mendefinisikan PORTB sebagai port rangkaian LED.
  • unsigned char ram sebagai global ram yang berfungsi bebas.

Langkah program :
  • Menunggu karakter input dari komputer secara serial COM.
  • Jika 'A' (0x41 dalam heksa) maka proses mencari GARIS_NILAITENGAH dilakukan.
  • Jika karakter selain 'A' lanjut ke proses selanjutnya.
  • Membaca ADC(0) - ADC(7).
  • Jika ADC(x) lebih besar dari nilai tengah maka dataport[x] = 0 (hitam = 0).
  • Jika ADC(x) lebih kecil sama dengan dari nilai tengah maka dataport[x] = 1 (Putih = 1).
  • Tampilkan hasil pengolahan data ADC pada LED setelah dikomplemenkan (LED rendah aktif).

Sensor Garis ADC : Nilai Tengah Sensor Garis

.
Data yang ingin diolah oleh Robot Line Tracing nantinya adalah logika 1/0 dari data PORTA ADC sensor garis, sehingga dibutuhkan konversi data dari ADC ke logika 1 atau logika 0 (ADCtoBoolean). Tetapi sebelumnya dibutuhkan fungsi yang menentukan batasan-batasan nilai ADC untuk logika 1 dan nilai ADC untuk logika 0, salah satu caraya yaitu dengan batasan Nilai Tengah Sensor Garis.

Sebelum lanjut ke Coding menentukan nilai tengah, proses Sensor Garis ADC : Membaca Data harus benar-benar meyakinkan yaitu nilai data ADC antara gelap (hitam) dan terang (putih) harus memiliki perbedaan yang signifikan, jika perbedaannya tipis sebaiknya ganti sensornya terlebih dahulu. Hal ini mempengaruhi hasil berikutnya bahkan Robot Line Tracing secara keseluruhan.

Berikut coding mencari nilai tengah ADC pada sensor garis (dengan LDR ataupun IR)
- Konfigurasi CodeWizzardAVR (LCD tidak digunakan).

Library math.h dibutuhkan untuk fungsi ceil dan abs (absolut). Data sensor nilai tengah sensor garis nantinya akan disimpan kedalam EEPROM dengan type data integer sehingga anda cukup 1 kali saya melakukan inisialisasi sensor garis dan seterusnya boleh melakukan lagi atau tidak, terserah anda.

EEPROM (Electrically Erasable Programmable Read-Only Memory) = memori yang tetap menyimpan data secara permanen meskipun supply dimatikan.

Program tersebut akan membaca nilai ADC untuk hitam terlebih dahulu kemudian nilai ADC untuk putih, setelah itu nilai tengah diperoleh dari (nilai hitam - nilai putih) / 2. Untuk meyakinkan apakah proses pembacaan data telah benar dan sesuai saya gunakan komputer komunikasi port serial (port COM) untuk menampilkan nilai-nilai tersebut.

Sebenarnya saya menggunakan nilai absolut (abs) yaitu nilai negatif akan menjadi positif sehingga nilainya akan selalu positif, nah dengan tambahan ini meskipun anda terbalik tetap akan benar data nilai tengahnya. Maksudnya, seharusnya inisialisasi yang benar adalah hitam dulu baru putih tetapi jika putih dulu baru hitam tetap tidak masalah.

Selasa, 16 Juni 2009

Sensor Garis ADC : Membaca Data

.
Program (Coding) yang akan saya bahas berikut ini adalah membaca tegangan keluaran dari sensor yang masuk pada port ADC mikrokontroler ATmega8535 jadi program ini tidak terbatas hanya pada pembacaan data sensor garis saja.

CodeWizzardAVR
Gunakan CodeWizzardAVR pada CodeVisionAVR dan atur konfigurasi seperti gambar 1. Disini saya sertakan pengecekan pembacaan sensor ADC tampilan komputer dengan UART dan tampilan LCD karakter 16 x 2, silahkan pilih salah satu (dua-duanya jg g masalah). Tapi saya mencoba hanya pada UART karena tidak tertarik menggunakan LCD 16x2, selain itu LCD hanya akan berguna 1 kali saja (nanti anda setuju juga sama saya).

ADC yang digunakan adalah 8 bit, silahkan mencoba untuk data 10 bit tetapi ingat penggunaan type datanya harus unsigned int (range 0 - 65535) atau int (range -32768 hingga 32767 )jangan menggunakan unsigned char (range 0 - 255) karena jika data 10 bit (logika 1 semua) berarti range ADC 0 - 1023. Untuk HighSpeed saya belum mencoba. Sebaiknya anda penasaran dan silahkan coba-coba setiap nilai (tentunya baca buku referensi dulu).
Untuk konfigurasi UART dan LCD, no comment.

Baca ADC Dengan UART
Gambar 2 adalah listing lengkap untuk Cek ADC dengan UART. Beberapa inisialisasi saya hilangkan karena kondisi default dan pembacaan ADC saya taruh d bawah (default di atas).

Wow.... Simple kan main programnya.
Sebisa mungkin main program adalah program yang hanya memanggil fungsi atau prosedure karena banyak keuntunggannya,
antara lain :
  • Memperkecil memori.
  • Mempermudah mengoreksi program.
  • Memperkecil penggunaan global variabel (semakin banyak global variabel, register yang digunakan semakin banyak).
  • Program menjadi lebih terstruktur dan terorganisasi.
  • Membuat Anda akan merancang Flowchart / Statechart terlebih dahulu sebelum melakukan Coding (biasanya langsung Coding sehingga sering merivisi programnya).
  • dll.
Program ini akan menunggu anda mengetik karakter 'A' ( 41 dalam Hex Code ) dan kemudian memproses pembacaan ADC. ADC(0) di baca terlebih dahulu dan terakhir ADC(7). putchar(13) adalah pindah ke baris berikutnya ( 13 = 0x0D = enter ).

Mengapa menggunakan buf[12] ?
Data yang akan ditampilkan misal untuk ADC(5) "LDR 5 : 230 " (ada spasi di akhirnya), perhatikan total karakter yang ditampilkan adalah 12 buah.

Baca ADC LCD 16x2
Gambar 3 adalah potongan listing untuk Cek ADC dengan LCD 16x2 karakter.
Berbeda dengan UART, seluruh data pada ADC(x) dibaca terlebih dahulu secara keseluruhan dan disimpan pada data[x].
lcd_clear() berfungsi untuk menghapus LCD dan posisi x,y otomatis (0,0). Baris 1 LCD dengan jumlah 16 karakter akan menampilkan data ADC(0) - ADC(3) sedangkan Baris 2 LCD menampilkan data ADC(4) - ADC(7).

Selasa, 07 April 2009

Mobil Robot & Wall Tracing

.
Sekarang ke algoritma.
Sebelum anda jauh melihat listing programnya, biar tidak bingung sebaiknya anda pelajari bahasa C mencakup struktur, command-command, tipe data, operator, membuat fungsi, dll. Tetapi jika anda menguasai bahasa pemrograman lain seperti bahasa Pascal, BasCom, atau assembler maka lihat bagaimana memprogramnya dan logika pemrogramannya lalu bagaimana mengimplementasikan pada bahasa pemrograman yang anda kuasai.

Saya akan memprogram mobil robot untuk mempertahankan jarak mobil robot terhadap dinding dengan jarak referensi 20 cm, bisa menggunakan hanya 1 buah sensor PING atau 2 sensor PING. Jika anda menggunakan hanya 1 sensor PING maka pada arena yg anda buat tidak boleh ada halangan di depan mobil robot. Mobil robot akan diprogram agar dapat berbelok dengan tikungan hingga 180 derajat. Hal penting sebelum ke program utama adalah menentukan nilai PWM yang akan diberikan pada mobil robot untuk kondisi jarak tertentu, tujuannya adalah agar menghasilkan pergerakan mobil robot yang halus, selain itu juga karena karakteristik motor DC yang berbeda-beda. Motor DC yang saya gunakan pasti berbeda dengan yang anda gunakan.

Listing pada Gambar 1 adalah pengujian untuk mengetahui karaktersitik motor DC yang anda gunakan apakah linier atau logaritmik. Jika anda telah mengetahui linier atau logaritmik maka akan mempermudah mencapai hasil yang maksimal nantinya, tetapi jika anda tidak sabaran silahkan langsung ke listing Gambar 2 dan lakukan Trial and Error dengan mengubah nilai PWM terus-menerus hingga didapatkan hasil yang maksimal. Apabila anda beruntung dengan sedikit coba-coba ketemu dah.

Pengujian yang baik dan lebih teliti tentu saja dengan menggunakan alat ukur kecepatan putaran
atau tachometer atau encoder, tetapi saya menganggap anda tidak memilikinya sehingga pengujian seperti di bawah ini (saya juga ga punya si).

Cara pengujian sebagai berikut :
- Program awal ROBOT(Stop) selama 3 detik.
- ROBOT(Maju) selama 3 detik dengan nilai PWM 250.
- ROBOT(Stop) selama 3 detik.
- ROBOT(Maju) selama 3 detik dengan nilai PWM 200.
- ROBOT(Stop) selama 3 detik.
- ROBOT(Maju) selama 3 detik dengan nilai PWM 150.
- ROBOT(Stop) selama 3 detik.
- ROBOT(Maju) selama 3 detik dengan nilai PWM 100.
- ROBOT(Stop) selama 3 detik.
- ROBOT(Maju) selama 3 detik dengan nilai PWM 50.
- Gunakan alas yang licin (lantai keramik) atau menggunakan kertas karton putih.
- Posisikan mobil robot dan beri tanda pada lantai posisi awal mobil robot.
- Setelah mobil robot di program dan sudut sensor PING telah diatur dengan baik, kemudian jalankan.
- Setiap mobil robot bergerak maju kemudian stop, berikan tanda pada lantai dimana posisi mobil Robot berhenti hingga mencapai akhir program.
- Catat perubahan jarak yang terjadi, dari listing diatas anda mendapatkan 5 data jarak.
- Dengan menggunakan rumus perbandingan antar jarak dengan nilai PWM maka dapat disimpulkan apakah motor DC anda Linier atau logaritmik. Jika motor DC anda linier tidak masalah tetapi jika logaritmik baru masalah (tenang ga gede kok).

Oh ya satu lagi, anda ubah nilai PWM pada listing Gambar 1 hingga nilai tersebut minimum, yaitu nilai PWM terkecil yang masih menyebabkan motor DC bergerak (pelaaaaaan banget), catat nilai PWM tersebut karena akan digunakan untuk berbelok 180 derajat.

Untuk mempermudah pemahaman program, saya gunakan perintah IF THEN ELSE saja, mengapa saya menuliskan program IF THEN ELSE seperti itu, silahkan pikirkan sendiri (Wkkk.....).
Nilai PWM dapat anda atur sesuai perhitungan anda berdasarkan karakteristik motor DC anda. Kalo ingin lebih cepat dan halus pergerakan mobil robot gunakan PI-Fuzzy, atau metode yg anda inginkan. Sensor PING berada pada sisi kiri mobil robot, jadi diprogram untuk meraba dinding kiri saja.

Kondisi awal pergerakan mobil robot adalah penting, jika mobil robot diprogram untuk mempertahankan jarak terhadap dinding kiri maka setelah mendeteksi dinding kiri, mobil robot tidak boleh melepas dinding ini, apabila mobil robot "tersesat" dari dinding kiri, buat prosedur cadangan.

Kondisi awal mobil robot hanya ada 2 :
- Tidak terdapat dinding di sisi kiri mobil robot.
- Terdapat dinding di sisi kiri mobil robot.

Lebih baik menganggap kondisi awal tidak ada dinding kiri daripada ada dinding kiri oleh sebab itu kondisi awal tidak ada dinding kiri. Jika tidak ada dinding kiri maka agar mobil robot cepat menemukan dinding kiri, mobil robot harus bergerak lurus dengan PWM 255 sampai tersentuh dinding kiri (atau dinding depan atau kanan --> ada PING depan dan kanan).

Bagaimana jika mobil robot lepas dari dinding kiri dan "tersesat" ?
Listing pada Gambar 2 menyebabkan mobil robot akan berputar-putar (belok kiri) jika dinding kiri memiliki jarak > 30 cm karena nilai PWM motor kiri pelan sekali (bahkan stop) sedangkan nilai PWM motor kanan 255 (maksimum). Gunakan variabel tambahan yaitu unsigned char cnt_kiri (count kiri) yang akan terus bertambah jika dinding kiri jarak > 30 cm. Karena unsigned char maka nilai maksimum cnt_kiri adalah 255. Nilai maksimum cnt_kiri anda tentukan sendiri dan sesuaikan dengan kecepatan motor DC anda, jika terlalu besar nilainya dapat membuat mobil robot akan berputar-putar cukup lama. Saya sarankan anda mengatur nilai maksimum cnt_kiri yang akan menyebabkan mobil robot berputar sebanyak 1 - 1,5 putaran.

Mengapa 1 - 1,5 putaran ?
Mobil robot saat melewati tikungan 180 derajat itu berarti mobil robot telah berputar sebanyak 1/2 putaran dan arena yang dibuat berupa bidang sehingga mobil tidak mungkin berbelok lebih dari 180 derajat, akan tetapi karena menganggap ada faktor X lainnya seperti ada batu atau tanjakan atau yang lain maka dibatasi 1 - 1,5 putaran, lebih dari itu menurut saya terlalu lama.

Nah sudah jadi nih Mobil Robot yang bisa jalan-jalan, klo udah berhasil dan anda mendapatkan pergerakan yang halus, sana pamerin aja trus kacak pinggang dan bilang "Ini Fuzzy ini, pake Sugeno ma Mammdani. Apik to.."

Mobil Robot & IC L298

.
Baca dulu H-Bridge IC.

Rangkaian Schematic

Mobil robot yang akan dibuat menggunakan driver motor DC H-Bridge menggunakan IC L298. Rangkaian schematik yang saya gunakan seperti di bawah ini

Perhatikan pemilihan Port dan konfigurasi yang digunakan, mengapa PortD dan mengapa susunan setiap pin pada PortD untuk driver Motor DC seperti itu. Hal tersebut saya bahas pada topik Mobil Robot & AVR. Jika driver motor DC telah dibuat, sekarang pengujian pergerakan pada mobil robot.

Pengujian Pin-pin PORTD
Apabila menggunakan IC L298, sebenarnya anda tidak perlu mengetahui atau menghapal seluruh konfigurasi pin, yang penting adalah Pin EN12 (Enable 12) dan Pin EN34 (Enable 34). Karena menggunakan PWM dengan rentang nilai 0 - 255 maka untuk mikrokontroler AVR ATmega8535 pasti menggunakan PORTD dan menggunakan pin OCR1B (PORTD.4) dan OCR1A (PORTD.5).

Gambar 2 adalah listing program pengujian pergerakan motor DC pada mobil robot. Pengujian ini bertujuan untuk mengetahui apakah driver motor DC berfungsi sehingga tidak menggunakan PWM. Pengujian yaitu dengan menggerakkan salah satu motor DC agar bergerak maju atau mundur selama selang waktu 3 detik, oleh sebab itu mobil robot dibuat tidak menyentuh lantai dan tetap terkoneksi dengan komputer sambil diprogram. Agar motor DC bergerak maka Pin enable harus berlogika 1, yaitu PD.4 dan PD.5 berlogika 1 dan tidak boleh diubah logikanya.

Langkah-langkah pada program Gambar 2 sebagai berikut :
1. Motor DC di buat berhenti selama 2 detik tujuannya agar mengetahui awal program dimana sehingga jika Motor DC bergerak, dapat diketahui baris mana pada listing yang sedang dieksekusi.
2. PD.0 PD.4 dan PD.5 berlogika 1 yang lain berlogika 0.
3. PD.1 PD.4 dan PD.5 berlogika 1 yang lain berlogika 0.
4. PD.6 PD.4 dan PD.5 berlogika 1 yang lain berlogika 0.
5. PD.7 PD.4 dan PD.5 berlogika 1 yang lain berlogika 0.
6. PD.2 dan PD.3 tidak diuji karena port ini tidak digunakan pada driver motor DC.

Pada langkah 2 - 6 Lihat motor mana yang bergerak dan apakah maju atau mundur.
Beri catatan disamping baris listing program yang sedang dieksekusi.

Pengujian Pergerakan Mobil Robot

Gambar 3 adalah Listing program untuk menguji dan melihat pergerakan serta kecepatan mobil robot saat kecepatan penuh. Tujuannya adalah untuk mengetahui logika-logika yang akan diberikan pada setiap pin PD.0 PD.1 PD.6 dan PD.7 yang akan mengatur gerak robot seperti Maju, Mundur, Belok Kanan, Belok Kiri, Rotasi Kanan, dan Rotasi Kiri. Selain itu juga mengetahui kecepatan Maksimum mobil robot. Pengaturan port sama seperti pada Gambar 2.

Langkah-langkah pada program Gambar 3 sebagai berikut :
1. Menggunakan informasi dari pengujian Gambar 2.
2. Mobil Robot dibuat berhenti selama 2 detik, tujuannya sama.
3. Mobil Robot dibuat bergerak Maju 3 detik. Yaitu motor kanan dan motor kiri maju.
4. Mobil Robot dibuat bergerak Mundur 3 detik. Yaitu Motor Kanan dan motor kiri mundur.
5. Mobil Robot dibuat bergerak Belok Kanan 3 detik. Yaitu motor kanan stop dan motor kiri maju.
6. Mobil Robot dibuat bergerak Belok Kiri 3 detik. Yaitu motor kanan maju dan motor kiri stop.
7. Mobil Robot dibuat bergerak Rotasi Kanan 3 detik. Yaitu motor kanan mundur dan motor kiri maju.
8. Mobil Robot dibuat bergerak Rotasi Kiri 3 detik. Yaitu motor kanan maju dan motor kiri mundur.

Pengujian dengan PWM
Setelah pengujian 3 berhasil, selanjutnya menggunakan PWM.
Dari hasil pengujian 3, buat subrutin atau prosedur baru dengan nama ROBOT(unsigned char gerak) yang isinya hanya mengatur pergerakan mobil robot, jangan lupa bahasa C adalah case sensitive yaitu huruf besar dan huruf kecil dibedakan, manfaatkan hal ini untuk membedakan antara variabel dengan judul prosedur atau hal lainnya. Selain itu penggunaan type variabel juga harus diperhatikan yaitu kapan menggunakan unsigned char, signed char, unsigned int, signed int, dll, karena hal ini berpengaruh pada penggunaan memori AVR yang terbatas, berbeda pada komputer yang menggunakan hardisk dan ram.

Mengapa unsigned char ?
signed char memiliki nilai -128 hingga 127
Unsigned char memiliki nilai 0 hingga 255
signed int memiliki nilai -32768 hingga 32767
Unsigned int memiliki nilai 0 hingga 65535
lebih jelas lihat help -> C Compiler Reference -> Data Type

Data yang dibutuhkan hanya :
- Stop dengan nilai 0
- Maju dengan nilai 1
- Mundur dengan nilai 2
- Bkanan dengan nilai 3
- Bkiri dengan nilai 4
- Rkanan dengan nilai 5
- Rkiri dengan nilai 6
Berarti data yang diperlukan hanya 7 data, jika unsigned char bahkan tersisa 256 - 7 = 249 data yang berarti lebih dari cukup. Pada mikrokontroler nilai 0 - 255 berarti menggunakan 1 buah register saja (1 byte memori).

.... Lanjut ....
Buat project baru dan lakukan konfigurasi seperti gambar 4 pada Code WizardAVR yaitu menggunakan timer 1, dan atur konfigurasi Port D seperti pada Gambar 2. Berdasarkan schematik Gambar 1 serta pengujian 2 dan pengujian 3 maka PD.4 atau OC1B adalah pin PWM yang akan mengatur kecepatan motor kanan sedangkan PD.5 atau OC1A adalah pin yang mengatur kecepatan motor kiri.

Lihat kembali Gambar 4.
Saat ROBOT(Stop) tidak diberikan nilai PWM karena berapapun nilai PWM yang diberikan tetap saja kedua motor DC akan berhenti. Mobil robot akan berhenti selama 2 detik kemudian maju 3 detik dengan PWM 255 (kecepatan penuh) lalu maju pelan 3 detik dengan nilai PWM 150. Tanpa berhenti mobil Robot akan mundur pelan 3 detik dangan nilai PWM 150 yang kemudian menjadi mudur cepat dengan nilai PWM 255 selama 3 detik. Untuk ROBOT(Bkanan) atau robot belok kanan berapapun nilai PWM yang diberikan pada motor kanan tidak berpengaruh karena motor kanan berhenti dan motor kiri yang bergerak begitu pula sebaliknya pada ROBOT(Bkiri) atau robot belok kiri . Untuk ROBOT(Rkanan) dan ROBOT(Rkiri) nilai PWM saya buat berbeda antara kanan dan kiri agar terlihat pergeseran karena perbedaan nilai PWM.

Jika anda ingin menguji 2 buah motor DC yang bertipe sama yaitu apakah motor DC memiliki RPM yang sama dan simetris, begini caranya :
(dengan catatan poros atau as pada kedua roda mobil robot sejajar dan segaris).
- Ukur jarak maksimum antar roda kanan dan roda kiri pada mobil robot.
- Gunakan alas atau lantai yang tidak kasar (lantai keramik) atau kertas karton putih.
- Gambar lingkaran dengan diameter jarak maksimum antar roda.
- Program mobil robot untuk berotasi ke kanan (atau kekiri) dengan kedua PWM bernilai 255.
- Tempatkan mobil robot hingga kedua roda tepat berada didalam lingkaran dan jalankan.
Jika semakin lama mobil robot keluar dari lingkaran maka kedua motor DC tidak simetris.
Apabila anda kesulitan mendapatkan motor DC yang simetris maka usahakan agar perbedaannya tidak besar karena bisa disesuaikan pada algoritma pemrogramannya.

Pada pengujian 4 mungkin anda mengalami hal seperti ini :
Mobil robot berjalan-jalan Maju...Maju...Mundur...Mundur...Stop.... atau Maju...Maju...Stop... atau Maju...Stop... atau Maju...Maju...Mundur...Stop... atau banyak variasi lain.

Mengapa begitu ??
Mungkin anda akan berpikir jika logika pemrogramannya yang salah, kemudian diutak-atik masih sama dan terus-menerus. Coba anda lihat listingnya lagi, perintah stop kemudian maju adalah perintah awal yang diberikan pada mobil robot. Hal ini berarti program tidak sampai selesai dieksekusi, jalan sedikit kemudian kembali ke awal yang berarti mikrokontroler selalu Reset.
Penyebabnya adalah Mikrokontroler kekurangan tegangan atau arus karena digunakan motor DC, apalagi jika motor DC berubah kondisi dari berputar ke kanan kemudian berputar ke kiri dengan nilai PWM 255 (kecepatan maksimum). Oleh sebab itu Power Supply yang diberikan untuk mikrokontroler harus berbeda dengan yang diberikan untuk motor DC.
Misal mikrokontroler baterai kotak 9 Vdc dan motor DC aki kering 24 Vdc atau mikrokontroler baterai kotak 9 Vdc 1 buah dan motor DC baterai kotak 9 Vdc 3 buah jadi ada 4 baterai kotak.

Mobil Robot & Sensor PING

.
Pada mobil robot ini sensor yang akan digunakan adalah sensor Ultrasonik.
Saya sudah biasa menggunakan sensor PING karena ukurannya yang ideal dan memiliki akurasi yang cukup baik. Saya tidak akan berkomentar banyak tentang Sensor Ultrasonik, saya hanya akan membahas hal-hal perlu yang berkaitan dengan pembuatan mobil robot saja.

Silahkan lihat Data Sheet PING atau Gambar 1.

Dari Gambar 1 seharusnya sudah dapat memprogram untuk mengakses PING. Yang perlu diperhatikan adalah sinyal dan waktu yang dibutuhkan pada SIG pin (pin Sinyal).
Langkah-langkah operasi Sensor PING :
- Kondisi awal SIG pin adalah logika 0 minimal 100 us (tidak tercantum).
- Mengaktifkan PING agar mulai pengukuran dengan memberikan logika 1 selama 2 uS - 5 uS saya gunakan 5 uS (optional).
- Tunggu hingga 750 uS (Tholdoff) yaitu saat PING mulai memancarkan sinyal ultrasonik.
- Persiapkan SIG pin sebagai input yang akan membaca jarak dengan cara membuat SIG pin berlogika 1, Apabila SIG pin berubah kondisi dari logika 1 menjadi logika 0 maka itulah jarak terukur.
- Jika tidak terdapat dinding atau tidak ada jarak terukur maka waktu tin-max bernilai 18,5 ms berarti jarak terukur adalah 300 cm.

Ada 2 cara memprogram Sensor PING, yaitu menggunakan Interupsi Timer dan Scanning.
Mana yang terbaik ? Tergantung dari penggunaannya.
Jika anda menggunakan Sensor PING untuk mengukur jarak dengan tingkat presisi hingga milimeter maka gunakan interupsi timer. Apabila anda menggunakan banyak sensor PING dengan tingkat presisi hingga centimeter maka gunakan Scanning.
Saya menggunakan scanning dan menggunakan interupsi timer tidak saya jelaskan.

Sebelum memprogram dengan sistem Scanning maka harus diketahui terlebih dahulu nilai tundaan yang digunakan untuk menscan setiap sensor PING. Kecepatan sinyal suara di udara adalah
344 M/S = 34400 cm/S = 34400 cm/1000000 uS = 1 cm/29,069767441 uS.
Karena Sensor PING menggunakan pantulan maka untuk mengukur jarak 1 cm sama
dengan 2t sehingga
1 cm = 2 x 29,069767441 uS = 58, 139534 uS ~ 58 uS.
Berarti setiap tertunda 58 uS bertambah jarak sebesar 1 cm.

Mobil robot yang baik adalah mobil robot yang selalu memberikan informasi pada programer tentang apa yang terjadi didalam mikrokontroler dalam hal ini memberikan informasi berupa jarak yang diukur oleh sensor PING, oleh sebab itu dibutuhkan Display tambahan berupa LCD 16x2. Programer sering kesulitan mengetahui kesalahan yang terjadi pada programnya jika tidak terdapat umpan balik yang informatif.

Pada mobil robot yang saya buat tidak menggunakan LCD 16x2 sebagai umpan balik (lagi kere), mungkin anda juga tidak ingin menggunakan LCD tambahan. Bagaimana caranya meminimalkan kesalahan pada pengukuran jarak sensor PING ? Akan saya bahas selanjutnya pada gambar 2.

Listing pada Gambar 2 adalah mengukur jarak dengan sensor PING dan menampilkannya pada komputer melalui serial port (COM), lebih informatif dan jelas apalagi jika anda menggunakan sensor PING yang banyak, sebab tampilan LCD memiliki ruang yang terbatas dan programer tambah pusing lihat data yang berubah dengan cepat di ruang yang sempit. Mencatat saja tidak sempat. Jika anda menggunakan modul Mikrokontroler AVR yang dibeli jadi, perhatikan port Rx dan port TX atau PD.0 dan PD.1 apakah telah sesuai ?

Buat project baru, pada CodeWizzardAVR atur konfigurasi serial seperti Gambar 2 selain itu atur seluruh Port B menjadi Output, mengapa saya memilih PortB, Hal tersebut saya bahas pada topik Mobil Robot & AVR. Sensor PING depan di PB.0, sensor PING kanan PB.1, dan sensor PING kiri PB.2.

Misal jarak terukur depan 20, kanan 15, dan kiri 30, maka tampilan pada komputer adalah :
Cek PING
Depan
20
Kanan
15
Kiri
30

Jika berhasil ditampilkan berarti mengakses sensor PING sukses.
Jarak terukur maksimum dibatasi hanya sampai 99 cm, hal ini karena mobil robot akan meraba salah satu dinding dengan jarak referensi 20 cm dan maksimum 30 cm sehingga lebih dari 30 cm dianggap jauh tak terhingga. Apabila ingin dibatasi hingga 50 cm saja lebih baik lagi karena mengurangi waktu scanning sensor PING yang dibutuhkan.

Coba anda membaca jarak dinding diatas 45 cm akan terjadi kesalahan pembacaan jarak, misal jarak sesungguhnya 55 cm maka jarak terukur kurang dari 55 cm, hal ini adalah kelemahan sistem scanning. Telah didefinisikan bahwa 58 uS = 1 cm padahal jika anda menggunakan mikrokontroler AT89S51 dengan kristal 12 MHz maka 1 siklus mesin (1 cycle) = 1 uS berarti 58 siklus = 58 uS = 1 cm. Jika menggunakan bahasa Assembler, banyaknya siklus bisa dihitung (agak ribet tapi) sehingga bisa meminimal kesalahan, akan tetapi bahasa C jika di ubah ke bahasa mesin akan menjadi tambah panjang bahkan lebih panjang dibanding jika anda menulis sendiri dalam bahasa assembler apalagi dalam proses looping, hal ini menyebabkan waktu pengukuran tidak tepat 58 uS.
Selain itu pada Gambar 2 digunakan 3 sensor PING, jika lebih banyak lagi bisa mengurangi tingkat akurasinya. Akan tetapi untuk jarak tertentu pada sistem scanning masih bisa mendekati akurasi yang baik. Saya mencoba, menampilkannya, dan mendapatkan nilai 4 cm - 44 cm.

Hal penting lainnya pada pengujian sensor PING adalah mengatur sudut kemiringan sensor PING terhadap dinding yang akan diukur. Oleh sebab itu pada pengujian ini saya menyarankan anda membuat sensor PING dapat diubah-ubah sudutnya secara fleksibel dengan membuat pondasi sensor PING dapat diputar-putar.

Cara pengujian sensor PING dari Gambar 2 untuk sensor PING samping (sensor PING depan tidak perlu diubah sudutnya) yaitu :
- Pasang sensor PING pada mobil robot dan longgarkan bautnya agar bisa diputar.
- Posisikan mobil robot sejajar dengan dinding samping dengan jarak 20 cm.
- Sensor PING samping dibuat tegak lurus terhadap dinding.
- Setelah di program dan dijalankan, putar secara perlahan sensor PING setiap 1 detik sambil memperhatikan tampilan data pada komputer.
- Jika tampilan pada komputer 20 cm maka terus putar sensor PING hingga nilai tersebut berubah menjadi >= 20 cm.
- Apabila jarak terukur >= 20 cm maka itu adalah sudut maksimum sensor PING yang diperbolehkan untuk menghindari kesalahan pembacaan jarak.

Sudut sensor PING terhadap dinding harus diperhatikan, apalagi jika anda hanya menggunakan sedikit sensor PING.
Oh ya, cukup dengan hanya 1 sensor PING saja, mobil robot dapat berjalan secara halus dan bagus dengan meraba dinding selama tidak ada dinding didepan mobil robot.
Mobil robot yang saya paparkan disini minimal sensor PING adalah 2, tetapi jika anda kesulitan mendapatkan sensor PING cukup 1 saja.

Ada hal lain yang penting mengenai sensor PING.
Sensor PING membutuhkan supply 5 Vdc dengan arus 30 mA - 35 mA, tetapi saat sinyal suara ultrasonik dipancarkan dibutuhkan arus yang lebih besar (kurang tahu). Jika arus ini tidak terpenuhi akan mempengaruhi pembacaan jarak pada sensor PING. Untuk mengetahui apakah PING kekurangan supply yaitu dengan melihat LED indikatornya, jika cahayanya redup atau kurang terang dibanding sebelumnya maka sensor PING kekurangan supply. Oleh sebab itu karena alasan ini dan alasan lain, scanning setiap sensor PING jangan terlalu cepat, misalkan anda membaca jarak mobil robot terhadap dinding setiap 50 mS atau 100 mS.

Topik yang Populer