//exercício 2
//Felipe Vieira Conway Baccarat

#define PIN_TRIG_1 5
#define PIN_ECHO_1 4
#define PIN_TRIG_2 3
#define PIN_ECHO_2 2
#include <Servo.h>
Servo servo1;
Servo servo2;

void setup() {
  pinMode(PIN_TRIG_1, OUTPUT);
  pinMode(PIN_TRIG_2, OUTPUT);
  pinMode(PIN_ECHO_1, INPUT);
  pinMode(PIN_ECHO_2, INPUT);
  servo1.attach(9);
  servo2.attach(10);
}

void loop() {
  // Inicia medição do sensor 1:
  digitalWrite(PIN_TRIG_1, HIGH);
    delayMicroseconds(10);
      digitalWrite(PIN_TRIG_1, LOW);
        int duration1 = pulseIn(PIN_ECHO_1, HIGH); //calcula a distancia do sensor 1
  int distanciaCM_1 = (duration1 / 58);

  // Inicia medição do sensor 2:
  digitalWrite(PIN_TRIG_2, HIGH);
    delayMicroseconds(10);
     digitalWrite(PIN_TRIG_2, LOW);
       int duration2 = pulseIn(PIN_ECHO_2, HIGH);//calcula a distancia do sensor 2
  int distanciaCM_2 = (duration2 / 58);

  delay(100);

if (distanciaCM_1 <= 3) {
  int posServo1 = 180;
  servo1.write(posServo1);
}
else if (distanciaCM_1 > 10) {
  int posServo1 = 0;
  servo1.write(posServo1);
}

if (distanciaCM_2 <= 3) {
  int posServo2 = 0;
  servo2.write(posServo2);
}
else if (distanciaCM_2 > 10) {
  int posServo2 = 180;
  servo2.write(posServo2);
}

delay(100);
}