//exercicio 1
// Gabriel Lisboa Leite de Melo


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

void setup() {
servo1.attach(6);
servo2.attach(5);
  servo1.write(0);
  servo2.write(0);
  Serial.begin(115200);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
}

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

 int distanciaCM = (duration/58);

 int servo1pos = map(distanciaCM, 12, 15, 0, 180);
 int servo2pos = map(distanciaCM, 17, 23, 0, 180);
  if (distanciaCM > 15) servo1pos = 180;
  if (distanciaCM > 23) servo2pos = 180;
 servo1.write(servo1pos);
 servo2.write(servo2pos);
  

  delay(1000);
}