Sensor Ultrasonico

Aquí les dejo el código para su NBRobot usándolo con sensor de Ultrasonido

Recuerden colocar cada cable en su respectivo lugar, ok.

Copiar y pegar en un nuevo archivo, ojo no vayan a duplicar la función SETUP y LOOP
solo debe existir una, y ya están incluidas en este código.


//+++++++++++++++++++++++++++++++++++++++++++++

#define ECO 12              //Pin eco del Sensor
#define TRIGER 11       //Pin de disparo del Sensor
#define RED 10
#define YELLOW 9
#define GREEN 8
long DURACION, DISTANCIA;


void setup() {
  // put your setup code here, to run once:
  pinMode(ECO,INPUT);         //ENTRADA DE ULTRASONIDO=ECO
  pinMode(TRIGER,OUTPUT);     //PIN DE DISPARO
  digitalWrite(TRIGER,LOW);   //DISPARO =LOW =0 VOLTS
  pinMode(RED,OUTPUT);        //LED RED
  pinMode(YELLOW,OUTPUT);     //LED YELLOW
  pinMode(GREEN,OUTPUT);      //LED GREEN
  Serial.begin(9600);
}

void loop() {
  // put your main code here, to run repeatedly:

  digitalWrite(TRIGER,HIGH);  //ON DISPARO
  delayMicroseconds(10);      //DELAY 10Ms
  digitalWrite(TRIGER,LOW);   //OFF DISPARO

  DURACION=pulseIn(ECO,HIGH); 
  DISTANCIA=(DURACION/2)/29;
  Serial.print(DISTANCIA);
  Serial.println("cm");



  if(DISTANCIA<20){         //POSIBLE COLISION
    digitalWrite(RED,HIGH); //ON RED   
    digitalWrite(YELLOW,LOW);
    digitalWrite(GREEN,LOW);
  }

  if(DISTANCIA>20 && DISTANCIA<60){//PRECAUSION
    digitalWrite(RED,LOW);    
    digitalWrite(YELLOW,HIGH);    //ON YELLOW
    digitalWrite(GREEN,LOW);
  }

  if(DISTANCIA>60){           //NO PROBLEM
    digitalWrite(RED,LOW);    
    digitalWrite(YELLOW,LOW);
    digitalWrite(GREEN,HIGH); //ON GREEN
  }

  delay(500);                 //ESPERA 0.5 SEGUNDOS

}

//+++++++++++++++++++++++++++++++++++++++++++++
OJO: si dan click en la pantalla del Software Arduino donde dice Monitor Serie y dejan conectado el cable USB a su placa
podrán ver la "medida de la distancias en centímetros" de los objetos que estén frente al sensor. Ok.  :)

Les deseo mucho éxito

y sigamos programando!!!