-
-
Erfahrener Benutzer
Fleißiges Mitglied
int main(void)
{
Init();
signed char empfangen[1];
int i;
SerWrite("\rWarte auf Fahrbefehl ...\n\r",27);
MotorSpeed(0,0);
MotorDir(BREAK,BREAK);
while(1)
{
StatusLED(0x00);
SerRead(empfangen,1,0); // Zeichen empfangen
StatusLED(0x03); // LED bestätigt Empfang
SerWrite(empfangen,1); // Zeichen zurücksenden
MotorSpeed(0xA0,0xA0);
switch(empfangen[0]) // Interpretation Fahrbefehl
{
case 'e': Ende(); break;
case 'v': MotorDir(FWD,FWD); break;
case 'z': MotorDir(RWD,RWD); break;
case 'r': MotorDir(FWD,RWD); break;
case 'l': MotorDir(RWD,FWD); break;
default: StatusLED(0x02); break;
}
for(i=0;i<100;i++) Sleep(72); // ... dann mach das mal für 100 ms
MotorSpeed(0x00,0x00); // und tritt auf die Bremse
MotorDir(FREE,FREE);
SerWrite(". ",1);
};
}
Linienverfolgung und LED an/aus mußt du dir noch selber einbasteln, ist aber auch recht einfach.
Viele Grüße, (Michael)
Berechtigungen
- Neue Themen erstellen: Nein
- Themen beantworten: Nein
- Anhänge hochladen: Nein
- Beiträge bearbeiten: Nein
-
Foren-Regeln
Lesezeichen