int duracao,duracao2;
//configura ultrasonic
#include <Ultrasonic.h>
#define PINO_TRIGGER1 8
#define PINO_ECHO1 7
#define PINO_TRIGGER2 4
#define PINO_ECHO2 5
//configura servo
#include <Servo.h>
Servo servo;
void setup() {
//ultrassonic direita
pinMode(PINO_TRIGGER1, OUTPUT);
pinMode(PINO_ECHO1, INPUT);
//ultrassonic esquerda
pinMode(PINO_TRIGGER2, OUTPUT);
pinMode(PINO_ECHO2, INPUT);
//pino do servo
servo.attach(3);
}
void loop() {
//Sensor 1, direita
digitalWrite(PINO_TRIGGER1, HIGH);
delayMicroseconds(10);
digitalWrite(PINO_TRIGGER1, LOW);
duracao = pulseIn(PINO_ECHO1, HIGH);
float D = duracao * 0.034 / 2 ;
//Sensor 2, esquerda
digitalWrite(PINO_TRIGGER2, HIGH);
delayMicroseconds(10);
digitalWrite(PINO_TRIGGER2, LOW);
duracao2 = pulseIn(PINO_ECHO2, HIGH);
float D2 = duracao2 * 0.034 / 2 ;
if(D < D2){
servo.write(180);
}
if(D > D2){
servo.write(0);
}
/*
if(D > 150 && D < 200 && D2 > 150 && D2 < 200 || D == D2){
servo.write(90); xD n usa isso krl, mta coisa
}*/
if(D > 150 && D2 > 150);
}