domingo, 7 de junio de 2009

Código del proyecto

int motoravanza = 10;
int motoretro = 11;
int derecha = 12;
int izquierda = 13;
int sensor1 = 4;
int sensor2 = 3;
int valor1 = 0;
int valor2 = 0;
int led1=7;
int led2=6;
int vallux=0;
int LDR=0;

void setup()
{
pinMode(motoravanza, OUTPUT);
pinMode(motoretro, OUTPUT);
pinMode(izquierda , OUTPUT);
pinMode(derecha, OUTPUT);
pinMode(valor1, INPUT );
pinMode(valor2, INPUT );
pinMode(led1, OUTPUT);
pinMode(led2, OUTPUT);
}
void loop()
{
vallux=analogRead(LDR);
valor1 = digitalRead(sensor1); // valores del sensor
valor2 = digitalRead(sensor2);
if ( vallux>10)
{
digitalWrite(led1,LOW);
digitalWrite(led2,LOW);
}
else
{
digitalWrite(led1,HIGH);
digitalWrite(led2,HIGH);
}


if(valor1==0 && valor2==0)
{
analogWrite(motoretro ,80);
analogWrite(motoravanza ,0);
analogWrite(izquierda ,0);
analogWrite(derecha,0);

}
if(valor1>0 && valor2>0)
{
analogWrite(motoravanza,100); //avanzan
analogWrite(motoretro ,0);
analogWrite(izquierda ,0);
analogWrite(derecha ,0);

}
if(valor1<=0 && valor2>0)
{
analogWrite(motoravanza,170); // giro derecha
analogWrite(derecha ,255);
analogWrite(motoretro ,0);
analogWrite(izquierda ,0);
}
if(valor1>0 && valor2<=0)
{
analogWrite(motoravanza,170);
analogWrite(izquierda,255);// giro izquierda
analogWrite(derecha,0);
analogWrite(motoretro,0);// giro izquierda
}
}

2 comentarios:

  1. Que buen proyecto me gusto que hayas incluido el metodo para hacer los PCB del robot :)

    ResponderEliminar
  2. este es el codigo del robot seguidor de linea?

    ResponderEliminar