#include "VL53L1X.h"
#include "Wire.h"

VL53L1X sensor;

void sensor_init(VL53L1X::DistanceMode range_mode, bool high_speed) {
  Wire.begin();
  sensor.setTimeout(500);
  sensor.init();
  sensor.setDistanceMode(range_mode);  
  int budget = high_speed ? 33000 : 140000;
  sensor.setMeasurementTimingBudget(budget);
}

void setup() {
  Serial.begin(115200);
  sensor_init(VL53L1X::Medium, false); // The sensor is initialized with a medium range mode and high speed disabled.

}

void loop() {
  int dist = sensor.readRangeSingleMillimeters();
  Serial.println(dist);
  delay(1000);

  Wire.beginTransmission(0x65);

  const char message[] = "ongelofelijk";
  Wire.write((uint8_t*)message, sizeof(message) - 1); // Send the byte array

  Wire.endTransmission();
  delay(1000);
}