Auch auf die Gefahr hin, in diesem Threat Selbstgespräche zu führen habe ich das o. a. Programm etwas überarbeitet:
Code:
/*************************************************************************
Hauptprogramm
*************************************************************************/
int main(void)
{
uint8_t n,m,diff;
Init();
FrontLED(ON);
while(1)
{
n=abstand_rechts();
m=abstand_links();
if ((n > 2) || (m > 2))
{
StatusLED(GREEN);
MotorDir(FWD, FWD);
MotorSpeed(100,100);
}
else if ((n < 2) || (m < 2))
{
StatusLED(RED);
MotorDir(RWD, RWD);
MotorSpeed(100,100);
}
else
MotorSpeed(BREAK, BREAK);
}
}
Damit hält der Asuro einen bestimmten Abstand zu einem Hindernis ein, dass sich entfernt bzw. auf ihn zubewegt - allerdings ohne sich seitlich zu bewegen.
Ich möchte nun einbauen dass sich der Asuro immer mit beiden "Augen" auf das Hindernis ausrichtet und den Abstand beibehält.
Hätte ev. einer von euch einen Tipp, wie ich dies machen könnte?
Danke in voraus für eure Unterstützung.
Lesezeichen