RU2654964C1 - Способ определения корректирующих поправок в бесплатформенной инерциальной навигационной системе - Google Patents

Способ определения корректирующих поправок в бесплатформенной инерциальной навигационной системе Download PDF

Info

Publication number
RU2654964C1
RU2654964C1 RU2017122618A RU2017122618A RU2654964C1 RU 2654964 C1 RU2654964 C1 RU 2654964C1 RU 2017122618 A RU2017122618 A RU 2017122618A RU 2017122618 A RU2017122618 A RU 2017122618A RU 2654964 C1 RU2654964 C1 RU 2654964C1
Authority
RU
Russia
Prior art keywords
error
errors
navigation system
information
vector
Prior art date
Application number
RU2017122618A
Other languages
English (en)
Inventor
Сергей Михайлович Бабурин
Валентина Вилениновна Силина
Татьяна Евгеньевна Сивохина
Сергей Анатольевич Черенков
Елена Владимировна Николаева
Original Assignee
Публичное акционерное общество "Московский институт электромеханики и автоматики" (ПАО "МИЭА")
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Публичное акционерное общество "Московский институт электромеханики и автоматики" (ПАО "МИЭА") filed Critical Публичное акционерное общество "Московский институт электромеханики и автоматики" (ПАО "МИЭА")
Priority to RU2017122618A priority Critical patent/RU2654964C1/ru
Application granted granted Critical
Publication of RU2654964C1 publication Critical patent/RU2654964C1/ru

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/02Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Astronomy & Astrophysics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

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

Description

Изобретение относится к области корректируемых инерциальных навигационных систем и может быть использовано при разработке комплексированных навигационных систем, в которых основная навигационная информация, поставляемая бесплатформенными инерциальными навигационными системами (БИНС), корректируется по позиционной и скоростной информации, поставляемой спутниковой навигационной системой (СНС), и угловой (астро) информации, поставляемой астросистемой.
Далее при описании предлагаемого способа в тексте используются следующие обозначения:
- векторы и матрицы обозначаются жирным шрифтом;
- надстрочный индекс "'" обозначает операцию дифференцирования;
- надстрочный индекс "т" обозначает операцию транспонирования;
- надстрочный индекс "-1" обозначает операцию обращения матрицы;
- надстрочный индекс "^", стоящий после матрицы, обозначает кососимметрическую матрицу.
При описании способа используются следующие ортогональные системы координат (трехгранники):
- трехгранник Oh1h2h3, лежащий в плоскости Гринвичского меридиана, ось Oh3 направлена на Северный полюс;
- идеальный (сопровождающий) трехгранник Mx1x2x3 с началом в точке М, связанной с объектом, ось х3 совпадает с местной вертикалью;
- модельный трехгранник Му1у2у3, реализуемый бортовой ЦВМ;
- приборный трехгранник Mz1z2z3, связанный со строительными осями системы (блока чувствительных элементов).
Взаимная ориентация трехгранников Mx1x2x3 и My1y2y3 определяется вектором α малых углов поворота.
Взаимная ориентация трехгранников Mz1z2z3 и My1y2y3 задается матрицей ориентации А.
Figure 00000001
где ϑ, γ, ψ - углы крена, тангажа и гироскопического курса соответственно.
Figure 00000002
где ϕ, λ, ε - географические координаты и курсовой угол.
Стандартная схема, по которой строится способ определения корректирующих поправок в БИНС, представлена на Фиг. 1, где
G - импульсная переходная функция объекта регулирования;
Н - матрица связи вектора корректируемых параметров системы х и вектора измерения z;
K - коэффициент усиления сигнала.
На один вход разностной блок-схемы подается сигнал Нх, а на другой - измерение z. Полученная разность (невязка) z-Hx подается на вход блока обратной связи с коэффициентом усиления К, выход которого подключен к входу блока G. Математическая запись системы, представленной на Фиг. 1, имеет вид:
Figure 00000003
Примером такого способа определения корректирующих поправок БИНС по внешней позиционной и скоростной информации, поставляемой доплеровским измерителем скорости и угла сноса (ДИСС), является известный способ, реализованный в серийных астроинерциальных системах Л-14МА [1] и Л41 [2], входящих в состав навигационных комплексов ВП-021 и Н-202.
В известном способе определения корректирующих поправок в БИНС используется астроинерциальная информация с астроинерциальной навигационной системы, а также позиционная и скоростная информация с ДИСС. Для получения корректирующих поправок из каталога визируемых звезд последовательно выбираются две звезды, доступные визированию в данный момент времени в данной точке местоположения объекта, проводится их последовательное визирование с определением разностей между их расчетными и фактическими углами (угловых поправок), пересчет полученных угловых поправок в вектор кинематических ошибок корректируемой системы, и по скорости изменения этого вектора на базе кинематических уравнений ошибок системы определяются такие инструментальные ошибки корректируемой системы, как нескомпенсированные дрейфы гироскопов. Внешняя скоростная информация используется для определения ошибок построения вертикали на базе динамической группы уравнений ошибок системы, при этом ошибки местоположения объекта определяются как алгебраическая сумма определенных ошибок построения вертикали и кинематических ошибок системы.
В известной системе при построении фильтра ставилась задача оценки ошибок построения вертикали, скоростных ошибок и линейной комбинации кинематических ошибок системы, инструментальных ошибок (нескомпенсированные дрейфы и ошибки акселерометров) и ошибок измерения, вызванных ошибками взаимной привязки осей корректируемой системы и антенн ДИСС. Базовой при построении фильтра скоростной коррекции (импульсная переходная функция G) была принята динамическая группа уравнений ошибок системы (6)-(11), приведенная ниже.
Асимптотически устойчивый фильтр шестого порядка, реализованный в системе Л-14МА, обеспечивал готовность оценок ошибок построения вертикали и скоростной ошибки за время, превосходящее 30 минут, а фильтр того же порядка, реализованный в системе Л41 с использованием метода калмановской фильтрации (метод корня), обеспечивал готовность оценок ошибок построения вертикали и скоростной ошибки за 12 минут времени. Однако ошибки внешней скоростной информации, вызванные ошибками взаимной привязки осей корректируемой системы и антенн ДИСС, приводят к дополнительным ошибкам корректируемых параметров инерциальной системы.
Задачей изобретения является разработка способа определения корректирующих поправок в БИНС, свободного от указанных недостатков путем использования позиционной и скоростной информации, поставляемой СНС, и астроинформации, поставляемой средствами астросистемы, а также существенно повышающего надежность проведения коррекции.
Поставленная задача решается способом определения корректирующих поправок в бесплатформенной инерциальной навигационной системе, в котором для коррекции бесплатформенной инерциальной навигационной системы используется астроинерциальная информация с астроинерциальной навигационной системы, а также позиционная и скоростная информация со спутниковой навигационной системы, при этом в процессе формирования астроинформации выбирается из каталога визируемых звезд звезда, доступная визированию в данный момент времени в данной точке местоположения объекта, ее визирование с определением двух угловых поправок посредством вычисления разности между расчетным и фактическим углами визирования звезды по азимуту и разности между расчетным и фактическим углами ее визирования по высоте; по полученной позиционной и скоростной информации на базе динамической группы уравнений ошибок корректируемой системы вычисляются ее позиционная ошибка, скоростная ошибка и ошибка построения вертикали, по совокупности ошибок определяются горизонтальные проекции вектора кинематических ошибок системы на плоскость местного горизонта, как результат визирования гипотетической звезды, находящейся в зените, затем по полученной в виде угловых поправок астроинерциальной информации и горизонтальных проекций вектора кинематических ошибок вычисляется его вертикальная проекция, производится пересчет горизонтальных и вертикальной проекций в вектор кинематических ошибок, после чего по его скорости определяются такие инструментальные ошибки, как некомпенсированные дрейфы гироскопов.
При построении способа учитывается то обстоятельство, что в совокупности определяемых ошибок системы такие ошибки, как ошибка α построения вертикали и ошибки γ определения местоположения, являются двухкомпонентными векторами, определяемыми в проекциях на оси сопровождающего трехгранника (местного горизонта), а кинематические ошибки β и инструментальные ошибки системы ν, ε (некомпенсированные дрейфы и ошибки акселерометров) являются трехкомпонентными векторами, при этом инструментальные ошибки ν, ε, которые рассматриваются как систематические ошибки, определены в проекциях на оси приборного трехгранника, ориентированного в БИНС относительно сопровождающего трехгранника, как было сказано выше, произвольным образом. Взаимная ориентация этих трехгранников определяется матрицей ориентации (1).
Учет этих особенностей при построении способа идентификации ошибок БИНС привел к построению трехступенчатого алгоритма, на первой ступени которого, представляющей двухканальную систему, определяются такие ошибки системы, как ошибка определения координат γ, скоростная ошибка Δω, ошибка построения вертикали α. Полученные оценки ошибок БИНС используются как новый вектор измерения, поступающий на вход алгоритма второй ступени, решающей задачу определения третьей компоненты β3 вектора β кинематических ошибок, при этом, как будет показано ниже, для определения третьей компоненты β3 вектора β достаточно визирования одной звезды, что существенно повышает надежность формирования оценок ошибок корректируемой системы; на третьей ступени, представляющей собой трехканальную систему, определяются такие инструментальные ошибки, как нескомпенсированные дрейфы системы ν.
В качестве базовых при построении алгоритма оценки ошибок БИНС используются уравнения, описывающие поведение динамических и кинематических ошибок в проекциях на оси сопровождающего трехгранника классической платформенной системы [1], [2], в которых учтены особенности построения БИНС.
Figure 00000004
Figure 00000005
Figure 00000006
Figure 00000007
Figure 00000008
Figure 00000009
где
Δω1 Δω2 - скоростные ошибки системы;
α1, α2 - ошибки построения вертикали;
β - вектор кинематических ошибок системы;
δε1, δε2, δω - проекции векторов инструментальных ошибок ε, ν (ошибок акселерометров, некомпенсированных дрейфов системы соответственно) на оси сопровождающего трехгранника, определяемые как:
Figure 00000010
Figure 00000011
где
ε, ν - систематические составляющие векторов инструментальных ошибок системы (ошибок акселерометров, некомпенсированных дрейфов системы соответственно), определенные в проекциях на оси приборного трехгранника как:
Figure 00000012
Figure 00000013
А - матрица ориентации, определяемая по (1);
ω - кососимметрическая матрица, соответствующая вектору абсолютных угловых скоростей вращения сопровождающего трехгранника;
ω1=V2/R+ub13,
ω2=-V1/R+ub23,
где
b13, b23 - элементы матрицы направляющих косинусов В, определяемые по (2);
V1, V2 - линейные скорости движения объекта;
R - радиус Земли;
u=15 град/ч - скорость вращения Земли.
Прежде чем приступать к изложению предложенного способа, проведем стандартную процедуру выделения наблюдаемого подпространства.
Задача построения наблюдаемого подпространства и определения меры наблюдаемости достаточно подробно и исчерпывающе изложена в [5].
Необходимым и достаточным условием наблюдаемости линейной динамической системы (6)-(9) является максимальный ранг матрицы наблюдаемости, равный размерности системы:
Figure 00000014
где
A=E+Gdt;
Е - единичная матрица;
dt - шаг интегрирования.
В основе процедуры построения наблюдаемого подпространства лежит преобразование:
Figure 00000015
где
Т - невырожденная матрица, структура которой может быть представлена в виде:
Figure 00000016
приводящее систему к каноническому виду, в котором импульсная переходная функция будет иметь вид:
Figure 00000017
с матрицей связи вектора измерения z с вектором х оцениваемых параметров системы:
Figure 00000018
или блочный вид:
Figure 00000019
где
& - элементы матрицы, отличные от нуля;
* - элементы матрицы, которые могут отличаться от нуля.
Процедура заключается в определении элементов xi вектора х наблюдаемых параметров.
Обозначим:
Figure 00000020
Figure 00000021
Figure 00000022
Figure 00000023
где Δω1, Δω2, γ1, γ2 определяются как:
Figure 00000024
Figure 00000025
Figure 00000026
Figure 00000027
ϕснс, λснс - географические широта и долгота, поставляемые СНС;
ϕ, λ - географические широта и долгота, поставляемые инерциальной системой;
γ1, γ2, Δϕ, Δλ - элементы вектора измерения z, формируемого по внешней позиционной и скоростной информации, т.е. наблюдаемыми величинами.
Подставляя х1, х2, х5, х6 в (20), (21), получаем:
Figure 00000028
Figure 00000029
Figure 00000030
Figure 00000031
Figure 00000032
Figure 00000033
Figure 00000034
Figure 00000035
где
Figure 00000036
Figure 00000037
Figure 00000038
Figure 00000039
Здесь при дифференцировании х2, х3, х6, х7 сделаны допущения о равенстве нулю производных членов δε10 21δω30 2, δε20 22δω30 2, ub13β3+δω1, ub13β3+δω2, поскольку эти производные представляют величины второго порядка малости.
В результате проделанных преобразований получили автономную систему, в новых переменных xi, i=1, 2, …, 8:
Figure 00000040
переходная матрица которой имеет форму жордановой матрицы:
Figure 00000041
вида (19) с матрицей связи:
Figure 00000042
вида (10), т.е. наблюдаемую систему.
Сделанные выше допущения о малости переменных δε10 21δω30 2, δε20 22δω30 2, ub13β3+δω1, ub13β3+δω2 позволили построить относительно простую наблюдаемую систему четвертого порядка по каждому каналу.
Построенная система в новых (наблюдаемых) переменных xi представляет первую ступень предложенного способа. Выходом этой ступени являются оценки β1, β2 горизонтальных каналов системы, определяемые по (9) по x1, x3, x4, x7, полученные на выходе первой ступени, а также переменные х3, х7, являющиеся (как это следует из (36), (37)) оценками ошибок построения вертикали. Эти переменные используются в качестве исходных параметров второй ступени для получения оценки β3 корректируемой БИНС.
На графиках Фиг. 2 представлены измерения Z1, Z2, полученные при работе первой ступени. Асимптотическая сходимость этих переменных к нулю свидетельствует об устойчивости и наблюдаемости полученной системы. На графиках Фиг. 3 представлены оцениваемые параметры β1 β2 и разницы между этими параметрами и их оценками, определяющими точность оцениваемых параметров. На графиках Фиг. 4 представлены оцениваемые параметры α1 α2 и разницы между этими параметрами и их оценками. На графиках Фиг. 5-7 представлены измерения, параметры и разницы между этими параметрами и их оценками, аналогичные параметрам, представленным на графиках Фиг. 2-4, при ошибке β3=10 угл. мин. На графиках Фиг. 8, 9 представлены параметры и разницы между этими параметрами и их оценками, аналогичные параметрам, представленным на графиках Фиг. 2-4, при инструментальных ошибках системы δω1=0.1 угл. мин/мин и δω2=0.2 угл. мин/мин. На графиках Фиг. 10, 11 представлены параметры и разницы между этими параметрами и их оценками, аналогичные параметрам, представленным на графиках Фиг. 2-4, при центрированной позиционной случайной ошибке, равномерно распределенной в диапазоне ±0.5 угл. мин, и при нулевых инструментальных и курсовой ошибках системы. Графики Фиг. 5-11 показывают влияние таких ошибок системы, как курсовая ошибка, нескомпенсированные дрейфы по горизонтальным осям и случайная ошибка измерения позиции, на точность определяемых выходных параметров системы при сделанных выше допущениях.
Выбор коэффициентов усиления в цепи обратной связи схемы Фиг. 1 может производиться любым из известных способов и не входит в рассмотрение данной заявки. В частности, для определения коэффициентов усиления может применяться асимптотически устойчивый способ, по которому коэффициенты усиления выбираются из условия равенства корней рассматриваемой системы, обеспечивающих ее сходимость с заданным коэффициентом затухания 0<λ<1; при определении коэффициентов усиления может быть использован критерий Гаусса:
Figure 00000043
где
Z - вектор измерений;
Н - матрица связи вектора измерений с вектором χ оцениваемых параметров;
D - матрица весовых коэффициентов;
т - операция транспонирования,
и построенный на базе этого критерия Гаусса фильтр Калмана; определенную привлекательность представляет критерий оптимальности, предложенный в свое время Чебышевым, минимизирующий кусочно-линейную форму:
Figure 00000044
где m - число измерений.
Привлекательность использования критерия (48) заключается в том, что в отличие от критерия (47) определяется не доверительный, а гарантированный интервал, за рамки которого не выходит ошибка оценки, полученной в данной конкретной реализации, - метод, получивший название метода гарантированной оценки.
При использовании угловой (астро) информации связь между угловыми поправками и кинематическими ошибками инерциальной навигационной системы определяется линейным соотношением
Figure 00000045
или в скалярной форме:
Figure 00000046
где
z - вектор угловых поправок (вектор измерения);
Figure 00000047
- вектор кинематических ошибок системы, подлежащих определению;
Н - матрица связи, структура которой определяется схемой подвеса телеблока и кинематикой отработки его углов наведения;
h1, h2, h3 - элементы матрицы Н.
Поскольку при визировании одной звезды получаем два измерения (две угловые поправки), для решения уравнения (45) требуется проведение измерений, получаемых при визировании как минимум двух звезд.
Базовыми при построении алгоритма оценки ошибок БИНС по результатам астроизмерений являются кинематические уравнения ошибок системы (8). Не нарушая общности изложения, рассмотрим схему азимутально-высотного подвеса телеблока, в котором углы наведения телеблока отрабатываются разворотом кардана телеблока на азимутальный угол А против часов в плоскости местного горизонта и угол В, отсчитываемый от плоскости местного горизонта в ортогональной плоскости. Тогда в уравнении (45) структура матрицы Н в (46) определится как:
Figure 00000048
Для однозначного определения трехкомпонентного вектора β необходимо, как было сказано, визирование как минимум двух звезд. Тогда матрица связи Н будет иметь вид:
Figure 00000049
где подстрочными индексами 1, 2 обозначены номера визируемых звезд.
Необходимым и достаточным условием невырожденности системы (45) с матрицей связи (48) является синус угла между визируемыми звездами, т.е. синус этого угла является мерой наблюдаемости системы.
Отметим, что система (48), определяющая связь вектора измерения Z с вектором определяемых параметров β, является избыточной, поскольку содержит четыре уравнения для определения трех неизвестных βi.
В настоящей заявке рассматривается задача построения наблюдаемого подпространства для достаточно узкого класса систем вида
Figure 00000050
где
Figure 00000051
- трехкомпонентный вектор;
Ω^ - кососимметрическая матрица, соответствующая вектору Ω угловых скоростей трехгранника (предполагается, что G'=Ω'=0, либо частотные характеристики этих параметров настолько ниже частотных характеристик строящихся алгоритмов, что позволяют сделать такое допущение без ухудшения качества работы этих алгоритмов).
Не составляет труда убедиться, что тип уравнений (4)-(11), с которыми предстоит работать в дальнейшем, соответствует (49). Кроме того, как было сказано выше, перепроектирование векторов из системы координат, связанной с сопровождающим трехгранником, в систему координат, связанную с приборным трехгранником, и обратно осуществляется перемножением исходного вектора на матрицу ориентации А, либо на Ат, представляющую ни что иное как ортонормированную матрицу направляющих косинусов.
Figure 00000052
Figure 00000053
Дифференциируя (50), (51) с учетом уравнения Пуассона
Figure 00000054
получаем:
Figure 00000055
Уравнение (53) получено транспонированием уравнения (52) Пуассона с учетом свойства кососимметрических матриц (Ω^)т=-Ω^.
Figure 00000056
Прежде чем строить наблюдаемое подпространство второй ступени, докажем одно утверждение.
Лемма 1
Для кососимметрической матрицы Ω^
Figure 00000057
справедливо:
Figure 00000058
где
Figure 00000059
(56), (57) доказывается непосредственно перемножением матриц
Figure 00000060
Figure 00000061
Непосредственно из Леммы 1 следует Теорема 1.
Теорема 1
Для систем вида (50) с f(t)=Const имеет место тождество:
Figure 00000062
Утверждение доказывается непосредственным дифференцированием x(t). С учетом уравнения Пуассона:
Figure 00000063
Figure 00000064
Обозначив, как и выше, Ω1 22 23 3=S2, получим (60).
Теорема 2
Для алгебраических соотношений вида:
Figure 00000065
Figure 00000066
Figure 00000067
где А - ортонормированная матрица, образуемая разворотом исходной системы координат (трехгранника) на три угла Эйлера (примером такой матрицы является матрица (1)), справедливо:
Figure 00000068
Figure 00000069
Доказательство
Дифференцируя (63), (64), из уравнений Пуассона получаем:
Figure 00000070
Figure 00000071
откуда, проведя два шага дифференцирования, получаем (66), (67), где вектор
Figure 00000072
представляет проекции вектора инструментальных ошибок системы ν на оси сопровождающего трехгранника
Figure 00000073
Обозначим вектор
Figure 00000072
через у. Тогда:
Figure 00000074
и в соответствии с Теоремой 1, последовательно дифференцируя у, получаем:
Figure 00000075
Применим полученные результаты (Теорема 1) для построения наблюдаемого подпространства второй ступени.
Будем решать задачу определения векторов β и ν в проекциях на оси сопровождающего трехгранника, где в качестве базовых берутся кинематические уравнения (8) ошибок системы, записанные в проекциях на оси сопровождающего трехгранника.
Для построения наблюдаемого подпространства второй ступени введем переменные:
Figure 00000076
Figure 00000077
i=l, 2, 3
В новых переменных (8) запишется:
Figure 00000078
Figure 00000079
Figure 00000080
Тогда из (48) по измерениям z однозначно определяется вектор xi, i=1, 2, 3 (при условии, что матрица Н имеет максимальный ранг; условия, обеспечивающие максимальный ранг матрицы Н оговорены выше), а система (8) в новых переменных (75)-(77) с измерением z запишется:
Figure 00000081
Figure 00000082
где
Figure 00000083
Figure 00000084
Структура (81) совпадает с (63).Тогда, последовательно дифференцируя и вводя новые переменные, в соответствии с Теоремой 1 получаем:
Figure 00000085
Figure 00000086
Figure 00000087
Figure 00000088
где
Figure 00000089
где ωi, i=1, 2, 3 - скорости вращения матрицы ориентации А (скорости изменения углов курса, крена и тангажа).
Тогда уравнение кинематических ошибок системы в матричном виде запишется:
Figure 00000090
где переходная матрица имеет блочный вид (каждый блок имеет размер 3×3)
Figure 00000091
где
Е - единичная матрица размера 3×3;
dT - шаг интегрирования;
σ2 - определяется по (86).
Использование фильтра (80)-(88) для определения ошибок β, ν системы по результатам астроизмерений является стандартной процедурой, используемой для коррекции БИНС по результатам астроизмерений. Использование скоростной и позиционной информации, поставляемой СНС, существенно упрощает способ коррекции БИНС, повышая надежность его работы.
Прежде всего отметим, что поскольку выходными параметрами рассмотренной выше первой ступени являются элементы β1, β2 вектора β кинематических ошибок системы, то результат работы первой ступени можно рассматривать как результат визирования гипотетической звезды, находящейся в зените. Тогда, принимая это во внимание для определения всех трех компонент вектора β при наличии внешней позиционной и скоростной информации, достаточно визирования одной звезды, что существенно облегчит получение необходимых для коррекции системы астропоправок. При этом матрица связи Н будет иметь вид:
Figure 00000092
где азимутальный угол А в первых двух строках матрицы Н может быть определен как:
Figure 00000093
Процедура определения третьей компоненты β3 может быть еще более упрощена, если формировать вектор измерения, получаемый при визировании второй (реальной) звезды, как алгебраическую сумму угловой поправки, получаемой в результате визирования выбранной звезды, и оценок β1, β2 вектора β, получаемых на выходе первой ступени, использующей позиционную и скоростную информацию, как это было показано выше. Так, из четвертой строки (89) получаем:
Figure 00000094
откуда, сформировав вектор измерения
Figure 00000095
где β1, β2 - выходные параметры первой ступени, получаем:
Figure 00000096
где
Figure 00000097
В результате проделанных выкладок построили вторую ступень в виде линейного уравнения (93) первого порядка, выходом которого является оценка третьей компоненты β3 вектора кинематических ошибок системы β.
Выходом двух ступеней построенного метода определения вектора β кинематических ошибок системы является оценка этого вектора.
На графиках Фиг. 12 представлены кинематическая ошибка системы β3 и разность между этой ошибкой и ее оценкой, полученной по (93), (94) при наличии азимутального дрейфа ν3=0.1 град/ч и при нулевых ошибках измерения, характеризующая точность получаемой по этому способу оценки. Большая ошибка получаемой оценки на первых 500 секундах вызвана переходным процессом при получении оценок β1, β2 на первой ступени. В установившемся состоянии ошибка оценки не превышает 0.8 угл. мин. На графиках Фиг. 13 представлены аналогичные результаты при наличии центрированной случайной позиционной ошибки измерения, распределенной по равномерному закону в диапазоне 0.1 угл. мин.
Для получения оценки вектора v инструментальных ошибок системы построим третью ступень, используя в качестве измерения выходные параметры βi, i=1, 2, 3, получаемые на выходе первой и второй ступеней. В этом случае, строя наблюдаемое подпространство из (8), как и выше, получаем:
Figure 00000098
где
Figure 00000099
Figure 00000100
Последовательно дифференцируя и вводя новые переменные, в соответствии с Теоремой 1 получаем:
Figure 00000101
Figure 00000102
Figure 00000103
Figure 00000104
где
Figure 00000105
ωi, i=1, 2, 3 - скорости вращения матрицы ориентации А (скорости изменения углов курса, крена и тангажа).
Сформировав измерение как:
Figure 00000106
получаем:
Figure 00000107
где
Figure 00000108
откуда, применяя Теорему 1, получаем в векторной форме:
Figure 00000109
где матрица F имеет блочный вид F=E+GdT,
Figure 00000110
где
Е - единичная матрица размера 3×3;
σ2 - определяется по (103).
На графиках Фиг. 14 показаны оценки дрейфов ν1=0.1 град/ч, ν2=0.2 град/ч, ν3=0.3 град/ч при наличии случайной центрированной ошибки измерения, равномерно распределенной в диапазоне 0.01 угл. мин.
В результате проделанных операций построен относительно простой способ использования позиционной и скоростной информации, поставляемой СНС, и астроинформации, представляющий трехступенчатую схему обработки информации, на первой ступени которой используется позиционная и скоростная информация для определения таких ошибок БИНС, как скоростная и позиционная ошибки и ошибки построения вертикали. По совокупности полученных на выходе первой ступени оценок позиционных ошибок и ошибок построения вертикали определяются горизонтальные проекции β1, β2 вектора β кинематических ошибок системы, что позволило на второй ступени, в которой для коррекции системы используется астроинформация, использовать только одну звезду в качестве астроориентира, что существенно облегчило условие проведения астрорежима, а также повысило точность за счет улучшения частотных характеристик способа обработки информации (за счет исключения времени, затрачиваемого на переброс визирной оси телеблока с линии визирования одной звезды на линию визирования другой при визировании двух звезд). И, наконец, на третьей ступени по информации, получаемой с выхода второй ступени, определяются такие инструментальные ошибки системы как нескомпенсированные дрейфы.

Claims (1)

  1. Способ определения корректирующих поправок в бесплатформенной инерциальной навигационной системе, в котором для коррекции бесплатформенной инерциальной навигационной системы используется астроинерциальная информация с астроинерциальной навигационной системы, а также позиционная и скоростная информация со спутниковой навигационной системы, при этом в процессе формирования астроинформации выбирается из каталога визируемых звезд звезда, доступная визированию в данный момент времени в данной точке местоположения объекта, ее визирование с определением двух угловых поправок посредством вычисления разности между расчетным и фактическим углами визирования звезды по азимуту и разности между расчетным и фактическим углами ее визирования по высоте; по полученной позиционной и скоростной информации на базе динамической группы уравнений ошибок корректируемой системы вычисляются ее позиционная ошибка, скоростная ошибка и ошибка построения вертикали, по совокупности ошибок определяются горизонтальные проекции вектора кинематических ошибок системы на плоскость местного горизонта как результат визирования гипотетической звезды, находящейся в зените, затем по полученной в виде угловых поправок астроинерциальной информации и горизонтальных проекций вектора кинематических ошибок вычисляется его вертикальная проекция, производится пересчет горизонтальных и вертикальной проекций в вектор кинематических ошибок, после чего по его скорости определяются такие инструментальные ошибки, как нескомпенсированные дрейфы гироскопов.
RU2017122618A 2017-06-27 2017-06-27 Способ определения корректирующих поправок в бесплатформенной инерциальной навигационной системе RU2654964C1 (ru)

Priority Applications (1)

Application Number Priority Date Filing Date Title
RU2017122618A RU2654964C1 (ru) 2017-06-27 2017-06-27 Способ определения корректирующих поправок в бесплатформенной инерциальной навигационной системе

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
RU2017122618A RU2654964C1 (ru) 2017-06-27 2017-06-27 Способ определения корректирующих поправок в бесплатформенной инерциальной навигационной системе

Publications (1)

Publication Number Publication Date
RU2654964C1 true RU2654964C1 (ru) 2018-05-23

Family

ID=62202510

Family Applications (1)

Application Number Title Priority Date Filing Date
RU2017122618A RU2654964C1 (ru) 2017-06-27 2017-06-27 Способ определения корректирующих поправок в бесплатформенной инерциальной навигационной системе

Country Status (1)

Country Link
RU (1) RU2654964C1 (ru)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110689571A (zh) * 2019-08-28 2020-01-14 陈加志 基于误差角度自适应调节的星体观测方法及天文望远镜
CN113551667A (zh) * 2021-07-21 2021-10-26 北京航空航天大学 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法
CN117664116A (zh) * 2024-01-29 2024-03-08 中国人民解放军国防科技大学 一种组合导航的初始位置确定方法及组合导航系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2527132C1 (ru) * 2013-03-11 2014-08-27 Общество с ограниченной ответственностью "АВИАРЕАЛ" Способ коррекции дрейфа микромеханического гироскопа, используемого в системе дополненной реальности на движущемся объекте
EP2112472B1 (en) * 2008-04-22 2014-09-10 Exelis Inc. Navigation system and method of obtaining accurate navigational information in signal challenging environments
RU2586443C1 (ru) * 2015-03-23 2016-06-10 Акционерное общество "Московский институт электромеханики и автоматики" (АО "МИЭА") Способ астровизирования
RU2607305C1 (ru) * 2015-09-30 2017-01-10 Открытое акционерное общество Московский научно-производственный комплекс "Авионика" имени О.В. Успенского (ОАО МНПК "Авионика") Способ определения и компенсации девиации магнитометрических датчиков и устройство для его осуществления
RU2614192C1 (ru) * 2015-12-02 2017-03-23 Акционерное общество "Раменское приборостроительное конструкторское бюро" Способ оценивания ошибок инерциальной информации и её коррекции по измерениям доплеровского измерителя скорости

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2112472B1 (en) * 2008-04-22 2014-09-10 Exelis Inc. Navigation system and method of obtaining accurate navigational information in signal challenging environments
RU2527132C1 (ru) * 2013-03-11 2014-08-27 Общество с ограниченной ответственностью "АВИАРЕАЛ" Способ коррекции дрейфа микромеханического гироскопа, используемого в системе дополненной реальности на движущемся объекте
RU2586443C1 (ru) * 2015-03-23 2016-06-10 Акционерное общество "Московский институт электромеханики и автоматики" (АО "МИЭА") Способ астровизирования
RU2607305C1 (ru) * 2015-09-30 2017-01-10 Открытое акционерное общество Московский научно-производственный комплекс "Авионика" имени О.В. Успенского (ОАО МНПК "Авионика") Способ определения и компенсации девиации магнитометрических датчиков и устройство для его осуществления
RU2614192C1 (ru) * 2015-12-02 2017-03-23 Акционерное общество "Раменское приборостроительное конструкторское бюро" Способ оценивания ошибок инерциальной информации и её коррекции по измерениям доплеровского измерителя скорости

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110689571A (zh) * 2019-08-28 2020-01-14 陈加志 基于误差角度自适应调节的星体观测方法及天文望远镜
CN110689571B (zh) * 2019-08-28 2022-07-12 陈加志 基于误差角度自适应调节的星体观测方法及天文望远镜
CN113551667A (zh) * 2021-07-21 2021-10-26 北京航空航天大学 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法
CN113551667B (zh) * 2021-07-21 2024-05-24 北京航空航天大学 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法
CN117664116A (zh) * 2024-01-29 2024-03-08 中国人民解放军国防科技大学 一种组合导航的初始位置确定方法及组合导航系统
CN117664116B (zh) * 2024-01-29 2024-04-26 中国人民解放军国防科技大学 一种组合导航的初始位置确定方法及组合导航系统

Similar Documents

Publication Publication Date Title
CN103994763A (zh) 一种火星车的sins/cns深组合导航系统及其实现方法
Yao et al. Transverse Navigation under the Ellipsoidal Earth Model and its Performance in both Polar and Non-polar areas
CN103792561B (zh) 一种基于gnss通道差分的紧组合降维滤波方法
CN105371844A (zh) 一种基于惯性/天文互助的惯性导航系统初始化方法
CN110849360B (zh) 面向多机协同编队飞行的分布式相对导航方法
CN103557864A (zh) Mems捷联惯导自适应sckf滤波的初始对准方法
RU2654964C1 (ru) Способ определения корректирующих поправок в бесплатформенной инерциальной навигационной системе
CN103674064B (zh) 捷联惯性导航系统的初始标定方法
Xue et al. In-motion alignment algorithm for vehicle carried SINS based on odometer aiding
CN109489661B (zh) 一种卫星初始入轨时陀螺组合常值漂移估计方法
RU2654965C1 (ru) Комбинированная бесплатформенная астроинерциальная навигационная система
CN105606093B (zh) 基于重力实时补偿的惯性导航方法及装置
Zhao et al. Comparison of initial alignment methods for SINS
Lu et al. In-motion initial alignment and positioning with INS/CNS/ODO integrated navigation system for lunar rovers
CN106643726B (zh) 一种统一惯性导航解算方法
Gu et al. A Kalman filter algorithm based on exact modeling for FOG GPS/SINS integration
CN204255368U (zh) 一种适用于火星车的sins/cns深组合导航系统
RU2539131C1 (ru) Бесплатформенная интегрированная навигационная система средней точности для мобильного наземного объекта
RU2502049C1 (ru) Малогабаритная бесплатформенная инерциальная навигационная система средней точности, корректируемая от системы воздушных сигналов
Binder Dead reckoning using an attitude and heading reference system based on a free gyro with equatorial orientation
Wang et al. An adaptive cascaded Kalman filter for two-antenna GPS/MEMS-IMU integration
Rao et al. Calibration of laser inertial navigator with dual-axis rotation
Ben et al. System reset for underwater strapdown inertial navigation system
Emel’yantsev et al. Vertical deflection determination in high latitudes using precision IMU and two-antenna GNSS system
RU2428659C2 (ru) Способ спутниковой коррекции гироскопических навигационных систем морских объектов