// Controlling multiple servo motors,

#include <slowServo.h>
#include <mechButton.h>

#define CLOSE_1 20
#define CLOSE_2 160
#define OPEN_1 90
#define OPEN_2 90
#define MS_DEG 20

mechButton  closeBtn(2);
mechButton  openBtn(3);
slowServo   servo1(5);
slowServo   servo2(4);


void setup() {
  
  closeBtn.setCallback(closeClk);
  openBtn.setCallback(openClk);
  servo1.begin();
  servo2.begin();
  servo1.setDeg(CLOSE_1);
  servo2.setDeg(CLOSE_2);
  sleep(1000);
  servo1.setMsPerDeg(MS_DEG);
  servo2.setMsPerDeg(MS_DEG);
}


void closeClk() {

    if (~closeBtn.getState()) {
      servo1.setDeg(30);
      servo2.setDeg(150);
    }
}


void openClk() {

   if (~openBtn.getState()) {
      servo1.setDeg(90);
      servo2.setDeg(90);
    }
}


void loop() {

  idle();
}