#include <Servo.

h>
Servo
Servo
Servo
Servo
Servo

Trola;
Puyuo;
Servo3;
Servo4;
Servo5;

// incluimos la biblioteca Servo

// creamos un objecto servo para controlar el motor
// creamos un objecto servo para controlar el motor
// creamos un objecto servo para controlar el motor
// creamos un objecto servo para controlar el motor
// creamos un objecto servo para controlar el motor

unsigned char dato;

int valPot1 = 0;
int angulo1 = 0;

// variable para guardar el valor del potenciometro

// variable para guardar la posicion del servo

int valPot2 = 0;
int angulo2 = 0;

// variable para guardar el valor del potenciometro

// variable para guardar la posicion del servo

int valPot3 = 0;
int angulo3 = 0;

// variable para guardar el valor del potenciometro

// variable para guardar la posicion del servo

int valPot4 = 0;
int angulo4 = 0;

// variable para guardar el valor del potenciometro

// variable para guardar la posicion del servo

int valPot5 = 0;
// variable para guardar el valor del potenciometro
int angulo5 = 0;
// variable para guardar la posicion del servo
int pulsador = 13;
int datoSensor=12;
int activeSensor=8;
int dato0=0;
int dato1=0;
int led=7;
void setup()
{
Trola.attach(3); // liga el servo al pin 3
Puyuo.attach(5); // liga el servo al pin 5
Servo3.attach(6); // liga el servo al pin 6
Servo4.attach(11); // liga el servo al pin 9
Servo5.attach(10); // liga el servo al pin 10
pinMode(pulsador, INPUT);
pinMode(datoSensor, INPUT);
pinMode(activeSensor, OUTPUT);
pinMode(led, OUTPUT);
Serial.begin(9600);
}
void loop()
{
Servo4.write(180);
for(int i=20; i<=90; i++){
Trola.write(i);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el se
rvo llegue a su posicion
}
for(int i=80; i<=125; i++){
Puyuo.write(i);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el se
rvo llegue a su posicion
}

for(int i=15; i<=155; i++){

Servo3.write(i);
// manda al servo la posicion
delay(30);
// espera unos milisegundos para que el se
rvo llegue a su posicion
}
// espera unos milisegundos para que el servo llegue a su pos
icion
for(int i=110; i<=140; i++){
Servo5.write(i);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el se
rvo llegue a su posicion
}
delay(100);
// espera unos milisegundos para que el servo llegue a su po
sicion
for (int i=125; i>=80; i--) {
Puyuo.write(i);
// manda al servo la posicion
delay(30);
// espera unos milisegundos para que el se
rvo llegue a su posicion
}
for(int i=155; i>=80; i--){
Servo3.write(i);
delay(40);
}
for(int i=90; i>=20; i--){
Trola.write(i);
// manda al servo la posicion
// manda al servo la posicion
delay(10);
// espera unos milisegundos para que el se
rvo llegue a su posicion
}
for(int i=180; i>=0; i--){
Servo4.write(i);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el servo llegue a
su posicion
}

for(int i=80; i>=15; i--){

Servo3.write(i);
delay(40);
}
for(int i=140; i>=110; i--){
Servo5.write(i);
// manda al servo la posicion
delay(10);
// espera unos milisegundos para que el se
rvo llegue a su posicion
}

delay(1000);

dato0=digitalRead(pulsador);
while(dato0==1){
digitalWrite(activeSensor, HIGH);
dato1=digitalRead(datoSensor);

servo
servo
servo
servo
servo

if(dato1==1){
Trola.write(90);
delay(1000);
llegue a su posicion
Puyuo.write(35);
delay(1000);
llegue a su posicion
Servo3.write(90);
delay(1000);
llegue a su posicion
Servo4.write(90);
delay(1000);
llegue a su posicion
Servo5.write(90);
delay(1000);
llegue a su posicion

// manda al servo la posicion

// espera unos milisegundos para que el
// manda al servo la posicion
// espera unos milisegundos para que el
// manda al servo la posicion
// espera unos milisegundos para que el
// manda al servo la posicion
// espera unos milisegundos para que el
// manda al servo la posicion
// espera unos milisegundos para que el

}
else{

servo

servo
servo
servo

Puyuo.write(125);
delay(1000);
llegue a su posicion
Servo3.write(90); //
delay(1000);
Trola.write(90);
delay(1000);
llegue a su posicion
Servo4.write(90);
delay(1000);
llegue a su posicion
Servo5.write(90);
delay(1000);
llegue a su posicion

// manda al servo la posicion

// espera unos milisegundos para que el
manda al servo la posicion
// espera unos milisegundos para que el
// manda al servo la posicion
// espera unos milisegundos para que el
// manda al servo la posicion
// espera unos milisegundos para que el

}
dato0=digitalRead(pulsador);
if(!dato0){
digitalWrite(activeSensor, LOW);
digitalWrite(led, LOW);
break;
}

if (Serial.available()){
dato = Serial.read();
while(dato == '0')
{
valPot1 = analogRead(A0);
// leemos el valor del potenciometro
angulo1 = map(valPot1, 0, 1023, 0, 180);
// convertimos los valores
del potenciometro a los del servo
Trola.write(angulo1);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el se
rvo llegue a su posicion
valPot2 = analogRead(A1);
// leemos el valor del potenciometro
angulo2 = map(valPot2, 0, 1023, 0, 180);
// convertimos los valores
del potenciometro a los del servo
Puyuo.write(angulo2);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el se
rvo llegue a su posicion
valPot3 = analogRead(A2);
// leemos el valor del potenciometro
angulo3 = map(valPot3, 0, 1023, 0, 180);
// convertimos los valores
del potenciometro a los del servo
Servo3.write(angulo3);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el se
rvo llegue a su posicion
valPot4 = analogRead(A3);
// leemos el valor del potenciometro
angulo4 = map(valPot4, 0, 1023, 0, 180);
// convertimos los valores
del potenciometro a los del servo
Servo4.write(angulo4);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el se
rvo llegue a su posicion
valPot5 = analogRead(A4);
// leemos el valor del potenciometro
angulo5 = map(valPot5, 0, 1023, 0, 180);
// convertimos los valores
del potenciometro a los del servo
Servo5.write(angulo5);
// manda al servo la posicion
delay(15);
// espera unos milisegundos para que el servo lleg
ue a su posicion

}
if(dato == '1')
{
Trola.write(180);
// manda al servo la posicion
delay(1000);
// espera unos milisegundos para que el
servo llegue a su posicion
Puyuo.write(0);
// manda al servo la posicion
delay(1000);
// espera unos milisegundos para que el
servo llegue a su posicion
Trola.write(45);
// manda al servo la posicion
delay(1000);
// espera unos milisegundos para que el

servo llegue a su posicion

Servo3.write(45);
delay(1000);
servo llegue a su posicion
Servo4.write(45);
delay(1000);
servo llegue a su posicion
Trola.write(120);
delay(1000);
servo llegue a su posicion

}
}
}

// manda al servo la posicion

// espera unos milisegundos para que el
// manda al servo la posicion
// espera unos milisegundos para que el
// manda al servo la posicion
// espera unos milisegundos para que el