#include <Servo.h>

int count = 0;

//Dpad
Servo dpadLR;
int dPadLeft = 180;
int dPadUp = 90;
int dPadRight = 0;
int maxCount = 17 * 2; //17 keer links 17 keer rechts
bool servoDPadDown = false;
bool gaRechts = false;

//Button
Servo buttons;
bool servoButtonDown = false;
int buttonDown = 15; //25 graden als ie naar beneden is
int buttonUp = 10;

//Timer
unsigned long previousMillis = 0;
const long interval = 500;




void setup() {
  dpadLR.attach(9);
  buttons.attach(10);
}

void loop()
{
  unsigned long currentMillis = millis();
  if (currentMillis - previousMillis >= interval) {
    previousMillis = currentMillis;

    //    //button
    //    if (servoButtonDown == false)
    //      servoButtonDown = true;
    //    else
    //      servoButtonDown = false;
    //
    //    if (servoButtonDown == true)
    //      buttons.write(buttonDown);
    //    else
    //      buttons.write(buttonUp);

    //dPad
    if (servoDPadDown == false)
      servoDPadDown = true;
    else
      servoDPadDown = false;

    if (servoDPadDown == true)
    {
      if (gaRechts)
        dpadLR.write(dPadRight);
      else
        dpadLR.write(dPadLeft);
    }
    else
      dpadLR.write(dPadUp);

    if (count >= maxCount)
    {
      if (gaRechts == true)
        gaRechts = false;
      else
        gaRechts = true;
        
      count = 0; // begin opnieuw
    }
    
    count++;
  }
}