Pseudorange[m] = (AverageTravelTime[s] + delta_t[s]) * speedOfLight[m/s]
где: m
- метры, s
- секунды.
Попробуйте следующим образом:
- Выберите спутники из одного созвездия (сначала попробуйте с GPS).
- Выберите максимальное значение
ReceivedSvTimeNanos
. - Рассчитайте
delta_t
для каждого спутника как
макс. ReceivedSvTimeNanos
минус ток ReceivedSvTimeNanos
(delta_t = maxRst - curRst
). - Среднее время в пути составляет 70 миллисекунд, скорость света 299792458 м / с.используйте его для расчета.
Не забудьте преобразовать все значения в одни и те же единицы.
Подробнее см. этот pdf и UserPositionVelocityWeightedLeastSquare
класс