mirror of
https://github.com/dragonpilot/dragonpilot.git
synced 2026-08-06 00:35:44 +08:00
Dragonpilot Team
4d7a40310f
version: dragonpilot v0.8.16 beta for EON/C2 date: 2022-08-11T09:38:43 dp-dev(priv2) master commit: c6cd233f23f60e7a6055d42850bc593c0e69082e
20 lines
685 B
Python
20 lines
685 B
Python
import numpy as np
|
|
from laika.raw_gnss import GNSSMeasurement
|
|
|
|
def parse_prr(m):
|
|
sat_pos_vel_i = np.concatenate((m[GNSSMeasurement.SAT_POS],
|
|
m[GNSSMeasurement.SAT_VEL]))
|
|
R_i = np.atleast_2d(m[GNSSMeasurement.PRR_STD]**2)
|
|
z_i = m[GNSSMeasurement.PRR]
|
|
return z_i, R_i, sat_pos_vel_i
|
|
|
|
def parse_pr(m):
|
|
pseudorange = m[GNSSMeasurement.PR]
|
|
pseudorange_stdev = m[GNSSMeasurement.PR_STD]
|
|
sat_pos_freq_i = np.concatenate((m[GNSSMeasurement.SAT_POS],
|
|
np.array([m[GNSSMeasurement.GLONASS_FREQ]])))
|
|
z_i = np.atleast_1d(pseudorange)
|
|
R_i = np.atleast_2d(pseudorange_stdev**2)
|
|
return z_i, R_i, sat_pos_freq_i
|
|
|