Diff: main.cpp

Revision:

13:c0ef2ae9e6a7

Parent:

11:6d4d6e9b3729

--- a/main.cpp	Thu May 06 14:12:02 2021 +0000
+++ b/main.cpp	Fri May 07 15:12:28 2021 +0000
@@ -1,33 +1,39 @@
 /*
- *  This VL53L3 Expansion board test application performs range measurements
- *  using the onboard embedded centre sensor, in singleshot, polling mode.
- *  Measured ranges are ouput on the Serial Port, running at 115200 baud.
+ * This VL53L3 Expansion board test application performs range measurements
+ * using the onboard embedded centre sensor, in singleshot, polling mode.
+ * Measured ranges are ouput on the Serial Port, running at 115200 baud.
+ *
+ * The User Blue button stops the current measurement and entire program,
+ * releasing all resources.
  *
- *  The User Blue button stops the current measurement and entire program,
- *  releasing all resources.
+ * The Reset button can be used to restart the program.
  *
- *  The Reset button can be used to restart the program.
+ * *** Note :
+ * Default Mbed build system settings disable print floating-point support.
+ * Offline builds can enable this, again.
+ * https://github.com/ARMmbed/mbed-os/blob/master/platform/source/minimal-printf/README.md
+ * .\mbed-os\platform\mbed_lib.json
+ *
  */
- 
-  //Main_single_polling.h
- 
+
 #include <stdio.h>
 #include <time.h>
 
 #include "mbed.h"
+
 #include "XNucleo53L3A2.h"
 #include "vl53L3_I2c.h"
 
 
 // define i2c mcu pins
-#define I2C_SDA   D14 
-#define I2C_SCL   D15 
+#define I2C_SDA   D14
+#define I2C_SCL   D15
 
 static XNucleo53L3A2 *board=NULL;
 #if (MBED_VERSION  > 60300)
-    UnbufferedSerial  pc(USBTX, USBRX);
+UnbufferedSerial  pc(USBTX, USBRX);
 #else
-    Serial pc(SERIAL_TX, SERIAL_RX);
+Serial pc(SERIAL_TX, SERIAL_RX);
 #endif
 
 
@@ -39,11 +45,11 @@
 VL53LX_DEV                     Dev = &devCentre;
 
 
- 
+
 /*=================================== Main ==================================
 =============================================================================*/
 int main()
-{   
+{
     int status;
     VL53L3 * Sensor;
     uint16_t wordData;
@@ -55,7 +61,7 @@
     printf("Hello world!\r\n");
 
     vl53L3_DevI2C *dev_I2C = new vl53L3_DevI2C(I2C_SDA, I2C_SCL);
-    
+
     /* creates the 53L1A1 expansion board singleton obj */
     board = XNucleo53L3A2::instance(dev_I2C, A2, D8, D2);
     printf("board created!\r\n");
@@ -67,70 +73,66 @@
         printf("Failed to init board!\r\n");
         return 0;
     }
-       
-   
+
+
     printf("board initiated! \n");
-                                            
+
     printf("configuring centre channel \n");
     Dev=&devCentre;
     Sensor=board->sensor_centre;
     Dev->I2cDevAddr = NEW_SENSOR_CENTRE_ADDRESS;
     printf("configured centre channel \n");
-  
-        
-   // configure the i2c connection     
+
+
+    // configure the i2c connection
     Dev->comms_speed_khz = 400;
     Dev->comms_type = 1;
 
-/* Device Initialization and setting */
+    /* Device Initialization and setting */
 
     status = Sensor->VL53LX_DataInit();
-    uint8_t NewDataReady=0;     
+    uint8_t NewDataReady=0;
+
 
-    
-    status = Sensor->VL53LX_StartMeasurement();   
-    printf("VL53LX_StartMeasurement %d \n",status);         
-        
-    while(1) 
-    {     
+    status = Sensor->VL53LX_StartMeasurement();
+    printf("VL53LX_StartMeasurement %d \n",status);
+
+    while(1) {
         status = Sensor->VL53LX_WaitMeasurementDataReady();
 
-        if(!status)
-        {
+        if(!status) {
 
             status = Sensor->VL53LX_GetMultiRangingData( &RangingData);
 
-            if ( status == 0)
-            {
+            if ( status == 0) {
                 int no_of_object_found=RangingData.NumberOfObjectsFound;
-                if ( no_of_object_found < 10 ) 
-                {
-                    for(int j=0;j<no_of_object_found;j++){
-                          if ((RangingData.RangeData[j].RangeStatus == VL53LX_RANGESTATUS_RANGE_VALID) || 
-                            (RangingData.RangeData[j].RangeStatus == VL53LX_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL))
-                            {   // print data
-                                printf("centre \t object %d  \t status=%d, \t D=%5dmm, \t Signal=%2.2f Mcps, \t Ambient=%2.2f Mcps \n",
-                                j,
-                                RangingData.RangeData[j].RangeStatus,
-                                RangingData.RangeData[j].RangeMilliMeter,
-                                RangingData.RangeData[j].SignalRateRtnMegaCps/65536.0,
-                                RangingData.RangeData[j].AmbientRateRtnMegaCps/65536.0);
-                            } //if
+                if ( no_of_object_found < 10 ) {
+                    for(int j=0; j<no_of_object_found; j++) {
+                        if ((RangingData.RangeData[j].RangeStatus == VL53LX_RANGESTATUS_RANGE_VALID) ||
+                                (RangingData.RangeData[j].RangeStatus == VL53LX_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL)) {
+                            // print data
+                            printf("centre \t object %d  \t status=%d, \t D=%5dmm, \t Signal=%2.2f Mcps, \t Ambient=%2.2f Mcps \n",
+                                   j,
+                                   RangingData.RangeData[j].RangeStatus,
+                                   RangingData.RangeData[j].RangeMilliMeter,
+                                   (RangingData.RangeData[j].SignalRateRtnMegaCps/65535.0),
+                                   (RangingData.RangeData[j].AmbientRateRtnMegaCps/65535.0));
+                        } //if
                     } //for
-                } // if  ( no_of_object_found < 10 ) 
-            }   // if status VL53LX_GetMultiRangingData                                                                          
-                                        
-            } // if !status VL53LX_WaitMeasurementDataReady
-            else
-            {
-                printf("VL53L1_WaitMeasurementDataReady failed %d \n",status);
-            }
+                } // if  ( no_of_object_found < 10 )
+            }   // if status VL53LX_GetMultiRangingData
+
+        } // if !status VL53LX_WaitMeasurementDataReady
+        else {
+            printf("VL53L1_WaitMeasurementDataReady failed %d \n",status);
+        }
 
-            status = Sensor->VL53LX_ClearInterruptAndStartMeasurement();
-        
+        status = Sensor->VL53LX_ClearInterruptAndStartMeasurement();
+
     } // while(1)
-    
-//       status = Sensor->VL53LX_StopMeasurement(); 
-    
+
+    // *** will not reach, after infinite loop.
+    status = Sensor->VL53LX_StopMeasurement();
+
 }