/*
ETEC Aristóteles Ferreira
Ensino Médio Integrado com Técnico em Eletrônica
Controle de Motor com Dois Sensores Ultrassonicos

Andrey Celestino
Manuela Marques
Maria Luiza Rodrigues
*/ 

#include <Servo.h>

#define trigE 2
#define echoE 11

#define trigD 4
#define echoD 9

int distE = 0;
int distD = 0;


Servo servo;

void setup() {
  pinMode(trigE, OUTPUT);
  pinMode(echoE, INPUT);
  pinMode(trigD, OUTPUT);
  pinMode(echoD, INPUT);
  servo.attach(3);
}

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

  float duraE = pulseIn(echoE, HIGH);

  digitalWrite(trigD, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigD, LOW);

  float duraD = pulseIn(echoD, HIGH);

  float distE = duraE / 58;
  float distD = duraD / 58;


if((distD || distE > 31)
|| (distD > 25 && distE > 25)
){
  servo.write(90);
}

if(distD < 25 && (distD - 0.5) < distE){
  servo.write(180);
}

if(distE < 25 && (distE - 0.5) < distD){
  servo.write(0);
}

delay(100);

}