mirror of
https://github.com/meshtastic/firmware.git
synced 2026-02-15 18:11:12 -05:00
a71b47b5bb
* rework I2C sensor init the goal is to only instantiate sensors that are pressend to save memory. side effacts: - easyer sensor integration (less C&P code) - nodeTelemetrySensorsMap can be removed when all devices are migrated * add missing ifdef * refactor a bunch of more sensors RAM -816 Flash -916 * fix build for t1000 * refactor more sensors RAM -192 Flash -60 * improve error handling Flash -112 * fix build * fix build * fix IndicatorSensor * fix tracker-t1000-e build not sure what magic is used but it works * Apply suggestion from @Copilot Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Apply suggestion from @Copilot Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Apply suggestion from @Copilot Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Update src/modules/Telemetry/Sensor/DFRobotGravitySensor.h Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Fix --------- Co-authored-by: Ben Meadors <benmmeadors@gmail.com> Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com>
78 lines
2.0 KiB
C++
78 lines
2.0 KiB
C++
#include "configuration.h"
|
|
|
|
#if !MESHTASTIC_EXCLUDE_ENVIRONMENTAL_SENSOR
|
|
|
|
#include "../mesh/generated/meshtastic/telemetry.pb.h"
|
|
#include "RCWL9620Sensor.h"
|
|
#include "TelemetrySensor.h"
|
|
|
|
RCWL9620Sensor::RCWL9620Sensor() : TelemetrySensor(meshtastic_TelemetrySensorType_RCWL9620, "RCWL9620") {}
|
|
|
|
bool RCWL9620Sensor::initDevice(TwoWire *bus, ScanI2C::FoundDevice *dev)
|
|
{
|
|
LOG_INFO("Init sensor: %s", sensorName);
|
|
status = 1;
|
|
begin(bus, dev->address.address);
|
|
initI2CSensor();
|
|
return status;
|
|
}
|
|
|
|
bool RCWL9620Sensor::getMetrics(meshtastic_Telemetry *measurement)
|
|
{
|
|
measurement->variant.environment_metrics.has_distance = true;
|
|
LOG_DEBUG("RCWL9620 getMetrics");
|
|
measurement->variant.environment_metrics.distance = getDistance();
|
|
return true;
|
|
}
|
|
|
|
void RCWL9620Sensor::begin(TwoWire *wire, uint8_t addr, uint8_t sda, uint8_t scl, uint32_t speed)
|
|
{
|
|
_wire = wire;
|
|
_addr = addr;
|
|
_sda = sda;
|
|
_scl = scl;
|
|
_speed = speed;
|
|
_wire->begin();
|
|
}
|
|
|
|
float RCWL9620Sensor::getDistance()
|
|
{
|
|
uint32_t data = 0;
|
|
uint8_t b1 = 0, b2 = 0, b3 = 0;
|
|
|
|
LOG_DEBUG("[RCWL9620] Start measure command");
|
|
|
|
_wire->beginTransmission(_addr);
|
|
_wire->write(0x01); // À tester aussi sans cette ligne si besoin
|
|
uint8_t result = _wire->endTransmission();
|
|
LOG_DEBUG("[RCWL9620] endTransmission result = %d", result);
|
|
delay(100); // délai pour laisser le capteur répondre
|
|
|
|
LOG_DEBUG("[RCWL9620] Read i2c data:");
|
|
_wire->requestFrom(_addr, (uint8_t)3);
|
|
|
|
if (_wire->available() < 3) {
|
|
LOG_DEBUG("[RCWL9620] less than 3 octets !");
|
|
return 0.0;
|
|
}
|
|
|
|
b1 = _wire->read();
|
|
b2 = _wire->read();
|
|
b3 = _wire->read();
|
|
|
|
data = ((uint32_t)b1 << 16) | ((uint32_t)b2 << 8) | b3;
|
|
|
|
float Distance = float(data) / 1000.0;
|
|
|
|
LOG_DEBUG("[RCWL9620] Bytes readed = %02X %02X %02X", b1, b2, b3);
|
|
LOG_DEBUG("[RCWL9620] data=%.2f, level=%.2f", (double)data, (double)Distance);
|
|
|
|
if (Distance > 4500.00) {
|
|
return 4500.00;
|
|
} else {
|
|
return Distance;
|
|
}
|
|
}
|
|
|
|
#endif
|