Code:
#include <stdio.h>
#include "asuro.h"
int main(void)
{
Init();
while(1)
{
int data[2];
OdometrieData(data);
int a = data[0];
int b = data[1];
char buffer1[10];
char buffer2[10];
int n = sprintf(buffer1,"%d",a);
int o = sprintf(buffer2,"%d",b);
SerWrite("\nWert links: \n",16);
int x;
for(x=0;x<10;x++)
{
SerWrite(buffer1,n);
}
SerWrite("\nWert rechts: \n",17);
int y;
for(y=0;y<10;y++)
{
SerWrite(buffer2,o);
}
int taster = PollSwitch();
while(taster == 0)
{
FrontLED(ON);
unsigned int line[2];
LineData(line);
if (line[0] == line[1])
{
MotorDir(FWD,FWD);
MotorSpeed(200,200);
StatusLED(GREEN);
BackLED(ON,ON);
}
else if(line[0] < line[1])
{
MotorDir(FWD,FWD);
MotorSpeed(150,200);
StatusLED(GREEN);
BackLED(OFF,ON);
}
else
{
MotorDir(FWD,FWD);
MotorSpeed(200,150);
StatusLED(GREEN);
BackLED(ON,OFF);
}
int j;
for(j=0;j<20;j++)
{
Sleep(255);
}
taster = PollSwitch();
}
if(taster >= 8)
{
StatusLED(RED);
MotorDir(RWD,RWD);
MotorSpeed(200,200);
int i;
for(i=0;i<100;i++)
{
Sleep(255);
}
MotorDir(BREAK,RWD);
MotorSpeed(0,200);
int j;
for(j=0;j<170;j++)
{
Sleep(255);
}
}
else
{
StatusLED(RED);
MotorDir(RWD,RWD);
MotorSpeed(200,200);
int i;
for(i=0;i<100;i++)
{
Sleep(255);
}
MotorDir(BREAK,FWD);
MotorSpeed(0,200);
int j;
for(j=0;j<170;j++)
{
Sleep(255);
}
}
}
return 0;
}
Das ist der komplette Code, welcher auch funktioniert hat.
Ich werde deine Idee später einbauen.
Lesezeichen