Hier :
Code:
$regfile = "m32def.dat"
$crystal = 16000000
$baud = 9600
$hwstack = 32
$swstack = 32
$framesize = 32
Config Portd.7 = Output
Config Portd.7 = Output
Config Pinc.6 = Output 'Linker Motor Kanal 1
Config Pinc.7 = Output 'Linker Motor Kanal 2
Config Pind.4 = Output 'Linker Motor PWM
Config Pinb.0 = Output 'Rechter Motor Kanal 1
Config Pinb.1 = Output
Config Pind.5 = Output
'Rechter Motor PWM
Config Timer1 = Pwm , Pwm = 10 , Compare A Pwm = Clear Up , Compare B Pwm = Clear Up
Pwm1a = 0
Pwm1b = 0
Tccr1b = Tccr1b Or &H02 'Prescaler = 8
Dim Rckanal As Word
Dim Lala As Word
Sound Portd.7 , 400 , 450
Sound Portd.7 , 400 , 250
Sound Portd.7 , 400 , 450
Wait 2
Main:
Waitms 10
Pulsein Rckanal , Pind , 2 , 1 'Messung Zeit zwischen 1 und 0 Pegel
Waitms 10
Pulsein Lala , Pind , 3 , 1 'Messung Zeit zwischen 1 und 0 Pegel
Waitms 10
Select Case Rckanal
Case 90 To 140
Portc.6 = 1
Portc.7 = 0
Portd.4 = 1
Pwm1a = 600
Waitms 10
Case 160 To 200
Portc.6 = 1
Portc.7 = 0
Portd.4 = 1
Pwm1a = 600
Waitms 10
Case Else
Portc.6 = 1
Portc.7 = 0
Portd.4 = 1
Pwm1a = 0
Waitms 10
End Select
Select Case Lala
Case 90 To 140
Portb.0 = 1
Portb.1 = 0
Portd.5 = 1
Pwm1b = 600
Waitms 10
Case 160 To 200
Portb.0 = 1
Portb.1 = 0
Portd.5 = 1
Pwm1b = 600
Waitms 10
Case Else
Portb.0 = 0
Portb.1 = 1
Portd.5 = 1
Pwm1b = 0
Waitms 10
End Select
Goto Main
Lesezeichen