pohui_pohui/firmware
1
0
Fork 0
mirror of https://github.com/meshtastic/firmware.git synced 2025-06-16 18:12:07 +00:00
Code Issues Actions 6 Packages Projects Releases Wiki Activity

Fix wrong-side-of-globe when precision set to 32

Browse Source
This commit is contained in:
Jonathan Bennett 2024-02-25 21:27:32 -06:00
parent d434117ffd
commit 0dcd3584e4
1 changed files with 7 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
src/modules/PositionModule.cpp
View File

@ -118,13 +118,16 @@ meshtastic_MeshPacket *PositionModule::allocReply()
// lat/lon are unconditionally included - IF AVAILABLE! // lat/lon are unconditionally included - IF AVAILABLE!
LOG_DEBUG("Sending location with precision %i\n", precision); LOG_DEBUG("Sending location with precision %i\n", precision);
p.latitude_i = localPosition.latitude_i & (INT32_MAX << (32 - precision)); if (precision < 32 && precision > 0) {
p.longitude_i = localPosition.longitude_i & (INT32_MAX << (32 - precision)); p.latitude_i = localPosition.latitude_i & (INT32_MAX << (32 - precision));
p.longitude_i = localPosition.longitude_i & (INT32_MAX << (32 - precision));
// We want the imprecise position to be the middle of the possible location, not // We want the imprecise position to be the middle of the possible location, not
if (precision < 31 && precision > 1) {
p.latitude_i += (1 << (31 - precision)); p.latitude_i += (1 << (31 - precision));
p.longitude_i += (1 << (31 - precision)); p.longitude_i += (1 << (31 - precision));
} else {
p.latitude_i = localPosition.latitude_i;
p.longitude_i = localPosition.longitude_i;
} }
p.precision_bits = precision; p.precision_bits = precision;
p.time = localPosition.time; p.time = localPosition.time;