///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
////////////////////////////////////   PROGRAMA CONTROL DISTANCIA   ///////////////////////////////////////////////////////////////////////////////
/////////////////////////////////////////////   ULTRASONS   //////////////////////////////////////////////////////////////////////////////////////////


// Definimos os pins da placa arduino que se empregarían para o sensor de ultrasons. 

//Temos que ter coidado de non empregar ningún dos pins reservados pola librería do lector RFID 11, 12 e 13, en caso contrario o sensor non funcionará

const int EchoPin = 5; // Temos que colocar entre o pin Echo de arduino e o Trigger una resitencia de 1 kilo ohm
const int TriggerPin = 6;


void setup() 
{
Serial.begin(9600); // Inicializamos a comunicación serie


//Configuramos a o pin de emisión de ultrasons como saída e o que recibe o rebote como entrada

  pinMode(TriggerPin, OUTPUT);
  pinMode(EchoPin, INPUT);

}


void loop() 
{

//arrancamos o sensor de ultrasons creando unha variable cm que nos indicará a distancia á cal temos un obxecto en centímetros e mostramos esta distancia no monitor serie

int cm = mide(TriggerPin, EchoPin);
Serial.print("Distancia en cm: ");
Serial.println(cm);
delay(2000);

}

 

//Creamos o bucle de traballo propio do sensor de ultrasons

int mide(int TriggerPin, int EchoPin)
  {
  long duracion, distanciaCm;
  digitalWrite(TriggerPin, LOW);
  delayMicroseconds(4);
  digitalWrite(TriggerPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(TriggerPin, LOW);
  duracion = pulseIn(EchoPin, HIGH)/2;
  distanciaCm = duracion * 10 / 292;
  return distanciaCm;
}