МЕТОДЫ И АППАРАТУРА ОПРЕДЕЛЕНИЯ НАПРАВЛЕНИЯ ДВИЖЕНИЯ ПРИЕМНИКА ГНСС

1. Метод определения направления движения приемника ГНСС, отличающийся тем, что включает на каждом такте работы следующие шаги:
(A) формирование первичной оценки модуля вектора скорости с использованием текущих оценок проекций вектора скорости;
(B) формирование экстраполированного значения модуля вектора скорости с использованием предыдущих оценок модуля вектора скорости, полученных на шаге (A);
(C) формирование первичной оценки угла ориентации вектора скорости в одной из двух возможных областей определения угла: [0…2π] или [-π…+π], с использованием текущих оценок проекций вектора скорости;
(D) формирование оценки дисперсии первичной оценки угла ориентации вектора скорости в соответствии со следующим правилом:
(i) если оценка модуля вектора скорости, сформированная на шаге (A), меньше заданного минимального значения, то значение оценка дисперсии первичной оценки угла ориентации вектора скорости полагается равной заранее выбранной максимальной величине, а
(ii) в противном случае оценка дисперсии первичной оценки угла ориентации вектора скорости вычисляется как отношение предварительно полученной оценки дисперсии модуля вектора скорости к квадрату первичной оценки модуля вектора скорости, сформированной на (A);
(E) если экстраполированная величина модуля вектора скорости, полученная на шаге (B) больше заданного минимального значения, то выполняется шаг (G), в противном случае, выполняется шаг (F);
(F) установка следующей сглаженной оценки угла ориентации вектора скорости, равной своему предыдущему значению;
(G) формирование сглаженной оценки угла ориентации вектора скорости на основе нелинейной рекуррентной фильтрации первичных оценок угла ориентации, полученных на шаге (C), причем параметры фильтра на каждом такте получаются на основе оценки дисперсии первичной оценки угла ориентации вектора скорости, полученной на шаге (D).
2. Метод по п.1, отличающийся тем, что шаги (Е), (F) и (G) модифицируются для определения угла ориентации вектора скорости по предварительно сглаженным оценкам проекций вектора скорости согласно следующим правилам, при которых:
на шаге (Е), если и (a) экстраполированная оценка модуля вектора скорости, полученная на шаге (B) больше заданной минимальной величины скорости, и (b) счетчик времени определяет, что длительность предполагаемой остановки больше, чем заданная минимальная длительность, то выполняется шаг (G), в противном случае, выполняется шаг (F),
шаг (F) дополнительно включает увеличение значения счетчика времени;
шаг (G) дополнительно включает, установку счетчика времени в ноль;
3. Метод по п.1, отличающийся тем, что нелинейная рекуррентная фильтрация на шаге (G) включает использование модифицированного калмановского фильтра для обеспечения фильтрации циклической величины; а метод дополнительно включает на каждом такте:
(1) установку области определения сглаженной оценки угла в соответствии с областью определения первичных оценок угла ориентации вектора скорости, если сглаженная оценка не принадлежит к области определения угла, выбранной на шаге (C);
(2) установку области определения экстраполированной оценки угла в соответствии с областью определения первичных оценок угла ориентации вектора скорости, если экстраполированная оценка не принадлежит к области определения угла, выбранной на (C);
(3) формирование сигнала ошибки как кратчайшего расстояния между первичной оценкой угла ориентации вектора скорости и экстраполированной и экстраполированной оценкой этого угла.
4. Метод по п.3, отличающийся тем, что модифицированный калмановский фильтр, описанный на шаге (G) одновременно обрабатывает первичные оценки угла ориентации вектора скорости и первичные оценки угловой скорости, полученные с использованием фазовых измерений навигационного приемника, по крайней мере, в двух различных частотных диапазонах, оценка дисперсии которых определяется в зависимости от точности фазовых измерений приемника.
5. Метод по п.3, отличающийся тем, что в модифицированном калмановском фильтре к расчетному значению корреляционной матрицы ошибок экстраполяции добавляется матрица поправок где:
- величины поправок рассчитываются на основе заданной интенсивности вероятного маневра угла ориентации вектора скорости; и
- корреляционная матрица добавляется только на таких циклах операции фильтрации, когда модуль сигнала ошибки больше, чем квадратный корень дисперсии первичной оценки угла ориентации вектора скорости, полученной на шаге (D) не менее чем в 3-7 раз.
6. Метод по п.1, отличающийся тем, что на шаге (B) экстраполированное значение модуля вектора скорости определяется на основании первичной оценки модуля вектора скорости, полученной на шаге (A) на нескольких предыдущих тактах.
7. Метод по п.1, отличающийся тем, что на шаге (B) экстраполированное значение модуля вектора скорости определяется на основе оценки скорости изменения модуля вектора скорости, который, в свою очередь, формируется за счет сглаживания первичной оценки модуля вектора скорости на шаге (A).
8. Метод по п.4, отличающийся тем, что шаг (F) изменяется следующим образом:
(1) счетчик времени, определяющий длительность предполагаемой остановки увеличивается на 1;
(2) оценка дисперсии первичной оценки угла ориентации вектора скорости, полученной на шаге (D) на текущем такте заменяется заранее выбранной максимальной величиной;
(3) а затем выполняется шаг (G).
9. Аппаратура приемника ГНСС, отличающаяся тем, что предназначена для выполнения следующих действий:
(A) формирования первичной оценки модуля вектора скорости с использованием текущих оценок проекций вектора скорости;
(B) формирования экстраполированного значения модуля вектора скорости с использованием предыдущих оценок модуля вектора скорости, полученных на шаге (A);
(C) формирования первичной оценки угла ориентации вектора скорости в одной из двух возможных областей определения угла: [0…2π] или [-π…+π], с использованием текущих оценок проекций вектора скорости;
(D) формирования оценки дисперсии первичной оценки угла ориентации вектора скорости в соответствии со следующим правилом:
(i) если оценка модуля вектора скорости, сформированная на шаге (A), меньше заданного минимального значения, то значение оценка дисперсии первичной оценки угла ориентации вектора скорости полагается равной заранее выбранной максимальной величине, а
(ii) в противном случае оценка дисперсии первичной оценки угла ориентации вектора скорости вычисляется как отношение предварительно полученной оценки дисперсии модуля вектора скорости к квадрату первичной оценки модуля вектора скорости, сформированной на (A);
(E) если экстраполированная величина модуля вектора скорости, полученная на шаге (B) больше заданного минимального значения, то выполняется шаг (G), в противном случае, выполняется шаг (F);
(F) установка следующей сглаженной оценки угла ориентации вектора скорости, равной своему предыдущему значению;
(G) формирование сглаженной оценки угла ориентации вектора скорости на основе нелинейной рекуррентной фильтрации первичных оценок угла ориентации, полученных на шаге (C), причем параметры фильтра на каждом такте получаются на основе оценки дисперсии первичной оценки угла ориентации вектора скорости, полученной на шаге (D).
10. Аппаратура по п.9, отличающаяся тем, что шаги (E), (F) и (G) модифицируются для определения угла ориентации вектора скорости по предварительно сглаженным оценкам проекций вектора скорости согласно следующим правилам:
- на шаге (E), если и (a) экстраполированная оценка модуля вектора скорости, полученная на шаге (B) больше заданной минимальной величины скорости, и (b) счетчик времени определяет, что длительность предполагаемой остановки больше, чем заданная минимальная длительность, то выполняется шаг (G), в противном случае, выполняется шаг (F),
- шаг (F) дополнительно включает увеличение значения счетчика времени;
- шаг (G) дополнительно включает, установку счетчика времени в нуль;
11. Аппаратура по п.9, отличающаяся тем, что содержит модифицированный калмановский фильтр для нелинейной рекуррентной фильтрации для обеспечения фильтрации циклической величины; и на каждом такте аппаратура дополнительно выполняет следующее:
(1) установку области определения сглаженной оценки угла в соответствии с областью определения первичных оценок угла ориентации вектора скорости, если сглаженная оценка не принадлежит к области определения угла, выбранной на шаге (C);
(2) установку области определения экстраполированной оценки угла в соответствии с областью определения первичных оценок угла ориентации вектора скорости, если экстраполированная оценка не принадлежит к области определения угла, выбранной на (C); и
(3) формирование сигнала ошибки как кратчайшего расстояния между первичной оценкой угла ориентации вектора скорости и экстраполированной оценкой этого угла.
12. Аппаратура по п.10, отличающаяся тем, что модифицированный калмановский фильтр, описанный на шаге (G), одновременно обрабатывает первичные оценки угла ориентации вектора скорости и первичные оценки угловой скорости, полученные с использованием фазовых измерений навигационного приемника, по крайней мере, в двух различных частотных диапазонах, оценка дисперсии которых определяется в зависимости от точности фазовых измерений приемника.
13. Аппаратура по п.11, отличающаяся тем, что в модифицированном калмановском фильтре к расчетному значению корреляционной матрицы ошибок экстраполяции добавляется матрица поправок; где:
- величины поправок рассчитываются на основе заданной интенсивности вероятного маневра угла ориентации вектора скорости; и
- корреляционная матрица добавляется только на таких циклах операции фильтрации, когда модуль сигнала ошибки больше, чем квадратный корень дисперсии первичной оценки угла ориентации вектора скорости, полученной на шаге (D) не менее чем в 3-7 раз.
14. Аппаратура по п.9, отличающаяся тем, что на шаге (B) экстраполированное значение модуля вектора скорости определяется на основании первичной оценки модуля вектора скорости, полученной на шаге (A) на нескольких предыдущих тактах.
15. Аппаратура по п.9, отличающаяся тем, что на шаге (B) экстраполированное значение модуля вектора скорости определяется на основе оценки скорости изменения модуля вектора скорости, который, в свою очередь, формируется за счет сглаживания первичной оценки модуля вектора скорости на шаге (A).
16. Аппаратура по п 12, отличающаяся тем, что шаг (F) заменяется следующим образом:
(1) счетчик времени, определяющий длительность предполагаемой остановки увеличивается на 1;
(2) оценка дисперсии первичной оценки угла ориентации вектора скорости, полученной на шаге (D) на текущем такте заменяется заранее выбранной максимальной величиной;
(3) а затем выполняется шаг (G).
17. Метод определения направления движения приемника ГНСС, отличающийся тем, что включает на каждом такте работы шаги:
n
E
N
<mrow />
<mrow />
<mrow><msub><mi>V</mi><mi>n</mi></msub><mo>=</mo><msqrt><mrow><msubsup><mi>V</mi><mi>E</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>V</mi><mi>N</mi><mn>2</mn></msubsup></mrow></msqrt></mrow>
(A) формирование первичных оценок модуля вектора скорости V, используя текущие оценки проекций вектора скорости V и V следующим образом:
;
pred
n
(B) формирование экстраполированной величины модуля вектора скорости V используя V, полученного на шаге (A) на пред и предпредыдущем тактах работы или еще более ранних тактах;
<mrow />
<mrow />
<mrow><mi>Θ</mi><mo>=</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>g</mi><mrow><mo>(</mo><mrow><mfrac><mrow><msub><mi>V</mi><mi>E</mi></msub></mrow><mrow><msub><mi>V</mi><mi>N</mi></msub></mrow></mfrac></mrow><mo>)</mo></mrow></mrow>
(C) формирование первичной оценки угла ориентации вектора скорости Θ следующим образом:
, где Θ находится в области [0…2π];
<mrow><msubsup><mi>σ</mi><mi>Θ</mi><mn>2</mn></msubsup></mrow>
(D) формирование оценки дисперсии
угла Θ:
<mrow><msubsup><mi>σ</mi><mi>Θ</mi><mn>2</mn></msubsup><mo>=</mo><mrow><mo>{</mo><mrow><mtable><mtr><mtd><mrow><msubsup><mi>σ</mi><mrow><mi>Θ</mi><mi>M</mi><mi>A</mi><mi>X</mi></mrow><mn>2</mn></msubsup></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><msub><mi>V</mi><mi>n</mi></msub><mo><</mo><msub><mi>V</mi><mrow><mi>min</mi></mrow></msub></mrow><mo>〉</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mfrac bevelled="true"><mrow><msubsup><mi>σ</mi><mi>V</mi><mn>2</mn></msubsup></mrow><mrow><msubsup><mi>V</mi><mi>n</mi><mn>2</mn></msubsup></mrow></mfrac></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><msub><mi>V</mi><mi>n</mi></msub><mo>≥</mo><msub><mi>V</mi><mrow><mi>min</mi></mrow></msub></mrow><mo>〉</mo></mrow></mrow></mtd></mtr></mtable></mrow></mrow></mrow>
,
<mrow><msubsup><mi>σ</mi><mrow><mi>Θ</mi><mi>M</mi><mi>A</mi><mi>X</mi></mrow><mn>2</mn></msubsup></mrow>
<mrow><msubsup><mi>σ</mi><mi>V</mi><mn>2</mn></msubsup></mrow>
min
n
где
,
, V - это заранее заданные величины, a V получена на шаге (A);
pred
min
(E) если V>V, то выполняется шаг (G), в противном случае выполняется шаг (F);
<mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub></mrow>
<mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub><mo>:</mo><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub><mo>=</mo><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub></mrow>
(F) установка следующей сглаженной оценки угла ориентации вектора скорости
, равного его предыдущей величине
;
<mrow />
<mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub></mrow>
<mrow><msub><mi>Θ</mi><mi>n</mi></msub></mrow>
<mrow><msubsup><mi>σ</mi><mi>Θ</mi><mn>2</mn></msubsup></mrow>
(G) формирование сглаженной оценки
с помощью калмановской фильтрации, приспособленной к первичным оценкам фильтра
, полученным на шаге (C) и с помощью
, взятого на шаге (D):
<mrow><msubsup><mi>ϑ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>=</mo><msub><mi>F</mi><mn>2</mn></msub><mrow><mo>[</mo><mrow><msub><mi>Φ</mi><mi>n</mi></msub><mo>⋅</mo><msub><mover accent="true"><mi>ϑ</mi><mo>˜</mo></mover><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub></mrow><mo>]</mo></mrow></mrow>
,
<mrow><msubsup><mi>Ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>=</mo><msub><mi>Φ</mi><mi>n</mi></msub><mo>⋅</mo><mrow><mo>(</mo><mrow><msub><mi>Ψ</mi><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mi>Ψ</mi><mn>0</mn></msub></mrow><mo>)</mo></mrow><mo>⋅</mo><msubsup><mi>Φ</mi><mi>n</mi><mi>T</mi></msubsup></mrow>
,
<mrow><msub><mi>K</mi><mi>n</mi></msub><mo>=</mo><msubsup><mi>Ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>⋅</mo><msubsup><mi>H</mi><mi>n</mi><mi>T</mi></msubsup><mo>⋅</mo><msup><mrow><mrow><mo>(</mo><mrow><msub><mi>H</mi><mi>n</mi></msub><mo>⋅</mo><msubsup><mi>Ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>⋅</mo><msubsup><mi>H</mi><mi>n</mi><mi>T</mi></msubsup><mo>+</mo><msub><mi>R</mi><mi>n</mi></msub></mrow><mo>)</mo></mrow></mrow><mrow><mo>−</mo><mn>1</mn></mrow></msup></mrow>
,
<mrow><msub><mover accent="true"><mi>ϑ</mi><mo>˜</mo></mover><mi>n</mi></msub><mo>=</mo><msub><mi>F</mi><mn>2</mn></msub><mrow><mo>[</mo><mrow><msubsup><mi>ϑ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>+</mo><msub><mi>K</mi><mi>n</mi></msub><mo>⋅</mo><msub><mi>F</mi><mn>1</mn></msub><mrow><mo>[</mo><mrow><msub><mi>Y</mi><mi>n</mi></msub><mo>−</mo><msub><mi>H</mi><mi>n</mi></msub><mo>⋅</mo><msubsup><mi>ϑ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow><mo>]</mo></mrow></mrow><mo>]</mo></mrow></mrow>
,
<mrow><mi>Ψ</mi><mo>=</mo><msubsup><mi>Ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>−</mo><msub><mi>K</mi><mi>n</mi></msub><mo>⋅</mo><msub><mi>H</mi><mi>n</mi></msub><mo>⋅</mo><msubsup><mi>Ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow>
,
<mrow><msub><mi>Y</mi><mi>n</mi></msub><mo>=</mo><msub><mi>Θ</mi><mi>n</mi></msub></mrow>
где
- первичная оценка угла с шага (C),
<mrow><msub><mi>R</mi><mi>n</mi></msub><mo>=</mo><msubsup><mi>σ</mi><mrow><mi>Θ</mi><mi>n</mi></mrow><mn>2</mn></msubsup></mrow>
i - оценка дисперсии с шага (D),
<mrow><msubsup><mi>ϑ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow>
- экстраполированная оценка,
<mrow><msub><mover accent="true"><mi>ϑ</mi><mo>˜</mo></mover><mi>n</mi></msub></mrow>
- сглаженная оценка,
1
2
F[…] и F[…] - нелинейные преобразования, чтобы модифицировать Калмановский фильтр для фильтрации циклических величин,
0
Ψ - заранее заданная величина параметра, ограничивающего полосу пропускания калмановского фильтра,
n
матрица Φ основана на выбранной модели изменения угла,
n
матрица H учитывает выбранный порядок фильтра.
<mrow><msub><mi>V</mi><mi>E</mi></msub><mo>=</mo><msub><mover accent="true"><mi>V</mi><mo>˜</mo></mover><mi>E</mi></msub></mrow>
<mrow><msub><mi>V</mi><mi>N</mi></msub><mo>=</mo><msub><mover accent="true"><mi>V</mi><mo>˜</mo></mover><mi>N</mi></msub></mrow>
18. Метод по п.17, отличающийся тем, что шаги (E), (F) и (G) модифицируются для определения угла Θ, используя предварительно сглаженные
и
:
pred
min
s
причем, на шаге (E), если и V>Vи t>Т, то выполняется шаг (G), в противном случае выполняется шаг (F),
s
где t - это счетчик времени длительности предполагаемой остановки, T - это заранее заданная минимальная величина времени;
s
s
причем шаг (F) дополнительно включает увеличение счетчика на 1 t=t+1; и
s
на шаге (G), t=0.
19. Метод по п.17, отличающийся тем, что калмановский фильтр на шаге (G) обеспечивает фильтрацию циклической величины, и включает:
<mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub></mrow>
<mrow><msub><mi>Θ</mi><mi>n</mi></msub></mrow>
<mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub><mo>≡</mo><mrow><mo>{</mo><mrow><mtable><mtr><mtd><mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><mn>0</mn><mo><</mo><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub><mo><</mo><mn>2</mn><mi>π</mi></mrow><mo>〉</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub><mo>−</mo><mn>2</mn><mi>π</mi></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub><mo>></mo><mn>2</mn><mi>π</mi></mrow><mo>〉</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>Θ</mi><mi>n</mi></msub><mo>+</mo><mn>2</mn><mi>π</mi></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><msub><mover accent="true"><mi>Θ</mi><mo>˜</mo></mover><mi>n</mi></msub><mo><</mo><mn>0</mn></mrow><mo>〉</mo></mrow></mrow></mtd></mtr></mtable></mrow></mrow></mrow>
2
(1) установку области для
в соответствии с областью
, выбранной на шаге (C) путем использования преобразования F[…], где
;
<mrow><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow>
<mrow><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>≡</mo><mrow><mo>{</mo><mrow><mtable><mtr><mtd><mrow><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><mn>0</mn><mo><</mo><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo><</mo><mn>2</mn><mi>π</mi></mrow><mo>〉</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>−</mo><mn>2</mn><mi>π</mi></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>></mo><mn>2</mn><mi>π</mi></mrow><mo>〉</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>+</mo><mn>2</mn><mi>π</mi></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo><</mo><mn>0</mn></mrow><mo>〉</mo></mrow></mrow></mtd></mtr></mtable></mrow></mrow></mrow>
n
2
(2) установку области для
в соответствии с областью Θ, выбранной на шаге (C) путем использования преобразования F[…], где
; и
<mrow><msub><mi>Δ</mi><mrow><mi>Θ</mi><mi>n</mi></mrow></msub><mo>=</mo><msub><mi>F</mi><mn>1</mn></msub><mrow><mo>[</mo><mrow><msub><mi>Y</mi><mi>n</mi></msub><mo>−</mo><msub><mi>H</mi><mi>n</mi></msub><mo>⋅</mo><msubsup><mi>ϑ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow><mo>]</mo></mrow></mrow>
<mrow><msub><mi>Θ</mi><mi>n</mi></msub></mrow>
<mrow><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow>
1
n
(3) формирование сигнала ошибки
как разницы по кратчайшей дуге между
и
, где преобразование F[Δ]
,
<mrow><msub><mi>Δ</mi><mi>n</mi></msub><mo>=</mo><msub><mi>Θ</mi><mi>n</mi></msub><mo>−</mo><msubsup><mi>Θ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow>
Θn
где
- в области Δ, выбранном на шаге (C).
n
<mrow><msubsup><mover accent="true"><mi>Θ</mi><mo>˙</mo></mover><mi>n</mi><mi>ϕ</mi></msubsup></mrow>
<mrow><msubsup><mi>Φ</mi><mi>n</mi><mrow><mi>L</mi><mn>1</mn></mrow></msubsup></mrow>
<mrow><msubsup><mi>Φ</mi><mi>n</mi><mrow><mi>L</mi><mn>2</mn></mrow></msubsup></mrow>
<mrow><msubsup><mi>σ</mi><mrow><msup><mover accent="true"><mi>Θ</mi><mo>˙</mo></mover><mi>ϕ</mi></msup></mrow><mn>2</mn></msubsup></mrow>
20. Метод по п.19, отличающийся тем, что фильтр на шаге (G) одновременной обрабатывает Θ и первичные оценки скорости угла
, полученные с использование фазовых измерений
,
полученных ГНСС приемником не менее, чем в двух частотных диапазонах L1, L2, оценка дисперсии которых
, определяется в зависимости от точности фазовых измерений приемника и
n
n
<mrow><msub><mi>Y</mi><mi>n</mi></msub><mo>=</mo><mrow><mo>‖</mo><mrow><mtable><mtr><mtd><mrow><msub><mi>Θ</mi><mi>n</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mover accent="true"><mi>Θ</mi><mo>˙</mo></mover><mi>n</mi><mi>ϕ</mi></msubsup></mrow></mtd></mtr></mtable></mrow><mo>‖</mo></mrow></mrow>
<mrow><msub><mi>R</mi><mi>n</mi></msub><mo>=</mo><mrow><mo>‖</mo><mrow><mtable><mtr><mtd><mrow><msubsup><mi>σ</mi><mi>Θ</mi><mn>2</mn></msubsup></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mrow><msubsup><mi>σ</mi><mrow><msup><mover accent="true"><mi>Θ</mi><mo>˙</mo></mover><mi>ϕ</mi></msup></mrow><mn>2</mn></msubsup></mrow></mtd></mtr></mtable></mrow><mo>‖</mo></mrow></mrow>
где матрицы фильтра Y, R имеют форму
,
,
<mrow><msubsup><mover accent="true"><mi>Θ</mi><mo>˙</mo></mover><mi>n</mi><mi>ϕ</mi></msubsup></mrow>
причем для оценки
используется приращение угла на каждом такте работы τ равное
<mrow><mi>Δ</mi><msubsup><mi>θ</mi><mi>n</mi><mi>ϕ</mi></msubsup><mo>=</mo><mfrac><mrow><msub><mi>f</mi><mrow><mi>L</mi><mn>2</mn></mrow></msub></mrow><mrow><msub><mi>f</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>−</mo><msub><mi>f</mi><mrow><mi>L</mi><mn>2</mn></mrow></msub></mrow></mfrac><mo>⋅</mo><mi>Δ</mi><msubsup><mi>φ</mi><mi>n</mi><mrow><mi>L</mi><mn>1</mn></mrow></msubsup><mo>−</mo><mfrac><mrow><msub><mi>f</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub></mrow><mrow><msub><mi>f</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>−</mo><msub><mi>f</mi><mrow><mi>L</mi><mn>2</mn></mrow></msub></mrow></mfrac><mo>⋅</mo><mi>Δ</mi><msubsup><mi>φ</mi><mi>n</mi><mrow><mi>L</mi><mn>2</mn></mrow></msubsup></mrow>
,
L1
L2
где, f и f - номинальные значения несущей частоты в соответствующих диапазонах ГНСС,
<mrow><mi>Δ</mi><msubsup><mi>φ</mi><mi>n</mi><mrow><mi>L</mi><mn>1</mn></mrow></msubsup><mo>=</mo><msubsup><mi>φ</mi><mi>n</mi><mrow><mi>L</mi><mn>1</mn></mrow></msubsup><mo>−</mo><msubsup><mi>φ</mi><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow><mrow><mi>L</mi><mn>1</mn></mrow></msubsup></mrow>
<mrow><mi>Δ</mi><msubsup><mi>φ</mi><mi>n</mi><mrow><mi>L</mi><mn>2</mn></mrow></msubsup><mo>=</mo><msubsup><mi>φ</mi><mi>n</mi><mrow><mi>L</mi><mn>2</mn></mrow></msubsup><mo>−</mo><msubsup><mi>φ</mi><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow><mrow><mi>L</mi><mn>2</mn></mrow></msubsup></mrow>
и
- приращения полных фаз, измеренные с помощью ГНСС приемника на соответствующих несущих частотах на каждом такте, и где
<mrow><msubsup><mi>σ</mi><mrow><msup><mover accent="true"><mi>Θ</mi><mo>˙</mo></mover><mi>ϕ</mi></msup><mo>,</mo><mi>n</mi></mrow><mn>2</mn></msubsup></mrow>
<mrow><mi>S</mi><mi>N</mi><msubsup><mi>R</mi><mrow><mi>j</mi><mo>,</mo><mi>n</mi></mrow><mrow><mi>L</mi><mn>1</mn></mrow></msubsup></mrow>
<mrow><mi>S</mi><mi>N</mi><msubsup><mi>R</mi><mrow><mi>j</mi><mo>,</mo><mi>n</mi></mrow><mrow><mi>L</mi><mn>2</mn></mrow></msubsup></mrow>
для оценки
, используются оценки отношения сигнал-шум
и
после того, как они получены от j-того спутника в диапазонах L1 и L2 соответственно.
<mrow><msubsup><mi>ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow>
<mrow><mrow><mo>{</mo><mrow><msub><mi>G</mi><mi>n</mi></msub><mo>⋅</mo><msub><mi>ψ</mi><mi>η</mi></msub><mo>⋅</mo><msubsup><mi>G</mi><mi>n</mi><mi>T</mi></msubsup></mrow><mo>}</mo></mrow></mrow>
21. Метод по п.19, отличающийся тем, что в модифицированном калмановском фильтре к расчетному значению корреляционной матрицы ошибок экстраполяции
добавляется матрица поправок
, величины которых вычисляются в соответствии с ожидаемой максимальной интенсивностью маневра по углу ориентации вектора скорости,
<mrow><msub><mi>ψ</mi><mi>η</mi></msub><mo>=</mo><msubsup><mi>σ</mi><mover accent="true"><mi>Θ</mi><mo>¨</mo></mover><mn>2</mn></msubsup></mrow>
причем величины поправок рассчитываются на основе заранее заданной интенсивности возможного маневра угла ориентации вектора скорости
,
<mrow><mrow><mo>{</mo><mrow><msub><mi>G</mi><mi>n</mi></msub><mo>⋅</mo><msub><mi>ψ</mi><mi>η</mi></msub><mo>⋅</mo><msubsup><mi>G</mi><mi>n</mi><mi>T</mi></msubsup></mrow><mo>}</mo></mrow></mrow>
<mrow><msub><mi>σ</mi><mrow><msub><mi>Θ</mi><mi>n</mi></msub></mrow></msub></mrow>
Θn
причем матрица поправок
добавляется только на таких тактах операции фильтрования, когда |Δ| больше стандартного отклонения
более чем в 3-7 раз,
<mrow><msubsup><mi>Ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>=</mo><mrow><mo>{</mo><mrow><mtable><mtr><mtd><mrow><msubsup><mi>ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>+</mo><msub><mi>G</mi><mi>n</mi></msub><mo>⋅</mo><msub><mi>ψ</mi><mi>η</mi></msub><mo>⋅</mo><msubsup><mi>G</mi><mi>n</mi><mi>T</mi></msubsup></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><mrow><mo>|</mo><mrow><msub><mi>Δ</mi><mrow><mi>Θ</mi><mi>n</mi></mrow></msub></mrow><mo>|</mo></mrow><mo>></mo><mi>Π</mi><mo>⋅</mo><msub><mi>σ</mi><mrow><mi>Θ</mi><mi>n</mi></mrow></msub></mrow><mo>〉</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>ψ</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup></mrow></mtd><mtd><mrow><mi>i</mi><mi>f</mi><mrow><mo>〈</mo><mrow><mrow><mo>|</mo><mrow><msub><mi>Δ</mi><mrow><mi>Θ</mi><mi>n</mi></mrow></msub></mrow><mo>|</mo></mrow><mo>≤</mo><mi>Π</mi><mo>⋅</mo><msub><mi>σ</mi><mrow><mi>Θ</mi><mi>n</mi></mrow></msub></mrow><mo>〉</mo></mrow></mrow></mtd></mtr></mtable></mrow></mrow></mrow>
,
где Π=3…7, и
n
где матрица G учитывает выбранную модель изменения угла.
<mrow><msubsup><mi>V</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>=</mo><mn>2</mn><mo>⋅</mo><msub><mi>V</mi><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub><mo>−</mo><msub><mi>V</mi><mrow><mi>n</mi><mo>−</mo><mn>2</mn></mrow></msub></mrow>
n-1
n-2
22. Метод по п.17, отличающийся тем, что на шаге (B),
, где V, V берутся с шага (A) на предыдущем и пред-предыдущем тактах работы соответственно.
<mrow><msubsup><mi>V</mi><mi>n</mi><mrow><mi>p</mi><mi>r</mi><mi>e</mi><mi>d</mi></mrow></msubsup><mo>=</mo><msub><mover accent="true"><mi>V</mi><mo>˜</mo></mover><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mover accent="true"><mover accent="true"><mi>V</mi><mo>˙</mo></mover><mo>˜</mo></mover><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub><mo>⋅</mo><mi>τ</mi></mrow>
<mrow><msub><mover accent="true"><mi>V</mi><mo>˜</mo></mover><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub></mrow>
<mrow><msub><mover accent="true"><mover accent="true"><mi>V</mi><mo>˙</mo></mover><mo>˜</mo></mover><mrow><mi>n</mi><mo>−</mo><mn>1</mn></mrow></msub></mrow>
23. Метод по п.17, отличающийся тем, что на шаге (B)
, где
,
- сглаженные оценки модуля вектора скорости и его первая производная соответственно, взятые с предыдущего такта работы.
24. Метод по п.20, отличающийся тем, что шаг (F) изменяется на следующее:
s
s
s
(1) счетчик времени t предназначенный для определения длительности предполагаемой остановки увеличивается на 1: t=t+1;
<mrow><msubsup><mi>σ</mi><mrow><mi>Θ</mi><mi>n</mi></mrow><mn>2</mn></msubsup></mrow>
<mrow><msubsup><mi>σ</mi><mrow><mi>Θ</mi><mi>M</mi><mi>A</mi><mi>X</mi></mrow><mn>2</mn></msubsup><mo>:</mo><msubsup><mi>σ</mi><mrow><mi>Θ</mi><mi>n</mi></mrow><mn>2</mn></msubsup><mo>=</mo><msubsup><mi>σ</mi><mrow><mi>Θ</mi><mi>M</mi><mi>A</mi><mi>X</mi></mrow><mn>2</mn></msubsup></mrow>
(2)
для текущего такта на шаге (D) заменяется на
,
(3) а затем выполняется шаг (G).