So hier ist der fertige Code:
Code:
#include "asuro.h"
int main(void){
Init();
int zeit;
unsigned int taste1, taste2;
MotorDir(FWD,FWD);
MotorSpeed(120,124);
StatusLED(GREEN);
FrontLED(ON);
while (1){
taste1=PollSwitch();
taste2=PollSwitch();
if(taste1 == taste2){
if (taste == 1){
MotorSpeed(0,0);
StatusLED(RED);
BackLED(ON,ON);
MotorDir(RWD,RWD);
MotorSpeed(150,151);
for(zeit=0;zeit<1000;zeit++){
Sleep(72);
}
BackLED(OFF,OFF);
StatusLED(GREEN);
MotorDir(FWD,FWD);
MotorSpeed(0,180);
for (zeit=0; zeit<415; zeit++){
Sleep(72);
}
MotorSpeed(120,121);
for(zeit=0;zeit<500;zeit++){
Sleep(72);
}
BackLED(OFF,OFF);
StatusLED(GREEN);
MotorDir(FWD,FWD);
MotorSpeed(180,0);
for (zeit=0; zeit<415; zeit++){
Sleep(72);
}
MotorSpeed(120,121);
}
else if (taste==32){
MotorSpeed(0,0);
StatusLED(RED);
BackLED(ON,ON);
MotorDir(RWD,RWD);
MotorSpeed(150,152);
for(zeit=0;zeit<1000;zeit++){
Sleep(72);
}
BackLED(OFF,OFF);
StatusLED(GREEN);
MotorDir(FWD,FWD);
MotorSpeed(180,0);
for (zeit=0; zeit<415; zeit++){
Sleep(72);
}
MotorSpeed(120,122);
for(zeit=0;zeit<500;zeit++){
Sleep(72);
}
BackLED(OFF,OFF);
StatusLED(GREEN);
MotorDir(FWD,FWD);
MotorSpeed(0,180);
for (zeit=0; zeit<415; zeit++){
Sleep(72);
}
MotorSpeed(120,122);
}
else if (taste==16 || taste==2){
MotorSpeed(0,0);
StatusLED(RED);
BackLED(ON,ON);
MotorDir(RWD,RWD);
MotorSpeed(150,152);
for(zeit=0;zeit<1000;zeit++){
Sleep(72);
}
BackLED(OFF,OFF);
StatusLED(GREEN);
MotorDir(FWD,FWD);
MotorSpeed(0,180);
for (zeit=0; zeit<1000; zeit++){
Sleep(72);
}
MotorSpeed(120,122);
}
}
}
while(1);
return 0;
}
Lesezeichen