Auch auf die Gefahr hin, in diesem Threat Selbstgespräche zu führen habe ich das o. a. Programm etwas überarbeitet:
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.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); } }
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.







Zitieren

Lesezeichen