где Ω = 7,292115 |
10–5 с–1 – угловая скорость вращения Земли; |
μ = 398605 109 м3/с2 – произведение гравитационной постоянной |
|
на массу Земли; x, |
y, z – координаты КА; Vx, Vy, Vz – скорости КА; |
r 
x2 y2 z2 – модуль радиус-вектора КА.
Первые слагаемые в правых частях уравнений для производных скоростей КА системы (80) являются проекциями силы тяготения на соответствующие оси. Второе и третье слагаемые в уравнениях для производных скоростей Vx и Vy обусловливают переход в неинерциальную вращающуюся систему координат.
Начальные условия определяются по данным траекторных измерений, которые образуют массив измеренных текущих навигационных параметров (ИТНП). При этом под траекторными измерениями понимаются измерения радиальной скорости D спутника относительно НП. Измерения радиальной скорости производятся с наземного НП в согласовании с бортом КА. Выбор радиальной скорости КА в качестве измеряемой функции обусловлен конструктивными возможностями системы.
Рассматривается движение КАна пассивном участке траектории. Во введенной ранее мгновенной системе координат состояние КА характеризуется в каждый момент времени t тремя координа-
тами x, y, z и тремя компонентами вектора скорости Vx, Vy, Vz.
Эти шесть параметров однозначно определяются через некоторые
НУ x0, y0, z0, Vx0, Vy0, Vz0 как решение задачи Коши. Таким образом, x0, y0, z0, Vx0, Vy0, Vz0 однозначно определяют траекторию движения КА по
теореме осуществовании и единственности решения задачи Коши. Введем обозначение Q = {x, y, z, Vx, Vy, Vz}. В момент времени tn
производят измерение функции D параметров траектории
|
|
|
Dn |
D (Q,tn ), |
|
|
(2.137) |
D (x xнп )2 (y yнп )2 (z zнп)2 , |
|
||||||
D |
1 |
(x xнп)Vx |
(y yнп)Vy |
(z zнп)Vz , |
(2.138) |
||
|
|||||||
|
D |
|
|
|
|
||
где D – радиальная дальность КА относительно НП; D – радиальная скорость; x, y, z, Vx, Vy, Vz – соответственно координаты и скорости КА в гринвичской системе координат, xнп, yнп, zнп – координаты НП. Как видно из (2.138); D – является функцией от текущих параметров траектории, которые зависят от НУ.
161
При этом измерения проводятся со среднеквадратичной ошибкой σn. Измеренное значение обозначим Dn изм .
Совокупность значений Dn изм (n = 1…N) функции D , измере-
ния которой проводятся в процессе полета КА на определенном промежутке времени, образует множество траекторных измерений.
Таким образом, задача обработки траекторных измерений и, соответственно, данного модуля формулируется следующим образом: определить неизвестные параметры x0, y0, z0, Vx0, Vy0, Vz0, характеризующие движение КА по информации о его траектории в виде измерений Dn изм , n = 1…N, полученных с известной точно-
стью и проведенных в моменты времени t1, t2, …, tN.
В качестве основной апостериорной информации о траектории методика определения параметров КА использует траекторные измерения. Предполагаем, что ошибки этих измерений носят случайный характер, некоррелированы между собой и распределены по нормальному закону с нулевым математическим ожиданием и известной дисперсией.
Наряду с рассмотренной апостериорной информацией для определения параметров движения используется и априорная информация о траектории, которая содержит ожидаемые значения определяемых параметров Q. Эти значения определяются в результате обработки предыдущих сеансов измерений и дальнейшего прогнозирования по ним параметров траектории КА.
Избыточность измерений (по сравнению с числом определяемых параметров) и случайный характер их ошибок вызывают необходимость статистического подхода к решению поставленной задачи. Результатом такого подхода и принятых допущений о характере ошибок измерений явился выбор в качестве статистического метода – метода наименьших квадратов.
Метод наименьших квадратов (МНК), применяемый для определения параметров Q0 траектории по измерениям
D1изм , D2изм , …, DN изм ,
приводит к необходимости минимизации целевой функции
N |
1 |
(Di Di изм )2 |
|
|
||
|
|
|
, |
(2.139) |
||
i |
2 |
|||||
i 1 |
|
|
|
|||
162
где Dn – расчетное значение радиальной скорости; σi – средне-
квадратическое отклонение измеренного значения.
Запишем для целевой функции (2.139) необходимые условия существования экстремума:
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
0; |
|
|
|
|
|
|
|
|
||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
x |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
0 |
|
|
|
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
0; |
|
|
|
|
|
|
|
|
||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||
|
|
|
|
|
|
|
|
|
|
|
|
y0 |
|
|
|
|
|
|
|
|
|||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
0; |
|
|
|
|
|
|
|
|
||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
z0 |
|
|
|
|
|
|
|
|
|
(2.140) |
|||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
0; |
|
|
|
|
|
|
|
|
||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||
|
|
|
|
|
|
|
|
|
|
|
|
|
Vx0 |
|
|
|
|
|
|
|
|
|
|
||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
0; |
|
|
|
|
|
|
|
|
||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
V |
y |
0 |
|
|
|
|
|
|
|
|
|
||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
0 |
|
|
|
|
|
|
|
|
||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
|
|
|
|
|
|
|
|
Vz0 |
|
|
|
|
|
|
|
|
|
||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||
или же |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
N |
|
1 |
|
|
|
|
|
|
|
|
|
|
|
D |
|
|
|
|
|
|||||
|
|
|
|
2 |
(Di Di изм ) |
|
0; |
||||||||||||||||||||||
x0 |
i2 |
x0 |
|||||||||||||||||||||||||||
|
|
|
i 1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||
|
|
|
|
|
N |
|
1 |
|
|
|
|
|
|
|
|
|
|
|
D 0; |
||||||||||
|
|
|
|
2 (Di Di изм ) |
|||||||||||||||||||||||||
y0 |
i2 |
||||||||||||||||||||||||||||
|
|
|
i 1 |
|
|
|
|
|
|
|
|
|
|
y0 |
|
|
|
|
|||||||||||
|
|
|
|
N |
|
1 |
|
|
|
|
|
|
|
|
|
|
|
D |
|
|
|
|
|||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||
|
|
|
|
|
|
|
|
2 |
(Di Di изм ) |
|
|
|
|
0; |
|||||||||||||||
z0 |
|
|
2 |
z0 |
|||||||||||||||||||||||||
|
|
|
i 1 |
i |
|
|
|
|
|
|
|
|
|
|
|
|
|
(2.141) |
|||||||||||
|
|
|
|
N |
1 |
|
|
|
|
|
|
|
|
|
|
|
|
D |
|||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||
|
|
|
|
|
|
|
|
|
|
|
2 |
(Di Di изм ) |
|
|
|
|
|
0; |
|||||||||||
Vx0 |
|
2 |
Vx0 |
||||||||||||||||||||||||||
|
i 1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||
|
|
|
|
|
|
|
|
|
|
i |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
N |
1 |
|
|
|
|
|
|
|
|
|
|
|
|
D |
|
|
|
||||||||
|
|
|
|
|
|
2 (Di Di изм ) |
|
|
0; |
||||||||||||||||||||
Vy0 |
|
i2 |
|
Vy0 |
|
||||||||||||||||||||||||
|
|
i 1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||
|
|
|
|
N |
1 |
|
|
|
|
|
|
|
|
|
|
|
|
D |
|
|
|||||||||
|
|
|
|
|
|
2 |
(Di Di изм ) |
|
|
0, |
|||||||||||||||||||
|
|
|
|
|
|
2 |
|
|
V |
|
|
|
|||||||||||||||||
V |
z0 |
|
i 1 |
|
|
|
|
|
|
|
|
|
|
|
|
z0 |
|
|
|||||||||||
|
|
|
i |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||
163
где
|
D |
|
|
|
D |
|
|
|
x |
|
|
D |
|
|
|
|
|
y |
|
D |
|
|
|
|
z |
|
|
|
|
|||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||||||||||||||
|
x0 |
|
x |
|
|
|
x0 |
|
y |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
x0 |
|
z |
|
|
|
|
x0 |
||||||||||||||||||||||||||||||||||
|
|
|
|
D |
|
V |
x |
|
D |
|
Vy |
|
|
|
|
D |
|
V |
z |
; |
|
|
|
|
|
|||||||||||||||||||||||||||||||||
|
|
|
V |
x |
|
x |
|
V |
y |
|
x |
|
|
|
V |
z |
x |
|
|
|
|
|
||||||||||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
0 |
|
|
|
|
|
|
|
|
|
|
|
0 |
|
|
|
|
|
|
|
|
|
|
|
0 |
|
|
|
|
|
|
|||||||||||||||
|
D |
|
|
|
D |
|
|
|
|
|
x |
|
|
|
D |
|
|
|
|
|
y |
D |
|
|
|
|
z |
|
|
|
||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||||||||||||||
|
y0 |
|
|
x |
|
|
|
|
y0 |
|
|
y |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
y0 |
|
z |
|
|
|
|
y0 |
||||||||||||||||||||||||||||||||||
|
|
|
|
D |
|
V |
x |
|
D |
|
Vy |
|
|
|
|
D |
|
V |
z |
; |
|
|
|
|
|
|||||||||||||||||||||||||||||||||
|
|
|
Vx |
|
|
|
|
|
|
|
|
Vy |
|
y0 |
|
|
|
Vz |
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
y0 |
|
|
|
|
|
|
|
|
|
|
|
|
|
y0 |
|
|
|
|
|
|
||||||||||||||||||||||||||||||
|
D |
|
|
|
D |
|
|
x |
|
|
D |
|
|
|
|
y |
D |
|
|
|
|
z |
|
|
|
|
|
|||||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||||||||||||||||||||||||||||||||
|
z0 |
|
x |
|
|
z0 |
|
|
y |
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
z0 |
|
z |
|
|
|
|
z0 |
||||||||||||||||||||||||||||||||||
|
|
|
|
D |
|
V |
x |
|
D |
|
Vy |
|
|
|
|
D |
|
V |
z |
; |
|
|
|
|
|
|||||||||||||||||||||||||||||||||
|
|
|
Vx |
|
|
|
|
|
|
|
|
Vy |
|
z0 |
|
|
|
Vz |
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
z0 |
|
|
|
|
|
|
|
|
|
|
|
|
|
z0 |
|
|
|
|
|
|
||||||||||||||||||||||||||||||
|
D |
|
|
|
D |
|
|
|
x |
|
|
|
D |
|
|
|
|
|
y |
|
D |
|
|
|
|
z |
||||||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||||||||||||||||||||||||||||||||
|
Vx0 |
|
|
|
Vx0 |
|
y |
|
|
Vx0 |
|
|
Vx0 |
|||||||||||||||||||||||||||||||||||||||||||||
|
|
|
|
|
x |
|
|
|
|
|
|
|
|
|
|
|
z |
|
|
|
|
|
|
|||||||||||||||||||||||||||||||||||
|
|
D |
|
V |
x |
|
|
|
|
D |
|
|
Vy |
|
|
|
|
D |
|
|
V |
z |
; |
|||||||||||||||||||||||||||||||||||
|
Vx |
|
|
|
|
|
|
|
|
|
Vy |
Vx0 |
|
|
|
Vz |
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||||||
|
|
|
|
|
|
Vx0 |
|
|
|
|
|
|
|
|
|
|
|
|
Vx0 |
|||||||||||||||||||||||||||||||||||||||
|
D |
|
|
|
|
D |
|
|
|
|
x |
|
|
|
D |
|
|
|
|
|
y |
|
D |
|
|
|
|
|
z |
|||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||||||||||||||||||||||||||||||
Vy0 |
|
|
|
|
x |
|
|
|
|
Vy0 |
|
|
y |
|
|
|
Vy0 |
|
|
z |
|
|
|
|
|
|
Vy0 |
|||||||||||||||||||||||||||||||
|
|
|
D |
|
|
V |
x |
|
|
|
|
|
D |
|
|
|
Vy |
|
|
|
|
D |
|
|
V |
z |
; |
|||||||||||||||||||||||||||||||
|
|
Vx |
|
|
|
|
|
|
|
|
|
|
|
|
Vy |
|
Vy0 |
|
|
|
Vz |
|
|
|
|
|
|
|
|
|
||||||||||||||||||||||||||||
|
|
|
|
|
|
Vy0 |
|
|
|
|
|
|
|
|
|
|
|
|
Vy0 |
|||||||||||||||||||||||||||||||||||||||
|
D |
|
|
|
D |
|
|
|
x |
|
|
|
D |
|
|
|
|
|
y |
|
D |
|
|
|
|
|
z |
|||||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||||||||||||||||||||||||||||||||
|
Vz0 |
|
|
|
Vz0 |
|
y |
|
|
Vz0 |
|
|
|
|
|
|
|
|
|
|
||||||||||||||||||||||||||||||||||||||
|
|
|
|
|
x |
|
|
|
|
|
|
|
|
|
|
|
z |
|
|
|
|
|
Vz0 |
|||||||||||||||||||||||||||||||||||
D Vx D Vy D Vz ,Vx Vz0 Vy Vz0 Vz Vz0
(2.142)
частные производные по текущим параметрам определяются в виде
164
D |
|
Lx |
Vx D2 x |
2 Vx |
; |
||||||||||
x |
|
|
|
D3 |
|
|
|||||||||
|
|
|
|
|
|
|
|
|
|||||||
D |
|
Ly |
Vy D2 y |
2 Vy |
|
|
; |
||||||||
y |
|
|
|
D3 |
|
|
|
|
|||||||
|
|
|
|
|
|
|
|
|
|||||||
D Lz |
Vz D2 z2 Vz |
; |
|
||||||||||||
|
|
|
|
|
|
|
|||||||||
z |
|
|
|
|
D3 |
|
|
|
|
(2.143) |
|||||
D |
|
Mx |
x xнп |
; |
|
|
|
|
|
||||||
Vx |
|
|
|
|
|
|
|
||||||||
|
|
|
|
D |
|
|
|
|
|
|
|||||
D |
|
My |
y yнп |
|
; |
|
|
|
|
|
|||||
Vy |
|
D |
|
|
|
|
|
||||||||
|
|
|
|
|
|
|
|
|
|
||||||
D |
Mz |
z zнп |
, |
|
|
|
|
|
|
||||||
|
|
|
|
|
|
|
|
||||||||
Vz |
|
|
|
|
D |
|
|
|
|
|
|
||||
где xнп, yнп, zнп – координаты НП.
2.4.2. Выбор алгоритма решения
Решение методом Ньютона – Гаусса сводится к серии последовательных приближений. Число приближений зависит от степени близости выбранного нулевого приближения x0(0) , y0(0) , z0(0) , Vx(00) ,
Vy(00) , Vz(00) к точному решению.
Пусть на (s – 1) приближении для параметров получены значения Q(s 1) , тогда разлагаем в ряд Тейлора в окрестностях этих зна-
чений параметров значение D |
на приближении s и отбрасываем |
|||||||||||||||||||||
члены порядка выше первого: |
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||
D |
(s) |
D |
(s 1) |
|
D |
(s) |
|
D |
|
(s) |
|
D |
|
(s) |
|
|||||||
|
|
|
x0 |
x0 |
y0 |
y0 |
z0 |
z0 |
||||||||||||||
|
|
|
D |
|
|
|
D |
|
|
D |
|
|
(2.144) |
|||||||||
|
|
|
V |
(s) |
|
V |
(s) |
|
V |
(s) |
, |
|||||||||||
|
|
|
||||||||||||||||||||
|
|
|
|
x0 |
|
y0 |
|
|
|
z0 |
|
|||||||||||
|
|
Vx0 |
Vy0 |
Vz0 |
|
|||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||
165