código en el cual hacemos funcionar los motores:
#include <Ultrasonic.h>
Ultrasonic ultrasonic(8,12); // (Trig PIN,Echo PIN)
Ultrasonic ultra(10,11);
//int sensor=2;
//int ult;
int sens;
int MderAvan=4;
int MderAtras=6;
int MizqAvan=5;
int MizqAtras=7;
int detec;
int valor1=0;
int valor;
void setup() {
Serial.begin(9600);
pinMode(sensor,INPUT);
pinMode(ult, INPUT);
pinMode(MderAvan,OUTPUT);
pinMode(MizqAvan,OUTPUT);
pinMode(MderAtras,OUTPUT);
pinMode(MizqAtras,OUTPUT);
}
void avanzar(){
pinMode(MderAvan,HIGH);
pinMode(MizqAvan,HIGH);
pinMode(MderAtras,LOW);
pinMode(MizqAtras,LOW);
}
void atras(){
pinMode(MderAvan,LOW);
pinMode(MizqAvan,LOW);
pinMode(MderAtras,HIGH);
pinMode(MizqAtras,HIGH);
}
void girar(){
pinMode(MderAvan,LOW);
pinMode(MizqAvan,LOW);
pinMode(MderAtras,LOW);
pinMode(MizqAtras,LOW);
}
void loop()
{
avanzar();
delay(10000);
atras();
delay(10000);
girar();
delay(10000);
}
