Merge ee1a97064761076d23ba90214d71dfae0252371e into 9714d659ea8259c55abaed4989d9cfe0126bfd85

components/ratgdo/sensor/ratgdo_sensor.cpp

@@ -87,14 +87,7 @@ namespace ratgdo {
                 status = this->distance_sensor_.VL53L4CX_GetMultiRangingData(pDistanceData);
                 objCount = pDistanceData->NumberOfObjectsFound;
 
-                for (int i = 0; i < distanceData.NumberOfObjectsFound; i++) {
-                    VL53L4CX_TargetRangeData_t *d = &pDistanceData->RangeData[i];
-                    if (d->RangeStatus == 0) {
-                        maxDistance = std::max(maxDistance, d->RangeMilliMeter);
-                    }
-                }
-
-                //maxDistance = objCount == 0 ? -1 : pDistanceData->RangeData[objCount - 1].RangeMilliMeter;
+                maxDistance = objCount == 0 ? -1 : pDistanceData->RangeData[objCount - 1].RangeMilliMeter;
                 /* 
                  * if the sensor is pointed at glass, there are many error -1 readings which will fill the
                  * vector with out of range data. The sensor should be sensitive enough to detect the floor