//exercicio 2
// Gabriel Lisboa Leite de Melo


#include <Servo.h>
Servo servo1;
Servo servo2;
int servo1pos;
int servo2pos;
#define PIN_TRIG1 3
#define PIN_ECHO1 2
#define PIN_TRIG2 5
#define PIN_ECHO2 4

void setup() {
servo1.attach(10);
servo2.attach(9);
  servo1.write(0);
  servo2.write(180);
  Serial.begin(115200);
  pinMode(PIN_TRIG1, OUTPUT);
  pinMode(PIN_ECHO1, INPUT);
  pinMode(PIN_TRIG2, OUTPUT);
  pinMode(PIN_ECHO2, INPUT);
}

void loop() {
  // Inicia uma nova medição:
  digitalWrite(PIN_TRIG1, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG1, LOW);
  digitalWrite(PIN_TRIG2, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG2, LOW);
   int duration1 = pulseIn(PIN_ECHO1, HIGH);
   int duration2 = pulseIn(PIN_ECHO2, HIGH);

 int distanciaCM1 = (duration1/58);
 int distanciaCM2 = (duration2/58);

if (distanciaCM1 <= 3) {
  servo1pos = 180;
  servo1.write(servo1pos);
}
  else if(distanciaCM1 >= 10)
  {
    servo1pos = 0;
    servo1.write(servo1pos);
  }

  if (distanciaCM2 <= 3) 
  {
    servo2pos = 0;
 servo2.write(servo2pos);
  }
else if(distanciaCM2 >=10 ){
  servo2pos = 180;
  servo2.write(servo2pos);
}
  delay(1000);
}