//#include "Ultrasonic.h"
#define PIN_TRIG 6
#define PIN_ECHO 5
#define verd 4
#define amar 3
#define verm 2

#include <LiquidCrystal.h>

LiquidCrystal lcd(12, 11, 10, 9, 8, 7);
//Ultrasonic ultra(6,5);
double tempo, m, inch;
void setup()
{
  Serial.begin(115200);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(verd, OUTPUT);
  pinMode(amar, OUTPUT);
  pinMode(verm, OUTPUT);
  
  lcd.begin(16, 2);
  lcd.setCursor(0,0);
  lcd.print("M =");
  lcd.setCursor(0,1);
  lcd.print("IN =");


  

}

void loop() {
  
  // Inicia uma nova medição:
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  // Leia o resultado:
  tempo = pulseIn(PIN_ECHO, HIGH);
  lcd.setCursor(5,0);
  m = ((tempo/58)/100);
  lcd.print(m);

  lcd.setCursor(5,1);
  inch = (tempo/148);
  lcd.print(tempo / 148);

  verif();

  delay(100);
}
void verif()
{
  if(m < 0.50)
  {
    digitalWrite(verm, HIGH);
    delay(100);
    digitalWrite(verm, LOW);
    delay(100);
  }
  else if(m < 1.00)
  {
    digitalWrite(amar, HIGH);
    delay(100);
    digitalWrite(amar, LOW);
    delay(100);

  }
  else
  {
    digitalWrite(verd, HIGH);
    delay(100);
    digitalWrite(verd, LOW);
    delay(100);
  }
 


}