#include <Servo.h>

const int trigPin = 2;
const int echoPin = 1;
const int ledPins[] = {3,4, 5, 6, 7, 8,9,10,11}; // Pines para la barra LED
const int buzzerPin = 12; // Pin para el zumbador
Servo servoMotor;

void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  servoMotor.attach(13); // Pin del servomotor
  for (int i = 0; i < sizeof(ledPins)/sizeof(ledPins[0]); i++) {
    pinMode(ledPins[i], OUTPUT);
  }
  pinMode(buzzerPin, OUTPUT);
  Serial.begin(9600);
}

void loop() {
  long duration, distance;
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);
  distance = (duration / 2) / 29.1; // Distancia en centímetros
  
  // Mapeo de la distancia para encender LEDs
  int numLedsToTurnOn = map(distance, 0, 200, 0, sizeof(ledPins)/sizeof(ledPins[0]));
  for (int i = 0; i < sizeof(ledPins)/sizeof(ledPins[0]); i++) {
    digitalWrite(ledPins[i], i < numLedsToTurnOn ? HIGH : LOW);
  }
  
  // Control del servomotor
  int angle = map(distance, 0, 200, 0, 180);
  servoMotor.write(angle);
  
  // Control del zumbador
  if (distance >200) {
    tone(buzzerPin, 600); // Generar un tono de 1000Hz
  } else {
    noTone(buzzerPin); // Detener el tono si la distancia es mayor que 20 cm
  }
  
  Serial.print("Distance: ");
  Serial.println(distance);
  delay(500);
}