void setup() [
Serial.begin(9600);//habilitar monitor en serie
//sensor tcrt5000
pinMode(12, INPUT);
pinMode(13, INPUT);
//motorizquierdo
pinMode(4, OUTPUT);
pinMode(5, OUTPUT);
pinMode(6, OUTPUT);
//motor derecho
pinMode(2, OUTPUT);
pinMode(3, OUTPUT);
pinMode(9, OUTPUT);
]
void adelante () [
//motor izquierdo adelante
digitalWrite(4, HIGH);
digitalWrite(5, HIGH);
analogWrite(6,130);
// motor derecho adelante
digitalWrite(2, HIGH);
digitalWrite(3, HIGH);
analogWrite(9,130);
]
void retroceder () [
//motor izquierdo retroceder
digitalWrite(4, LOW);
digitalWrite(5, HIGH);
analogWrite(6,130);
//motor derecho retroceder
digitalWrite(2, LOW);
digitalWrite(3;HIGH);
analogWrite(9,130);
]
void derecha () [
//motor izquierdo adelante
digitalWrite(4;HIGH);
digitalWrite(5, LOW);
analogWrite(6,130);
//motor derecho retroceder
digitalWrite(2, LOW);
digitalWrite(3, HIGH);
analogWrite(9,130);
]
void izquierda () [
//motor izquierdo retrocede
digitalWrite(4, LOW);
digitalWrite(5, HIGH);
analogWrite(6,130);
//motor derecho adelante
digitalWrite(2, HIGH);
digitalWrite(3, LOW);
analogWrite(9,130);
]
void detener () [
//motor izquierdo apagado
digitalWrite(4, LOW);
digitalWrite(5, LOW);
analogWrite(6, 0);
//motor derecho apagado
digitalWrite(2, LOW);
digitalWrite(3, LOW);
analogWrite(9,0);
]
void loop() {
Serial.print(¨izquierdo¨);
Serial.print(digitalRead(13));
Serial.print(¨¨);
Serial.print(¨derecho¨);
Serial.print(digitalRead(12))
int sensorD=digitalRead(12);
int sensor=digitalRead(13);
if (sensorI ==0 && sensorD==0){
detener();
}
if(sensorI ==1 && sensorD==0){
izquierda();
}
if