Aplikasi ini merupakan contoh penerapan mikrokontroler AVR ATmega16 pada robot avoider (robot yang dapat menghindar jika ada penghalang menggunaan sensor jarak Sharp GP2D12.
Sebagai sensor jarak digunakan sensor jarak infrared Sharp GP2D12 dengan output analog yang terhubungn di PA.0 dari mikrokontroler yang dapat berfungsi sebagai ADC. Kit mikrokontroler yang digunakan menggunakan SmartAVR for robotics dari
Berikut contoh kodenya :
‘Program robot avoider
‘deklarasi variabel
Dim W As Byte , Channel As Byte
Dim Rawdist As Word
Const Scale = $200
Const Trigger = 5
Declare Sub Bacaping()
Config Portc = Output
Enable Interrupts
Config Portb = Output ‘portb sebagai output
Call Bacaping() ‘panggil fungsi sensor
Channel = 0 ‘posisi sensor Sharp di channel 0
W = Getadc(channel)
Start Adc
‘jika jarak dibawah 200
If W <>
Portb = 12 ‘gerakkan roda maju
End If
If W >= 200 Then
Portb = 2 ‘ belok kanan
Waitms 100
End If
Sub Bacaping()
‘kode sensor ping atau Devantech SRF04 di sini
Return
End Sub
0 komentar:
Posting Komentar