//    *****************************************
//    **             RC-SOCCERBOT            **
//    **    Uebungen / Lehrerbegleitbuch     **
//    **                                     **
//    **      Autor: Hannes Runknagel        **
//    **  Copyright: 2007 by GRAUPNER        **
//    **  www.graupner-robotics.de           **
//    *****************************************

#include "qfixSoccerBoard.h"

SoccerBoard robot;


void waitForStart()
{
  robot.ledOn(0);
  robot.waitForButton(0);
  robot.ledOff(0);
}


void checkStop()
{
  robot.ledOn(1);
  if (robot.button(1)) {
    robot.motorsOff();
    robot.ledOff(1);
    waitForStart();
  }
}


int main()
{
  waitForStart();			//auf Startknopf warten

  while(true) {			//Endlosschleife 
    robot.motor(0, 70);		//Linksdrehung
    robot.motor(1, 70);
    robot.motor(2, 70);
    sleep(3);				//warten
    robot.motor(0, -70);	//Rechtsdrehung
    robot.motor(1, -70);
    robot.motor(2, -70);
    sleep(3);				//warten
    checkStop();			//Stopknopf prüfen
  }
}