|
|
|
@ -77,48 +77,41 @@ mesh::LocalIdentity radio_new_identity() { |
|
|
|
|
|
|
|
static INA3221 INA_3221(TELEM_INA3221_ADDRESS, &Wire); |
|
|
|
static INA219 INA_219(TELEM_INA219_ADDRESS, &Wire); |
|
|
|
static Adafruit_AHTX0 AHTX; |
|
|
|
|
|
|
|
bool PromicroSensorManager::begin() { |
|
|
|
if (INA_3221.begin()) { |
|
|
|
MESH_DEBUG_PRINTLN("Found INA3221 at address: %02X", INA_3221.getAddress()); |
|
|
|
MESH_DEBUG_PRINTLN("%04X %04X %04X", INA_3221.getDieID(), INA_3221.getManufacturerID(), INA_3221.getConfiguration()); |
|
|
|
initINA3221(); |
|
|
|
initINA219(); |
|
|
|
initAHTX(); |
|
|
|
|
|
|
|
for(int i = 0; i < 3; i++) { |
|
|
|
INA_3221.setShuntR(i, TELEM_INA3221_SHUNT_VALUE); |
|
|
|
} |
|
|
|
INA3221initialized = true; |
|
|
|
} else { |
|
|
|
INA3221initialized = false; |
|
|
|
MESH_DEBUG_PRINTLN("INA3221 was not found at I2C address %02X", TELEM_INA3221_ADDRESS); |
|
|
|
} |
|
|
|
if (INA_219.begin()) { |
|
|
|
MESH_DEBUG_PRINTLN("Found INA219 at address: %02X", INA_219.getAddress()); |
|
|
|
INA219_CHANNEL = INA3221initialized ? TELEM_CHANNEL_SELF + 4 : TELEM_CHANNEL_SELF + 1; |
|
|
|
INA_219.setMaxCurrentShunt(TELEM_INA219_MAX_CURRENT, TELEM_INA219_SHUNT_VALUE); |
|
|
|
INA219initialized = true; |
|
|
|
} else { |
|
|
|
INA219initialized = false; |
|
|
|
MESH_DEBUG_PRINTLN("INA219 was not found at I2C address %02X", TELEM_INA219_ADDRESS); |
|
|
|
} |
|
|
|
return true; |
|
|
|
} |
|
|
|
|
|
|
|
bool PromicroSensorManager::querySensors(uint8_t requester_permissions, CayenneLPP& telemetry) { |
|
|
|
int nextAvalableChannel = TELEM_CHANNEL_SELF + 1; |
|
|
|
if (requester_permissions & TELEM_PERM_ENVIRONMENT) { |
|
|
|
if (INA3221initialized) { |
|
|
|
for(int i = 0; i < 3; i++) { |
|
|
|
// add only enabled INA3221 channels to telemetry
|
|
|
|
if (INA3221_CHANNEL_ENABLED[i]) { |
|
|
|
telemetry.addVoltage(INA3221_CHANNELS[i], INA_3221.getBusVoltage(i)); |
|
|
|
telemetry.addCurrent(INA3221_CHANNELS[i], INA_3221.getCurrent(i)); |
|
|
|
telemetry.addPower(INA3221_CHANNELS[i], INA_3221.getPower(i)); |
|
|
|
telemetry.addVoltage(nextAvalableChannel, INA_3221.getBusVoltage(i)); |
|
|
|
telemetry.addCurrent(nextAvalableChannel, INA_3221.getCurrent(i)); |
|
|
|
telemetry.addPower(nextAvalableChannel, INA_3221.getPower(i)); |
|
|
|
nextAvalableChannel++; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
if(INA219initialized) { |
|
|
|
telemetry.addVoltage(INA219_CHANNEL, INA_219.getBusVoltage()); |
|
|
|
telemetry.addCurrent(INA219_CHANNEL, INA_219.getCurrent()); |
|
|
|
telemetry.addPower(INA219_CHANNEL, INA_219.getPower()); |
|
|
|
if (INA219initialized) { |
|
|
|
telemetry.addVoltage(nextAvalableChannel, INA_219.getBusVoltage()); |
|
|
|
telemetry.addCurrent(nextAvalableChannel, INA_219.getCurrent()); |
|
|
|
telemetry.addPower(nextAvalableChannel, INA_219.getPower()); |
|
|
|
nextAvalableChannel++; |
|
|
|
} |
|
|
|
if (AHTXinitialized) { |
|
|
|
sensors_event_t humidity, temp; |
|
|
|
AHTX.getEvent(&humidity, &temp); |
|
|
|
telemetry.addTemperature(TELEM_CHANNEL_SELF, temp.temperature); |
|
|
|
telemetry.addRelativeHumidity(TELEM_CHANNEL_SELF, humidity.relative_humidity); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
@ -162,4 +155,40 @@ bool PromicroSensorManager::setSettingValue(const char* name, const char* value) |
|
|
|
} |
|
|
|
} |
|
|
|
return false; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
void PromicroSensorManager::initINA3221() { |
|
|
|
if (INA_3221.begin()) { |
|
|
|
MESH_DEBUG_PRINTLN("Found INA3221 at address: %02X", INA_3221.getAddress()); |
|
|
|
MESH_DEBUG_PRINTLN("%04X %04X %04X", INA_3221.getDieID(), INA_3221.getManufacturerID(), INA_3221.getConfiguration()); |
|
|
|
|
|
|
|
for(int i = 0; i < 3; i++) { |
|
|
|
INA_3221.setShuntR(i, TELEM_INA3221_SHUNT_VALUE); |
|
|
|
} |
|
|
|
INA3221initialized = true; |
|
|
|
} else { |
|
|
|
INA3221initialized = false; |
|
|
|
MESH_DEBUG_PRINTLN("INA3221 was not found at I2C address %02X", TELEM_INA3221_ADDRESS); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
void PromicroSensorManager::initINA219() { |
|
|
|
if (INA_219.begin()) { |
|
|
|
MESH_DEBUG_PRINTLN("Found INA219 at address: %02X", INA_219.getAddress()); |
|
|
|
INA_219.setMaxCurrentShunt(TELEM_INA219_MAX_CURRENT, TELEM_INA219_SHUNT_VALUE); |
|
|
|
INA219initialized = true; |
|
|
|
} else { |
|
|
|
INA219initialized = false; |
|
|
|
MESH_DEBUG_PRINTLN("INA219 was not found at I2C address %02X", TELEM_INA219_ADDRESS); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
void PromicroSensorManager::initAHTX() { |
|
|
|
if (AHTX.begin(&Wire, 0, TELEM_AHTX_ADDRESS)) { |
|
|
|
MESH_DEBUG_PRINTLN("Found AHT10/AHT20 at address: %02X", TELEM_AHTX_ADDRESS); |
|
|
|
AHTXinitialized = true; |
|
|
|
} else { |
|
|
|
AHTXinitialized = false; |
|
|
|
MESH_DEBUG_PRINTLN("AHT10/AHT20 was not found at I2C address %02X", TELEM_AHTX_ADDRESS); |
|
|
|
} |
|
|
|
} |
|
|
|
|