void setup() {
Serial.begin(9600);//habilitar monitor serie
//sensore tcrt5000
pinMode(14, INPUT);
pinMode(5, INPUT);
//motor izquierdo//
pinMode(12,OUTPUT);
pinMode(13,OUTPUT);
//motor derecho//
pinMode(2,OUTPUT);
pinMode(4,OUTPUT);
}
void adelante(){
//motor izquiero adelante//
digitalWrite(12, HIGH);
digitalWrite(13, LOW);
//motor derecho adelante//
digitalWrite(2,HIGH);
digitalWrite(4, LOW);
}
void retroceder(){
//motor izquiero retroceder//
digitalWrite(12, LOW);
digitalWrite(13, HIGH);
//motor derecho retroceder//
digitalWrite(2,LOW);
digitalWrite(4,HIGH);
}
void derecha(){
//motor izquiero adelante//
digitalWrite(12, HIGH);
digitalWrite(13, LOW);
//motor derecho retroceder//
digitalWrite(2,LOW);
digitalWrite(4,HIGH);
}
void izquierda(){
//motor izquiero retrocede//
digitalWrite(12, LOW);
digitalWrite(13, HIGH);
//motor derecho adelante//
digitalWrite(2,HIGH);
digitalWrite(4,LOW);
}
void detener(){
//motor izquiero apagado//
digitalWrite(12, LOW);
digitalWrite(13, LOW);
//motor derecho apagado//
digitalWrite(2,LOW);
digitalWrite(4,LOW);
}
void loop() {
Serial.println(digitalRead(5));
int sensorD= digitalRead(5);
int sensorI= digitalRead(14);
if(sensorI == 1 && sensorD ==1){
adelante();
}
if(sensorI == 1 && sensorD ==0){
derecha();
}
if(sensorI == 0 && sensorD ==1){
izquierda();
}
}