ROBOT ARDUINO

Hola ! Somos Hugo y Anthony de 1º de batxillerat.

Nuestro ultimo proyecto para el blog ha sido programar este robot arduino con dos motores servo, nuestro principal objectivo era hacer que el robot se moviera hacia donde quisieramos, en este caso el robot irá hacia delante hará un giro de 360 grados y volvera a ir hacia delante.

Aqui os dejamos el programa para que lo probeis y editeis a vuestro gusto:

#include <Servo.h>                         // Inserció de la llibreria Servo

Servo servoLeft;                           // Declaració de variables tipus Servo
Servo servoRight;

void setup()                               // Configuració
{
  servoLeft.attach(9);                    // Assigna els senyals servo als pins
  servoRight.attach(10);                  
} 

void loop()                                // Execució
{                                         
 endavant();
 gir();
 endavant();
 aturada();
}
void endavant()
{
  servoLeft.writeMicroseconds(1700);       // Ample pols 1700: gir antihorari, velocitat màxima
  servoRight.writeMicroseconds(1300);      // Ample pols 1300: gir horari, velocitat màxima
  delay(3000);                             // Durada de l'acció: 3 segons
} 
void gir()
{
  servoLeft.writeMicroseconds(1700);       // Ample pols 1700: gir antihorari, velocitat màxima
  servoRight.writeMicroseconds(1700);      // Ample pols 1300: gir horari, velocitat màxima
  delay(3000);
}
void aturada()
{
  servoLeft.detach;
  servoRight.detach;
}