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

mechButton  myButton(2);
slowServo   servo5(5,0);    // Set for closed.
slowServo   servo6(6,90);   // Also ser for closed.
bool        closed;

void setup() {
  
  closed = true;                    // We start out in closed position.
  myButton.setCallback(btnClick);
  servo5.begin();
  servo5.setMsPerDeg(10);
  servo6.begin();
  servo6.setMsPerDeg(30);
}

void btnClick(void) {

  if (!myButton.getState()) {     // If button pressed.
    if (closed) {                 // If it's closed..
      servo5.setDeg(100);         // Some degree for open.
      servo6.setDeg(180);         // Some other degree for open.
    } else {                      // Else it's open?
      servo5.setDeg(0);           // Go back.
      servo6.setDeg(90);          // Go back.
    }                             //
    closed = !closed;             // Toggle state.
  }
}


void loop() { idle(); } // Idle makes the magic happen.