rbxii3/firmware
1
0
Fork 0
mirror of https://github.com/meshtastic/firmware.git synced 2025-12-21 18:22:32 +00:00
Code Issues Packages Projects Releases Wiki Activity

Implementation of smart positioning #934

Browse Source 
Initial check in for https://github.com/meshtastic/Meshtastic-device/issues/934
This commit is contained in:
Jm Casler
2021-11-26 19:12:00 -08:00
parent f6fde55363
commit 3ec508169a
3 changed files with 38 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

32
src/plugins/PositionPlugin.cpp
View File

@@ -4,6 +4,8 @@
#include "NodeDB.h"
#include "RTC.h"
#include "Router.h"
#include "gps/GeoCoord.h"
PositionPlugin *positionPlugin;
@@ -144,6 +146,9 @@ int32_t PositionPlugin::runOnce()
lastGpsSend = now;
lastGpsLatitude = node->position.latitude_i;
lastGpsLongitude = node->position.longitude_i;
// If we changed channels, ask everyone else for their latest info
bool requestReplies = currentGeneration != radioGeneration;
currentGeneration = radioGeneration;
@@ -151,6 +156,33 @@ int32_t PositionPlugin::runOnce()
DEBUG_MSG("Sending pos@%x:6 to mesh (wantReplies=%d)\n",
node->position.pos_timestamp, requestReplies);
sendOurPosition(NODENUM_BROADCAST, requestReplies);
} else if (radioConfig.preferences.position_broadcast_smart == true) {
// radioConfig.preferences.position_broadcast_smart
//NodeInfo *node = service.refreshMyNodeInfo(); // should guarantee there is now a position
if (node->has_position && (node->position.latitude_i != 0 || node->position.longitude_i != 0) ) {
float distance = GeoCoord::latLongToMeter(lastGpsLatitude * 1e-7, lastGpsLongitude * 1e-7,
node->position.latitude_i * 1e-7, node->position.longitude_i * 1e-7);
// Please don't change this value. This accomodates for possible poor positioning
// in the event the GPS has a poor satelite lock.
const uint8_t distanceTravel = 100;
// Minimum time between position updates.
const uint8_t timeTravel = 60;
// If the distance traveled since the last update is greater than 100 meters
// and it's been at least 60 seconds since the last update
if ((abs(distance) >= distanceTravel) && (lastGpsSend == 0 || now - timeTravel >= getPref_position_broadcast_secs() * 1000)) {
bool requestReplies = currentGeneration != radioGeneration;
currentGeneration = radioGeneration;
DEBUG_MSG("Sending pos@%x:6 to mesh (wantReplies=%d)\n",
node->position.pos_timestamp, requestReplies);
sendOurPosition(NODENUM_BROADCAST, requestReplies);
}
}
}
return 5000; // to save power only wake for our callback occasionally