Skip to content

Commit cdbebad

Browse files
committed
update relposlen calculation
1 parent 196e237 commit cdbebad

File tree

1 file changed

+7
-4
lines changed

1 file changed

+7
-4
lines changed

src/pygpsclient/ubx_handler.py

Lines changed: 7 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -361,13 +361,16 @@ def _process_NAV_RELPOSNED(self, data: UBXMessage):
361361
must be derived from the NED values
362362
- version 1 has heading and length attributes
363363
364+
NB: pyubx2 parses relPosHP values as mm, so total relPosN
365+
in cm = relPosN + (relPosHPN * 1e-1), etc.
366+
364367
:param UBXMessage data: NAV-RELPOSNED parsed message
365368
"""
366369

367370
if data.version == 0x00:
368-
n = data.relPosN + data.relPosHPN * 1e-2
369-
e = data.relPosE + data.relPosHPE * 1e-2
370-
d = data.relPosD + data.relPosHPD * 1e-2
371+
n = data.relPosN + data.relPosHPN * 1e-1
372+
e = data.relPosE + data.relPosHPE * 1e-1
373+
d = data.relPosD + data.relPosHPD * 1e-1
371374
relPosLength, relPosHeading = ned2vector(n, e, d)
372375
n = data.accN * 1e-2
373376
e = data.accE * 1e-2
@@ -376,7 +379,7 @@ def _process_NAV_RELPOSNED(self, data: UBXMessage):
376379
accHeading = accLength * relPosHeading / relPosLength # ballpark
377380
else:
378381
relPosLength, relPosHeading, accLength, accHeading = (
379-
data.relPosLength + data.relPosHPLength * 1e-2,
382+
data.relPosLength + data.relPosHPLength * 1e-1,
380383
data.relPosHeading,
381384
data.accLength * 1e-2,
382385
data.accHeading,

0 commit comments

Comments
 (0)