![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
baca lidar aja
Diff: main.cpp
- Revision:
- 3:03963277337b
- Parent:
- 2:8ac50bd2c7a1
--- a/main.cpp Fri Apr 21 11:22:11 2017 +0000 +++ b/main.cpp Thu Jan 17 12:51:00 2019 +0000 @@ -3,38 +3,17 @@ #include "vl53l0x_platform.h" #include "vl53l0x_i2c_platform.h" +#define USE_I2C_2V8 + Serial pc(USBTX, USBRX); DigitalOut led(LED1); -void print_pal_error(VL53L0X_Error Status){ - char buf[VL53L0X_MAX_STRING_LENGTH]; - VL53L0X_GetPalErrorString(Status, buf); - printf("API Status: %i : %s\n", Status, buf); -} - -void print_range_status(VL53L0X_RangingMeasurementData_t* pRangingMeasurementData){ - char buf[VL53L0X_MAX_STRING_LENGTH]; - uint8_t RangeStatus; - - /* - * New Range Status: data is valid when pRangingMeasurementData->RangeStatus = 0 - */ - - RangeStatus = pRangingMeasurementData->RangeStatus; - - VL53L0X_GetRangeStatusString(RangeStatus, buf); - printf("Range Status: %i : %s\n", RangeStatus, buf); - -} - VL53L0X_Error WaitMeasurementDataReady(VL53L0X_DEV Dev) { VL53L0X_Error Status = VL53L0X_ERROR_NONE; uint8_t NewDatReady=0; uint32_t LoopNb; - - // Wait until it finished - // use timeout to avoid deadlock + if (Status == VL53L0X_ERROR_NONE) { LoopNb = 0; do { @@ -59,8 +38,6 @@ uint32_t StopCompleted=0; uint32_t LoopNb; - // Wait until it finished - // use timeout to avoid deadlock if (Status == VL53L0X_ERROR_NONE) { LoopNb = 0; do { @@ -82,176 +59,65 @@ } + int main() { - + int x=1, measure=0; + int ave=0, sum=0; VL53L0X_Error Status = VL53L0X_ERROR_NONE; VL53L0X_Dev_t MyDevice; VL53L0X_Dev_t *pMyDevice = &MyDevice; + VL53L0X_RangingMeasurementData_t RangingMeasurementData; + VL53L0X_RangingMeasurementData_t *pRangingMeasurementData = &RangingMeasurementData; VL53L0X_Version_t Version; - VL53L0X_Version_t *pVersion = &Version; - VL53L0X_DeviceInfo_t DeviceInfo; - - int32_t status_int; - - pc.printf("VL53L0X API Simple Ranging Example\r\n"); // Initialize Comms pMyDevice->I2cDevAddr = 0x52; pMyDevice->comms_type = 1; pMyDevice->comms_speed_khz = 400; - pc.printf("Init comms\r\n"); + + VL53L0X_ERROR_CONTROL_INTERFACE; + VL53L0X_RdWord(&MyDevice, VL53L0X_REG_OSC_CALIBRATE_VAL,0); + VL53L0X_DataInit(&MyDevice); // Data initialization + Status = VL53L0X_ERROR_NONE; + uint32_t refSpadCount; + uint8_t isApertureSpads; + uint8_t VhvSettings; + uint8_t PhaseCal; - if(Status == VL53L0X_ERROR_NONE) - { - status_int = VL53L0X_GetVersion(pVersion); - if (status_int != 0) - Status = VL53L0X_ERROR_CONTROL_INTERFACE; - } - pc.printf("VL53L0X API Version: %d.%d.%d (revision %d)\r\n", pVersion->major, pVersion->minor ,pVersion->build, pVersion->revision); - - int addr; - - addr = VL53L0X_scan(); - printf("Device found at: %i\r\n", addr); - //uint8_t data; - //data=0; - if(Status == VL53L0X_ERROR_NONE) - { - printf ("Call of VL53L0X_DataInit\n"); - uint16_t osc_calibrate_val=0; - Status = VL53L0X_RdWord(&MyDevice, VL53L0X_REG_OSC_CALIBRATE_VAL,&osc_calibrate_val); - printf("%i\n",osc_calibrate_val); - Status = VL53L0X_DataInit(&MyDevice); // Data initialization - print_pal_error(Status); - } + VL53L0X_StaticInit(pMyDevice); // Device Initialization + VL53L0X_PerformRefSpadManagement(pMyDevice, &refSpadCount, &isApertureSpads); // Device Initialization + VL53L0X_PerformRefCalibration(pMyDevice, &VhvSettings, &PhaseCal); // Device Initialization + VL53L0X_SetDeviceMode(pMyDevice, VL53L0X_DEVICEMODE_CONTINUOUS_RANGING); // Setup in single ranging mode + VL53L0X_SetLimitCheckValue(pMyDevice, VL53L0X_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE, (FixPoint1616_t)(0.25*65536)); //High Accuracy mode, see API PDF + VL53L0X_SetLimitCheckValue(pMyDevice, VL53L0X_CHECKENABLE_SIGMA_FINAL_RANGE, (FixPoint1616_t)(18*65536)); //High Accuracy mode, see API PDF + VL53L0X_SetMeasurementTimingBudgetMicroSeconds(pMyDevice, 200000); //High Accuracy mode, see API PDF + VL53L0X_StartMeasurement(pMyDevice); - if(Status == VL53L0X_ERROR_NONE) - { - Status = VL53L0X_GetDeviceInfo(&MyDevice, &DeviceInfo); - if(Status == VL53L0X_ERROR_NONE) - { - printf("VL53L0X_GetDeviceInfo:\n"); - printf("Device Name : %s\n", DeviceInfo.Name); - printf("Device Type : %s\n", DeviceInfo.Type); - printf("Device ID : %s\n", DeviceInfo.ProductId); - printf("ProductRevisionMajor : %d\n", DeviceInfo.ProductRevisionMajor); - printf("ProductRevisionMinor : %d\n", DeviceInfo.ProductRevisionMinor); - - if ((DeviceInfo.ProductRevisionMinor != 1) && (DeviceInfo.ProductRevisionMinor != 1)) { - printf("Error expected cut 1.1 but found cut %d.%d\n", - DeviceInfo.ProductRevisionMajor, DeviceInfo.ProductRevisionMinor); - Status = VL53L0X_ERROR_NOT_SUPPORTED; - } + while (1){ + while(x<=50){ + WaitMeasurementDataReady(pMyDevice); + VL53L0X_GetRangingMeasurementData(pMyDevice, pRangingMeasurementData); + measure=pRangingMeasurementData->RangeMilliMeter; + //printf("In loop measurement %d\n", mea); + sum=sum+measure; + led=!led; + // Clear the interrupt + VL53L0X_ClearInterruptMask(pMyDevice, VL53L0X_REG_SYSTEM_INTERRUPT_GPIO_NEW_SAMPLE_READY); + VL53L0X_PollingDelay(pMyDevice); + x++; } - print_pal_error(Status); + ave=sum/x; + printf("Average is %d\n", ave); + x=1; + sum=0; + wait(20); } - VL53L0X_RangingMeasurementData_t RangingMeasurementData; - VL53L0X_RangingMeasurementData_t *pRangingMeasurementData = &RangingMeasurementData; - Status = VL53L0X_ERROR_NONE; - uint32_t refSpadCount; - uint8_t isApertureSpads; - uint8_t VhvSettings; - uint8_t PhaseCal; - - if(Status == VL53L0X_ERROR_NONE) - { - printf ("Call of VL53L0X_StaticInit\n"); - Status = VL53L0X_StaticInit(pMyDevice); // Device Initialization - // StaticInit will set interrupt by default - print_pal_error(Status); - } - - if(Status == VL53L0X_ERROR_NONE) - { - printf ("Call of VL53L0X_PerformRefCalibration\n"); - Status = VL53L0X_PerformRefCalibration(pMyDevice, - &VhvSettings, &PhaseCal); // Device Initialization - print_pal_error(Status); - } - - if(Status == VL53L0X_ERROR_NONE) - { - printf ("Call of VL53L0X_PerformRefSpadManagement\n"); - Status = VL53L0X_PerformRefSpadManagement(pMyDevice, - &refSpadCount, &isApertureSpads); // Device Initialization - print_pal_error(Status); - } - - if(Status == VL53L0X_ERROR_NONE) - { - - printf ("Call of VL53L0X_SetDeviceMode\n"); - Status = VL53L0X_SetDeviceMode(pMyDevice, VL53L0X_DEVICEMODE_CONTINUOUS_RANGING); // Setup in single ranging mode - print_pal_error(Status); - } - - if(Status == VL53L0X_ERROR_NONE) - { - printf ("Call of VL53L0X_StartMeasurement\n"); - Status = VL53L0X_StartMeasurement(pMyDevice); - print_pal_error(Status); - } - - if(Status == VL53L0X_ERROR_NONE) - { - uint32_t measurement; - uint32_t no_of_measurements = 6000; - - uint16_t* pResults = (uint16_t*)malloc(sizeof(uint16_t) * no_of_measurements); - - for(measurement=0; measurement<no_of_measurements; measurement++) - { - - Status = WaitMeasurementDataReady(pMyDevice); - - if(Status == VL53L0X_ERROR_NONE) - { - Status = VL53L0X_GetRangingMeasurementData(pMyDevice, pRangingMeasurementData); - - *(pResults + measurement) = pRangingMeasurementData->RangeMilliMeter; - printf("In loop measurement %lu: %d\n", measurement, pRangingMeasurementData->RangeMilliMeter); - wait(1); - led=!led; - // Clear the interrupt - VL53L0X_ClearInterruptMask(pMyDevice, VL53L0X_REG_SYSTEM_INTERRUPT_GPIO_NEW_SAMPLE_READY); - VL53L0X_PollingDelay(pMyDevice); - } else { - break; - } - } - - if(Status == VL53L0X_ERROR_NONE) - { - for(measurement=0; measurement<no_of_measurements; measurement++) - { - printf("measurement %lu: %d\n", measurement, *(pResults + measurement)); - } - } - - free(pResults); - } - - - if(Status == VL53L0X_ERROR_NONE) - { - printf ("Call of VL53L0X_StopMeasurement\n"); - Status = VL53L0X_StopMeasurement(pMyDevice); - } - - if(Status == VL53L0X_ERROR_NONE) - { - printf ("Wait Stop to be competed\n"); - Status = WaitStopCompleted(pMyDevice); - } - - if(Status == VL53L0X_ERROR_NONE) - Status = VL53L0X_ClearInterruptMask(pMyDevice, - VL53L0X_REG_SYSTEM_INTERRUPT_GPIO_NEW_SAMPLE_READY); - while (true) - if (pc.readable()) - pc.putc(pc.getc()); + VL53L0X_StopMeasurement(pMyDevice); + WaitStopCompleted(pMyDevice); + VL53L0X_ClearInterruptMask(pMyDevice,VL53L0X_REG_SYSTEM_INTERRUPT_GPIO_NEW_SAMPLE_READY); + }