1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
|
/* USER CODE BEGIN Header */
/**
******************************************************************************
* @file app_vl53l0x.c
* @author MCD Application Team
* @brief Proximity Application
******************************************************************************
* @attention
*
* Copyright (c) 2019-2021 STMicroelectronics.
* All rights reserved.
*
* This software is licensed under terms that can be found in the LICENSE file
* in the root directory of this software component.
* If no LICENSE file comes with this software, it is provided AS-IS.
*
******************************************************************************
*/
/* USER CODE END Header */
/* Includes ------------------------------------------------------------------*/
#include "app_vl53l0x.h"
#include "stm32_lcd.h"
#include "stm32wb5mm_dk_lcd.h"
/* Private defines -----------------------------------------------------------*/
#define PROXIMITY_UPDATE_PERIOD (uint32_t)(0.5*1000*1000/CFG_TS_TICK_VAL) /*500ms*/
#define DISTANCE_MAX_PROXIMITY 2000 /* 2m */
/* Private variables ---------------------------------------------------------*/
extern I2C_HandleTypeDef hbus_i2c3;
/* Proximity */
VL53L0X_Dev_t Dev =
{
.I2cHandle = &hbus_i2c3,
.I2cDevAddr = PROXIMITY_I2C_ADDRESS
};
uint8_t VL53L0X_PROXIMITY_Update_Timer_Id;
/* Private function prototypes -----------------------------------------------*/
/**
* @brief VL53L0X proximity sensor Initialization.
*/
void VL53L0X_PROXIMITY_Init(void)
{
uint16_t vl53l0x_id = 0;
VL53L0X_DeviceInfo_t VL53L0X_DeviceInfo;
memset(&VL53L0X_DeviceInfo, 0, sizeof(VL53L0X_DeviceInfo_t));
if (VL53L0X_ERROR_NONE == VL53L0X_GetDeviceInfo(&Dev, &VL53L0X_DeviceInfo))
{
if (VL53L0X_ERROR_NONE == VL53L0X_RdWord(&Dev, VL53L0X_REG_IDENTIFICATION_MODEL_ID, (uint16_t *) &vl53l0x_id))
{
if (vl53l0x_id == VL53L0X_ID)
{
if (VL53L0X_ERROR_NONE == VL53L0X_DataInit(&Dev))
{
Dev.Present = 1;
SetupSingleShot(Dev);
}
else
{
while(1){} // VL53L0X Time of Flight Failed to send its ID!
}
}
}
else
{
while(1){} // VL53L0X Time of Flight Failed to Initialize!
}
}
else
{
while(1){} // VL53L0X Time of Flight Failed to get infos!
}
//// UTIL_SEQ_RegTask( 1<<CFG_TASK_GET_MEASURE_TOF_ID, UTIL_SEQ_RFU, VL53L0X_PROXIMITY_PrintValue);
// /* Create timer to get the measure of TOF */
// HW_TS_Create(CFG_TIM_PROC_ID_ISR,
// &VL53L0X_PROXIMITY_Update_Timer_Id,
// hw_ts_Repeated,
// VL53L0X_PROXIMITY_Update_Timer_Callback);
}
void VL53L0X_Start_Measure(void)
{
/* Start the timer used to update the proximity value */
HW_TS_Start(VL53L0X_PROXIMITY_Update_Timer_Id, PROXIMITY_UPDATE_PERIOD);
}
void VL53L0X_Stop_Measure(void)
{
/* Stop the timer used to update the proximity value */
HW_TS_Stop(VL53L0X_PROXIMITY_Update_Timer_Id);
}
/**
* @brief Get distance from VL53L0X proximity sensor.
* @param None
* @retval Distance in mm
*/
uint16_t VL53L0X_PROXIMITY_GetDistance(void)
{
VL53L0X_RangingMeasurementData_t RangingMeasurementData;
VL53L0X_PerformSingleRangingMeasurement(&Dev, &RangingMeasurementData);
return RangingMeasurementData.RangeMilliMeter;
}
/**
* @brief Print distance measure from VL53L0X proximity sensor on the OLED screen.
* @param None
* @retval None
*/
void VL53L0X_PROXIMITY_PrintValue(void){
UTIL_LCD_ClearStringLine(4);
char distanceText[18];
uint16_t prox_value = 0;
uint16_t distance = 0;
prox_value = VL53L0X_PROXIMITY_GetDistance();
if(prox_value < DISTANCE_MAX_PROXIMITY)
{
distance = prox_value / 10;
sprintf(distanceText,"Distance : %3d cm",distance);
UTIL_LCD_DisplayStringAtLine(2,(uint8_t*)distanceText);
}
else
{
sprintf(distanceText, "Distance > 200 cm");
UTIL_LCD_DisplayStringAtLine(2,(uint8_t*)distanceText);
}
BSP_LCD_Refresh(0);
}
|
