brauche hilfe für projekt für US Asuro
guten tag liebe leute ich brauche dringend hilfe .
ich habe zur zeit ein asuro projekt .
mein roboter soll folgendes machen .
ultraschall so in 10 cm ein hinderniss erkennen soll rückwärts fahren und dann 90grad nach links biegen 5cm fahren und dann 90grad nach rechts biegen und dann gucken ob da ein hinderniss ist wenn nicht dann grade aus weiter fahren .
also kurz gesagt er muss um diesen hinderniss drum rum fahren . ich habe zwar diesen code hier.
[/code]
Code:
#include "asuro.h"
#include "ultrasonic.h"
int i,j,abstand=200; // Variablen deklarieren
int main(void) // Hier beginnt das Programm
{
Init();
while (1) //Endlosschleife
{
abstand = Chirp();
SerPrint("\r\n distanz in cm: ");
PrintInt(abstand);
while (abstand>10)
{
MotorDir(FWD,FWD);
MotorSpeed(180,180);
StatusLED(GREEN);
abstand = Chirp();
SerPrint("\r\n distanz in cm: ");
PrintInt(abstand);
} // Bei Kollision:
for (j=0;j<100;j++) // kurz warten
{
MotorDir(FREE,FREE);
Sleep(255);
}
for (i=0;i<200;i++)
{
MotorDir(RWD,RWD); // rückwärts drehen
MotorSpeed(120,0);
BackLED(ON,ON);
StatusLED(RED);
Sleep(255);
}
for (j=0;j<100;j++) // kurz warten
{
MotorDir(FREE,FREE);
Sleep(255);
}
}
}
aber mit dem hier fährt der nur nach rechts und weiter grade aus bis ein hinderniss kommt .
ich hoffe ihr habt erstens verstanden was ich sage und zweiten hoffe ich das ihr mir den quellcode sagen könnt . das wäre eine grosse hilfe .
danke voraus
