GRÚA (2GDL) CON ARDUINO

Durante el mes de marzo se ha realizado con los alumnos y alumnas de diversificación una grúa con dos servomotores, diodos leds, control por Joystick y la placa programable Arduino. Previa realización de circuitos más sencillos (encendido de diodos leds, control por pulsador, control de servomotor con dos pulsadores,...) se realiza el proyecto final que es el diseño y construcción de una grúa.

 

Materiales utilizados: Placa Programable Arduino, Placa de pruebas, cableado, Joystick,, dos servomotores. Además, para la pequeña estructura de la grúa se ha utilizado madera.

Código arduino:

//Proyecto: Grua con servomotores

#include <Servo.h>

//Definicion de los servos

Servo servo1;

Servo servo2;

int eje1=90;

int eje2=90;

void setup(){  

  servo1.attach(7);

  servo2.attach(6);

  servo1.write(90);

  servo2.write(90);

}

void loop(){

  //SERVO 1

  if (analogRead(0)<200 && eje1<180){

    eje1++;

    servo1.write(eje1);

  }

  if (analogRead(0)>700 && eje1>0){

    eje1--;

    servo1.write(eje1);

  }

  //SERVO 2

  if (analogRead(1)<200 && eje2<180){

    eje2++;

    servo2.write(eje2);

  }

  if (analogRead(1)>700 && eje2>0){

    eje2--;

    servo2.write(eje2);

  }

  delay(15);

}

 

Fdo. Óscar García Jiménez