#include <Servo.h>
#include <HCSR04.h>
#define servoMotor 9
#define echo 13
#define trigger 12
int duracao;
int distancia;
int grau = 0;
// instanciar os objtos da biblioteca
Servo servo1;
UltraSonicDistanceSensor ultrasonic(trigger, echo);
void setup() {
Serial.begin(9600);
servo1.attach(servoMotor);
}
void loop() {
for(grau=15;grau <=165;grau++){
servo1.write(grau);
delay(30);
digitalWrite(trigger, LOW);
delayMicroseconds(2);
digitalWrite(trigger, HIGH);
delayMicroseconds(10);
digitalWrite(trigger,LOW);
duracao = pulseIn(trigger, HIGH);
distancia = duracao*0.034/2;
Serial.print(servo1.read());
// Serial.print("º");
Serial.print(",");
Serial.print(distancia);
// Serial.println(".");
}
for(grau=165;grau >15;grau--){
servo1.write(grau);
delay(30);
digitalWrite(trigger, LOW);
delayMicroseconds(2);
digitalWrite(trigger, HIGH);
delayMicroseconds(10);
digitalWrite(trigger,LOW);
duracao = pulseIn(trigger, HIGH);
distancia = duracao*0.034/2;
Serial.print(servo1.read());
//Serial.print("º");
Serial.print(",");
Serial.print(distancia);
//Serial.println(".");
}
}