Abrir y cerrar una tolva de alimentos con dos servomotores

Abrir y cerrar una tolva de alimentos con dos servomotores

Escrito Por: admin Publicado En: Arduino Fecha de Creación: 2016-10-31 visitas: 1157

Abrir y cerrar una tolva de alimentos con dos servomotores

Objetivos: 

Cerrar y abrir un tolva con un servomotor usando Arduino uno

 

Estados:

Abrir 

Cerrar

 

Material:

2 servomotores

1 push- botón

1 arduino uno

 

Desarrollo:

Código

 

#include <Servo.h>                    // Incluir la librería Servo
Servo servo1;
Servo servo2;   

int angulo1 = 0 ;
int angulo2 = 0 ;


const int boton=2;  /// es el boton para abrir y cerrar la tolva


  
  
  #define  ABIERTO 0
  #define  CERRADO 1

  
 
int fsm_state = ABIERTO;


void setup() {
  pinMode(boton, INPUT);         //declaramos el boton como entrada
  pinMode(sensor, INPUT); 


servo1.attach(11) ;             // Conectar servo1 al pin 11
servo2.attach(10) ;             // Conectar servo1 al pin 12  


  // initialize the serial port:
  Serial.begin(9600);
}

void loop() {

switch(fsm_state) {

 

  case CERRADO:

  cerrar();

  if ( digitalRead(boton)==HIGH){

   fsm_state=ABIERTO;
  
  }

  break;


  case ABIERTO:

  abrir();

  if ( digitalRead(boton)==HIGH){
  
  fsm_state=CERRADO;

  }
  
  break;


}

 


  }
  
 
  

 

void abrir(){

servo1.write(180);
servo2.write(180);


}

void cerrar(){


servo1.write(90);
servo2.write(90);
}