From a0c657a418cac449c31f6a2f0dae208eec9d2202 Mon Sep 17 00:00:00 2001
From: Ollo <ollo@ollo.mobil>
Date: Wed, 22 Mar 2023 20:02:23 +0100
Subject: [PATCH] VL53L0X test started

---
 esp32test/Esp32DeepSleepTest/platformio.ini |  3 +-
 esp32test/Esp32DeepSleepTest/src/main.cpp   | 79 ++++++++++-----------
 2 files changed, 39 insertions(+), 43 deletions(-)

diff --git a/esp32test/Esp32DeepSleepTest/platformio.ini b/esp32test/Esp32DeepSleepTest/platformio.ini
index 777b595..1733f51 100644
--- a/esp32test/Esp32DeepSleepTest/platformio.ini
+++ b/esp32test/Esp32DeepSleepTest/platformio.ini
@@ -12,6 +12,5 @@
 platform = espressif32
 board = esp32doit-devkit-v1
 framework = arduino
-lib_deps = OneWire
-            DallasTemperature
+lib_deps = pololu/VL53L0X@^1.3.1
 build_flags = -DPIO_FRAMEWORK_ARDUINO_LWIP2_LOW_MEMORY -DBOOTLOADER_LOG_LEVEL_VERBOSE -DLOG_DEFAULT_LEVEL_VERBOSE -DCORE_DEBUG_LEVEL=5
diff --git a/esp32test/Esp32DeepSleepTest/src/main.cpp b/esp32test/Esp32DeepSleepTest/src/main.cpp
index 76edff7..bea0eec 100644
--- a/esp32test/Esp32DeepSleepTest/src/main.cpp
+++ b/esp32test/Esp32DeepSleepTest/src/main.cpp
@@ -1,61 +1,58 @@
 #include <Arduino.h>
-#include "driver/pcnt.h" 
+#include "driver/pcnt.h"
+#include <VL53L0X.h>
 
-#define PWM_FREQ 50000
-#define PWM_BITS 8
 
 #define OUTPUT_SENSOR       14
 #define SENSOR_PLANT        17
 
-int16_t         pulses        = 0; 
-int16_t         pulses2        = 0; 
+VL53L0X tankSensor;
 
-int plantId = 0;
-
-void setup() {
-RTC_SLOW_ATTR uint8_t tick = 0;
-RTC_SLOW_ATTR bool dir = true;
 void setup()
 {
   Serial.begin(115200);
   pinMode(OUTPUT_SENSOR, OUTPUT);
-
-  ledcSetup(plantId, PWM_FREQ, PWM_BITS);
-  ledcAttachPin(SENSOR_PLANT, plantId);
-  ledcWrite(plantId, plantId);
-  pinMode(SENSOR_PLANT, INPUT);
-
-
-  pcnt_config_t pcnt_config = { };                                        // Instancia PCNT config
-  pcnt_unit_t unit = (pcnt_unit_t)(PCNT_UNIT_0 + plantId);
-  pcnt_config.pulse_gpio_num = SENSOR_PLANT;                         // Configura GPIO para entrada dos pulsos
-  pcnt_config.ctrl_gpio_num = PCNT_PIN_NOT_USED;                         // Configura GPIO para controle da contagem
-  pcnt_config.unit = unit;                                          // Unidade de contagem PCNT - 0
-  pcnt_config.channel = PCNT_CHANNEL_0;                               // Canal de contagem PCNT - 0
-  pcnt_config.counter_h_lim = INT16_MAX;                             // Limite maximo de contagem - 20000
-  pcnt_config.pos_mode = PCNT_COUNT_INC;                                  // Incrementa contagem na subida do pulso
-  pcnt_config.neg_mode = PCNT_COUNT_DIS;                                  // Incrementa contagem na descida do pulso
-  pcnt_config.lctrl_mode = PCNT_MODE_KEEP;                             // PCNT - modo lctrl desabilitado
-  pcnt_config.hctrl_mode = PCNT_MODE_KEEP;                                // PCNT - modo hctrl - se HIGH conta incrementando
-  pcnt_unit_config(&pcnt_config);                                         // Configura o contador PCNT
-
-
-  pcnt_counter_pause(PCNT_UNIT_0);                                    // Pausa o contador PCNT
-  pcnt_counter_clear(PCNT_UNIT_0);                                    // Zera o contador PCNT
-
+  tankSensor.setTimeout(500);
 
   digitalWrite(OUTPUT_SENSOR, HIGH);
   Serial.println("Nodemcu ESP32 Start done");
+
+  tankSensor.setTimeout(500);
+  long start = millis();
+  bool distanceReady = false;
+  while (start + 500 > millis())
+  {
+    if (tankSensor.init())
+    {
+      distanceReady = true;
+      break;
+    }
+    else
+    {
+      delay(20);
+    }
+  }
+
+  if (distanceReady)
+  {
+    Serial.println("Sensor init done");
+    tankSensor.setSignalRateLimit(0.1);
+    // increase laser pulse periods (defaults are 14 and 10 PCLKs)
+    tankSensor.setVcselPulsePeriod(VL53L0X::VcselPeriodPreRange, 18);
+    tankSensor.setVcselPulsePeriod(VL53L0X::VcselPeriodFinalRange, 14);
+    tankSensor.setMeasurementTimingBudget(200000);
+  } else {
+    Serial.println("Sensor init failed");
+  }
 }
 
 void loop() { 
-    pcnt_counter_resume(PCNT_UNIT_0);
     
-    delay(500);
+  delay(500);
     
-    pcnt_counter_pause(PCNT_UNIT_0); 
-    pcnt_get_counter_value(PCNT_UNIT_0, &pulses);
-    pcnt_counter_clear(PCNT_UNIT_0);
-    
-    Serial.println(pulses*2);
+   
+  if (!tankSensor.timeoutOccurred())
+  {
+    uint16_t distance = tankSensor.readRangeSingleMillimeters();
+  }
 }