Added static VL53L0XSensor::getInstance() and setMode() to change Sensor mode using menu.

Author: smavridis

src/graphics/draw/MenuHandler.cpp

@@ -29,6 +29,7 @@
 #include <cmath>
 #include <functional>
 #include <utility>
+#include "modules/Telemetry/Sensor/VL53L0XSensor.h"
 
 extern uint16_t TFT_MESH;
 
@@ -1016,8 +1017,10 @@ void menuHandler::sensorsMenu()
     static int optionsEnumArray[2] = {Back, VL53L0X};
     int options = 1;
 
-    optionsArray[options] = "VL53L0X";
-    optionsEnumArray[options++] = VL53L0X;
+    if(VL53L0XSensor::getInstance()) {
+      optionsArray[options] = "VL53L0X";
+      optionsEnumArray[options++] = VL53L0X;
+    }
 
     BannerOverlayOptions bannerOptions;
     bannerOptions.message = "Sensors";
@@ -1046,18 +1049,18 @@ void menuHandler::sensorsVL53L0XMenu()
     bannerOptions.optionsArrayPtr = optionsArray;
     bannerOptions.optionsCount = 5;
     bannerOptions.bannerCallback = [](int selected) -> void {
+        VL53L0XSensor* vl = VL53L0XSensor::getInstance();
         if (selected == Back) {
             menuQueue = SensorsMenu;
         } else if (selected == Default) {
-        // TODO: set Sensitivity
+            vl->setMode(Adafruit_VL53L0X::VL53L0X_SENSE_DEFAULT);
         } else if (selected == LongRange) {
-        // TODO: set Sensitivity
+            vl->setMode(Adafruit_VL53L0X::VL53L0X_SENSE_LONG_RANGE);
         } else if (selected == HighSpeed) {
-        // TODO: set Sensitivity
+            vl->setMode(Adafruit_VL53L0X::VL53L0X_SENSE_HIGH_SPEED);
         } else if (selected == HighAccuracy) {
-        // TODO: set Sensitivity
+            vl->setMode(Adafruit_VL53L0X::VL53L0X_SENSE_HIGH_ACCURACY);
         }
-        // TODO: call VL50L0x::saveState();
     };
     screen->showOverlayBanner(bannerOptions);
 }

src/modules/Telemetry/Sensor/VL53L0XSensor.cpp

@@ -19,6 +19,21 @@
 #include <pb_decode.h>
 #include <pb_encode.h>
 
+static VL53L0XSensor* instance = 0;
+
+VL53L0XSensor* VL53L0XSensor::getInstance()
+{
+    return instance;
+}
+
+void VL53L0XSensor::setMode(Adafruit_VL53L0X::VL53L0X_Sense_config_t mode)
+{
+    if(this->mode != mode) {
+        this->mode = mode;
+        saveState();
+    }
+
+}
 
 bool VL53L0XSensor::loadState()
 {
@@ -76,7 +91,7 @@ bool VL53L0XSensor::saveState()
 #endif
 }
 
-VL53L0XSensor::VL53L0XSensor() : TelemetrySensor(meshtastic_TelemetrySensorType_VL53L0X, "VL53L0X") {}
+VL53L0XSensor::VL53L0XSensor() : TelemetrySensor(meshtastic_TelemetrySensorType_VL53L0X, "VL53L0X") {instance = this;}
 
 bool VL53L0XSensor::initDevice(TwoWire *bus, ScanI2C::FoundDevice *dev)
 {

src/modules/Telemetry/Sensor/VL53L0XSensor.h

@@ -18,10 +18,12 @@ class VL53L0XSensor : public TelemetrySensor
 
     Adafruit_VL53L0X::VL53L0X_Sense_config_t mode;
 
+  public:
+    static VL53L0XSensor* getInstance();
+    void setMode(Adafruit_VL53L0X::VL53L0X_Sense_config_t mode);
     bool loadState();
     bool saveState();
 
-  public:
     VL53L0XSensor();
     virtual bool getMetrics(meshtastic_Telemetry *measurement) override;
     virtual bool initDevice(TwoWire *bus, ScanI2C::FoundDevice *dev) override;