@@ -60,38 +60,38 @@ class WipperSnapper_I2C_Driver_VL53L4CX : public WipperSnapper_I2C_Driver {
60
60
*/
61
61
const char *getVL53L4CXStatusDescription (int statusCode) {
62
62
switch (statusCode) {
63
- case VL53L4CX_RANGESTATUS_RANGE_VALID:
64
- return " VL53L4CX_RANGESTATUS_RANGE_VALID" ;
65
- case VL53L4CX_RANGESTATUS_SIGMA_FAIL:
66
- return " VL53L4CX_RANGESTATUS_SIGMA_FAIL" ;
67
- case VL53L4CX_RANGESTATUS_RANGE_VALID_MIN_RANGE_CLIPPED:
68
- return " VL53L4CX_RANGESTATUS_RANGE_VALID_MIN_RANGE_CLIPPED" ;
69
- case VL53L4CX_RANGESTATUS_OUTOFBOUNDS_FAIL:
70
- return " VL53L4CX_RANGESTATUS_OUTOFBOUNDS_FAIL" ;
71
- case VL53L4CX_RANGESTATUS_HARDWARE_FAIL:
72
- return " VL53L4CX_RANGESTATUS_HARDWARE_FAIL" ;
73
- case VL53L4CX_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL:
74
- return " VL53L4CX_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL" ;
75
- case VL53L4CX_RANGESTATUS_WRAP_TARGET_FAIL:
76
- return " VL53L4CX_RANGESTATUS_WRAP_TARGET_FAIL" ;
77
- case VL53L4CX_RANGESTATUS_PROCESSING_FAIL:
78
- return " VL53L4CX_RANGESTATUS_PROCESSING_FAIL" ;
79
- case VL53L4CX_RANGESTATUS_XTALK_SIGNAL_FAIL:
80
- return " VL53L4CX_RANGESTATUS_XTALK_SIGNAL_FAIL" ;
81
- case VL53L4CX_RANGESTATUS_SYNCRONISATION_INT:
82
- return " VL53L4CX_RANGESTATUS_SYNCRONISATION_INT" ;
83
- case VL53L4CX_RANGESTATUS_RANGE_VALID_MERGED_PULSE:
84
- return " VL53L4CX_RANGESTATUS_RANGE_VALID_MERGED_PULSE" ;
85
- case VL53L4CX_RANGESTATUS_TARGET_PRESENT_LACK_OF_SIGNAL:
86
- return " VL53L4CX_RANGESTATUS_TARGET_PRESENT_LACK_OF_SIGNAL" ;
87
- case VL53L4CX_RANGESTATUS_MIN_RANGE_FAIL:
88
- return " VL53L4CX_RANGESTATUS_MIN_RANGE_FAIL" ;
89
- case VL53L4CX_RANGESTATUS_RANGE_INVALID:
90
- return " VL53L4CX_RANGESTATUS_RANGE_INVALID" ;
91
- case VL53L4CX_RANGESTATUS_NONE:
92
- return " VL53L4CX_RANGESTATUS_NONE" ;
93
- default :
94
- return ((" UNKNOWN STATUS: " ) + String (statusCode)).c_str ();
63
+ case VL53L4CX_RANGESTATUS_RANGE_VALID:
64
+ return " VL53L4CX_RANGESTATUS_RANGE_VALID" ;
65
+ case VL53L4CX_RANGESTATUS_SIGMA_FAIL:
66
+ return " VL53L4CX_RANGESTATUS_SIGMA_FAIL" ;
67
+ case VL53L4CX_RANGESTATUS_RANGE_VALID_MIN_RANGE_CLIPPED:
68
+ return " VL53L4CX_RANGESTATUS_RANGE_VALID_MIN_RANGE_CLIPPED" ;
69
+ case VL53L4CX_RANGESTATUS_OUTOFBOUNDS_FAIL:
70
+ return " VL53L4CX_RANGESTATUS_OUTOFBOUNDS_FAIL" ;
71
+ case VL53L4CX_RANGESTATUS_HARDWARE_FAIL:
72
+ return " VL53L4CX_RANGESTATUS_HARDWARE_FAIL" ;
73
+ case VL53L4CX_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL:
74
+ return " VL53L4CX_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL" ;
75
+ case VL53L4CX_RANGESTATUS_WRAP_TARGET_FAIL:
76
+ return " VL53L4CX_RANGESTATUS_WRAP_TARGET_FAIL" ;
77
+ case VL53L4CX_RANGESTATUS_PROCESSING_FAIL:
78
+ return " VL53L4CX_RANGESTATUS_PROCESSING_FAIL" ;
79
+ case VL53L4CX_RANGESTATUS_XTALK_SIGNAL_FAIL:
80
+ return " VL53L4CX_RANGESTATUS_XTALK_SIGNAL_FAIL" ;
81
+ case VL53L4CX_RANGESTATUS_SYNCRONISATION_INT:
82
+ return " VL53L4CX_RANGESTATUS_SYNCRONISATION_INT" ;
83
+ case VL53L4CX_RANGESTATUS_RANGE_VALID_MERGED_PULSE:
84
+ return " VL53L4CX_RANGESTATUS_RANGE_VALID_MERGED_PULSE" ;
85
+ case VL53L4CX_RANGESTATUS_TARGET_PRESENT_LACK_OF_SIGNAL:
86
+ return " VL53L4CX_RANGESTATUS_TARGET_PRESENT_LACK_OF_SIGNAL" ;
87
+ case VL53L4CX_RANGESTATUS_MIN_RANGE_FAIL:
88
+ return " VL53L4CX_RANGESTATUS_MIN_RANGE_FAIL" ;
89
+ case VL53L4CX_RANGESTATUS_RANGE_INVALID:
90
+ return " VL53L4CX_RANGESTATUS_RANGE_INVALID" ;
91
+ case VL53L4CX_RANGESTATUS_NONE:
92
+ return " VL53L4CX_RANGESTATUS_NONE" ;
93
+ default :
94
+ return ((" UNKNOWN STATUS: " ) + String (statusCode)).c_str ();
95
95
}
96
96
}
97
97
@@ -172,10 +172,10 @@ class WipperSnapper_I2C_Driver_VL53L4CX : public WipperSnapper_I2C_Driver {
172
172
return getProximity (proximityEvent, 0 );
173
173
}
174
174
175
-
176
175
/* ******************************************************************************/
177
176
/* !
178
- @brief Gets the VL53L4CX's current proximity for second object if found.
177
+ @brief Gets the VL53L4CX's current proximity for second object if
178
+ found.
179
179
@param proximityEvent
180
180
Pointer to an Adafruit_Sensor event.
181
181
@returns True if the proximity was obtained successfully, False
@@ -185,7 +185,6 @@ class WipperSnapper_I2C_Driver_VL53L4CX : public WipperSnapper_I2C_Driver {
185
185
bool getEventRaw (sensors_event_t *proximityEvent) {
186
186
return getProximity (proximityEvent, 1 );
187
187
}
188
-
189
188
190
189
/* ******************************************************************************/
191
190
/* !
@@ -210,11 +209,10 @@ class WipperSnapper_I2C_Driver_VL53L4CX : public WipperSnapper_I2C_Driver {
210
209
WS_DEBUG_PRINT (" Waiting for VL53L4CX data ready..." );
211
210
delay (250 );
212
211
213
- for (uint8_t i = 0 ;
214
- (status = _VL53L4CX->VL53L4CX_GetMeasurementDataReady (&NewDataReady)) &&
215
- !NewDataReady && i < 3 ;
216
- i++)
217
- {
212
+ for (uint8_t i = 0 ; (status = _VL53L4CX->VL53L4CX_GetMeasurementDataReady (
213
+ &NewDataReady)) &&
214
+ !NewDataReady && i < 3 ;
215
+ i++) {
218
216
delay (300 );
219
217
WS_DEBUG_PRINT (" ." );
220
218
}
@@ -224,8 +222,10 @@ class WipperSnapper_I2C_Driver_VL53L4CX : public WipperSnapper_I2C_Driver {
224
222
no_of_object_found = pMultiRangingData->NumberOfObjectsFound ;
225
223
226
224
for (j = 0 ; j < no_of_object_found; j++) {
227
- if (pMultiRangingData->RangeData [j].RangeStatus == VL53L4CX_RANGESTATUS_RANGE_VALID ||
228
- pMultiRangingData->RangeData [j].RangeStatus == VL53L4CX_RANGESTATUS_RANGE_VALID_MERGED_PULSE) {
225
+ if (pMultiRangingData->RangeData [j].RangeStatus ==
226
+ VL53L4CX_RANGESTATUS_RANGE_VALID ||
227
+ pMultiRangingData->RangeData [j].RangeStatus ==
228
+ VL53L4CX_RANGESTATUS_RANGE_VALID_MERGED_PULSE) {
229
229
int16_t mm = pMultiRangingData->RangeData [j].RangeMilliMeter ;
230
230
if (j == index) {
231
231
proximityEvent->data [0 ] = (float )mm;
@@ -236,13 +236,14 @@ class WipperSnapper_I2C_Driver_VL53L4CX : public WipperSnapper_I2C_Driver {
236
236
// TODO: Once I2C sensors fire all data points during a single call, we
237
237
// can return both distances and other metrics like the std deviation
238
238
} else {
239
- WS_DEBUG_PRINTLN (" VL53L4CX Error: " + String (getVL53L4CXStatusDescription (status)));
239
+ WS_DEBUG_PRINTLN (" VL53L4CX Error: " +
240
+ String (getVL53L4CXStatusDescription (status)));
240
241
}
241
242
return false ;
242
243
}
243
244
244
245
protected:
245
- VL53L4CX *_VL53L4CX = nullptr ; // /< Pointer to VL53L4CX temperature sensor object
246
+ VL53L4CX *_VL53L4CX; // /< Pointer to VL53L4CX temperature sensor object
246
247
};
247
248
248
249
#endif // WipperSnapper_I2C_Driver_VL53L4CX
0 commit comments