Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Codigo Gorra Comentado
Codigo Gorra Comentado
//Funcion que limpia los sensores de cualquier valor y lee el tiempo que tarda en
regresar la onda amitida
long readUltrasonicDistance(int triggerPin, int echoPin)
{
pinMode(triggerPin, OUTPUT); // Clear the trigger
digitalWrite(triggerPin, LOW);
delayMicroseconds(2);
// Sets the trigger pin to HIGH state for 10 microseconds
digitalWrite(triggerPin, HIGH);
delayMicroseconds(10);
digitalWrite(triggerPin, LOW);
pinMode(echoPin, INPUT);
// Reads the echo pin, and returns the sound wave travel time in microseconds
return pulseIn(echoPin, HIGH);
}
}
}
}
delay(300);
// measure the ping time in cm
frontSensor = 0.01723 * readUltrasonicDistance(6, 7);
rightSensor = 0.01723 * readUltrasonicDistance(8, 9);
leftSensor = 0.01723 * readUltrasonicDistance(10, 11);
}else{
if(leftSensor<70){
sonar("izquierdo");
delay(200);
if(frontSensor<180){
sonar("frontal");
delay(200);
}
if(rightSensor<70){
sonar("derecho");
delay(200);
}
}
else{
if(frontSensor<180){
sonar("frontal");
delay(200);
if(rightSensor<70){
sonar("derecho");
delay(200);
}
if(leftSensor<70){
sonar("izquierdo");
delay(200);