Ich hab nochwas mit dem Programm gemacht, das ist jetzt aber nur so zum Testen, ob die Motoren und taster richtig funktionieren und nein sie tun es nicht, aber hier das testprogramm:
#include "asuro.h"
#include "myasuro.h"
int main(void)
{
unsigned int ldata[2]; // Speicherplatz für Odo- und Linedaten
int i; // Integervariable zur freien Verwendung
Init();
FrontLED(ON); // Linienbeleuchtung einschalten
Sleep(255); // warten bis LED volle Helligkeit erreicht hat
LineData(ldata); // ADC anwärmen
while(1)
{
MotorSpeed(200,200); // und losfahren
while(PollSwitch() == 0) // folge der Linie bis zum ersten Hinderniss
{
LineData(ldata);
if (ldata [0] > ldata [1])
{
MotorSpeed(200,100);
}
else
{
MotorSpeed(100,200);
}
Sleep(100); // Regelung etwas dämpfen
}
StatusLED(RED);
MotorSpeed(0,0); // anhalten weil Hinderniss erkannt wurde
Msleep(2500);
StatusLED(GREEN); //fertig
}
return(0);
}
Was meinst du?
Zitat von kmikesch
Lesezeichen