martes, 9 de abril de 2019

Brazo Robótico.

#include <Servo.h>
  Servo mi_servo;
  int posicion_mi_servo;
  const int pulsador_izquierda = 2;
  const int pulsador_derecha   = 4;
  int estado_pulsador_izquierda = 0;   // Declaramos los elementos, como se encuentran y el ángulo                                                                                                     que queremos.
  int estado_pulsador_derecha   = 0;
  int incremento_de_angulo      = 10;
  void setup()
{
mi_servo.attach(9) ;

  pinMode(pulsador_izquierda, INPUT);      // Decimos que los interruptores están apagados.
  pinMode(pulsador_derecha,   INPUT);
 }
void loop() {
  estado_pulsador_izquierda = digitalRead(pulsador_izquierda);
  estado_pulsador_derecha   = digitalRead(pulsador_derecha)  ; 
  if (estado_pulsador_izquierda == HIGH)
  {
  posicion_mi_servo = posicion_mi_servo+ incremento_de_angulo;    // Si pulsamos el pulsador izquierdo, el servo se mueve un ángulo de 10º hacia un lado, esperando cierto tiempo.
mi_servo.write(posicion_mi_servo);                           
  delay(500);                                                             
   }
  else {if (estado_pulsador_derecha == HIGH)
{
  posicion_mi_servo = posicion_mi_servo - incremento_de_angulo;   // Si pulsamos el pulsador izquierdo, el servo se mueve un ángulo de 10º hacia el otro lado, esperando el tiempo indicado.
mi_servo.write(posicion_mi_servo);
  delay(500);
  }
    else {         
    delay(500);
  }
}
}

No hay comentarios:

Publicar un comentario