#include <Wire.h>
#include <VL53L0X.h>

VL53L0X sensor;
const int motorPin = D10; // Pin de salida PWM para el motor vibrador

void setup() {
  Serial.begin(9600); // Iniciar comunicación serial
  Wire.begin(); // Inicializar la comunicación I2C
  sensor.init(); // Inicializar el sensor
  sensor.setTimeout(500);
  sensor.startContinuous(); // Iniciar la medición continua
  pinMode(motorPin, OUTPUT); // Configurar el pin del motor como salida
}

void loop() {
  uint16_t distance = sensor.readRangeContinuousMillimeters(); // Leer distancia
  Serial.print("Distancia: ");
  Serial.print(distance);
  Serial.println(" mm");

  // Mapear la distancia leída al rango PWM
  int motorSpeed = map(distance, 20, 100, 255, 0);
  motorSpeed = constrain(motorSpeed, 0, 255); // Asegurarse de que el valor PWM esté en el rango
  
  // Controlar la velocidad del motor vibrador mediante PWM
  analogWrite(motorPin, motorSpeed);

 // delay(500); // Esperar un breve período antes de realizar la próxima lectura
}