برنامه ی ربات مسیر یاب

[reza8731]

سلام کسی هست که برنامه ی ربات مسیر یاب سه سنسوره با دو موتور را بلد باشه؟ :cry2: :cry2: :cry2: :cry2:

[turner]

پاسخ : برنامه ی ربات مسیر یاب

سلام
این برنامه به زبان بیسیک و برای روبات 8 سنسوره هست. میتونه مرجع خوبی باشه. اگه سوالی داشتی بپرس

$regfile = "m16def.dat"
$crystal = 8000000
Config Porta = Input
Config Portc = Input
Config Portd.0 = Output
Config Portd.1 = Output
Config Portd.2 = Output
Config Portd.3 = Output
Config Timer1 = Pwm , Pwm = 10 , Compare A Pwm = Clear Down , Compare B Pwm = Clear Down , Prescale = 64

Do

If Pina = &B00011000 Then
Pwm1a = 1000
Pwm1b = 1000
Portd.0 = 1
Portd.1 = 0
Portd.2 = 0
Portd.3 = 1
End If

If Pina = &B00001000 Then
Pwm1a = 940
Pwm1b = 1000
Portd.0 = 1
Portd.1 = 0
Portd.2 = 0
Portd.3 = 1
End If

If Pina = &B00000100 Then
Pwm1a = 860
Pwm1b = 1000
Portd.0 = 1
Portd.1 = 0
Portd.2 = 0
Portd.3 = 1
End If

If Pina = &B00000010 Then
Pwm1a = 750
Pwm1b = 1000
Portd.0 = 0
Portd.1 = 1
Portd.2 = 0
Portd.3 = 1
End If

If Pina = &B00000001 Then
Pwm1a = 700
Pwm1b = 1000
Portd.0 = 0
Portd.1 = 1
Portd.2 = 0
Portd.3 = 1
End If

If Pina = &B00010000 Then
Pwm1a = 1000
Pwm1b = 940
Portd.0 = 1
Portd.1 = 0
Portd.2 = 0
Portd.3 = 1
End If

If Pina = &B00100000 Then
Pwm1a = 1000
Pwm1b = 860
Portd.0 = 1
Portd.1 = 0
Portd.2 = 0
Portd.3 = 1
End If

If Pina = &B01000000 Then
Pwm1a = 1000
Pwm1b = 750
Portd.0 = 1
Portd.1 = 0
Portd.2 = 1
Portd.3 = 0
End If

If Pina = &B10000000 Then
Pwm1a = 1000
Pwm1b = 700
Portd.0 = 1
Portd.1 = 0
Portd.2 = 1
Portd.3 = 0
End If

Loop

End