Hier mal meine Version von heute (habe den Asuro seit Samstag
):
Ist zwar nicht sehr schnell unterwegs, aber dafür recht ruckelfrei.
Geschwindigkeit kann man ja je nach Kurs noch nach oben anpassen.
Grüsse,
Gerry
Code:
#include "asuro.h"
int main(void) {
unsigned int data[2];
unsigned char links,rechts;
int diffl,diffr;
Init();
FrontLED(ON);
MotorDir(FWD,FWD);
while(1) {
LineData(data);
diffl=data[0]-data[1];
diffr=data[1]-data[0];
links=120-(diffr*3);
rechts=120-(diffl*3);
if (links>120) {links=120;}
if (rechts>120) {rechts=120;}
MotorSpeed(links,rechts);
}
return 0;
}
Lesezeichen