// motor 1
pinMode(7, OUTPUT);
pinMode(6, OUTPUT);
//motor 2
pinMode(5, OUTPUT);
pinMode(4, OUTPUT);
//sensor Izq
pinMode(2, INPUT);
//sensor derecho
pinMode(3, INPUT);
void loop() {
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
}
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
== HIGH)
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, HIGH);
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
// motor 1
pinMode(7, OUTPUT);
// motor 1
pinMode(7, OUTPUT);
pinMode(6, OUTPUT);
//motor 2
pinMode(5, OUTPUT);
pinMode(4, OUTPUT);
//sensor Izq
pinMode(2, INPUT);
//sensor derecho
pinMode(3, INPUT);
void loop() {
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
digitalWrite(7, LOW);
digitalWrite(6, HIGH);
//motor 2
pinMode(5, OUTPUT);
pinMode(4, OUTPUT);
//sensor Izq
pinMode(2, INPUT);
//sensor derecho
pinMode(3, INPUT);
void loop() {
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
digitalWrite(7, LOW);
digitalWrite(6, HIGH);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, HIGH);
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
Servo servo1;
long t;
long d;
long dder;
long dizq;
int estado;
int opcion = 0;
void setup() {
//SENSOR ultrasonido
pinMode(8, INPUT);
pinMode(9, OUTPUT);
servo1.attach(10);
//SENSOR IAQ
pinMode(2, INPUT);
//SENSOR DER
pinMode(3, INPUT);
//MOTOR IZQ
pinMode(7, OUTPUT);
pinMode(6, OUTPUT);
//MOTOR DER
pinMode(5, OUTPUT);
pinMode(4, OUTPUT);
void loop() {
estado = Serial.read();
Serial.println(estado);
delay(150);
if (estado == 79)
opcion = 0;
if (estado == 80)
opcion = 1;
if (estado == 81)
opcion = 2;
}
switch (opcion)
case 0:
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
digitalWrite(7, LOW);
digitalWrite(6, HIGH);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, HIGH);
{
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
break;
case 1:
if (estado == 66)
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
if (estado == 72)
digitalWrite(7, LOW);
digitalWrite(6, HIGH);
digitalWrite(5, LOW);
digitalWrite(4, HIGH);
if (estado == 68)
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
}
if (estado == 70)
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
if (estado == 69)
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
break;
case 2:
digitalWrite(9, LOW);
delayMicroseconds(5);
digitalWrite(9, HIGH);
delayMicroseconds(10);
t = pulseIn(8, HIGH);
d = (0.017 * t);
Serial.println(d);
delay(500);
if (d <= 10)
{
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
servo1.write(0);
delay(500);
digitalWrite(9, LOW);
delayMicroseconds(5);
digitalWrite(9, HIGH);
delayMicroseconds(10);
t = pulseIn(8, HIGH);
delay(500);
servo1.write(180);
delay(1000);
digitalWrite(9, LOW);
delayMicroseconds(5);
digitalWrite(9, HIGH);
delayMicroseconds(10);
t = pulseIn(8, HIGH);
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
delay(500);
else
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
delay(500);
servo1.write(90);
delay(500);
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
delay(50);
break;
}
Serial.print(dizq);
Serial.print(" ");
Serial.println(dder);
Servo servo1;
long t;
long d;
long dder;
long dizq;
int estado;
int opcion = 0;
void setup() {
//SENSOR ultrasonido
pinMode(8, INPUT);
pinMode(9, OUTPUT);
servo1.attach(10);
//SENSOR IAQ
pinMode(2, INPUT);
//SENSOR DER
pinMode(3, INPUT);
//MOTOR IZQ
pinMode(7, OUTPUT);
pinMode(6, OUTPUT);
//MOTOR DER
pinMode(5, OUTPUT);
pinMode(4, OUTPUT);
void loop() {
estado = Serial.read();
Serial.println(estado);
delay(150);
if (estado == 79)
opcion = 0;
if (estado == 80)
opcion = 1;
if (estado == 81)
opcion = 2;
switch (opcion)
case 0:
{
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
digitalWrite(7, LOW);
digitalWrite(6, HIGH);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, HIGH);
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
break;
case 1:
if (estado == 66)
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
if (estado == 72)
digitalWrite(7, LOW);
digitalWrite(6, HIGH);
digitalWrite(5, LOW);
digitalWrite(4, HIGH);
if (estado == 68)
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
if (estado == 70)
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
if (estado == 69)
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
break;
case 2:
digitalWrite(9, LOW);
delayMicroseconds(5);
digitalWrite(9, HIGH);
delayMicroseconds(10);
t = pulseIn(8, HIGH);
d = (0.017 * t);
Serial.println(d);
delay(500);
if (d <= 10)
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
servo1.write(0);
delay(500);
digitalWrite(9, LOW);
delayMicroseconds(5);
digitalWrite(9, HIGH);
delayMicroseconds(10);
t = pulseIn(8, HIGH);
delay(500);
servo1.write(180);
delay(1000);
digitalWrite(9, LOW);
delayMicroseconds(5);
digitalWrite(9, HIGH);
delayMicroseconds(10);
t = pulseIn(8, HIGH);
digitalWrite(7, LOW);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
delay(500);
else
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
delay(500);
servo1.write(90);
delay(500);
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
delay(50);
break;
Serial.print(dizq);
Serial.print(" ");
Serial.println(dder);