mirror of
https://github.com/meshtastic/firmware.git
synced 2025-06-08 22:22:05 +00:00
189 lines
8.5 KiB
C++
189 lines
8.5 KiB
C++
#include "DeviceTelemetry.h"
|
|
#include "../mesh/generated/meshtastic/telemetry.pb.h"
|
|
#include "Default.h"
|
|
#include "MeshService.h"
|
|
#include "NodeDB.h"
|
|
#include "PowerFSM.h"
|
|
#include "RTC.h"
|
|
#include "RadioLibInterface.h"
|
|
#include "Router.h"
|
|
#include "configuration.h"
|
|
#include "main.h"
|
|
#include "memGet.h"
|
|
#include <OLEDDisplay.h>
|
|
#include <OLEDDisplayUi.h>
|
|
#include <meshUtils.h>
|
|
|
|
#define MAGIC_USB_BATTERY_LEVEL 101
|
|
|
|
int32_t DeviceTelemetryModule::runOnce()
|
|
{
|
|
refreshUptime();
|
|
bool isImpoliteRole =
|
|
IS_ONE_OF(config.device.role, meshtastic_Config_DeviceConfig_Role_SENSOR, meshtastic_Config_DeviceConfig_Role_ROUTER);
|
|
if (((lastSentToMesh == 0) ||
|
|
((uptimeLastMs - lastSentToMesh) >=
|
|
Default::getConfiguredOrDefaultMsScaled(moduleConfig.telemetry.device_update_interval,
|
|
default_telemetry_broadcast_interval_secs, numOnlineNodes))) &&
|
|
airTime->isTxAllowedChannelUtil(!isImpoliteRole) && airTime->isTxAllowedAirUtil() &&
|
|
config.device.role != meshtastic_Config_DeviceConfig_Role_REPEATER &&
|
|
config.device.role != meshtastic_Config_DeviceConfig_Role_CLIENT_HIDDEN) {
|
|
sendTelemetry();
|
|
lastSentToMesh = uptimeLastMs;
|
|
} else if (service->isToPhoneQueueEmpty()) {
|
|
// Just send to phone when it's not our time to send to mesh yet
|
|
// Only send while queue is empty (phone assumed connected)
|
|
sendTelemetry(NODENUM_BROADCAST, true);
|
|
if (lastSentStatsToPhone == 0 || (uptimeLastMs - lastSentStatsToPhone) >= sendStatsToPhoneIntervalMs) {
|
|
sendLocalStatsToPhone();
|
|
lastSentStatsToPhone = uptimeLastMs;
|
|
}
|
|
}
|
|
return sendToPhoneIntervalMs;
|
|
}
|
|
|
|
bool DeviceTelemetryModule::handleReceivedProtobuf(const meshtastic_MeshPacket &mp, meshtastic_Telemetry *t)
|
|
{
|
|
// Don't worry about storing telemetry in NodeDB if we're a repeater
|
|
if (config.device.role == meshtastic_Config_DeviceConfig_Role_REPEATER)
|
|
return false;
|
|
|
|
if (t->which_variant == meshtastic_Telemetry_device_metrics_tag) {
|
|
#ifdef DEBUG_PORT
|
|
const char *sender = getSenderShortName(mp);
|
|
|
|
LOG_INFO("(Received from %s): air_util_tx=%f, channel_utilization=%f, battery_level=%i, voltage=%f", sender,
|
|
t->variant.device_metrics.air_util_tx, t->variant.device_metrics.channel_utilization,
|
|
t->variant.device_metrics.battery_level, t->variant.device_metrics.voltage);
|
|
#endif
|
|
nodeDB->updateTelemetry(getFrom(&mp), *t, RX_SRC_RADIO);
|
|
}
|
|
return false; // Let others look at this message also if they want
|
|
}
|
|
|
|
meshtastic_MeshPacket *DeviceTelemetryModule::allocReply()
|
|
{
|
|
if (currentRequest) {
|
|
auto req = *currentRequest;
|
|
const auto &p = req.decoded;
|
|
meshtastic_Telemetry scratch;
|
|
meshtastic_Telemetry *decoded = NULL;
|
|
memset(&scratch, 0, sizeof(scratch));
|
|
if (pb_decode_from_bytes(p.payload.bytes, p.payload.size, &meshtastic_Telemetry_msg, &scratch)) {
|
|
decoded = &scratch;
|
|
} else {
|
|
LOG_ERROR("Error decoding DeviceTelemetry module!");
|
|
return NULL;
|
|
}
|
|
// Check for a request for device metrics
|
|
if (decoded->which_variant == meshtastic_Telemetry_device_metrics_tag) {
|
|
LOG_INFO("Device telemetry reply to request");
|
|
return allocDataProtobuf(getDeviceTelemetry());
|
|
} else if (decoded->which_variant == meshtastic_Telemetry_local_stats_tag) {
|
|
LOG_INFO("Device telemetry reply w/ LocalStats to request");
|
|
return allocDataProtobuf(getLocalStatsTelemetry());
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
meshtastic_Telemetry DeviceTelemetryModule::getDeviceTelemetry()
|
|
{
|
|
meshtastic_Telemetry t = meshtastic_Telemetry_init_zero;
|
|
t.which_variant = meshtastic_Telemetry_device_metrics_tag;
|
|
t.time = getTime();
|
|
t.variant.device_metrics = meshtastic_DeviceMetrics_init_zero;
|
|
t.variant.device_metrics.has_air_util_tx = true;
|
|
t.variant.device_metrics.has_battery_level = true;
|
|
t.variant.device_metrics.has_channel_utilization = true;
|
|
t.variant.device_metrics.has_voltage = true;
|
|
t.variant.device_metrics.has_uptime_seconds = true;
|
|
|
|
t.variant.device_metrics.air_util_tx = airTime->utilizationTXPercent();
|
|
t.variant.device_metrics.battery_level = (!powerStatus->getHasBattery() || powerStatus->getIsCharging())
|
|
? MAGIC_USB_BATTERY_LEVEL
|
|
: powerStatus->getBatteryChargePercent();
|
|
t.variant.device_metrics.channel_utilization = airTime->channelUtilizationPercent();
|
|
t.variant.device_metrics.voltage = powerStatus->getBatteryVoltageMv() / 1000.0;
|
|
t.variant.device_metrics.uptime_seconds = getUptimeSeconds();
|
|
|
|
return t;
|
|
}
|
|
|
|
meshtastic_Telemetry DeviceTelemetryModule::getLocalStatsTelemetry()
|
|
{
|
|
meshtastic_Telemetry telemetry = meshtastic_Telemetry_init_zero;
|
|
telemetry.which_variant = meshtastic_Telemetry_local_stats_tag;
|
|
telemetry.variant.local_stats = meshtastic_LocalStats_init_zero;
|
|
telemetry.time = getTime();
|
|
telemetry.variant.local_stats.uptime_seconds = getUptimeSeconds();
|
|
telemetry.variant.local_stats.channel_utilization = airTime->channelUtilizationPercent();
|
|
telemetry.variant.local_stats.air_util_tx = airTime->utilizationTXPercent();
|
|
telemetry.variant.local_stats.num_online_nodes = numOnlineNodes;
|
|
telemetry.variant.local_stats.num_total_nodes = nodeDB->getNumMeshNodes();
|
|
if (RadioLibInterface::instance) {
|
|
telemetry.variant.local_stats.num_packets_tx = RadioLibInterface::instance->txGood;
|
|
telemetry.variant.local_stats.num_packets_rx = RadioLibInterface::instance->rxGood + RadioLibInterface::instance->rxBad;
|
|
telemetry.variant.local_stats.num_packets_rx_bad = RadioLibInterface::instance->rxBad;
|
|
telemetry.variant.local_stats.num_tx_relay = RadioLibInterface::instance->txRelay;
|
|
}
|
|
#ifdef ARCH_PORTDUINO
|
|
if (SimRadio::instance) {
|
|
telemetry.variant.local_stats.num_packets_tx = SimRadio::instance->txGood;
|
|
telemetry.variant.local_stats.num_packets_rx = SimRadio::instance->rxGood + SimRadio::instance->rxBad;
|
|
telemetry.variant.local_stats.num_packets_rx_bad = SimRadio::instance->rxBad;
|
|
telemetry.variant.local_stats.num_tx_relay = SimRadio::instance->txRelay;
|
|
}
|
|
#else
|
|
telemetry.variant.local_stats.heap_total_bytes = memGet.getHeapSize();
|
|
telemetry.variant.local_stats.heap_free_bytes = memGet.getFreeHeap();
|
|
#endif
|
|
if (router) {
|
|
telemetry.variant.local_stats.num_rx_dupe = router->rxDupe;
|
|
telemetry.variant.local_stats.num_tx_relay_canceled = router->txRelayCanceled;
|
|
}
|
|
|
|
LOG_INFO("Sending local stats: uptime=%i, channel_utilization=%f, air_util_tx=%f, num_online_nodes=%i, num_total_nodes=%i",
|
|
telemetry.variant.local_stats.uptime_seconds, telemetry.variant.local_stats.channel_utilization,
|
|
telemetry.variant.local_stats.air_util_tx, telemetry.variant.local_stats.num_online_nodes,
|
|
telemetry.variant.local_stats.num_total_nodes);
|
|
|
|
LOG_INFO("num_packets_tx=%i, num_packets_rx=%i, num_packets_rx_bad=%i", telemetry.variant.local_stats.num_packets_tx,
|
|
telemetry.variant.local_stats.num_packets_rx, telemetry.variant.local_stats.num_packets_rx_bad);
|
|
|
|
return telemetry;
|
|
}
|
|
|
|
void DeviceTelemetryModule::sendLocalStatsToPhone()
|
|
{
|
|
meshtastic_MeshPacket *p = allocDataProtobuf(getLocalStatsTelemetry());
|
|
p->to = NODENUM_BROADCAST;
|
|
p->decoded.want_response = false;
|
|
p->priority = meshtastic_MeshPacket_Priority_BACKGROUND;
|
|
|
|
service->sendToPhone(p);
|
|
}
|
|
|
|
bool DeviceTelemetryModule::sendTelemetry(NodeNum dest, bool phoneOnly)
|
|
{
|
|
meshtastic_Telemetry telemetry = getDeviceTelemetry();
|
|
LOG_INFO("Send: air_util_tx=%f, channel_utilization=%f, battery_level=%i, voltage=%f, uptime=%i",
|
|
telemetry.variant.device_metrics.air_util_tx, telemetry.variant.device_metrics.channel_utilization,
|
|
telemetry.variant.device_metrics.battery_level, telemetry.variant.device_metrics.voltage,
|
|
telemetry.variant.device_metrics.uptime_seconds);
|
|
|
|
meshtastic_MeshPacket *p = allocDataProtobuf(telemetry);
|
|
p->to = dest;
|
|
p->decoded.want_response = false;
|
|
p->priority = meshtastic_MeshPacket_Priority_BACKGROUND;
|
|
|
|
nodeDB->updateTelemetry(nodeDB->getNodeNum(), telemetry, RX_SRC_LOCAL);
|
|
if (phoneOnly) {
|
|
LOG_INFO("Send packet to phone");
|
|
service->sendToPhone(p);
|
|
} else {
|
|
LOG_INFO("Send packet to mesh");
|
|
service->sendToMesh(p, RX_SRC_LOCAL, true);
|
|
}
|
|
return true;
|
|
} |