//  Capteur de telemetrie laser GY-VL53L0XV2 et afficheur OLED

// carte NANO

#include <Wire.h>
#include "Adafruit_VL53L0X.h"
#include <SPI.h>
#include <Adafruit_SSD1306.h>

Adafruit_SSD1306 display = Adafruit_SSD1306();
Adafruit_VL53L0X lox = Adafruit_VL53L0X();

void setup()
{
  Serial.begin(9600);  
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);  // initialiser avec l'adresse I2C 0x3C  
  Wire.begin();                               // initialiser la communication I2C

 if (!lox.begin()) {
    Serial.println(F("Failed to boot VL53L0X"));
    while(1);
  } 
}

void loop()
{
  VL53L0X_RangingMeasurementData_t measure;
  lox.rangingTest(&measure, false);
  display.setTextSize(3);
  display.setTextColor(WHITE);
  display.clearDisplay();

  if (measure.RangeStatus != 4) {  // mesure correcte
      display.setCursor(0,0);
      display.print(measure.RangeMilliMeter);
      display.print(" mm");
      delay(50);
  }
display.display();
}