2020-11-28 05:51:51 +00:00
|
|
|
#include "PositionPlugin.h"
|
2020-12-03 08:48:44 +00:00
|
|
|
#include "MeshService.h"
|
2020-11-28 05:51:51 +00:00
|
|
|
#include "NodeDB.h"
|
2020-12-03 08:48:44 +00:00
|
|
|
#include "RTC.h"
|
|
|
|
#include "Router.h"
|
|
|
|
#include "configuration.h"
|
2020-11-28 05:51:51 +00:00
|
|
|
|
2021-01-08 05:15:49 +00:00
|
|
|
PositionPlugin *positionPlugin;
|
2020-11-28 05:51:51 +00:00
|
|
|
|
2020-12-03 08:48:44 +00:00
|
|
|
bool PositionPlugin::handleReceivedProtobuf(const MeshPacket &mp, const Position &p)
|
2020-11-28 05:51:51 +00:00
|
|
|
{
|
2020-12-03 08:48:44 +00:00
|
|
|
// FIXME - we currently update position data in the DB only if the message was a broadcast or destined to us
|
|
|
|
// it would be better to update even if the message was destined to others.
|
|
|
|
|
2020-12-05 02:00:46 +00:00
|
|
|
if (p.time) {
|
|
|
|
struct timeval tv;
|
|
|
|
uint32_t secs = p.time;
|
|
|
|
|
|
|
|
tv.tv_sec = secs;
|
|
|
|
tv.tv_usec = 0;
|
|
|
|
|
|
|
|
perhapsSetRTC(RTCQualityFromNet, &tv);
|
|
|
|
}
|
|
|
|
|
2020-12-03 08:48:44 +00:00
|
|
|
nodeDB.updatePosition(mp.from, p);
|
2020-11-28 05:51:51 +00:00
|
|
|
|
|
|
|
return false; // Let others look at this message also if they want
|
|
|
|
}
|
2020-12-03 08:48:44 +00:00
|
|
|
|
2020-12-07 02:18:11 +00:00
|
|
|
MeshPacket *PositionPlugin::allocReply()
|
2020-12-03 08:48:44 +00:00
|
|
|
{
|
2021-01-04 01:59:53 +00:00
|
|
|
NodeInfo *node = service.refreshMyNodeInfo(); // should guarantee there is now a position
|
|
|
|
assert(node->has_position);
|
2021-01-03 12:11:26 +00:00
|
|
|
|
2021-01-04 01:59:53 +00:00
|
|
|
return allocDataProtobuf(node->position);
|
2020-12-07 02:18:11 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void PositionPlugin::sendOurPosition(NodeNum dest, bool wantReplies)
|
|
|
|
{
|
2021-02-11 09:39:53 +00:00
|
|
|
// cancel any not yet sent (now stale) position packets
|
|
|
|
if(prevPacketId) // if we wrap around to zero, we'll simply fail to cancel in that rare case (no big deal)
|
|
|
|
service.cancelSending(prevPacketId);
|
2021-02-11 11:00:17 +00:00
|
|
|
|
2020-12-07 02:18:11 +00:00
|
|
|
MeshPacket *p = allocReply();
|
2020-12-03 08:48:44 +00:00
|
|
|
p->to = dest;
|
|
|
|
p->decoded.want_response = wantReplies;
|
2021-02-11 11:00:17 +00:00
|
|
|
p->priority = MeshPacket_Priority_BACKGROUND;
|
2021-02-11 09:39:53 +00:00
|
|
|
prevPacketId = p->id;
|
2020-12-03 08:48:44 +00:00
|
|
|
|
|
|
|
service.sendToMesh(p);
|
|
|
|
}
|
2020-12-05 03:15:06 +00:00
|
|
|
|