Hi,
probiers mal so
Code:
#include "asuro.h"
int main(void)
{
unsigned char empfangen[0]="000";
Init();
/* Menü Anzeige */
{
SerPrint("\n\r");
SerPrint("Fernsteruerung:\n\r");
SerPrint("[w] => Geradeaus fahren\n\r");
SerPrint("[s] => Rueckwaerts fahren\n\r");
SerPrint("[a] => Linkskurfe\n\r");
SerPrint("[d] => Rechtskurfe\n\r");
SerPrint("[q] => Stopp\n\r");
}
while(1)
{
SerRead(empfangen, 1, 2); //1 Zeichen über UART einlesen, TimeOut 2ms
if (empfangen [0] == 'w') //Geradeaus fahren
{
MotorSpeed(205,200);
MotorDir(FWD,FWD);
}
else if (empfangen [0] == 's') //Rückwärts fahren
{
MotorSpeed(130,120);
MotorDir(RWD,RWD);
}
else if (empfangen [0] == 'a') //Linkskurfe
{
MotorSpeed(100,185);
MotorDir(FWD,FWD);
}
else if (empfangen [0] == 'd') //Rechtskurfe
{
MotorSpeed(190,100);
MotorDir(FWD,FWD);
}
else if (empfangen [0] == 'q') //Stopp
{
MotorDir(BREAK,BREAK);
}
else
{
MotorDir(BREAK,BREAK);
}
}
return 0;
}
Lesezeichen