Super enkel nybörjare Robot! (16 / 17 steg)
Steg 16: Source Code
Källkoden för alternativet ekolod i nästa steg (särskilda saker)
Följ anvisningarna för din mikrokontroller och klippa och klistra in denna kod i redigeraren. Sammanställa och skicka till roboten.
Koden är ultra enkel men bot undviker de flesta hinder ser. Det är lätt att ta min kod och expandera på den.
"SuperSimpleBeginnersRobot
"www.instructables.com
"Ted Macy
"ted
"2/16/09
'-----------------------------------------------------------------
' Skapa och konfigurera objekt
'-----------------------------------------------------------------
Dim Servo_Right som ny oServo
Dim Servo_Left som ny oServo
Dim SRF04Servo som ny oServo
Dim GP2D12 som oIRRange(3,8,cvOn)
Dim SRF04 som oSonarDV(8,9,cvOn)
SRF04Servo.IOLine=29 ' sätta servo att använda i/o-Line 30.
SRF04Servo.Center=28 ' sätta servon centrum till 28. (se manualen)
SRF04Servo.operate=cvTrue ' sista sak att göra, aktivera Servo.
Servo_Right.IOLine = 30 ' sätta servo att använda i/o-Line 30.
Servo_Right.Center = 28 ' sätta servon centrum till 28. (se manualen)
Servo_Right.operate = cvTrue ' sista sak att göra, aktivera Servo.
Servo_Left.IOLine = 31 ' sätta servo att använda i/o-Line 31.
Servo_Left.Center = 28 ' sätta servon centrum till 28. (se manualen)
Servo_Left.operate = cvTrue ' sista sak att göra, aktivera Servo.
'-----------------------------------------------------------------
' Skapa och konfigurera objekt
"Main rutin är din primära rutin uppmanade makt!
'-----------------------------------------------------------------
Main (sub)
Göra
Anropa IR
Kalla Forward_All
Kalla SServo
Loop
End Sub
'-----------------------------------------------------------------
"Slutet av Main rutin
"Början av Drive System subrutiner
'-----------------------------------------------------------------
Sub Spin_Left()
Servo_Left.Invert=0
Servo_Left = 62
Servo_Right = 60
End Sub
Sub Spin_Right()
Servo_Right.Invert=1
Servo_Left = 62
Servo_Right = 60
End Sub
Sub Forward_All()
Servo_Right.Invert=0
Servo_Left.Invert=1
Servo_Right = 60
Servo_Left = 62
End Sub
Sub REVERSE()
Servo_Right.Invert=1
Servo_Left.Invert=0
Servo_Right = 60
Servo_Left = 62
End Sub
Sub STOP()
Servo_Left = 0
Servo_Right = 0
Kalla SServo
End Sub
'-----------------------------------------------------------------
"Slutet av Drive System subrutiner
"Början av Sensor subrutiner
'-----------------------------------------------------------------
Sub SServo()
SRF04Servo.position=15
SRF04. Operate.Pulse(1,1,250)
Om SRF04. Värdet < 128 sedan
Kalla Spin_Right
Annat samtal Forward_All
Slut om
ooPIC.Delay=600
SRF04Servo.position=31
SRF04. Operate.Pulse(1,1,250)
Om SRF04. Värdet < 64 sedan
Kalla omvänd
Annat samtal Forward_All
Slut om
ooPIC.Delay=600
SRF04Servo.position=46
SRF04. Operate.Pulse(1,1,250)
Om SRF04. Värdet < 128 sedan
Kalla Spin_Left
Annat samtal Forward_All
Slut om
ooPIC.Delay=600
SRF04Servo.position=31
SRF04. Operate.Pulse(1,1,250)
Om SRF04. Värdet < 64 sedan
Kalla omvänd
Annat samtal Forward_All
Slut om
ooPIC.Delay=600
End Sub
Sub IR()
Om GP2D12. Värdet < 64 sedan
Ring STOP
Slut om
End Sub
'-----------------------------------------------------------------
"Slutet av Sensor subrutiner
'-----------------------------------------------------------------