#define PIN_TRIG 3
#define PIN_ECHO 2
#define vaga_on 4
#define vaga_off 5

#define cota 200
int distancia=0;

void setup() {
  Serial.begin(115200);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(vaga_on, OUTPUT);
  pinMode(vaga_off, OUTPUT);

}

void loop() {

  distancia=(dist(PIN_TRIG,PIN_ECHO,distancia)/58);
  Serial.println(distancia);
  if(distancia>=cota){
    digitalWrite(vaga_off, HIGH);
    digitalWrite(vaga_on, LOW);
  }else {
    digitalWrite(vaga_on, HIGH);
    digitalWrite(vaga_off, LOW);
  }
  delay(100);
}

//Função do ultrassom

  int dist(int X,int Y,int duration){
    digitalWrite(X, HIGH);
    delayMicroseconds(10);
    digitalWrite(X, LOW);
    duration = pulseIn(Y, HIGH);
    return duration;
 }