// Exercício 1
// Breno Correia Lociks

#include <Servo.h>

Servo servo1;
Servo servo2;

#define PIN_ECHO 2
#define PIN_TRIG 3

void setup() {
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);

  servo1.attach(5);
  servo2.attach(6);
}

void loop() {
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  int duration = pulseIn(PIN_ECHO, HIGH);

  int distCM = duration / 58;

  int CMmap1 = map(distCM, 12, 15, 0, 180);
  int CMmap2 = map(distCM, 17, 23, 0, 180);

  servo1.write(CMmap1);
  servo2.write(CMmap2);

  delay(1000);
}