Add VL53L0 distance sensor.

Added new Environment Telemetry class VL53L0XSensor.
Tested with a Heltec V3.

Author: smavridis

platformio.ini

@@ -199,6 +199,8 @@ lib_deps =
 	adafruit/Adafruit SHT31 Library@2.2.2
 	# renovate: datasource=custom.pio depName=Adafruit VEML7700 packageName=adafruit/library/Adafruit VEML7700 Library
 	adafruit/Adafruit VEML7700 Library@2.1.6
+	# renovate: datasource=custom.pio depName=Adafruit VL53L0X packageName=adafruit/library/Adafruit VL53L0X
+	adafruit/Adafruit_VL53L0X@^1.2.4
 	# renovate: datasource=custom.pio depName=Adafruit SHT4x packageName=adafruit/library/Adafruit SHT4x Library
 	adafruit/Adafruit SHT4x Library@1.0.5
 	# renovate: datasource=custom.pio depName=SparkFun Qwiic Scale NAU7802 packageName=sparkfun/library/SparkFun Qwiic Scale NAU7802 Arduino Library

src/configuration.h

@@ -225,6 +225,7 @@ along with this program.  If not, see <http://www.gnu.org/licenses/>.
 #define AHT10_ADDR 0x38
 #define RCWL9620_ADDR 0x57
 #define VEML7700_ADDR 0x10
+#define VL530X_ADDR 0x29
 #define TSL25911_ADDR 0x29
 #define OPT3001_ADDR 0x45
 #define OPT3001_ADDR_ALT 0x44

src/detect/ScanI2C.h

@@ -50,6 +50,7 @@ class ScanI2C
         TCA9535,
         TCA9555,
         VEML7700,
+        VL53L0X,
         RCWL9620,
         NCP5623,
         LP5562,

src/detect/ScanI2CTwoWire.cpp

@@ -566,12 +566,21 @@ void ScanI2CTwoWire::scanPort(I2CPort port, uint8_t *address, uint8_t asize)
                 break;
             case TSL25911_ADDR:
                 registerValue = getRegisterValue(ScanI2CTwoWire::RegisterLocation(addr, 0xA0 | 0x12), 1);
-                if (registerValue == 0x50) {
-                    type = TSL2591;
-                    logFoundDevice("TSL25911", (uint8_t)addr.address);
-                } else {
-                    type = TSL2561;
-                    logFoundDevice("TSL2561", (uint8_t)addr.address);
+                switch (registerValue) {
+                    case 0x00 ... 0x04:
+                        type = VL53L0X;
+                        logFoundDevice("VL53L0X", (uint8_t)addr.address);
+                        break;
+                    case 0x50:
+                        type = TSL2591;
+                        logFoundDevice("TSL25911", (uint8_t)addr.address);
+                        break;
+                    case 0x51 ... 0x57:
+                        type = TSL2561;
+                        logFoundDevice("TSL2561", (uint8_t)addr.address);
+                        break;
+                    default:
+                        break;
                 }
                 break;
 

src/mesh/generated/meshtastic/telemetry.pb.h

@@ -111,7 +111,9 @@ typedef enum _meshtastic_TelemetrySensorType {
     /* Sensirion STC31 CO2 sensor */
     meshtastic_TelemetrySensorType_STC31 = 48,
     /* SCD30 CO2, humidity, temperature sensor */
-    meshtastic_TelemetrySensorType_SCD30 = 49
+    meshtastic_TelemetrySensorType_SCD30 = 49,
+    /* VL53L0X distance sensor */
+    meshtastic_TelemetrySensorType_VL53L0X = 50
 } meshtastic_TelemetrySensorType;
 
 /* Struct definitions */
@@ -489,8 +491,8 @@ extern "C" {
 
 /* Helper constants for enums */
 #define _meshtastic_TelemetrySensorType_MIN meshtastic_TelemetrySensorType_SENSOR_UNSET
-#define _meshtastic_TelemetrySensorType_MAX meshtastic_TelemetrySensorType_SCD30
-#define _meshtastic_TelemetrySensorType_ARRAYSIZE ((meshtastic_TelemetrySensorType)(meshtastic_TelemetrySensorType_SCD30+1))
+#define _meshtastic_TelemetrySensorType_MAX meshtastic_TelemetrySensorType_VL53L0X
+#define _meshtastic_TelemetrySensorType_ARRAYSIZE ((meshtastic_TelemetrySensorType)(meshtastic_TelemetrySensorType_VL53L0X+1))
 
 
 

src/modules/Telemetry/EnvironmentTelemetry.cpp

@@ -85,6 +85,10 @@ extern void drawCommonHeader(OLEDDisplay *display, int16_t x, int16_t y, const c
 #include "Sensor/VEML7700Sensor.h"
 #endif
 
+#if __has_include(<Adafruit_VL53L0X.h>)
+#include "Sensor/VL53L0XSensor.h"
+#endif
+
 #if __has_include(<Adafruit_TSL2591.h>)
 #include "Sensor/TSL2591Sensor.h"
 #endif
@@ -214,6 +218,9 @@ void EnvironmentTelemetryModule::i2cScanFinished(ScanI2C *i2cScanner)
 #if __has_include(<Adafruit_VEML7700.h>)
     addSensor<VEML7700Sensor>(i2cScanner, ScanI2C::DeviceType::VEML7700);
 #endif
+#if __has_include(<Adafruit_VL53L0X.h>)
+    addSensor<VL53L0XSensor>(i2cScanner, ScanI2C::DeviceType::VL53L0X);
+#endif
 #if __has_include(<Adafruit_TSL2591.h>)
     addSensor<TSL2591Sensor>(i2cScanner, ScanI2C::DeviceType::TSL2591);
 #endif

src/modules/Telemetry/Sensor/VL53L0XSensor.cpp

@@ -0,0 +1,39 @@
+#include "configuration.h"
+#include <memory>
+
+#if !MESHTASTIC_EXCLUDE_ENVIRONMENTAL_SENSOR && __has_include(<Adafruit_VL53L0X.h>)
+
+#include "../mesh/generated/meshtastic/telemetry.pb.h"
+#include "TelemetrySensor.h"
+#include "VL53L0XSensor.h"
+
+#include <Adafruit_VL53L0X.h>
+#include <typeinfo>
+
+VL53L0XSensor::VL53L0XSensor() : TelemetrySensor(meshtastic_TelemetrySensorType_VL53L0X, "VL53L0X") {}
+
+bool VL53L0XSensor::initDevice(TwoWire *bus, ScanI2C::FoundDevice *dev)
+{
+    LOG_INFO("Init sensor: %s", sensorName);
+    status = vl53l0x.begin(VL53L0X_I2C_ADDR, false, bus);
+    if (!status) {
+        return status;
+    }
+
+    initI2CSensor();
+    return status;
+}
+
+bool VL53L0XSensor::getMetrics(meshtastic_Telemetry *measurement)
+{
+    VL53L0X_RangingMeasurementData_t measure;
+    vl53l0x.rangingTest(&measure, false);
+
+    measurement->variant.environment_metrics.has_distance = true;
+    measurement->variant.environment_metrics.distance = measure.RangeMilliMeter;
+
+    LOG_INFO("distance %f", measurement->variant.environment_metrics.distance);
+
+    return true;
+}
+#endif

src/modules/Telemetry/Sensor/VL53L0XSensor.h

@@ -0,0 +1,20 @@
+#include "configuration.h"
+
+#if !MESHTASTIC_EXCLUDE_ENVIRONMENTAL_SENSOR && __has_include(<Adafruit_VL53L0X.h>)
+
+#include "../mesh/generated/meshtastic/telemetry.pb.h"
+#include "TelemetrySensor.h"
+#include <Adafruit_VL53L0X.h>
+
+class VL53L0XSensor : public TelemetrySensor
+{
+  private:
+
+    Adafruit_VL53L0X vl53l0x;
+
+  public:
+    VL53L0XSensor();
+    virtual bool getMetrics(meshtastic_Telemetry *measurement) override;
+    virtual bool initDevice(TwoWire *bus, ScanI2C::FoundDevice *dev) override;
+};
+#endif