Kleiner Kettenroboter

[avus17]

Hallo, ich habe gerade die bumper montiert, würde dieses Programm funktionieren, damit der Roboter Hindernissen ausweicht????

$regfile = "m8def.dat"
$crystal = 1000000

Config Pinb.1 = Output
Config Pinb.2 = Output
Config Pinb.3 = Output
Config Pinc.5 = Output
Config Pinc.4 = Output
Config Pinc.3 = Output
Config Pind.7 = Input
Config Pinb.0 = Input

Enable1 Alias Portb.1

Ina1 Alias Portb.2

Inb1 Alias Portb.3

Enable2 Alias Portc.5

Ina2 Alias Portc.4

Inb2 Alias Portc.3

Taster1 Alias Pind.7

Taster2 Alias Pinb.0


Do

 Enable1 = 1
 Enable2 = 1
 Ina1 = 1
 Ina2 = 1

 If Taster1 = 1 Then

 Enable1 = 0
 Enable2 = 0
 Ina1 = 0
 Ina2 = 0
 Waitms 200

 Enable1 = 1
 Enable2 = 1

 Inb1 = 1
 Inb2 = 1
 Waitms 300

 Inb2 = 0
 Waitms 500

 Inb1 = 0
 Enable1 = 0
 Enable2 = 0
 Waitms 200

 Enable1 = 1
 Enable2 = 1

 End If

 If Taster2 = 1 Then

 Enable1 = 0
 Enable2 = 0
 Ina1 = 0
 Ina2 = 0
 Waitms 200

 Enable1 = 1
 Enable2 = 1

 Inb1 = 1
 Inb2 = 1
 Waitms 300

 Inb2 = 0
 Waitms 500

 Inb1 = 0

 Enable1 = 0
 Enable2 = 0
 Waitms 200

 Enable1 = 1
 Enable2 = 1

 End If








Loop