#include "qfixSoccerBoard.h"
#define SPEED1 150
SoccerBoard robot; // Klasse SoccerBoard initialisieren
int main()
{
// Die LEDs sollen 10mal blinken
for(int i=0; i<10; i++)
{
robot.ledOff(0); // LED 0 und 1 einschalten
robot.ledOff(1);
sleep(1);
robot.ledOn(0); // LED 0 und 1 einschalten
robot.ledOn(1);
sleep(1);
}
robot.ledOff(0); // LED 0 und 1 einschalten
robot.ledOff(1);
// Endlosschleife
while(1)
{
// Die Motoren drehen jeweils 2 s und stehen dann 2 s still
robot.motor(0, SPEED1);
robot.motor(1, SPEED1);
robot.motor(2, SPEED1);
robot.msleep(2000);
robot.motorsOff();
robot.msleep(2000);
}
}