#include <Wire.

h>
#include <Adafruit_PWMServoDriver.h>
int masa=0;
int relleno1=0;
int relleno2=0;

Adafruit_PWMServoDriver servos = Adafruit_PWMServoDriver(0x40);

unsigned int pos0=172; // ancho de pulso en cuentas para pocicion 0�

unsigned int pos180=565; // ancho de pulso en cuentas para la pocicion 180�

void setup() {
servos.begin();
servos.setPWMFreq(60); //Frecuecia PWM de 60Hz o T=16,66ms
pinMode(2, INPUT);
pinMode(7, INPUT);
pinMode(6, INPUT);

void setServo(uint8_t n_servo, int angulo) {

int duty;
duty=map(angulo,0,180,pos0, pos180);
servos.setPWM(n_servo, 0, duty);
}

void loop() {

masa = digitalRead(2);
relleno1=digitalRead(7);
relleno2=digitalRead(6);

if(masa==HIGH) {
setServo(0,90);
delay(500);
// setServo(0,180);
// delay(500);
setServo(0,0);
delay(500);
}
else{if (masa==LOW)
{
setServo(0,0);
}
}

if (relleno1==HIGH)
{
setServo(1,90);
delay(500);
//setServo(1,180);
//delay(500);
setServo(1,0);
delay(500);

}
else{if (relleno1==LOW)
{
 setServo(1,0);
}
}
if (relleno2==HIGH)
{
setServo(2,90);
delay(500);
//setServo(1,180);
//delay(500);
setServo(2,0);
delay(500);

}
else{if (relleno1==LOW)
{
setServo(2,0);
}
}