Compare commits

..

2 Commits

Author SHA1 Message Date
Paul Wieland 575b4bd3f3
Merge ee1a970647 into 494af2b067 2024-12-30 23:02:32 +11:00
Paul Wieland 494af2b067 Fix out of range data 2024-12-29 22:08:28 -05:00
1 changed files with 2 additions and 1 deletions

View File

@ -80,7 +80,7 @@ namespace ratgdo {
VL53L4CX_MultiRangingData_t* pDistanceData = &distanceData;
uint8_t dataReady = 0;
int objCount = 0;
int16_t maxDistance = 0;
int16_t maxDistance = -1;
int status;
if (this->distance_sensor_.VL53L4CX_GetMeasurementDataReady(&dataReady) == 0 && dataReady) {
@ -91,6 +91,7 @@ namespace ratgdo {
VL53L4CX_TargetRangeData_t *d = &pDistanceData->RangeData[i];
if (d->RangeStatus == 0) {
maxDistance = std::max(maxDistance, d->RangeMilliMeter);
maxDistance = maxDistance <= 25 ? -1 : maxDistance; // ignore the dust protection sticker
}
}