// Exercício 2
// Breno Correia Lociks

#include <Servo.h>

Servo servo1;
Servo servo2;

#define PIN_ECHO1 8
#define PIN_TRIG1 9
#define PIN_ECHO2 2
#define PIN_TRIG2 3

void setup() {
  pinMode(PIN_TRIG1, OUTPUT);
  pinMode(PIN_ECHO1, INPUT);
  pinMode(PIN_TRIG2, OUTPUT);
  pinMode(PIN_ECHO2, INPUT);

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

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

  int duration1 = pulseIn(PIN_ECHO1, HIGH);
  
  digitalWrite(PIN_TRIG2, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG2, LOW);

  int duration2 = pulseIn(PIN_ECHO2, HIGH);

  int distCM1 = duration1 / 58;
  int distCM2 = duration2 / 58;

  int CMmap1 = map(distCM1, 3, 10, 180, 0);
  int CMmap2 = map(distCM2, 3, 10, 0, 180);

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

  delay(1000);
}