Aunque el taller haya finalizado, todo avanza, aquí os traemos al servobot en su versión 2.0 :
Os dejo el código de fuente:
// ********************************************************
// ***** Programa: Siguelines *****
// ***** Autor...: Taller Dunas *****
// ***** Fecha...: 21/06/2009 *****
// ***** Notas...: Este programa ha sido desarrollado *****
// ***** para el taller de Robotica del I.E.S. *****
// ***** "Las Dunas de las Chapas" *****
// ********************************************************
// Patillas control motores
int md_ade = 2;
int md_atr = 3;
int md = 5;
int mi_ade = 4;
int mi_atr = 7;
int mi = 6;
// Patillas de sensores
int s0 = 4;
int s1 = 3;
int s2 = 2;
int s3 = 5;
int s4 = 1;
int s5 = 0;
void setup()
{
// Definimos patillas de salida para los motores
pinMode(md_ade, OUTPUT);
pinMode(md_atr, OUTPUT);
pinMode(md , OUTPUT);
pinMode(mi_ade, OUTPUT);
pinMode(mi_atr, OUTPUT);
pinMode(mi , OUTPUT);
}
void loop()
{
digitalWrite(md_atr,LOW);
digitalWrite(md_ade,HIGH);
digitalWrite(mi_atr,LOW);
digitalWrite(mi_ade,HIGH);
// Algoritmo siguelineas
if (analogRead(s3) > 500)
{ analogWrite(md,150); }
else
{ analogWrite(md,0); }
if (analogRead(s2) > 500)
{ analogWrite(mi,150); }
else
{ analogWrite(mi,0); }
if (analogRead(s4) > 500)
{ analogWrite(md,200); }
else
{ analogWrite(md,0); }
if (analogRead(s1) > 500)
{ analogWrite(mi,200); }
else
{ analogWrite(mi,0); }
if (analogRead(s5) > 500)
{ analogWrite(md,250); }
else
{ analogWrite(md,0); }
if (analogRead(s0) > 500)
{ analogWrite(mi,250); }
else
{ analogWrite(mi,0); }
}
Comentarios Recientes