#include <HCSR04.h>
#include <Servo.h>

Servo servo1;

#define TRIGGER_1 12
#define ECHO_1 11

#define TRIGGER_2 7 
#define ECHO_2 6   

UltraSonicDistanceSensor distanceSensor1(TRIGGER_1, ECHO_1);
UltraSonicDistanceSensor distanceSensor2(TRIGGER_2, ECHO_2); 

void setup() {
  servo1.attach(5);
}

void loop() {
 
    int esquerda = distanceSensor1.measureDistanceCm();
    int direita = distanceSensor2.measureDistanceCm();

    if (esquerda > 199 && direita < 200 ) {
      servo1.write(0);
     
    } else {
      servo1.write(90);
    }

    if (esquerda < 199 && direita > 200  ) {
      servo1.write(180); 
     
    } else {
      servo1.write(90);
      
    }
  }