mirror of
https://github.com/meshtastic/firmware.git
synced 2026-11-06 14:24:20 -05:00
* fix(position): stamp the broadcast cadence only when a position packet was actually sent * fix(position): honor the router verdict and always fall back to nodeinfo when no position goes out * fix(position): snapshot Time::getMillis() for the throttle stamps and trim the added comments * fix(position): consume the radio-generation change only on a position send that went out * refactor(position): share one smart-broadcast path and drop the duplicated fresh-position guard * fix(position): persist smart broadcasts to the transmit history
123 lines
6.1 KiB
C++
123 lines
6.1 KiB
C++
#pragma once
|
|
#include "Default.h"
|
|
#include "ProtobufModule.h"
|
|
#include "concurrency/OSThread.h"
|
|
|
|
/**
|
|
* Position module for sending/receiving positions into the mesh
|
|
*/
|
|
class PositionModule : public ProtobufModule<meshtastic_Position>, private concurrency::OSThread
|
|
{
|
|
CallbackObserver<PositionModule, const meshtastic::Status *> nodeStatusObserver =
|
|
CallbackObserver<PositionModule, const meshtastic::Status *>(this, &PositionModule::handleStatusUpdate);
|
|
|
|
/// The id of the last packet we sent, to allow us to cancel it if we make something fresher
|
|
PacketId prevPacketId = 0;
|
|
|
|
/// We limit our GPS broadcasts to a max rate
|
|
uint32_t lastGpsSend = 0;
|
|
|
|
// Store the latest good lat / long
|
|
int32_t lastGpsLatitude = 0;
|
|
int32_t lastGpsLongitude = 0;
|
|
|
|
/// We force a rebroadcast if the radio settings change
|
|
uint32_t currentGeneration = 0;
|
|
|
|
public:
|
|
/** Constructor
|
|
* name is for debugging output
|
|
*/
|
|
PositionModule();
|
|
|
|
/**
|
|
* Send our position into the mesh. True only when the router took the packet.
|
|
*/
|
|
bool sendOurPosition(NodeNum dest, bool wantReplies = false, uint8_t channel = 0);
|
|
bool sendOurPosition();
|
|
|
|
/**
|
|
* Answer a position request that arrived on a channel we never share position on (the event channel):
|
|
* the reply goes out on the position channel at that channel's precision, tagged as a reply to req.
|
|
* Subject to the same reply throttle as allocReply(). No-op when no channel carries positions.
|
|
*/
|
|
void replyOnPositionChannel(const meshtastic_MeshPacket &req);
|
|
|
|
void handleNewPosition();
|
|
|
|
// Pure broadcast-policy helpers, split out so they're unit-testable without the module.
|
|
// True when two coordinates truncate to the same precision cell (so a re-broadcast would be a
|
|
// duplicate). precision 0 or >=32 returns false: no coarse cell to hold within, never suppress.
|
|
static bool positionWithinPrecisionCell(int32_t aLat, int32_t aLon, int32_t bLat, int32_t bLon, uint32_t precision);
|
|
// Effective min interval: stationary positions are held to stationaryFloorMs (when that is the
|
|
// longer of the two); otherwise the normal configured interval.
|
|
static uint32_t effectiveBroadcastIntervalMs(uint32_t configuredIntervalMs, bool stationary, uint32_t stationaryFloorMs);
|
|
// Pure local-play policy: stream our own position to the phone/UI when we have a valid
|
|
// position, the phone queue is idle, and the cadence has elapsed. everSentToPhone (rather
|
|
// than a lastSentMs sentinel) marks the never-sent state, so a send stamped at millis()==0
|
|
// still honors the cadence.
|
|
static bool shouldSendPositionToPhone(bool hasValidPosition, bool phoneQueueEmpty, bool everSentToPhone, uint32_t nowMs,
|
|
uint32_t lastSentMs, uint32_t intervalMs);
|
|
|
|
protected:
|
|
/** Called to handle a particular incoming message
|
|
|
|
@return true if you've guaranteed you've handled this message and no other handlers should be considered for it
|
|
*/
|
|
virtual bool handleReceivedProtobuf(const meshtastic_MeshPacket &mp, meshtastic_Position *p) override;
|
|
|
|
virtual void alterReceivedProtobuf(meshtastic_MeshPacket &mp, meshtastic_Position *p) override;
|
|
|
|
/** Messages can be received that have the want_response bit set. If set, this callback will be invoked
|
|
* so that subclasses can (optionally) send a response back to the original sender. */
|
|
virtual meshtastic_MeshPacket *allocReply() override;
|
|
|
|
/** Does our periodic broadcast */
|
|
virtual int32_t runOnce() override;
|
|
|
|
private:
|
|
meshtastic_MeshPacket *allocPositionPacket(uint32_t atPrecision);
|
|
// Streams our own position to the connected phone/UI at full precision without touching the
|
|
// mesh. Keeps the local view alive now that mesh position sharing is opt-in. Returns true
|
|
// only when a packet was handed to the phone queue.
|
|
bool sendOurPositionToPhone();
|
|
bool hasSentPositionToPhone = false;
|
|
uint32_t lastPhoneSendMs = 0;
|
|
static constexpr uint32_t sendToPhoneIntervalMs = 60 * 1000; // Matches telemetry's local cadence
|
|
struct SmartPosition getDistanceTraveledSinceLastSend(meshtastic_PositionLite currentPosition);
|
|
// Broadcast early when we have moved far enough since the last send, subject to the minimum
|
|
// interval. Stamps the cadence and the last-sent coords only on a send that went out.
|
|
void trySmartBroadcast(const meshtastic_PositionLite &selfPos, uint32_t nowMs);
|
|
// True when our position is unchanged since the last broadcast: it truncates to the same
|
|
// precision grid cell, so re-sending would be a duplicate that traffic management dedups
|
|
// downstream anyway. Used to hold stationary broadcasts to a 12h floor. useConfiguredPrecision
|
|
// gauges movement at our own configured (unclamped) precision rather than the on-wire
|
|
// (public-clamped) precision - trackers report finer movement.
|
|
bool positionUnchangedSinceLastSend(const meshtastic_PositionLite &selfPos, bool useConfiguredPrecision);
|
|
meshtastic_MeshPacket *allocAtakPli();
|
|
void trySetRtc(meshtastic_Position p, bool isLocal, bool forceUpdate = false);
|
|
uint32_t precision;
|
|
void sendLostAndFoundText();
|
|
bool hasQualityTimesource();
|
|
bool hasGPS();
|
|
uint32_t lastSentReply = 0; // Last time we sent a position reply (used for reply throttling only)
|
|
|
|
#if USERPREFS_EVENT_MODE
|
|
// In event mode we want to prevent excessive position broadcasts
|
|
// we set the minimum interval to 5m
|
|
const uint32_t minimumTimeThreshold =
|
|
max(uint32_t(300000), Default::getConfiguredOrDefaultMs(config.position.broadcast_smart_minimum_interval_secs,
|
|
default_broadcast_smart_minimum_interval_secs));
|
|
#else
|
|
const uint32_t minimumTimeThreshold = Default::getConfiguredOrDefaultMs(config.position.broadcast_smart_minimum_interval_secs,
|
|
default_broadcast_smart_minimum_interval_secs);
|
|
#endif
|
|
};
|
|
|
|
struct SmartPosition {
|
|
float distanceTraveled;
|
|
uint32_t distanceThreshold;
|
|
bool hasTraveledOverThreshold;
|
|
};
|
|
|
|
extern PositionModule *positionModule; |