You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
111 lines
3.1 KiB
111 lines
3.1 KiB
// -----------------------------------------------------------------------------
|
|
// VL53L1X Sensor over I2C
|
|
// Copyright (C) 2017-2019 by Xose Pérez <xose dot perez at gmail dot com>
|
|
// -----------------------------------------------------------------------------
|
|
|
|
#if SENSOR_SUPPORT && VL53L1X_SUPPORT
|
|
|
|
#pragma once
|
|
|
|
#include <VL53L1X.h>
|
|
|
|
#include "I2CSensor.h"
|
|
|
|
class VL53L1XSensor : public I2CSensor<> {
|
|
|
|
public:
|
|
|
|
using MeasurementTimingBudget = espurna::duration::critical::Microseconds;
|
|
using InterMeasurementPeriod = espurna::duration::Milliseconds;
|
|
|
|
// ---------------------------------------------------------------------
|
|
|
|
void setDistanceMode(VL53L1X::DistanceMode mode) {
|
|
_vl53l1x.setDistanceMode(mode);
|
|
}
|
|
|
|
void setMeasurementTimingBudget(MeasurementTimingBudget value) {
|
|
_vl53l1x.setMeasurementTimingBudget(value.count());
|
|
}
|
|
|
|
void setInterMeasurementPeriod(InterMeasurementPeriod value) {
|
|
if (_measurement_period != value) {
|
|
_measurement_period = value;
|
|
_dirty = true;
|
|
}
|
|
}
|
|
|
|
// ---------------------------------------------------------------------
|
|
// Sensor API
|
|
// ---------------------------------------------------------------------
|
|
|
|
unsigned char id() const override {
|
|
return SENSOR_VL53L1X_ID;
|
|
}
|
|
|
|
unsigned char count() const override {
|
|
return 1;
|
|
}
|
|
|
|
void begin() override {
|
|
if (!_dirty) {
|
|
return;
|
|
}
|
|
|
|
// I2C auto-discover
|
|
static constexpr uint8_t addresses[] {0x29};
|
|
const auto address = findAndLock(addresses);
|
|
if (address == 0) {
|
|
return;
|
|
}
|
|
|
|
_vl53l1x.setAddress(address);
|
|
if (!_vl53l1x.init()) {
|
|
return;
|
|
}
|
|
|
|
_vl53l1x.startContinuous(_measurement_period.count());
|
|
|
|
_ready = true;
|
|
_dirty = false;
|
|
}
|
|
|
|
// Descriptive name of the sensor
|
|
String description() const override {
|
|
char buffer[21];
|
|
snprintf_P(buffer, sizeof(buffer),
|
|
PSTR("VL53L1X @ I2C (0x%02X)"), lockedAddress());
|
|
return String(buffer);
|
|
}
|
|
|
|
// Type for slot # index
|
|
unsigned char type(unsigned char index) const override {
|
|
if (index == 0) return MAGNITUDE_DISTANCE;
|
|
return MAGNITUDE_NONE;
|
|
}
|
|
|
|
// Pre-read hook (usually to populate registers with up-to-date data)
|
|
void pre() override {
|
|
if (!_vl53l1x.dataReady()) {
|
|
return;
|
|
}
|
|
|
|
_distance = (double) _vl53l1x.read(false) / 1000.00;
|
|
}
|
|
|
|
// Current value for slot # index
|
|
double value(unsigned char index) override {
|
|
if (index == 0) {
|
|
return _distance;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
private:
|
|
InterMeasurementPeriod _measurement_period;
|
|
VL53L1X _vl53l1x;
|
|
double _distance = 0;
|
|
|
|
};
|
|
|
|
#endif // SENSOR_SUPPORT && VL53L1X_SUPPORT
|