#include <Servo.h>

const int pinoTrig = 13;
const int pinoEcho = 12;
const int pinoServo = 8;
const int pinoLed = 10;
const int pinoBuzzer = 11;

Servo servoMotor;

long tempoPulso = 0;
int distanciaCm = 0;
int posicaoServo = 0;
bool aumentandoAngulo = true;

void setup() {
  pinMode(pinoTrig, OUTPUT);
  pinMode(pinoEcho, INPUT);
  pinMode(pinoLed, OUTPUT);
  pinMode(pinoBuzzer, OUTPUT);

  servoMotor.attach(pinoServo);

  Serial.begin(9600);
}

void loop() {
  servoMotor.write(posicaoServo);

  if (aumentandoAngulo) {
    posicaoServo++;

    if (posicaoServo >= 180) {
      aumentandoAngulo = false;
    }
  } else {
    posicaoServo--;

    if (posicaoServo <= 0) {
      aumentandoAngulo = true;
    }
  }

  digitalWrite(pinoTrig, LOW);
  delayMicroseconds(2);

  digitalWrite(pinoTrig, HIGH);
  delayMicroseconds(10);

  digitalWrite(pinoTrig, LOW);

  tempoPulso = pulseIn(pinoEcho, HIGH);
  distanciaCm = tempoPulso * 0.034 / 2;

  if (distanciaCm > 0 && distanciaCm < 50) {
    digitalWrite(pinoLed, HIGH);

    int tomBuzzer = map(distanciaCm, 2, 50, 2000, 500);
    tone(pinoBuzzer, tomBuzzer);
  } else {
    digitalWrite(pinoLed, LOW);
    noTone(pinoBuzzer);
  }

  delay(20);
}