Аннотация
При решении задач определения параметров движения космических аппаратов (КА) часто возникает
задача определения движения КА на фоне работы двигателей. В качестве примера можно привести
следующие задачи: контроль участка выведения КА на орбиту искусственного спутника Земли,
оперативная оценка исполнения импульсов и прогноза падения орбитального комплекса по
измерениям наземных средств на фоне работы двигательной установки, определение параметров
движения КА с электроракетной двигательной установкой. В работе рассмотрены алгоритмы решения
указанных выше задач при различных характеристиках воздействующего шума. К модели такого типа
привела задача определения параметров движения КА по измерениям псевдоскорости и
псевдодальности спутниковых навигационных систем. Динамическая модель, описывающая поведение
кинематических и служебных параметров приемника, состоит из уравнений динамики полета КА и
уравнений авторегрессии, в которые входит возбуждающий белый шум.
Abstract
By solving problems of parameter determination of the SC motion frequently arises a problem
of determination of the SC motion upon a noise background of engine’s work. As examples it is
possible to present the following problems: controlling of the space vehicle launch phase
into orbit of the Earth’s artificial satellite, actual estimation of performance of impulses
and forecast of a falling of an orbital complex on measurements of ground means with a noise
of boosters working, determination of the SC motion parameters with an electro-rocket propulsion
system. In this work algorithms of a solution of the mentioned above problems taking into
account various performances of an influencing noise are considered. To the model of such
kind a problem of the SC motion parameters determination on measurements of a pseudo-rates
and pseudo-ranges of satellite navigational systems leads. The dynamic model describing
a behavior of kinematical and service parameters consists of the equations of a SC flight
dynamics and equations of an autoregression, into which the exciting white noise enters.
Введение
Задача определения параметров движения
космического аппарата (КА) является одной из основных задач, решаемых в ходе
управления его полетом [1-14]. При решении этой задачи часто возникает
ситуация, в которой определение параметров движения КА надо выполнять на фоне
работы двигателей. В качестве примера можно привести следующие задачи: контроль
участка выведения КА на орбиту искусственного спутника Земли, оперативная
оценка исполнения импульсов и прогноза падения орбитального комплекса по
измерениям наземных средств на фоне работы двигательной установки, определение
параметров движения КА с электроракетной двигательной установкой (ЭРДУ).
Определение параметров движения КА на участке
выведения является важной частью навигационного обеспечения управления полётом
[3]. Для контроля выведения
используется сеть наземных измерительных пунктов, которые обеспечивают
измерения дальности, азимута и угла места в различных комбинациях. Результатом контроля является вектор
состояния и другие данные, позволяющие определить: находится ли реальная
траектория в допустимой трубке от
номинальной траектории. Кроме того, в результате контроля участка выведения,
получаются самые первые данные об орбите выведения КА. В основе используемой
модели движения ракеты-носителя лежит представление фактического движения КА
как отклонения от номинальной траектории. Номинальная траектория в виде таблицы
подаётся на вход задаче определения параметров траектории КА. Отклонение от
этой траектории на ограниченном интервале времени предполагается
равноускоренным. Остающиеся невязки рассматриваются как шумовая составляющая.
Импульсы, реализующие сход с орбиты
орбитального комплекса (ОК) «Мир», имели такую большую длительность, что в зоне
видимости комплекса не оставалось интервалов его пассивного движения. Для
оперативной оценки исполнения импульсов и прогноза падения ОК «Мир», а также
апостериорного анализа его движения на заключительном этапе полета, в ИПМ была
разработана специальная методика [4]. Эта методика позволила определять по
данным наземных радиотехнических измерений траекторию движения ОК на фоне
работы его двигательной установки.
Полет КА с включенным ЭРДУ создает дополнительные
проблемы при решении задач навигации и управления полетом. Фактическое
ускорение, создаваемое ЭРДУ, отличается от модели этого ускорения, заложенного
в расчеты. Имеются ошибки величины и ориентации вектора тяги ЭРДУ в
пространстве [5].
Решение
этих задач основано на применении моделей динамических систем, в которых помехи
имеются не только в измерениях, но и влияют на поведение самого объекта. Такие
модели исследованы, в основном в рамках линейных моделей, в общей теории систем
[15-20]. Применение этих моделей и методов в задачах определения движения КА
требует использования соответствующих нелинейных моделей и учета особенностей
уравнений динамики и измеряемых функций.
К
модели такого типа привела задача определения параметров движения КА по
измерениям псевдоскорости и псевдодальности спутниковых навигационных систем.
Задача определения параметров движения в такой постановке требует наряду с
уточнением кинематических параметров движения КА уточнять служебные параметры
приемника [21-23]. Эти служебные параметры включают: смещение шкалы времени
приемника относительно шкалы времени космической системы (идеальной шкалы),
уход частоты задающего генератора и сдвиг фазы генерации псевдошумовой
последовательности. Случайные процессы, описывающие поведение служебных
параметров во времени, представляются авторегрессиями. Динамическая модель,
описывающая поведение кинематических и служебных параметров, состоит из
уравнений динамики полета КА и уравнений авторегрессии, в которые входит
возбуждающий белый шум. В функциональные зависимости измеряемых функций входят
кинематические параметры движения КА и служебные параметры приемника.
При
решении указанных выше задач применяются различные модели шума и соответственно
используются различные методы и алгоритмы оценки вектора состояния. Могут
применяться комбинированные методы.
В
предположении, что шум близок по своим характеристикам к белому шуму, а
количество аномальных измерений невелико, целесообразно применять алгоритм,
который обеспечивает оценку вектора состояния и суммарные возмущения между
измерениями. Этот алгоритм рассмотрен в первой главе.
Во
второй главе приведен алгоритм оценки вектора состояния в случае отсутствия
возмущений.
Если
шум близок к постоянным систематическим воздействиям, целесообразно применять
алгоритм, позволяющий оценивать средние значения приращений этих воздействий на
мерном интервале. Алгоритм оценки вектора состояния и средних значений
возмущений рассмотрен в главе 3.
В
тех случаях, когда точность и состав измеряемых функций не позволяют оценить
параметры шума, целесообразно применять метод мешающих параметров [1,2]. Если в
качестве оцениваемого вектора состояния выбрать вектор состояния на конец
мерной базы, то неучтенный шум будет приводить к увеличивающимся ошибкам модели
по мере перемещения от конца мерной базы к ее началу. Суть метода мешающих
параметров состоит в учете этой нарастающей ошибки модели в весовой матрице
измерений. Алгоритм оценки вектора состояния с использованием метода мешающих параметров
рассмотрен в главе 4. В этой главе рассмотрены варианты алгоритма для двух
типов возмущений: белого шума и случайных величин, постоянных на всем
интервале. Алгоритм оценки вектора состояния с использованием метода мешающих
параметров целесообразно применять при решении задач оценки точности
определения параметров движения КА. Этот алгоритм позволяет оценить воздействие
шума при приближенных представлениях о его статистических характеристиках.
В главе 5 рассмотрен
алгоритм оценки вектора состояния и возмущений дискретной динамической системы.
Задача в такой постановке решается на каждом шаге итерационного процесса в
алгоритме оценки вектора состояния и суммарных воздействий возмущений между
измерениями. В качестве критерия качества оценки использована функция,
содержащая квадрат взвешенного отклонения априорно заданного вектора состояния
от его расчетного значения, а также квадраты взвешенных невязок измеренных и
расчетных значений и взвешенных возмущений. Рассмотрены свойства этих оценок,
включая рекуррентные соотношения между оценками, полученными по различным
мерным базам, и рекуррентные соотношения для получения оценки вектора состояния
и возмущения внутри мерной базы.
1.
Алгоритм оценки вектора состояния и суммарных
воздействий возмущений между измерениями
1.1.
Постановка задачи
Рассмотрим динамическую систему, математическая модель которой
описывается стохастическим дифференциальным уравнением:
, (1.1)
где
|
─
|
-мерный вектор состояния;
|
|
─
|
-мерная гладкая вектор-функция;
|
|
─
|
матрица порядка , элементы которой являются непрерывными функциями;
|
|
─
|
-мерный белый шум с нулевым математическим ожиданием и
заданной матрицей интенсивности порядка .
|
Начальные условия для
системы (1.1) задаются априорным вектором и его ковариационной
матрицей .
В моменты времени производятся
измерения функций . Измеренное значение функции обозначим через . Для каждого момента времени справедливо
(1.2)
где
|
–
|
случайный вектор, имеющий нулевое
математическое ожидание и ковариационную матрицу .
|
Запись в качестве параметра функции означает, что функция
зависит не от
мгновенного значения вектора состояния, а от функции , которая является решением уравнения (1.1).
Рассмотрим
сначала задачу в линейной постановке.
1.1.
Линейный случай
В линейной постановке
уравнение (1.1) примет вид:
, (1.3)
где
|
–
|
квадратная матрица порядка , элементы которой
являются непрерывными функциями времени
.
|
Измеряемые функции в линейной постановке
являются линейными функциями вектора состояния . В каждый момент времени справедливо
соотношение:
(1.4)
где
|
–
|
вектор параметров размерности , измеряемых в момент времени ;
|
|
–
|
матрица размерности ;
|
|
–
|
последовательность независимых случайных
векторов, имеющих нулевое математическое ожидание и ковариационную матрицу .
|
Зависимость между векторами
состояния системы в дискретные моменты времени , определяемая дифференциальным уравнением (1.3), может быть
выражена при помощи его разностного аналога, определяемого соотношениями:
(1.5)
Здесь
– фундаментальная матрица, удовлетворяющая
матричному уравнению
(1.6)
при начальном условии , где — единичная матрица
размерности .
–
последовательность случайных векторов с нулевым математическим ожиданием и
ковариационными матрицами , вычисляемыми по формуле:
(1.7)
Случайный вектор связан с шумом соотношением:
. (1.8)
Он может быть интерпретирован, как
суммарное воздействие возмущений на интервале
времени от до , т. е. между ым и ым измерениями.
Введем следующие обозначения:
(1.9)
С учетом соотношения (1.4) и
полученной системы разностных уравнений задача оценивания может далее
рассматриваться в дискретной постановке. Требуется получить оценку вектора
состояния дискретной
динамической системы, которая описывается следующим соотношением:
(1.10)
при априорно заданной оценке начального
вектора состояния и ковариационной
матрице этой оценки . Измеряемые величины связаны с векторами
состояния уравнениями:
,
(1.11)
где — случайный вектор
размерности с нулевым
математическим ожиданием и ковариационной матрицей .
Построим
оценку вектора состояния и суммарных возмущающих воздействий дискретной
динамической системы (1.10, 1.11) по мерной базе, содержащей измерений. Используем метод наименьших квадратов. Критерием
качества оценки является квадратичная форма следующего вида:
,
(1.12)
где
|
–
|
оценка вектора состояния на момент с использованием измерений : ;
|
|
–
|
оценка вектора суммарных возмущений при использовании измерений: .
|
Квадратичная форма содержит
члены трех типов:
- квадраты невязок
измеренных и расчетных значений, отнесенные к априорно известным
среднеквадратическим отклонениям ошибок измерений;
- квадраты суммарных
возмущений на интервалах между измерениями, отнесенные к априорно известным
средним значениям суммарных возмущений на тех же интервалах;
- квадрат взвешенного
отклонения априорно заданного вектора состояния от его расчетного значения.
В разделе 5 показано, что
оценки и , т.е. оценки векторов состояния на момент последнего
измерения, полученные по и измерениям, связаны
следующим рекуррентным соотношением:
,
(1.13)
где матрица вычисляется по
рекуррентным формулам:
,
, (1.14)
,
,
……………………………...
,
.
Оценки вектора состояния
и суммарного
воздействия возмущений на момент вычисляются с
использованием следующих рекуррентных соотношений:
(1.15)
(1.16)
Здесь
– вспомогательные
векторы.
Рекуррентные соотношения
(1.13, 1.14) называются уравнениями фильтра Калмана.
1.2.
Нелинейный случай
Решение уравнения (1.1) на
интервале будем
аппроксимировать функциями вида:
,
где
, (1.17)
. (1.18)
Матричная функция удовлетворяет
уравнению
(1.19)
при начальных условиях .
|
–
|
вектор, параметризующий семейство функций .
|
Покажем, что действительно
аппроксимирует решения системы (1.1). Действительно,
Группируя члены, содержащие и используя
соотношение (1.18), получим:
Так как , то аппроксимирует
решение уравнения (1.1).
Заметим, что удовлетворяет
линейному стохастическому дифференциальному уравнению
. (1.20)
Зависимость между векторами
состояния в дискретные моменты
времени может быть выражена
разностным уравнением
(1.21)
Обозначим случайный вектор как . Этот случайный вектор имеет нулевое математическое ожидание
и ковариационную матрицу
(1.22)
Положим . Тогда вектор начальных условий однозначно определяет
значения вектор функции в дискретных точках: . Однако при вычислении значений функции нужно знать
зависимость в окрестности каждого
момента времени . Представим эту зависимость в виде:
(1.23)
Таким образом, построена параметрическая
зависимость , где вектор уточняемых параметров, состоящий из компонент векторов
.
Критерием
качества оценки, как и в линейном случае, является функционал, содержащий
квадрат взвешенного отклонения априорно заданного вектора состояния от его
расчетного значения, а также квадраты взвешенных невязок измерений и взвешенных
суммарных возмущений между измерениями. Этот функционал можно представить в
виде:
(1.24)
Если
минимум функционала (1.24) искать методом Ньютона, то поправки каждого шага
итерации минимизируют квадратичную форму, полученную из (1.24) заменой
нелинейных зависимостей линейными членами ряда Тейлора. Это означает, что на
шаге итерации решается задача
оптимальной оценки состояния линейной системы (1.3,1.4). Матрицы и этой системы
вычисляются по следующим формулам:
(1.25)
1.3.
Проверка качества
измерений с использованием приведенного среднеквадратического отклонения
Приведенным СКО случайного
вектора с математическим
ожиданием и ковариационной
матрицей будем называть
величину:
В одномерном случае эта величина равна , где – дисперсия . Так как для нормально распределенной случайной величины
справедливо правило трех сигм, т. е. с вероятностью
0.997, то с той же
вероятностью.
При оценке качества
измерений под случайной величиной будем понимать
прогноз невязки измерения , сделанный по оценке вектора состояния с использованием
измерений , т.е.:
(1.26)
В качестве ковариационной матрицы невязок
измерений будем использовать ее прогноз:
(1.27)
Таким образом, при проверке
качества измерения вычисляется величина и сравнивается с
заданным пороговым значением. Если величина не превосходит пороговое значение,
измерение используется для построения текущей оценки, в другом случае – не
используется.
Рассмотрим
алгоритм, позволяющий определять аномальную компоненту вектора измерений. Если
вектор невязок распределен по нормальному закону, условное распределение любой
его компоненты, при фиксированных остальных, также является нормальным с
дисперсией, равной соответствующему диагональному элементу ковариационной
матрицы. Поэтому следует искать компоненты вектора невязок, которые более, чем
в три раза превосходят квадратные корни из соответствующих диагональных
элементов ковариационной матрицы.
2.
Алгоритм оценки вектора состояния в случае, когда
возмущений нет
Когда нет шума и не
используется априорная информация, функция (1.12) примет вид:
(2.1)
Будем искать оценку вектора
состояния на момент последнего измерения, которую обозначим как . Тогда , а оценки векторов состояния на моменты времени выражаются через с использованием
переходной матрицы:
(2.2)
После
подстановки (2.2) в (2.1) и некоторых
преобразований, получим:
(2.3)
Требуется найти из условия минимума
(2.3). Функция (2.3) является квадратичной формой метода наименьших квадратов.
Оценка находится из решения
системы нормальных уравнений по формуле:
(2.4)
где
.
Следует отметить, что
(2.5)
Соотношение (2.5) целесообразно использовать
при вычислениях, а именно:
(2.6)
В ходе обработки проводится
селекция аномальных измерений. Разделение измерений производится с
использованием заданного порогового значения по приведенному СКО. Измерения,
приведенные СКО которых более заданного порога, отбрасываются, т.е. вычисление
сумм (2.6) происходит только по тем значениям индекса , для которых приведенные СКО измерений меньше заданного
порога. С учетом этого, целесообразно вычислить и запомнить матрицы на этапе подготовки к
обработке. В ходе обработки вычисляется матрица и вектор
столбец по формулам (2.6).
Далее получается оценка по формулам (2.4).
Ковариационной матрицей оценки является матрица . На основе полученной оценки вычисляется множество невязок
измерений и их ковариационных матриц
(2.7)
Приведенное СКО вычисляется
с использованием вектора невязок и ковариационной матрицы по тому же алгоритму,
что и в п. 1.4. Если оценка построена только по
измерениям, приведенное СКО которых меньше заданного порога, то оценка
считается достоверной. Если это не так, необходима селекция аномальных
измерений. После селекции аномальных измерений, вновь происходит вычисление
матрицы и вектора столбца и процесс
повторяется. При отбраковке аномальных измерений производится контроль на
отношение исключенных к общему числу измерений. Если это отношение превосходит
заданный порог, увеличивается пороговое значение приведенного СКО.
3.
Алгоритм оценки вектора состояния и средних значений
приращений возмущений
Пусть в системе (1.3)
представляет собой не белый шум, а некоторое постоянное воздействие, которое
необходимо определить наряду с вектором состояния. В этом случае:
, (3.1)
где – неизвестный – мерный вектор.
Вектора состояния на моменты и связаны между собой
соотношением:
(3.2)
После умножения (3.2) слева на матрицу , получим:
(3.3)
Из (3.3) получим зависимость от и :
(3.4)
Рассмотрим расширенный
вектор состояния , состоящий из компонент
вектора и компонент
вектора . Тогда уравнение (3.4) перепишется в виде:
(3.5)
где и – нулевые матрицы и .
При получении оценки будем
искать минимум функционала (2.1) такого же, как для случая отсутствия
возмущений. Под искомым вектором оценки будем понимать расширенный вектор
состояния, а под переходной матрицей — расширенную переходную матрицу
(3.6)
Искомая оценка находится по
формуле:
(3.7)
где
Аналогом формулы (2.5) является соотношение:
(3.8)
Матрица и вектор столбец представляются
аналогично (2.6) в виде:
3.9)
Для
эффективной работы алгоритма селекции аномальных измерений на этапе подготовки
целесообразно вычислить и запомнить матрицы
(3.10)
С использованием этих матриц соотношения
(3.9) перепишутся в виде:
(3.11)
При работе алгоритма
селекции аномальных измерений и получения оценки методом наименьших квадратов
суммы (3.11) вычисляются только по тем значениям индекса , которым соответствуют измерения, удовлетворяющие заданным
критериям.
Вычисление интегралов в соотношении (3.10)
удобно проводить с использованием следующего рекуррентного соотношения:
(3.12)
4.
Алгоритм оценки вектора состояния с использованием
метода мешающих параметров
Метод
мешающих параметров [1,2] целесообразно применять, когда точность и состав
измеряемых функций не позволяют оценить параметры шума. В качестве оцениваемого
вектора состояния выбран вектор состояния на конец мерной базы. Неучтенный
шум приводит к увеличению ошибок модели
по мере перемещения от конца мерной базы к ее началу. Суть метода состоит в
учете этой нарастающей ошибки модели в весовой матрице измерений. Рассмотрим
варианты алгоритма для двух типов возмущений: белого шума (п.4.1.) и случайных
величин, постоянных на всем интервале измерений (п.4.2.).
4.1.
Мешающие параметры в
форме белого шума
Поиск минимума функции
(1.12) ведется по уточняемым
параметрам, состоящим из – мерного
вектора и векторов , имеющих размерность . Чтобы избежать увеличения размерности решаемой задачи можно
рассмотреть как мешающие
параметры. При таком рассмотрении следует уменьшать вес измерений по мере их
удаления по времени от момента . Для расчета весовой матрицы измерения необходимо знать
ковариационную матрицу вектора состояния на момент при известной
ковариационной матрице вектора состояния на момент и заданных
статистических характеристиках шума. В этом разделе будет рассмотрен случай,
когда шум в уравнении (1.3)
представляет собой белый шум с постоянной матрицей интенсивности .
Пусть известен вектор
состояния на момент . Тогда при сделанных ранее предположениях, вектор
состояния на момент связан с следующим
соотношением:
(4.1)
Невязка -го измерения равна
(4.2)
и содержит наряду с ошибкой измерения вектор методической
ошибки . Это приводит к
тому, что возникает корреляция между измерениями на моменты времени и . Найдем ковариационную матрицу методической ошибки , соответствующую измерениям и . Не ограничивая общности, положим . Тогда
(4.3)
Так как представляет собой –мерный белый шум с матрицей интенсивности , справедливо соотношение:
Тогда
(4.4)
С учетом того, что , получим:
(4.5)
Обозначим
Тогда
и (4.6)
Для вычисления
интеграла целесообразно
использовать рекуррентное соотношение:
(4.7)
Используя соотношения (4.6)
и (4.7), построим ковариационную матрицу измерений в виде следующей
блочной матрицы:
(4.8)
В случае коррелированных
измерений для нахождения оценки минимизируется
функция, представляющая собой квадратичную форму:
. (4.9)
Вектор столбец и матрица вычисляются так же,
как и в (2.4). Оценка находится по следующей формуле:
,
(4.10)
а ее ковариационная матрица равна .
4.2.
Мешающие параметры в
форме случайных величин, постоянных на всем интервале
Рассмотрим теперь случай,
когда в уравнении (1.3)
представляет собой не белый шум, а случайный вектор , постоянный на всем интервале. Обозначим ковариационную
матрицу этого вектора как . Оценка вектора состояния на момент связана с оценкой
вектора состояния на момент последнего измерения следующим
соотношением:
(4.11)
Ковариационная матрица методической ошибки,
соответствующая измерениям на моменты и , в этом случае будет
равна
(4.12)
Ковариационная матрица
измерений представляется
формулой (4.8), в которой под блоком понимаются матрицы,
вычисленные по формуле (4.12).
Оценка
вектора состояния и ковариационная матрица этой оценки находятся по формуле
(4.10).
Следует отметить, что
рассмотренный случай имеет значение для получения оценок и моделирования, так
как если возмущения, вносимые вектором , приводят к невязкам
, которые сопоставимы
с точностью измерений, то для оценки вектора состояния и возмущений можно
использовать методику, изложенную в п. 3.
5.
Оценка вектора состояния и возмущений дискретной
динамической системы и свойства этих оценок
Алгоритм оценки
вектора состояния и возмущения дискретной динамической системы используется на
каждом шаге итерационного процесса оценки вектора состояния и суммарных
воздействий возмущений между измерениями непрерывной динамической системы (п.1.). Оценка строится на основе критерия
качества, который содержит квадрат взвешенного отклонения априорно заданного вектора
состояния и его расчетного значения, а так же квадраты взвешенных невязок
измерений и взвешенных возмущений.
Рассмотрим задачу оценки мерного вектора состояния на моменты времени дискретной
динамической системы:
где
|
-
|
невырожденная матрица ;
|
|
-
|
мерный вектор, описывающий шум, действующий на
систему;
|
|
-
|
матрица.
|
Канал измерений описывается
соотношением:
где
|
-
|
мерный вектор измеряемых величин;
|
|
-
|
матрица,
описывающая связь измеренного значения с вектором состояния;
|
|
-
|
мерный вектор, описывающий шум измерительного
канала.
|
Обозначим оценку вектора
состояния на момент по измерениям , как , а оценку вектора шума, действующего на систему в этот же
момент, как .
Рассмотрим свойства оценок , полученных в результате минимизации функции:
где
|
-
|
априорно заданный вектор состояния на
начальный момент;
|
|
-
|
положительно определенная - матрица;
|
|
-
|
положительно определенные – матрицы;
|
|
-
|
положительно определенные – матрицы.
|
Свойство 1. Оценки и связаны рекуррентным
соотношением:
,
где матрица вычисляется по
следующим рекуррентным формулам:
,
,
,
,
………………………..
,
.
Свойство
1 показывает, что известное рекуррентное соотношение между оценками и является следствием
формы минимизируемого функционала. Для случая, когда нет шума в динамической
системе, доказательство существенно упрощается. Такие доказательства приведены
в [2] и [17]. Идеи доказательства для случая с шумом приведены в [19].
Свойство 2. Оценки векторов
состояния и возмущающих
воздействий на моменты времени связаны с оценкой следующими
рекуррентными формулами:
,
,
,
,
,
для
Свойство 2 показывает, как
вычисляется оценка вектора состояния на середину мерной
базы при наличии измерений. На
практике эту оценку часто путают с оценкой .
Свойство 3. Обозначим как невязку между
истинным и априорно заданным векторами на начальный момент. Если интерпретировать как
некоррелированные между собой случайные векторы с нулевыми математическими
ожиданиями и ковариационными матрицами: , то является
ковариационной матрицей оценки .
Свойство 3 фактически
показывает, при каких условиях рекуррентное соотношение, связывающее оценки и , становится
уравнением фильтра Калмана.
Свойства 1-3 следуют из лемм
1-6 сформулированных и доказанных ниже.
Лемма 1. Пусть
заданы:
|
-
|
вектор размерности ;
|
|
-
|
вектор размерности ;
|
|
-
|
положительно определенная матрица;
|
|
-
|
векторы размерности , ;
|
|
-
|
положительно определенные матрицы, ;
|
|
-
|
матрицы, ;
|
|
-
|
матрицы, ;
|
|
-
|
положительно определенные матрицы, ;
|
|
-
|
матрицы, .
|
Тогда значения переменных , для которых достигается минимум функции:
(5.1)
при ограничениях:
(5.2)
удовлетворяет системе уравнений:
,
,
, (5.3)
для
.
Доказательство. Для получения необходимых
условий экстремума функции (5.1) при ограничениях (5.2) воспользуемся правилом
множителей Лагранжа. Введем векторные множители размерности : и функцию
(5.4)
Сначала вычислим строки частных производных: и
,
, (5.5)
.
Вычислим строки частных производных: и при :
,
, (5.6)
.
Наконец, вычислим строку частных производных :
. (5.7)
Получим систему уравнений, приравнивая нулю
строки частных производных:
,
, (5.8)
.
,
, (5.9)
для
. (5.10)
Из первого уравнения системы (5.8) получим:
. (5.11)
Из второго уравнения системы (5.8) следует,
что:
(5.12)
После подстановки (5.12) в третье уравнение
(5.8), получим:
. (5.13)
Преобразуем теперь систему (5.9). Из второго
уравнения получим:
.
(5.14)
После подстановки (5.14) в третье уравнение
системы (5.9) получим:
. (5.15)
Введем дополнительную
переменную и свяжем ее
уравнением . Это позволяет объединить уравнения (5.9) и (5.10):
(5.16)
Соединяя (5.11), (5.13),
(5.15), (5.12), (5.14) и (5.16), получим искомую систему уравнений (5.3). Лемма
доказана.
Введем
обозначения матриц, которые потребуются при дальнейшем изложении:
(5.17)
……………….………………
Заметим,
что матрицы будут положительно
определены, если матрица – положительно
определена, так как операции добавления неотрицательно определенной матрицы и
обращения матрицы сохраняют положительную определенность.
Лемма 2. При :
Доказательство.
Из системы уравнений (5.3) следует:
,
, (5.18)
,
.
Получим уравнение для , подставив выражения для и во второе уравнение
системы (5.18):
(5.19)
Использовав обозначение для матрицы из (5.17), запишем
уравнение (5.19) в виде:
(5.20)
Разрешив (5.20) относительно , получим:
(5.21)
так как
Использовав представление через , преобразуем (5.21) :
(5.22)
Выражение для получается
подстановкой соотношения для (последнее уравнение
(5.18)) в предпоследнее уравнение (5.18). Лемма доказана.
Лемма 3. Пусть для всех справедливо:
тогда из системы уравнений (5.3) следует,
что:
(5.23)
Доказательство. Используем
индукцию по . Сначала докажем, что (5.23) справедливо для . Преобразуем выражения для и системы (5.3):
(5.24)
(5.25)
Получим выражение для , использовав лемму 2:
После подстановки
полученного выражения для в (5.25), получим:
(5.26)
Подставляя (5.26) в (5.24), получим уравнение
для :
После преобразований получим:
Так как
Следовательно, для равенство выполняется.
Предположим, что равенство
(5.23) выполняется для , и докажем, что равенство выполняется для . Используя предположение индукции, преобразуем выражение для системы (5.3) :
(5.27)
Из системы (5.3) имеем выражение для :
(5.28)
Используя предположение леммы, выразим через и :
(5.29)
После подстановки (5.28) и (5.29) в (5.27),
получим :
После преобразований имеем:
откуда следует:
Лемма доказана.
Лемма 4. Векторы и связаны соотношением:
(5.30)
Доказательство. Используем индукцию по . Справедливость равенства (5.30) для доказана в лемме 2.
Предположим, что для всех равенство (5.30)
выполняется. Тогда по лемме 3:
(5.31)
Уравнение для системы (5.3) имеет
вид:
После подстановки в него (5.31) получим:
(5.32)
Получим уравнение для , подставив в (5.32) выражение для из системы (5.3):
(5.33)
Разрешая (5.33) относительно , получим:
Так как в соответствии с (5.17) , решение уравнения
(5.33) имеет вид:
Лемма доказана.
Лемма 5. Векторы и , связаны с следующими
рекуррентными формулами:
,
,
для ,
Доказательство следует из системы (5.3).
Обозначим истинное значение при как , а разность между и как .
Лемма
6. Если попарно некоррелированные случайные векторы такие, что:
то:
(5.34)
Доказательство. Обозначим невязку между
истинным значением и оценкой как . Истинные значения и связаны между собой
соотношением:
(5.35)
а вектор измеренных значений связан с этими
векторами соотношением:
(5.36)
Обозначим матрицу . Вычитая из (5.35) равенство, связывающее оценки и получим:
(5.37)
Докажем (5.34), использовав индукцию по . Докажем сначала (5.34) для . При соотношение (5.37)
примет вид:
(5.38)
Так как по условию и и - некоррелированы, то:
(5.39)
Рассмотрим:
(5.40)
Подставляя (5.40) в (5.39), получим:
Для утверждение доказано.
Предположим теперь, что утверждение леммы справедливо для , т.е. . Оценка получена при
использовании случайных векторов , которые не коррелированны со случайными векторами и . Поэтому невязка не коррелированна со
случайными векторами и . Используя это и соотношение (5.37), вычислим:
Лемма доказана.
Список литературы
- Аким Э.Л., Энеев Т.М. Определение параметров движения космического летательного аппарата
по данным траекторных измерений // Космич. исслед. 1963. Вып. 1. Т.
1.
- Эльясберг П.Е. Определение движения по результатам измерений. М.:
Наука,
1976.
- Akim E.L., Stepaniants V.A., Tuchin A.G.
Tracking of the launch-vehicle during the insertion to Earth orbit // RBCM
– J. of the Braz. Soc. Mecanical Sciences Vol. XXI – Special Issue – 1999,
рр.
387-399.
- Баллистико-навигационное обеспечение заключительного этапа полета
орбитальной станции «МИР» (БЦ ИПМ). Отчет Института прикладной математики
им. М.В. Келдыша РАН, инв. № 5-01-02, 2001.
- Аким Э.Л., Заславский Г.С., Морской И.М. и др. Баллистика,
навигация и управление полетом космического аппарата в проекте “Фобос
—Грунт” // Теория и системы управления. 2002. № 5.
6. Akim
E.L., Stepaniants V.A., Tuchin A.G.
“INTERBALL-1” and “INTERBALL-2” spacecrafts orbit determination tacking
into account non-modeled small accelerations // Inrenational Symposium Space
Dynamics, 26-30 june, 2000, Biarritz, France.
- Nazarenko A.I. Determination and
prediction of satellite motion at the end of the lifetime // Proc.
International Workshop on Salyt-7/Kosmos-1685 Reentry, ESOC, Darmstadt,
1991.
- Брандин В.Н., Разоренков Г.П. Определение траекторий космических
аппаратов. М.: Машиностроение, 1978.
- Решетнев М.Ф., Лебедев А.А., Бартенев В.А. и др. Управление и
навигация искусственных спутников Земли на околокруговых орбитах. М.:
Машиностроение, 1988.
- Иванов Н.М., Поляков В.С. Наведение автоматических межпланетных
станций. М.: Машиностроение, 1987.
11.
Квашнин А.Г., Тучин А.Г. Построение вычислительной схемы алгоритма
оценивания параметров динамической системы // Автоматизация проектирования,
информатика. 1993. Вып. 4.
12.
Квашнин А.Г., Тучин А.Г. Априорная гарантированная оценка точности
определения параметров динамической системы. Препринт № 104. М.: ИПМ им. М.В.
Келдыша РАН, 1991.
13.
Квашнин А.Г., Тучин А.Г. Синтез вычислительной схемы алгоритма
оценивания параметров динамической системы. Препринт № 26. М.: ИПМ им. М.В.
Келдыша РАН, 1991.
14.
Аким Э.Л., Горохова А.А., Степаньянц В.А., Тучин А. Г. Контроль
траектории выведения по данным траекторных измерений. Препринт № 10. М.: ИПМ
им. М.В. Келдыша РАН, 1999.
15.
Аоки М. Оптимизация
стохастических систем. М.: Наука, 1967.
16.
Красовский Н.Н. Теория управления движением. М.: Наука, 1968.
17.
Льюнг Л. Идентификация систем. Теория для пользователя. М.: Наука,
1991.
18.
Острем К. Введение в стохастическую теорию управления. М.: Мир, 1973.
19.
Ли Р. Оптимальные оценки, определение характеристик и управление. М.:
Наука, 1966.
20.
Калман Р., Фалб П., Арбиб М. Очерки по математической теории систем.
М.: Мир, 1971.
21. E.L. Akim E.L, D.A. Tuchin A.D. GPS errors statistical analysis for ground receiver measurement // The
Proceedings of the 17th International Symposium on Space Flight
Dynamics, 16-20 June, Moscow, Russia, М.: Keldysh Institute of
Applied Mathematics, KIA Systems, 2003.
22.
Тучин Д.А. Кодовые
измерения псевдодальности системы GPS. Модель ошибок и априорная
оценка точности определения вектора состояния. Препринт № 30. М.: ИПМ им. М.В.
Келдыша РАН, 2002.
23.
Э.Л. Аким Э.Л., Тучин Д.А. Апостериорная оценка точности определения
вектора состояния земного наблюдателя по измерениям дальности и скорости
системы космической навигации GPS. Препринт № 36. М.: ИПМ им. М.В. Келдыша РАН, 2001.
|