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

#define PIN_TRIG 3
#define PIN_ECHO 2
#include <Servo.h>
Servo servo1;
Servo servo2;

void setup() {
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  servo1.attach(9);
  servo2.attach(10);
}

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

  // Leia o resultado:
  int duration = pulseIn(PIN_ECHO, HIGH);
  int distanciaCM = (duration / 58);

  delay(1000);

int posServo1 = map(distanciaCM, 12, 15, 0, 180);
int posServo2 = map(distanciaCM, 17, 23, 0, 180);

if (distanciaCM > 15) posServo1 = 180;
if (distanciaCM > 23) posServo2 = 180;

servo1.write(posServo1);
servo2.write(posServo2);
delay(50);
}