Diff: main.cpp

Revision:

2:2489dfbd49d7

Parent:

1:3151ff0b9da9

Child:

3:025bcf0d211d

--- a/main.cpp	Tue Jul 20 16:11:02 2021 +0000
+++ b/main.cpp	Wed Jul 21 12:33:05 2021 +0000
@@ -100,6 +100,8 @@
 // config profile details
     RANGING_SENSOR_Result_t Result;
     RANGING_SENSOR_ProfileConfig_t Profile;
+    uint16_t zone = 0;
+    uint16_t target = 0;
     printf("MX_53L3A2_MultiSensorRanging_Process\n");
     
     
@@ -137,12 +139,29 @@
             EventDetected = 0;
             status = sensor->CUSTOM_RANGING_GetDistance(ToF_sensor, &Result);
             if ((status == BSP_ERROR_NONE) && 
+                ( Result.ZoneResult[zone].NumberOfTargets != 0))  // is there data
+            {
+                for ( target = 0 ; target < Result.ZoneResult[zone].NumberOfTargets; target++)
+                { 
+                    if (Result.ZoneResult[zone].Status[target] == VL53LX_RANGESTATUS_RANGE_VALID )
+                    {
+                        printf("\n |---> ");
+                        printf("Status = %d, Target %d, Distance = %5d mm",
+                               Result.ZoneResult[zone].Status[target],
+                               target,
+                               Result.ZoneResult[zone].Distance[target]);
+                    }
+                }
+            }
+            /*
+            if ((status == BSP_ERROR_NONE) && 
                 (Result.NumberOfZones != 0) && 
                 (Result.ZoneResult[0].Status[0] == BSP_ERROR_NONE ))
             {
                 printf("\n%s\t - ", TofDevStr[ToF_sensor]);
                 print_result(&Result);
             }
+            */
         }
       
     }