Está en la página 1de 2

#include <Servo.

h>

Servo servo_01;
Servo servo_02;
Servo servo_03;
Servo servo_04;

int pos_servo_01;
int pos_servo_02;
int pos_servo_03;
int pos_servo_04;

const int pulsador_izquierda = 2;


const int pulsador_derecha = 3;
const int pulsador_arriba = 4;
const int pulsador_abajo = 5;

int estado_pulsador_izquierda = 0;
int estado_pulsador_derecha = 0;
int estado_pulsador_arriba = 0;
int estado_pulsador_abajo = 0;
int inc_de_angulo = 2;

void setup()
{
servo_01.attach(9);
servo_02.attach(10);
servo_03.attach(11);
servo_04.attach(12);

pinMode(pulsador_izquierda, INPUT);
pinMode(pulsador_derecha, INPUT);
pinMode(pulsador_arriba, INPUT);
pinMode(pulsador_abajo, INPUT);
}

void loop() {

estado_pulsador_izquierda = digitalRead(pulsador_izquierda);
estado_pulsador_derecha = digitalRead(pulsador_derecha);
estado_pulsador_arriba = digitalRead(pulsador_arriba);
estado_pulsador_abajo = digitalRead(pulsador_abajo);

if (estado_pulsador_izquierda == HIGH)
{
pos_servo_01 = pos_servo_01 + inc_de_angulo;
servo_01.write(pos_servo_01);
delay(100);
}
else if(estado_pulsador_derecha == HIGH)
{
pos_servo_01 = pos_servo_01 - inc_de_angulo;
servo_01.write(pos_servo_01);
delay(100);
}
else if (estado_pulsador_arriba == HIGH)
{
pos_servo_02 = pos_servo_02 + inc_de_angulo;
servo_02.write(pos_servo_02);
delay(100);
}
else if (estado_pulsador_abajo == HIGH)
{
pos_servo_02 = pos_servo_02 - inc_de_angulo;
servo_02.write(pos_servo_02);
delay(100);
}
else
{
delay(100);
}
}

También podría gustarte