OBSTÁCULO evitando BOT (2 / 2 paso)

Paso 2: Escribir código

int trigPin = 8;
echoPin int = 9;
int a = 3;
int b = 2;
int c = 5;
int d = 4;
distancia del flotador;
Float pingTime;
Float speedOfSound = 347.22;
Float lDistance;
Float rDistance;

void setup() {}
Serial.Begin(9600);
pinMode(trigPin,OUTPUT);
pinMode(a,OUTPUT);
pinMode(b,OUTPUT);
pinMode(c,OUTPUT);
pinMode(d,OUTPUT);
pinMode(echoPin,INPUT);
}

flotador meaSure()
{

digitalWrite(trigPin,LOW);
delayMicroseconds(2000);

digitalWrite(trigPin,HIGH);
delayMicroseconds(10);

digitalWrite(trigPin,LOW);
pingTime=pulseIn(echoPin,HIGH);
distancia =(speedOfSound*pingTime)/20000; //in cm
volver a distancia;
}

{} void forward()

digitalWrite(a,HIGH);
digitalWrite(b,LOW);
digitalWrite(c,HIGH);
digitalWrite(d,LOW);
Delay(500);
Stopp();

}
void backward() {}
digitalWrite(b,HIGH);
digitalWrite(a,LOW);
digitalWrite(d,HIGH);
digitalWrite(c,LOW);
Delay(1000);
Stopp();

}
left() vacío {}
digitalWrite(a,HIGH);
digitalWrite(b,LOW);
digitalWrite(d,HIGH);
digitalWrite(c,LOW);
Delay(570);
Stopp();

}
right() vacío {}
digitalWrite(b,HIGH);
digitalWrite(a,LOW);
digitalWrite(c,HIGH);
digitalWrite(d,LOW);
Delay(1000);
Stopp();

}
void stopp() {}
digitalWrite(a,LOW);
digitalWrite(b,LOW);
digitalWrite(c,LOW);
digitalWrite(d,LOW);
Serial.println("Stopp");
}

void loop() {}
Mida la distancia
digitalWrite(trigPin,LOW);
delayMicroseconds(2000);

digitalWrite(trigPin,HIGH);
delayMicroseconds(10);

digitalWrite(trigPin,LOW);
pingTime=pulseIn(echoPin,HIGH);
distancia =(speedOfSound*pingTime)/20000; //in cm
if(Distance>20) {}
Forward();
Serial.println ("No obstackle");
}
Si (distancia < = 20) {}
Stopp();
Serial.println ("comprobación de izquierda");
Left();
Delay(250);

lDistance = meaSure();
Serial.println ("comprobación de derecha");
Right();
Delay(250);
rDistance=meaSure();
Si (rDistance > lDistance & & rDistance > 20) {}
Forward();
Serial.println ("avanzar en el camino correcto");
}
Si (rDistance < = lDistance & & lDistance > 20) {}
Right();
Delay(250);
Forward();
Serial.println ("avanzar en el camino izquierdo");
}
Else {}
Serial.println ("en cueva");
Serial.println ("volver y comprobar una vez más);
backward();
Stopp();
Left();
Delay(250);
lDistance=meaSure();
Right();
Delay(250);
rDistance=meaSure();
Si (rDistance > lDistance & & rDistance > 20) {}
Forward();
}
Si (rDistance < = lDistance & & lDistance > 20) {}
Right();
Delay(250);
Forward();
}
}
}
}

Artículos Relacionados

Obstáculo evitando Robot utilizando el módulo IR interconectado con un tablero de Mediatek LinkIt

Obstáculo evitando Robot utilizando el módulo IR interconectado con un tablero de Mediatek LinkIt

En esta Intructable, podrá ser capaz de a hacer un obstáculo evitando Robot con módulo IR L293D y Mediatek Linkit un tablero.Paso 1: requisitos Controlador de Motor L293D IC.2 módulos de Sensor de infrarrojos.Chasis para Bot.Junta de LinkItOne de Med
Siguientes obstáculos evitando Arduino rescate Bot de autónoma pared

Siguientes obstáculos evitando Arduino rescate Bot de autónoma pared

soy una ingeniería eléctrica importante y cada año rama del mi colegio de IEEE compite en una competencia estudiantil de hardware. Concurso del año pasado fue inspirado por los desastres naturales en Haití y Chile (el concurso se realizó una semana d
Línea autónoma DIY seguimiento con obstáculos evitando Robot (Rover)

Línea autónoma DIY seguimiento con obstáculos evitando Robot (Rover)

ADVERTENCIA: HACER SU COMPUTADORA BRILLO BAJO, PORQUE ESTE PROYECTO EMITE UN ALTO NIVEL DE GENIALIDAD QUE PUEDE DAÑAR TUS OJOS :D 3:)Este proyecto participó en RoboCup 2015 Egipto Local concurso y el premio "mejor diseño" con mi equipo Abdelrahm
Obstáculo evitando Robot V2

Obstáculo evitando Robot V2

recientemente hice un instructable sobre un obstáculo sencillo evitando robot. En este instructable implementará un barrido PING))) sensor, a diferencia del anterior robot que tiene sensor estaba inmóvil. Utilizaré este tercer servo que el PING))) se
Cómo construir obstáculos evitando Robot para principiantes con Arduino Tutorial

Cómo construir obstáculos evitando Robot para principiantes con Arduino Tutorial

Este Tutorial es para cualquier persona para empezar con arduino. Vamos construir un obstáculo evitando el robot que utiliza un sensor de ultrasonidos HC SR-04 para detectar objetos y 2 servos de continua (360 grados) conectados a una fuente de bater
Obstáculo, evitando Robot

Obstáculo, evitando Robot

Este instructable es la versión escrita de mi video de Youtube "Arduino: Cómo para construir un obstáculo evitando Robot" que he subido recientemente. Recomiendo comprobar hacia fuera.Así, sin más preámbulos, comencemos!Paso 1: Un chasis! el pri
(Archivos de código fuente para) Cómo hacer un OAWR (obstáculo evitando caminar Robot)

(Archivos de código fuente para) Cómo hacer un OAWR (obstáculo evitando caminar Robot)

esto es una rama Instructable de cómo hacer un OAWR (obstáculo evitando caminar Robot) y contiene versiones de los archivos de ese instructivo en formatos editables (todos agradable y abierto source'ary me gusta pensar).(Si hay cualquier otro archivo
Cómo hacer un obstáculo evitando Arduino Robot! "Mi Robot V1"

Cómo hacer un obstáculo evitando Arduino Robot! "Mi Robot V1"

Este instructable muestra las instrucciones de pasos para hacer un obstáculo evitando robot con Arduino.Empezar a dejarmi bloghttp://robot4pro.blogspot.com/p/My-robots.htmlPaso 1: Materiales necesariosAquí le damos todo que lo necesario para hacer My
Cómo hacer un obstáculo evitando robot

Cómo hacer un obstáculo evitando robot

obstáculo evitando robot con i.r obstáculo detector y controlador de motor.Paso 1: las cosas que necesitamos we need :-1 un mortor de dc gared2 un viejo teléfono inteligente flip cubierta3 pegamento4 algunos cablescircuito de dector de obstáculo 5con
Obstáculo, evitando Robot con Arduino

Obstáculo, evitando Robot con Arduino

Hola chicos en este instructable veremos cómo hacer un obstáculo autónomo evitando Robot.This robot ha sido diseñado y programado de tal manera que evita la colisión. Básicamente, el robot se mueve hacia delante y siempre que detecte un objeto/obstác
Cómo hacer un obstáculo evitando Arduino Robot

Cómo hacer un obstáculo evitando Arduino Robot

Hola a todos! En este Instructable voy se que muestra cómo hacer un robot similar a la "móvil Arduino plataforma Experimental" (MAEP) que hice. Está equipado con dos motores que pueden dirigir el robot y la habilidad de ver los obstáculos delant
Cómo hacer un OAWR (obstáculo evitando caminar Robot)

Cómo hacer un OAWR (obstáculo evitando caminar Robot)

este Instructable muestra cómo hacer un pequeño robot a pie que evita obstáculos (al igual que muchas opciones disponibles en el mercado). Pero qué es la diversión en la compra de un juguete cuando en su lugar puede iniciar con un motor, la hoja de p
Obstáculo, evitando Robot - escudo del Motor

Obstáculo, evitando Robot - escudo del Motor

¡ Hola chicos! Este es un tutorial fácil y básico para la fabricación de un Robot evitando obstáculo... Sigue leyendo...Paso 1: Materiales necesarios Para construir el Robot evitando obstáculo, se necesita-Arduino Uno R3 (recomendamos usar Arduino Un
Obstáculo, evitando Robot con sensores de infrarrojos sin microcontrolador

Obstáculo, evitando Robot con sensores de infrarrojos sin microcontrolador

Bien este es un proyecto mayor, hizo en 2014 en el mes de julio o agosto, pensaba compartir con ustedes chicos. Su un obstáculo sencillo evitar el robot que utiliza sensores infrarrojos y funciona sin microcontrolador. Los sensores IR utiliza IC opam