Controlador PWM Servos HSER9685.c

//HeTpro Tutoriales.

#include <Wire.h>
#include <Adafruit_PWMServoDriver.h> //Librería Adafruit

Adafruit_PWMServoDriver servos = Adafruit_PWMServoDriver(0x40);  //Dirección del módulo PCA9685

unsigned int p0=148; // posicion 0°
unsigned int p180=615; // posicion 180°

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

void setServo(int nservo, int angulo){ 
  int ancho;
  ancho= map(angulo,0,180, p0, p180);    
  servos.setPWM(nservo, 0, ancho);  
}

void loop() {
    setServo(1,180);    //Posición del servo 1 en 180°
    delay(1000);      
    setServo(1,0);  //Posición del servo 1 en 0°
    delay(1000);
    setServo(8,0);    //Posición del servo 8 en 0°
    delay(1000);
    setServo(8,120);   //Posición del servo 8 en 120°
    delay(1000);
}