Labyrinth_programm

[Philipp2195]

Hallo danke für eure Antworten!

Ich habe mittlerweile ein eigenes Programm geschrieben, dass prinzipiell funktioniert.

Mein Programm sieht folgendermaßen aus:


#include "asuro.h"

int main(void) {
Init();
int i;
int grad=0;
while(1) {

if(PollSwitch()==0) {
MotorDir(FWD,FWD);
MotorSpeed(130,117);

}

else if(PollSwitch()!=0) {

if (grad==0){

MotorDir(BREAK,BREAK);
MotorDir(RWD,RWD);
MotorSpeed(100,100);
for ( i=0 ; i<=220 ; i++)
{ Sleep (5000); }
MotorDir(RWD,FWD);
MotorSpeed(110,110);

for ( i=0 ; i<=150 ; i++ )
{ Sleep ( 5000 ); }
grad = 1;
}


else if (grad==1) {
MotorDir(BREAK,BREAK);
MotorDir(RWD,RWD);
MotorSpeed(100,100);
for ( i=0 ; i<=220 ; i++)
{ Sleep (5000); }
MotorDir(FWD,RWD);
MotorSpeed(110,110);

for ( i=0 ; i<=340 ; i++ )
{ Sleep ( 5000 ); }
grad = 0;
}

}




}
return 0;
}


Ich bin aber noch nicht ganz zufrieden mit dem Programm. Mir wäre es am liebsten, dass sich ASURO sozusagen nicht abwechselnd(wie bei diesem Programm) dreht, sondern dass er an Jeder ecke wieder mit dem linksdrehen anfängt. denn bei dem jetztigem programm kommt es öfters vor, dass der ASURO wieder durch den Beginn des Labyrinths herausfährt. Ist mein Anliegen einigermaßen verständlich?

Kann mir von euch jemand weiter helfen. hab schon einiges probiert aber bin auf kein ergebnis gekommen.

Gruß Philipp

P.S im anhang befindet sich das programm in besserer Form