#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(".");

    }
  }