feat: update_rois. feat: get_avg_range_top_mm. mod: method to get rois don't call update

Author: eigen-value

examples/sensor_tof/sensor_tof.ino

@@ -18,34 +18,34 @@ void setup() {
 
 void loop() {
     bool updated = false;
-    updated = tof.update();
+    updated = tof.update_rois();
 
     if (updated) {
       Serial.println(" ");
       Serial.print("TOP=");
-      Serial.println(tof.get_min_range_top_mm());
+      Serial.println(tof.top);
       Serial.print("BOT=");
-      Serial.println(tof.get_max_range_bottom_mm());
+      Serial.println(tof.bottom);
       Serial.print("LEFT=");
-      Serial.println(tof.get_min_range_left_mm());
+      Serial.println(tof.left);
       Serial.print("RIGHT=");
-      Serial.println(tof.get_min_range_right_mm());
+      Serial.println(tof.right);
       Serial.print("CLEFT=");
-      Serial.println(tof.get_min_range_center_left_mm());
+      Serial.println(tof.center_left);
       Serial.print("CRIGHT=");
-      Serial.println(tof.get_min_range_center_right_mm());
+      Serial.println(tof.center_right);
       Serial.print("CENTER=");
+      Serial.println(tof.center);
+      Serial.print("LEFT_MIN=");
+      Serial.println(tof.get_min_range_left_mm());
+      Serial.print("RIGHT_MIN=");
+      Serial.println(tof.get_min_range_right_mm());
+      Serial.print("CLEFT_MIN=");
+      Serial.println(tof.get_min_range_center_left_mm());
+      Serial.print("CRIGHT_MIN=");
+      Serial.println(tof.get_min_range_center_right_mm());
+      Serial.print("CENTER_MIN=");
       Serial.println(tof.get_min_range_center_mm());
-      Serial.print("LEFT_AVG=");
-      Serial.println(tof.get_avg_range_left_mm());
-      Serial.print("RIGHT_AVG=");
-      Serial.println(tof.get_avg_range_right_mm());
-      Serial.print("CLEFT_AVG=");
-      Serial.println(tof.get_avg_range_center_left_mm());
-      Serial.print("CRIGHT_AVG=");
-      Serial.println(tof.get_avg_range_center_right_mm());
-      Serial.print("CENTER_AVG=");
-      Serial.println(tof.get_avg_range_center_mm());
     }
 
     delay(1000);

src/sensor_tof_matrix.h

@@ -21,6 +21,14 @@ class SensorTofMatrix{
         uint32_t _wire_base_clock;
 
     public:
+        int top;
+        int bottom;
+        int left;
+        int right;
+        int center_left;
+        int center_right;
+        int center;
+
         SensorTofMatrix(TwoWire * wire, const uint8_t lpn_pin, const uint8_t i2c_rst_pin, const int size=4, const int ranging_freq=-1, const bool wire_boost = true, const uint32_t wire_base_clock=WIRE_BASE_CLOCK){
             _wire=wire;
             _sensor = new VL53L7CX(_wire,lpn_pin,i2c_rst_pin);
@@ -109,8 +117,19 @@ class SensorTofMatrix{
             return return_value;
         }
 
+        bool update_rois() {
+            bool out = update();
+            top = get_avg_range_top_mm();
+            bottom = get_max_range_bottom_mm();
+            left = get_avg_range_left_mm();
+            right = get_avg_range_right_mm();
+            center_left = get_avg_range_center_left_mm();
+            center_right = get_avg_range_center_right_mm();
+            center = get_avg_range_center_mm();
+            return out;
+        }
+
         int get_min_range_top_mm() {
-            update();
 
             int16_t top_min = results.distance_mm[0];
 
@@ -121,8 +140,20 @@ class SensorTofMatrix{
             return top_min;
         }
 
+        int get_avg_range_top_mm() {
+
+            int16_t _avg = 0;
+            uint8_t n = 0;
+
+            for (int i=0; i < (_size==4?4:16) ;i++) {
+                _avg += results.distance_mm[i];
+                n++;
+            }
+
+            return _avg/n;
+        }
+
         int get_max_range_bottom_mm() {
-            update();
 
             int16_t bottom_max = results.distance_mm[0];
 
@@ -134,7 +165,6 @@ class SensorTofMatrix{
         }
 
         int get_min_range_left_mm() {
-            update();
 
             int16_t _min = results.distance_mm[0];
 
@@ -149,7 +179,6 @@ class SensorTofMatrix{
         }
 
         int get_min_range_right_mm() {
-            update();
 
             int16_t _min = results.distance_mm[0];
 
@@ -164,7 +193,6 @@ class SensorTofMatrix{
         }
 
         int get_min_range_center_left_mm() {
-            update();
 
             int16_t _min = results.distance_mm[0];
 
@@ -179,7 +207,6 @@ class SensorTofMatrix{
         }
 
         int get_min_range_center_right_mm() {
-            update();
 
             int16_t _min = results.distance_mm[0];
 
@@ -194,7 +221,6 @@ class SensorTofMatrix{
         }
 
         int get_min_range_center_mm() {
-            update();
 
             int16_t _min = results.distance_mm[0];
 
@@ -209,7 +235,6 @@ class SensorTofMatrix{
         // avgs
 
         int get_avg_range_left_mm() {
-            update();
 
             int16_t _avg = 0;
             uint8_t n = 0;
@@ -227,7 +252,6 @@ class SensorTofMatrix{
         }
 
         int get_avg_range_right_mm() {
-            update();
 
             int16_t _avg = 0;
             uint8_t n = 0;
@@ -245,7 +269,6 @@ class SensorTofMatrix{
         }
 
         int get_avg_range_center_left_mm() {
-            update();
 
             int16_t _avg = 0;
             uint8_t n = 0;
@@ -263,7 +286,6 @@ class SensorTofMatrix{
         }
 
         int get_avg_range_center_right_mm() {
-            update();
 
             int16_t _avg = 0;
             uint8_t n = 0;
@@ -281,7 +303,6 @@ class SensorTofMatrix{
         }
 
         int get_avg_range_center_mm() {
-            update();
 
             int16_t _avg = 0;
             uint8_t n = 0;