Научная статья на тему 'Синтез алгоритмов инерциально-спутниковых навигационных систем на основе пространственных моделей движения'

Синтез алгоритмов инерциально-спутниковых навигационных систем на основе пространственных моделей движения Текст научной статьи по специальности «Физика»

CC BY
131
40
i Надоели баннеры? Вы всегда можете отключить рекламу.
Журнал
Научное приборостроение
ВАК
RSCI
Область наук
Ключевые слова
ИНЕРЦИАЛЬНО-СПУТНИКОВЫЕ НАВИГАЦИОННЫЕ СИСТЕМЫ / ПРОСТРАНСТВЕННЫЕ МОДЕЛИ ДВИЖЕНИЯ / АПОСТЕРИОРНАЯ ОЦЕНКА / АВТОНОМНЫЕ ИЗМЕРЕНИЯ / SPATIAL (SPACE) MODELS OF MOVEMENT / INERTIAL-SATELLITE NAVIGATION SYSTEMS / A POSTERIORI ESTIMATION / AUTONOMIC MEASUREMENTS

Аннотация научной статьи по физике, автор научной работы — Соколов Сергей Викторович, Вдовиченко С. С.

Показано, что использование пространственных моделей траектории объекта в географических координатах сокращает размерность оцениваемого вектора навигационных параметров, уменьшая вычислительные затраты, и позволяет принципиально решить задачу апостериорной оценки параметров движения автономными измерителями при пропадании спутниковых сообщений.

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по физике , автор научной работы — Соколов Сергей Викторович, Вдовиченко С. С.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

SYNTHESIS OF ALGORITHMS OF INERTIAL-SATELLITE NAVIGATING SYSTEMS ON THE BASIS OF SPATIAL MODELS OF MOVEMENT

It is shown that use of spatial models of a trajectory of object in geographical coordinates reduces dimension of an estimated vector of navigating parameters, reducing computing expenses, and allows to solve essentially a problem of а posterior estimations of parameters of movement by independent measuring instruments at loss of satellite messages.

Текст научной работы на тему «Синтез алгоритмов инерциально-спутниковых навигационных систем на основе пространственных моделей движения»

ISSN 0868-5886

НАУЧНОЕ ПРИБОРОСТРОЕНИЕ, 2012, том 22, № 3, c. 114-122

ТЕОРЕТИЧЕСКИЕ ИССЛЕДОВАНИЯ

УДК 621.391; 629.78 © С. В. Соколов, С. С. Вдовиченко

СИНТЕЗ АЛГОРИТМОВ ИНЕРЦИАЛЬНО-СПУТНИКОВЫХ НАВИГАЦИОННЫХ СИСТЕМ НА ОСНОВЕ ПРОСТРАНСТВЕННЫХ МОДЕЛЕЙ ДВИЖЕНИЯ

Показано, что использование пространственных моделей траектории объекта в географических координатах сокращает размерность оцениваемого вектора навигационных параметров, уменьшая вычислительные затраты, и позволяет принципиально решить задачу апостериорной оценки параметров движения автономными измерителями при пропадании спутниковых сообщений.

Кл. сл.: инерциально-спутниковые навигационные системы, пространственные модели движения, апостериорная оценка, автономные измерения

ВВЕДЕНИЕ

В настоящее время алгоритмы тесной интеграции бесплатформенных инерциальных навигационных систем (БИНС) и спутниковых навигационных систем (СНС) формируются в основном или на основе дифференциальной модели объекта [1], или на основе так называемых уравнений ошибок ИНС [2]. Оба случая предполагают априорную информацию об изменении траектории объекта во времени, что для подавляющего большинства подвижных объектов возможно лишь с весьма ограниченной точностью и на небольших интервалах времени. Последнее обстоятельство приводит в свою очередь или к значительным ошибкам инерциально-спутниковых систем в режиме их интеграции, или к быстрой расходимости процесса фильтрации при пропадании спутниковых сообщений. В то же время для навигации широкого класса объектов (железнодорожного, автомобильного, авиационного и пр. транспортов), движущихся по заранее известным с высокой точностью пространственным траекториям (железным дорогам, автострадам и пр.), возможно использование пространственных моделей пути, существенно упрощающих решение навигационной задачи и повышающих его точность. При этом необходимо подчеркнуть, что данные модели формируются на основе геодезических измерений или соответствующей картографической информации и инвариантны к характеру движения объекта и виду его модели. Так, изменение высоты h, соответствующее заданной пространственной траектории, естественно описывать двумерной функцией широты ф и долготы Л — h = ^А,Л,ф), а изменение долготы Л на данной траектории — функ-

цией широты ф : Л= Л(Р,ф), где А, Р — векторы известных параметров приведенных моделей. (Например, при аппроксимации изменения высоты полиномиальной зависимостью

h = МА,Л,ф) = ¿а*Лф

и ]=о

вектор А образован множеством известных постоянных коэффициентов а*). Очевидно, что при совместном применении обеих моделей модель высоты можно представить одномерной функцией

h = МА,Л,ф)=^Л,Л(Р,ф),ф) = МЛ, P,ф).

ПОСТАНОВКА ЗАДАЧИ

Цель настоящего исследования — показать, что использование подобных пространственных моделей не требует линеаризации навигационных уравнений (как при построении уравнений ошибок), повышая точность позиционирования; сокращает размерность оцениваемого вектора навигационных параметров, уменьшая вычислительные затраты; расширяет вектор наблюдений, позволяя принципиально решить задачу апостериорной оценки параметров движения автономными измерителями при пропадании спутниковых сообщений. Рассмотрим перечисленные преимущества подробнее.

При описании движения объекта будем использовать следующие правые системы координат (СК) [2, 3]:

- приборную СК (ПСК) J 0xyz, начало которой расположено в центре масс (ЦМ) объекта,

а оси направлены по взаимно ортогональным осям чувствительности приборов измерительного комплекса БИНС;

- инерциальную СК (ИСК) I Ог/^С с началом в центре Земли;

- вращающуюся вместе с Землей гринвичскую СК (ГрСК) С

- сопровождающую (ССК) OXYZ, начало которой совпадает с центром масс ПО, ось Y совпадает с направлением местного меридиана, ось Z направлена по линии отвеса, а ось X дополняет систему до правой.

Считаем также, что в начальный момент времени оси ПСК и ССК (а также ИСК и ГрСК) совпадают и в измерительный комплекс БИНС входят три акселерометра и три датчика угловой скорости (ДУС). В качестве модели шумов измерений чувствительных элементов (ЧЭ) примем белый гаус-совский шум (БГШ). Такой подход не накладывает принципиальных ограничений на решение поставленной задачи, поскольку путем расширения вектора состояния за счет введения формирующих фильтров оказывается возможным получить модель помехи ЧЭ не только с заданными временными статистическими характеристиками (матожиданием, корреляционной функцией и т. д.), но и с требуемым законом распределения.

СИНТЕЗ ИНТЕГРИРОВАНИИ НАВИГАЦИОННОЙ СИСТЕМЫ

Система уравнений навигационных параметров исследуемой БИНС, инвариантная к характеру движения объекта и виду его физической модели, как показано в [3], имеет следующий вид:

= Т,

= и,

= и,

(1)

где

Т =

соэ^

соэ Р соэ Р соэ^ - эт^ 0 smxtg Р cosxtg Р 1

-Wi) = Ф(Р,г)^ - Wi),

и =

0 (соэф)

-1

-V

у у

Vv

(г + h) \

и = СТ (а,Р,у,Х,ф)Za +

2

0

О соэф О этф

+(г+h)1

-О2 ( г + h) соэфэтф О2 (г + h) соэ2 ф + g

-VY Vx

Vx tgф

-СТ (а,Р,у,А,ф)Wa.

2

0

X

0

=

Zy ZA — вектор изме-ортогональных ДУСов;

Здесь а, /, у — углы Эйлера—Крылова, определяющие ориентацию трехгранника ПСК относительно ИСК;

рений трех

т

= Ж Жу ЖА — вектор аддитивных помех

измерения ДУСов (БГШ с нулевым средним и матрицей интенсивностей Б,); Л— долгота, ф — широта, h — высота объекта; Ух ,УГ ,У2 — проекции линейной скорости объекта на соответствующие оси сопровождающей СК; г — радиус Земли; О — угловая скорость вращения Земли; g — гра-

I |Т

витационное ускорение; Ъа = Zay Zaz| —

вектор выходных сигналов акселерометров;

т

= Жа Жа Жа — вектор помех акселерометров (БГШ с нулевым математическим ожиданием и матрицей интенсивностей Ба);

С (а,/,у,Л,ф) = Б (а,/,у) Вт (Л,ф) — матрица направляющих косинусов, определяющая ориентацию ССК относительно ПСК; Б (а,/,у) — матрица поворота 2-го рода [4], определяющая ориентацию ПСК относительно ИСК (приведена в Приложении 1); В = Б(Л + О^ = у,-ф,0) — матрица

2-го рода, определяющая ориентацию ССК относительно ИСК.

Здесь следует подчеркнуть, что наблюдение приведенного полного вектора навигационных параметров возможно только с помощью внешних измерителей (в частности, СНС), т. к. информационные модели всех параметров уже использованы в уравнениях вектора состояния БИНС. Используя в качестве системы внешних измерений СНС, далее рассмотрим только кодовые и доплеровские измерения как дающие полное представление о принципах решения задачи построения интегрированной НС на основе пространственных моделей пути (ПМП).

В стандартном (автономном) режиме информационный сигнал кодовых измерений (псевдодальность) может быть записан как [1, 5]

ZR = л/(^с - £)2 + (Лс -л)2 + (С - О2 + Ж2г

(2)

где ,с, л с, Сс — известные координаты спутника в гринвичской СК; , , л , С — текущие координаты объекта в гринвичской СК; Ж^ — БГШ с нулевым средним и известной дисперсией DZ (0 , обусловленный алгоритмически нескомпенсированными

ошибками часов спутников и приемника, задержками сигнала при прохождении ионосферы и тропосферы, ошибками многолучевости и инструментальными погрешностями.

Информационный сигнал доплеровских измерений (псевдоскорости) ZУ в автономном режиме может быть представлен следующим образом [1,

5]:

Zy = [(, - ,)(У,с - У() +

+(Лс - л) (Улс - У) + (Сс - С)(Усс - У)] х

х^ (4с - £)2 + (Лс-л)2 + (Сс - С)2 )-1 + ж^ ,

(3)

где У, УУ ,УС —

* г! лс' Сс

проекции вектора скорости

спутника на оси гринвичской СК; У,Ул,Ус — проекции вектора скорости объекта на оси гринвичской СК; Ж^ — БГШ с нулевым средним и

известной дисперсией DZ^ ^), обусловленный аппаратурными погрешностями приемника объекта и передатчика спутника, погрешностями многолу-чевости и случайными погрешностями измерения.

Для возможности использования измерительных сигналов (2, 3) в качестве наблюдателей вектора состояния НС, описываемого системой (1), выразим входящие в них переменные через навигационные параметры в ССК. Для координат объекта имеем:

, =( г + h) cosф• sin Л, л = ( г + h) sinф, д = (г + h) cosф • cos Л.

(4)

= У У У

I у£ ул УС

= 1 Ух У УZ

При определении проекций скорости учтем, что связь вектора скорости в гринвичской СК VG =

Т с вектором скорости V = Т в ССК определяется матрицей В = Б (-ф, Л, 0) = В (ф,Л) ориентации ССК относительно гринвичской СК: V = В (ф,Л) VG, откуда сразу следует возможность представления вектора VG через навигационные параметры объекта:

VG = ВТ (ф,Л) V

(5)

Исходя из (4, 5), сигналы кодовых и доплеров-ских измерений можно представить как информационные модели наблюдателей вектора состояния НС (1):

2К (,с - (г + И)^ ф sin Л)2 + (,с - (г + И^т ф)2 + (,с - (г + й)соэ ф cos I)2 + ^^ = = Н (ф,Л,И) + WZR,

= [(& - (Г + И)cos ф sin Л)(V,, - В^ (ф, Л)^) +(, - (г + И)sin ф)(V,,, - В^ (ф, Л)^) + +(, - (Г + ф cos Л)(V,, - В^фЛ^ )]х

х(д/ (,с - (г + И)^ ф sin Л)2 + (,с - (г + И)sin ф)2 + (,с - (г + И)^ ф cos Л)2) + ^^ =

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

= Ну (ф,Л,И, Vs) + Wzр,

(6)

где В^.) (ф, Л) — 7-я строка матрицы BТ (ф, Л).

Анализируя полученные уравнения спутниковых наблюдателей, можно сделать вывод, что сигналы измерения (6) содержат информацию обо всех навигационных параметрах линейного движения объекта, но не обеспечивают наблюдения параметров вращения приборного трехгранника относительно ЦМ объекта (подобная ситуация является типичной для существующих алгоритмов фильтрации в СНС). Т. е. использование только спутниковых измерений может привести к неустойчивости процесса оценивания угловых параметров объекта.

НАВИГАЦИОННЫЕ АЛГОРИТМЫ НА ОСНОВЕ ПРОСТРАНСТВЕННЫХ МОДЕЛЕЙ ПУТИ

Использование ПМП Л(Р,ф), И (А, Р,ф) принципиально меняет ситуацию.

Во-первых, в этом случае сокращается размерность уравнений состояния НС (1), т. к. отпадает необходимость в уравнениях, описывающих динамику изменения Л, И, а следовательно, и вертикальной проекции скорости

Проекция скорости Vz здесь выражается через остальные параметры движения дифференцированием модели высоты:

V = и = дИ(ЛР,ф) ф = дИ(ЛР,ф) V (г+И(Л,Р,ф))-\

Более того, проекция скорости V- здесь также может быть выражена через другие параметры движения — уже дифференцированием модели долготы.

Т. к.

Л = Лф) ф

дф ,

то подставляя в данное равенство выражения производных Л, ф из уравнений системы (1), получим

V* (<™ф)-1 (г + И)-1 =дЛдфф1 V (Г + И)-1, откуда получаем искомое уравнение связи:

V* =

дЛ(Р,ф)

дф

cosф.

дф

дф

Во-вторых, принципиальным обстоятельством здесь является то, что отсутствие необходимости использования уравнений проекций V*, Vz в уравнениях вектора состояния позволяет использовать их, как будет показано ниже, для построения автономного наблюдателя этого вектора, обеспечивающего оценивание при пропадании спутниковых измерений.

Рассмотрим построение фильтра для данных ПМП более подробно. Уравнения состояния приобретают при этом достаточно простой вид:

= Ф(Р,у)^ - Wd), ф = Vr (г + И(А,Р,ф))-

= С2) (а,Р,у,Л(Р,ф),ф)Ъа -

20 +

( г + И(А, Р,ф) )-1

дф

дЛ(Р,ф) дф

VY cosфsinф -

- ЩАЦф) П ( г + И(А, Р,ф) )-2 +

+ 02(г + И(А,Р,ф))cosфsinф -С^(а,р,у,Л(Р,ф),ф)Wа

(7)

где СТ2) (а, р,у,Л(Р,ф),ф) — 2-я строка матрицы Ст (а,р,у,Л(Р,ф),ф) .

В векторной форме Ланжевена, исходной для построения апостериорных оценок, уравнения (7) описываются как

У = F ( У, t) + F1 ( У, t) %,

(8)

V =

дЛ(Р,ф)

дф

, дИ(Л, Р,фЬ Ч_1

со8ф 1 — ^ ( г + И(Л, Р,ф))

VY.

Т. е. в данном случае измерения и функции наблюдения СНС выглядят как

ZR = Н (ф) + Wzв , Zv = Н (ф, VJ) +

может быть выражена как

т> дЛ(Р,ф) . -Уг =—cosфVY +

дф

+

8

где У = |ayвуфVY| , ^0)=^, % = WaT| функции F (У, t), F1 (У, t) приведены в Приложении 2.

При использовании спутниковых измерений (6) в качестве наблюдателя вектора У они также трансформируются соответствующим образом: вместо переменных И, Л записываются их функциональные зависимости от ф— И(А, Р,ф), Л(Р,ф), а вектор V представляется как

/дЛ(Р,ф)еозф'к2 ( г + И(А, Р,ф) )-1. (10)

дф ^ дф )

Выражая в (10) производную скорости V из ее уравнения, входящего в систему (1), и используя уравнение связи, окончательно имеем:

V. =^^^^2) (а,р,у,Л(Р,ф),ф)Za -

дф

20 +

дЛ(Р,ф) дф

vr ( г + И(А, Р,ф))-1

дЛ(Р,ф)

^ дф

VY cosфsinф-

дИ(А, Р,ф) дф

хvy 2 ( г + И(А, Р,ф)) + + 02 (г + И(А,Р,ф))cosфsinф -

(9)

Но главное в приведенной трансформации вектора состояния — это возможность построения автономного наблюдателя навигационных параметров на основе выходных сигналов акселерометров. Используем для этого уравнение проекции скорости V* из системы (1) (не вошедшее в (7)), учитывая, что из уравнения связи ее производная

- СТ2)(а, р,у,Л(Р,ф),фЩа | +

+ ^ 2 ( г + и(а, Р,ф))-

дф{ дф гК У '

(11)

С другой стороны, уравнение проекции скорости V* из системы (1) с учетом уравнения связи может быть преобразовано к виду

X

Т

¥х = ^(а, /3,у,Я(Р,ф),ф)Ъа +

+

20 +

дЯ(Р,ф) дф

У7 (г + ^А,Р,ф))-

хК7 {sinф -

inф — ^^^ (г + ^А, Р,ф) )-1 соф -

-С^а,р,у,к(Р,ф),фуЯа.

(12)

Выбирая в качестве наблюдателя параметров состояния БИНС акселерометр, расположенный по оси 0х ПСК (выбор оси принципиального значения не имеет), построим информационную модель его выходного сигнала , приравнивая правые части уравнений (11) и (12):

=

V

дЯ(Р,ф) дф

cosф с1;

+

дЯ(Р,ф)

Л дф

( дЯ(Р,ф)

cosфс22 - с2

2Ч +

/ л

дф

20 +

cosф с32 - с3

+

дЯ(Р,ф) дф

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

cosф х

дЯ(Р,ф) дф

V ( г + h(А, Р,ф) )-

дЯ(Р,ф) ф

х-У7 cosфsinф -

дф

д^А,Р,ф)т, 2/ , ,. _ ,чч-2 дф 2 (г + МА, Р,ф)) +

+02 (г + ^А, Р,ф)) cosфsinф

+

+

дГдЯ(Р,ф) Л 2, ... ч-1 cosф V2(г + МА,Р,ф)) -

дф V дф

\

+ (г + МА,Р,ф))-^

V дф /

V х

, . , dh(А,Р,ф). ,,А _ 1 ,1 х-^тф--^^ (г + h(А,Р,ф)) ^ф| +

+

сТ дЯ(Р,ф)___ сТ

С(1)--—-COsф С(2)

дф

(13)

С(,) = С(,)(«, ^,у,Я(Р,ф),ф) — /-я строка матрицы СТ(а,Р,у,Я(Р,ф),ф);

функции На (Y, ^), Н: (Y, t) приведены в Приложении 3.

Несмотря на более сложную модель информационного сигнала по сравнению со спутниковыми измерениями, дополнительным преимуществом данного наблюдателя (помимо автономности) является возможность явного наблюдения всех навигационных переменных (в том числе и угловых параметров), что принципиально влияет на точность оценивания вектора состояния БИНС.

Уравнения (8, 13), представленные в классической форме "объект—наблюдатель", позволяют осуществить теоретически строгое апостериорное оптимальное оценивание навигационного вектора по выбранному вероятностному критерию. Т. к. точное решение задачи связано с необходимостью интегрирования интегро-дифференци-ального уравнения в частных производных (уравнения Стратоновича) для апостериорной плотности вероятности (АПВ) [6], то с целью уменьшения вычислительных затрат используем далее субоптимальную оценку навигационного вектора на основе гауссовской аппроксимации АПВ (так называемый нелинейный фильтр Калмана):

Y = F(^t) + К(^t)[2х -На (^t)

где К ( ^t ) =

(14)

дН((Y,t) . .

к-^ + Ц (t) DАНI (^ t)

дY

х( Н „ (Y, t) Da Н (Y, t))-1;

дF t) дFT t)

К (^t К (^t) + К (^t

+

дY

+ Ц (Y, t) DÍF1T (Y, t)- К(^ t)(Н: (Y, t)Daн: (Y, t))КТ (Y, t);

^ = М(Y0); И0 = М{(Y0 - ^)(^ - ^)Т);

дY

, t )-

о, 0 0

; о а =

0 Оа Оа

= На (^ t) + Н: (Y, t) Wa ,

где

ср = ср (а, ^,у,Я(Р,ф),ф)— //-й элемент матрицы С(а,@,у,Я(Р,ф),ф);

О

Фильтр (14) необходимо использовать при отсутствии спутниковых измерений, обеспечивая непрерывность и устойчивость процесса оценивания в целом. При наличии же спутниковых сигналов целесообразно их комплексировать с сигналами акселерометров. В этом случае уравнения ком-

х

х

х

X

X

X

плексированного наблюдателя, учитывающие дискретный характер спутниковых сообщений, в векторной форме принимают следующий вид:

Zax на (Y, *)

Z ИНТ _ Zr _ н*(Ф)

Zv H у(ф, V)

нw ( Y, * ) 0

0 E,

= HИНТ ( Y,* ) + H0ИНТ (Y,* ) ZfT ,

Wa

WR

WTr

(15)

где Е2 — единичная матрица размерности 2; к — текущий такт поступления спутниковых измере-

I |Т

ний; С,7Т = WZк WZJ — БГШ с нулевым

средним и матрицей интенсивности DяяТ = Da 0 0 0 D7 0

ZR

0 0 D7

7l

Подобная задача относится уже к задачам непрерывно-дискретной фильтрации и просто с помощью фильтра Калмана решена быть не может [6].

В соответствии с [6], гауссовский алгоритм дискретного оценивания для расширенного наблюдателя (15) на к-м такте измерения имеет вид:

Y(tK + 0) = Y* о + R (t* + 0)-

анИ

(Y* 0, * )

aY

(Н0ИНТ (Y*0,*)БинтH0ИНТT (Y*0,*)) ZfT - HИНТ ( Y* 0, * )

* (I х

(16)

где

R (t* + 0) = RK0 - RK

ан ИНТ T (Y*0, *)

aY

анИНТ ( yy*0, *) анИНТ T (Y*0, *)

- R

aY

aY

+

+н0ИНТT (Y*0,*)Бинтн0ИНТ' (YK0,*) ан ИНТ (Y* 0, *)

aY

-R * 0.

При этом следует подчеркнуть, что непрерывный фильтр (14) используется только на вре-

менных интервалах [tk-1, tk], * = 1, 2,..., между дискретными спутниковыми измерениями (в том числе при их пропадании), поэтому начальные условия Y(t*4), R (t*-1) уравнений (14) на интервале [tk-i, tk] формируются как результат дискретного оценивания Y*- = Y(t*- + 0), R*- = R(t*-1 + 0) вектора состояния НС Y в момент времени t*-1:

Y(t*-1)= YY*-1 = Y(t*-1 + 0), R (t*-1) = R *-1 = R(t* -1 + 0).

В свою очередь, результат интегрирования Y(t*), R (t*) уравнений непрерывного оценивания (14) в конце временного интервала [tK-1, t*] является начальным условием Y(t* - 0) = Y*0, R(t* - 0) = R*0 для выполнения алгоритма дискретного оценивания (16) в момент времени tK:

Y(t* - 0)= YY*0= Y(t*), R(t* - 0)= R * 0 = R (t*).

Подобная связь начальных и конечных условий алгоритмов дискретного и непрерывного оценивания является одним из основных условий корректного функционирования режима интеграции автономной БИНС и СНС.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

ПРИМЕР

Для иллюстрации возможности эффективного использования предложенного алгоритма интеграции было проведено численное моделирование уравнений оценивания (14), (16). Моделирование осуществлялось на временном интервале t е[0;1000] с с шагом At = 0.01 с методом Рун-

ге—Кутта 4-го порядка. (Следует при этом отметить, что размерность фильтра с учетом симметричности ковариационной матрицы сократилась по сравнению с оценкой полного вектора состояния (1) с 54 уравнений до 20). Модели изменения долготы и высоты задавались полиномами 2-го порядка. В качестве модели помех был использован аддитивный гауссовский вектор-шум с нулевым матожиданием и интенсивностью: для акселерометров — (10-5 м/с2)2, кодовых измерений — (15 м)2, доплеровских измерений — (0.5 м/с)2. Моделирование пропадания спутниковых сигналов осуществлялось на 400-й секунде на временном интервале 300 с. По окончании временного интервала моделирования максимальные ошибки компонентов вектора Y составили: по проекции VY — 4 %, по углам ориентации — 0.1 %, по широте — 14 м, что свидетельствует о возможности эффективного практического использования пред-

+

T

X

X

X

X

X

-1

х

ложенного алгоритма, реализующего все преимущества, заявленные в начале статьи.

Приложение 1

О (а, р,у) =

эш^ эта эту + соэ^соэу cosаsinу соэ^этаэту - эт^соэу эт^этасозу - соэ^эт у соэасоэу cos^sinаcosу + эт^т у эт /Зсоэа - sinа соэ^соэа

Приложение 2

F ( Y, t ) =

ф (Р,у)

У7 (г + h(А,Р,ф))-

СТ2)(а,Р,у,Я(Р,ф),ф)Ъа -

20 +

дЯ(Р,ф)

дф

У7 (г + ^А,Р,ф))-

дЯ(Р,ф)

дф

У7 cosфsinф -

(г + h(А,Р,ф))-2 +02 (г + ^А,Р,ф))соэфэшф

Fl ( Y, t) =

-ф {Р,у)

0 0

0 -СТ2) (а,Ду,Я(Р,ф),"ф)

Приложение 3

На (^ t) =

дЯ(Р,ф) дф

соэф с1;

дЯ(Р,ф) дф

соэфс22 - с2

^ +

+

+

дЯ(Р,ф) дф

дЯ(Р,ф)

соэф с32 - с3

^ +

дф

соэф

20 +

дЯ(Р'ф) У,. ( г + Й(А, Р,ф))-1 ^дЯ(Р'ф)

дф

дф

У7 соэфэтф -

-д^Р,ф) У7 2 (г + МА, Р,ф))-2 +02 (г + ^А, Р,ф)) cosфsinф

+

+

д

дЯ(Рф)соэф^У7 2 (г + ^А, Р,ф))-1 -

дф V дф

0

2Q +

дЯ(Р,ф)

дф

VY (r + h(A, Р,ф))—

VY х

sinф — ^Р,ф) ( r + h(A, Р,ф) ) 1cosф

Hw(Y, 7) =

дЯ(Р,ф) ф >

-Л-С^Ф C12

дф

Ci--—— ^ф C(2)

'(1)

дф

СПИСОК ЛИТЕРАТУРЫ

1. Интегрированные инерциально-спутниковые системы: Сб. ст. и докл. / Сост. О.А. Степанов / Под общ. ред. акад. РАН В.Г. Пешехонова. СПб.: ГНЦ РФ ЦНИИ "Электроприбор", 2001. 233 с.

2. Анучин О.Н., Емельянцев Г.И. Интегрированные системы ориентации и навигации для морских подвижных объектов / Под общ. ред. акад. РАН В.Г. Пешехонова. СПб.: ГНЦ РФ ЦНИИ "Электроприбор", 2003. 390 с.

3. Соколов С.В., Погорелое В.А. Основы синтеза многоструктурных бесплатформенных навигационных систем. М.: Физматлит, 2009. 184 с.

4. Ишлинский А.Ю. Ориентация, гироскопы и инерци-альная навигация. М.: Наука, 1976. 672 с.

5. Интерфейсный контрольный документ ГЛОНАСС (5-я редакция). 2002.

6. Тихонов В.И., Харисов В.Н. Статистический анализ и синтез радиотехнических устройств и систем. М.: Радио и связь, 1991. 608 с.

Ростовский государственный университет путей сообщения, г. Ростов-на-Дону

Контакты: Соколов Сергей Викторович, [email protected]

Материал поступил в редакцию 24.01.2012.

х

С11 —

SYNTHESIS OF ALGORITHMS OF INERTIAL-SATELLITE NAVIGATING SYSTEMS ON THE BASIS OF SPATIAL MODELS OF MOVEMENT

S. V. Sokolov, S. S. Vdovichenko

Rostov State Transport University, Rostov-on-Don

It is shown that use of spatial models of a trajectory of object in geographical coordinates reduces dimension of an estimated vector of navigating parameters, reducing computing expenses, and allows to solve essentially a problem of a posterior estimations of parameters of movement by independent measuring instruments at loss of satellite messages.

Keywords: inertial-satellite navigation systems, spatial (space) models of movement, a posterioriestimation, autonomic measurements

i Надоели баннеры? Вы всегда можете отключить рекламу.