#include "evclibrary.h"

int main()
{
   //1. Konfiguartion der angeschlossenen Senoren und Motoren
   SET_OUT(OUT_A,OUT_MOTOR);
   SET_OUT(OUT_B,OUT_MOTOR);

   //2. Initialisierung des EV3 Brick
   EVC_INIT();

   //3. Steuerung des Roboters
   WRITE_OUT(OUT_A,MOTOR_POWER,60);
   WRITE_OUT(OUT_B,MOTOR_POWER,60);
   SLEEP(2000);
   WRITE_OUT(OUT_A,MOTOR_STOP,MOTOR_BRAKE);
   WRITE_OUT(OUT_B,MOTOR_STOP,MOTOR_BRAKE);
   WRITE_OUT(OUT_A,MOTOR_POWER,60);
   WRITE_OUT(OUT_B,MOTOR_POWER,-60);
   SLEEP(370);
   WRITE_OUT(OUT_A,MOTOR_POWER,60);
   WRITE_OUT(OUT_B,MOTOR_POWER,60);
   SLEEP(1500);
   WRITE_OUT(OUT_A,MOTOR_STOP,MOTOR_BRAKE);
   WRITE_OUT(OUT_B,MOTOR_STOP,MOTOR_BRAKE);
   WRITE_OUT(OUT_A,MOTOR_POWER,-60);
   WRITE_OUT(OUT_B,MOTOR_POWER,60);
   SLEEP(370);
    WRITE_OUT(OUT_A,MOTOR_POWER,60);
   WRITE_OUT(OUT_B,MOTOR_POWER,60);
   SLEEP(2000);
   WRITE_OUT(OUT_A,MOTOR_STOP,MOTOR_BRAKE);
   WRITE_OUT(OUT_B,MOTOR_STOP,MOTOR_BRAKE);
   WRITE_OUT(OUT_A,MOTOR_POWER,60);
   WRITE_OUT(OUT_B,MOTOR_POWER,-60);
   SLEEP(370);
    WRITE_OUT(OUT_A,MOTOR_POWER,60);
   WRITE_OUT(OUT_B,MOTOR_POWER,60);
   SLEEP(1500);
   WRITE_OUT(OUT_A,MOTOR_STOP,MOTOR_BRAKE);
   WRITE_OUT(OUT_B,MOTOR_STOP,MOTOR_BRAKE);
   WRITE_OUT(OUT_A,MOTOR_POWER,-60);
   WRITE_OUT(OUT_B,MOTOR_POWER,60);
   SLEEP(370);
    WRITE_OUT(OUT_A,MOTOR_POWER,60);
   WRITE_OUT(OUT_B,MOTOR_POWER,60);
   SLEEP(2000);



   //4.Programmende
   EVC_CLOSE();
   return 0;


}