#include "asuro.h"
int main(void)
{
Init();
while(1)
{
if(PollSwitch()>=1)
{
StatusLED(RED);
MotorDir(RWD,RWD);
if(PollSwitch()>=7)
{
MotorSpeed(100,200);
BackLED(ON,OFF);
Msleep(1000);
}
else
{
MotorSpeed(200,100);
BackLED(OFF,ON);
Msleep(1000);
}
}
else
{
Msleep(100);
StatusLED(GREEN);
MotorDir(FWD,FWD);
MotorSpeed(200,180);
BackLED(ON,ON);
}
}
}
Lesezeichen