Fröhliche Weihnachten Leute!
Ich habe heute mal das Programm aus der Asuroanleitung zur Linienverfolgung ausprobiert. Bei mir funste es zum Glück auf Anhieb.
Ich habe Asuro gleichmal eine Strecke um einen Tannenbaum aufgezeichnet und sie ihn abfahren lassen.
Hier ein Bild dazu:
Bild hier
Hier das Video dazu:
http://www.youtube.com/watch?v=U2bEKGTRwiY
Hier der Quellcode, den ich aus der Anleitung abgeschrieben habe(hab noch eine Anzeige der Richtungsänderung mit den BackLEDs hinzugefügt:
Code:
#include "asuro.h" //Linienverfolgung auf einfachste Art
int main(void) {
unsigned int data[2]; //Speicher bereit stellen
Init();
FrontLED(ON); //Linienbeleuchtung einschalten
MotorDir(FWD,FWD); //Beide Motoren auf vorwärts
while(1){ //Endlosschleife, ASURO soll beliebig lang einer Linie nachfahren
LineData(data); //aktuelle Helligkeitswerte der Fototransistoren einlesen
if (data [0] > data[1]) //links heller als rechts
{MotorSpeed(200,150); //...dann links mehr Gas geben
BackLED(ON,OFF);} //Fahrtrichtung links anzeigen
else
{MotorSpeed(150,200); //...sonst rechts mehr Gas geben
BackLED(OFF,ON);} //Fahrtrichtung rechts anzeigen
}
return 0;
}
Habe noch eine Frage:
Woran liegt es, dass mein Asuro, wenn er mal keine Linie unter sich hat, immer nur nach rechts fährt?
Er müsste dann doch eigentlich gerade ausfahren...
Lesezeichen