#include "pwmWrite.h"

Pwm pwm = Pwm();

const byte servoPinA = 0;
const byte servoPinB = 1;
const byte servoPinC = 2;
const byte servoPinD = 3;
const byte servoPinE = 4;
const byte servoPinF = 5;

void setup() {
//Serial.begin(115200);
}

void loop() {
  pwm.writeServo(servoPinA, 0);
  pwm.writeServo(servoPinB, 0);
  pwm.writeServo(servoPinC, 0);
  pwm.writeServo(servoPinD, 0);
  pwm.writeServo(servoPinE, 0);
  pwm.writeServo(servoPinF, 0);
  delay(800);
  //pwm.printDebug();
  pwm.writeServo(servoPinA, 180);
  pwm.writeServo(servoPinB, 180);
  pwm.writeServo(servoPinC, 180);
  pwm.writeServo(servoPinD, 180);
  pwm.writeServo(servoPinE, 180);
  pwm.writeServo(servoPinF, 180);
  //pwm.printDebug();
  delay(800);
}