/*
     * Created by Naylamo Mechatronics and modified by Cuautli Garcia
     *
     * FabAcademy
     *
     * Version 1.0
     * Last Autor: Cuautli Garcia - cuautli.garciaa@gmail.com
     *
     */
#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>

Adafruit_PWMServoDriver servos = Adafruit_PWMServoDriver(0x40);

unsigned int pos0=130; // ancho de pulso en cuentas para pocicion 0°
unsigned int pos180=660; // ancho de pulso en cuentas para la pocicion 180°

void setup() {
  servos.begin();  
  servos.setPWMFreq(60); //Frecuecia PWM de 60Hz o T=16,66ms
}


void loop() {
  
  for (int duty = pos0; duty < pos180; duty=duty+10) {
    for(int n=0;n<3;n++)
    {
      servos.setPWM(n,0,duty);
    }   
  }
  delay(1000);
  for (int duty = pos180; duty > pos0; duty=duty-10) {
    for(int n=0;n<16;n++)
    {
      servos.setPWM(n,0,duty);
    }   
  }
  //servos.setPWM(0,0,((pos0+pos180)/2));
  delay(1000);
}