Grage Aeromodelling

Code: Select all

$regfile = "attiny13.dat"               ' Micon yg dipakai adalah ATtiny13
$crystal = 9600000                      ' = 9.6MHz
$hwstack = 32
$swstack = 8
$framesize = 16

Config Portb.0 = Output                 ' PB0 (Pin5) sebagai output
Config Pinb.1 = Input                   ' PB1 (Pin 6) sebagai input
Config Pinb.2 = Input                   ' PB2 (Pin 7) sebagai input
Config Pinb.3 = Input                   ' PB3 (Pin 2) sebagai input

Sw1 Alias Pinb.1                        ' PB1 (Pin 6)
Sw2 Alias Pinb.2                        ' PB2 (Pin 7)
Sw3 Alias Pinb.3                        ' PB3 (Pin 2)

' mengaktifkan internal pull-up resistor
Set Portb.1
Set Portb.2
Set Portb.3

' Untuk clock 4MHz satuan dalam 1uS (microdetik),
' jadi untuk 9.6MHz harus dikalian 2.4
Const Servomax = 4800                   ' = 2000uS * 2.4
Const Servomin = 2400                   ' = 1000uS * 2.4
Const Servocen = 3600                   ' = 1500uS * 2.4

Dim A As Word
Dim B As Word

B = Servocen                            ' posisi awal servo di tengah

Do
  If Sw1 = 0 Then                       ' jika Sw1 ditekan
     B = Servomax                       ' servo ke posisi maksimum
  End If
  If Sw2 = 0 Then                       ' jika Sw2 ditekan
     B = Servocen                       ' servo ke posisi tengah
  End If
  If Sw3 = 0 Then                       ' jika Sw3 ditekan
     B = Servomin                       ' servo ke posisi minimum
  End If

  Pulseout Portb , 0 , B                ' Menghasilkan pulsa di PB0 (Pin 5)
  Waitms 20                             ' tunggu 20 milidetik
Loop                                    ' ulangi terus sampai bosen
End