VL53L3CX ranging example application, using X-Nucleo-53L3A2 expansion shield and polling, on MbedOS v6.x
Dependencies: X_NUCLEO_53L3A2
Revision 13:c0ef2ae9e6a7, committed 2021-05-07
- Comitter:
- johnAlexander
- Date:
- Fri May 07 15:12:28 2021 +0000
- Parent:
- 12:e55a253f3991
- Commit message:
- Reformat to match mbed coding style.
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
--- 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(); + }