rpd000000832 (1012236), страница 4
Текст из файла (страница 4)
- “истинное” значение производной дальности между антенной потребителя и НИСЗ;
- “истинное” значение вектора скорости НИСЗ;
- “истинное” значение вектора скорости антенны;
- единичный вектор в направлении “истинной” дальности между антенной и НИСЗ;
- систематическая ошибка измерений производной дальности; представляет собой случайную центрированную гауссовскую величину с заданной дисперсией;
- случайная аддитивная ошибка, обусловленная внутренними шумами приемника представляющая собой реализацию случайного процесса, определяемого следующим уравнением формирующего фильтра первого порядка:
где
w – белый шум;
и – интервал корреляции и с.к.о. данного случайного процесса.
Модель измерений «опорной» производной дальности до НИСЗ описывается следующими соотношениями:
где
- опорное значение производной дальности между антенной пользователя и НИСЗ;
- опорное значение вектора скорости НИСЗ;
- опорное значение вектора скорости антенны;
- единичный вектор в направлении опорной дальности между антенной и НИСЗ
Рис. 1.1.
-
Среди полного созвездия НИСЗ необходимо учитывать только видимые, т.е. находящиеся в непосредственной геометрической видимости (см. рис. 1.1.)
Условие проверки видимости формируется следующим образом:
Для того чтобы выяснить будет ли НИСЗ находиться в зоне видимости потребителя, необходимо сравнить , угол должен быть больше чем угол (см. рис. 1.1).
-
Метод непосредственного решения навигационной задачи (только для задания №1) относится к конечным и состоит в следующем:
В результате навигационного сеанса известны координаты НИСЗ и измеренные значения дальностей до НИСЗ. Дальность выражается через координаты потребителя и НИСЗ следующим образом:
где - значение дальности до i-го НИСЗ,
- прямоугольные координаты i-го НИСЗ,
-прямоугольные координаты потребителя.
Решая совместно эти уравнения и проведя ряд замен переменных получаем в итоге квадратное уравнение относительно z:
Решение квадратного уравнения дает оценку координаты z. Значения координат x и y вычисляются подстановкой z с систему уравнений x(z),y(z):
Двузначность, связанная с решением квадратного уравнения решается путем сравнения со счисляемым местом.
Итерационные методы решения системы нелинейных уравнений различаются объемом и скоростью сходимости. Среди итерационных методов по выборке минимального объема наибольшее распространение имеет метод Ньютона, как один из проще всего реализуемых и быстро сходящихся. В качестве априорной информации требуются координаты потребителя. По окончании навигационного сеанса известны координаты НИСЗ i=1,2,3 , дальности до НИСЗ
. Далее рассчитываются невязки, которые рассчитывают путем вычитания расчетных величин
из измеренных
:
Решение системы методом Ньютона представляет собой процесс многократной обработки результатов навигационных измерений. В векторном виде решение можно представить следующей формулой:
где - вектор оцениваемых параметров объекта,
Таковы конечный и итерационный методы навигационных определений по минимально необходимому объему. Если при решении навигационной задачи есть возможность получить избыточный объем измерений, то целесообразно пользоваться статистическими методами обработки выборки измерений.
-
Для нахождения вектора состояния применяется метод наименьших квадратов (МНК) по полной выборке (только для задания №1). Минимизация функции квадратов невязок,
- вес i-го измерения, i=20/2i ,
лежит в основе оценивания искомых параметров по методу МНК. Невязка представляет собой разность между измеренной и расчетной величинами. Навигационной функцией в данном случае является дальность измеренная в ходе навигационного сеанса:
Так как функция является нелинейной, а МНК применим для линейных функций. линеаризуем ее разложением в ряд Тейлора в окрестности опорного положения:
Преобразуя полученное выражение, получим уравнение для приращения навигационной функции:
Приращение оценки в матричной форме записывается в следующем виде :
где W представляет из себя матрицу весов измерений, размерностью :
В результате вычислений получим значение оценки приращения положения потребителя. Затем сравним ее с заданной точностью вычислений, если полученная оценка не удовлетворяет заданной точности, то совершается новая итерация по ее улучшению. В противном случае, проводится новый сеанс измерений.
Таким образом, при использовании данного алгоритма используется линеаризованная в окрестности опорного положения потребителя модель измерений. Это означает, что начальное приближение координат должно незначительно отличаться от истинного, так как в противоположном случае линеаризация измерений некорректна и гарантировать сходимость вышеуказанного алгоритма не представляется возможным.
-
При обработке измерений рекуррентным байесовским алгоритмом (фильтром Калмана) используется линеаризованная модель движения 1.2 с фундаментальной матрицей решения 1.3. и моделью измерительных каналов, изложенных в п.4.
Уравнение фильтра запишем в виде:
где - апостериорная оценка отклонения вектора состояния КА от опорного значения;
yi – вектор истинных измеренных параметров (дальность и производная дальности);
Hi – матрица частных производных измеренных параметров по вектору состояния КА в окрестности опорной траектории;
Di – матрица интенсивностей шумов измерений.
Необходимо отметить, что также как и в предыдущем случае(п.7), в алгоритме вычисляются отклонения положения и скорости КА от опорных значений.
-
В случае уточнения систематических ошибок измерений дальности и производной дальности необходимо внести данные компоненты в расширенный фазовый вектор системы с формальных дифференциальным уравнением
и произвести их оценку учитывая изменения в фундаментальной матрице и матрице измерений.
Варианты заданий.
Задание №1 (варианты)
Потребитель (пользователь СНС):
Координаты в WGS-84: долгота - 38; широта - 56; высота над земным эллипсоидом – 70м, ковариационная матрица пользователя – диагональная, причем = 0.01, = 0.01, h = 10м.
Начальные условия движения НИСЗ СНС ГЛОНАСС/GPS:
Вектора математических ожиданий для каждого из НИСЗ приведены в Приложении 2.
Ковариационные матрицы для каждого НИСЗ СНС ГЛОНАСС являются диагональными, причем x,y,z = 13м., Vx, Vy, Vz = 0.3м/с.;
Ковариационные матрицы для каждого НИСЗ СНС GPS являются диагональными, причем x,y,z = 10м., Vx, Vy, Vz = 0.1м/с.;
Интервал времени навигационных определений 30 мин., частота работы навигационной системы – 1Гц.
Варианты заданий сведены в таблицу 1.1.
Таблица 1.1.
Задание №2 (варианты)
Потребитель (пользователь СНС):
КА, находящийся на круговой орбите высотой 500 км., долгота восходящего узла - 0; наклонение орбиты - 60; ковариационная матрица КА диагональная, причем
x,y,z = 100м., Vx, Vy, Vz = 1 м/с.;
Начальные условия движения НИСЗ СНС ГЛОНАСС/GPS:
Вектора математических ожиданий для каждого из НИСЗ приведены в Приложении 2.
Ковариационные матрицы для каждого НИСЗ СНС ГЛОНАСС являются диагональными, причем x,y,z = 13м., Vx, Vy, Vz = 0.3м/с.;
Ковариационные матрицы для каждого НИСЗ СНС GPS являются диагональными, причем x,y,z = 10м., Vx, Vy, Vz = 0.1м/с.;
Интервал времени навигационных определений 180 мин., частота работы навигационной системы – 0.1Гц.
Варианты заданий сведены в таблицу 1.2.