// Pinos do sensor HC-SR04
#define pino_trigger 19
#define pino_echo 18

// Pinos definidos para os Led's
#define led_verde 2 //Objeto distante
#define led_vermelho 4 //Objeto proximo

// Definição de variaveis 
long tempo_onda=0;
float velocidade_som = 0.034; // velocidade Som no Ar 340ms
float distancia_cm=0;

void setup() {
 Serial.begin(115200);
 pinMode(pino_trigger,OUTPUT);
 pinMode(pino_echo,INPUT);
 pinMode(led_verde,OUTPUT);
 pinMode(led_vermelho, OUTPUT);
}

void loop(){
  digitalWrite(pino_trigger,0);
  delayMicroseconds(2);
  digitalWrite(pino_trigger,1);
  delayMicroseconds(10);
  digitalWrite(pino_trigger,0);
  tempo_onda=pulseIn(pino_echo,1); //captura a duração do pulso
  distancia_cm=tempo_onda*velocidade_som/2; //Cálculo da distançia
  Serial.println("Velocidade em cm --> ");
  Serial.println(distancia_cm);
  if(distancia_cm<40){
    Serial.println("Objeto esta perto");
    digitalWrite(led_vermelho,1);
    digitalWrite(led_verde,0);
  }
  else{
  Serial.println("Objeto esta longe");
  digitalWrite(led_vermelho,0);
  digitalWrite(led_verde,1);
  }
  delay(1000);
}