Ich wollte meinen Roboter so Prgrammieren, dass er durch ein Labyrinth hindurch kommt. Mit dem Algorithmus der Tiefensuche ist das auch kein Problem. Aber irgendwie leuchtet nur die Status LED grün wenn ich den Roboter einschalte hier mein Code
Code:
include "asuro.h"
#define FULL_L 220
#define FULL_R 250
/* vorwärts */
void MotorFwd(void)
{
MotorDir(FWD,FWD);
MotorSpeed(FULL_L,FULL_R);
}
/* rückwärts */
void MotorRwd(void)
{
MotorDir(RWD,RWD);
MotorSpeed(FULL_L,FULL_R);
}
/* bremsen */
void MotorStop(void)
{
MotorSpeed(0,0);
}
int main(void)
{
unsigned char hit;
while(1);
{
hit = PollSwitch();
if(hit == 0);
{
MotorFwd();
}
if(hit == 32);
{
MotorFwd();
}
if(hit == 33);
{
MotorDir(FWD,RWD);
MotorSpeed(FULL_L,FULL_R);
}
if(hit != 32);
{
MotorDir(FWD,RWD);
MotorSpeed(FULL_L,FULL_R);
}
}
}
Hab ich irgendwo einen Fehler gemacht?Der Anfang ist aus dem Test Programm. Ich will dass der Asuro nach links fährt und so Kontakt mit der Wand hat. Und dieser so folgt.
Lesezeichen