Способ коррекции бесплатформенной инерциальной навигационной системы Российский патент 2018 года по МПК G01C21/06 

Описание патента на изобретение RU2646954C2

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

В бесплатформенной курсовертикали, установленной на летательном аппарате (ЛА), углы крена и тангажа вычисляются по информации от датчиков угловых скоростей как отклонения от опорной системы координат, которая определяется перед взлетом.

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

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

Известен способ коррекции бесплатформенной инерциальной навигационной системы, описанный в патенте RU 2564380, МПК G01C 21/06, опубликован 27.09.2015 г., бюллетень №27, принятый нами за прототип.

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

Недостаток известного способа заключается в том, что при маневрировании ЛА этот способ не обеспечивает достаточной точности. Это может привести к возникновению значительных погрешностей в результате постоянного маневрирования высокоманевренных ЛА.

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

Поставленная цель достигается за счет того, что согласно способу коррекции бесплатформенной инерциальной навигационной системы (БИНС), при котором на основании сигналов, поступающих с акселерометров, входящих в состав инерциальной навигационной системы (ИНС), определяют модуль абсолютного ускорения, действующего на объект, на котором установлена ИНС, комплексируют сигналы, соответствующие угловой скорости и земной скорости объекта, с сигналами, соответствующими линейным ускорениям и преобразованными с учетом параметров полета объекта, и осуществляют адаптивную оценку крена и тангажа посредством фильтра Калмана, в котором коэффициент усиления изменяется в зависимости от текущих значений модулей перегрузки и линейной скорости, а также угловых скоростей, дополнительно используют сигнал, соответствующий продольной скорости объекта, полученный от системы воздушных сигналов (СВС) в виде функции от динамического давления, и сигнал, соответствующий продольному ускорению, полученный путем дифференцирования с последующим сглаживанием сигнала скорости от СВС, а также производят оптимизацию коэффициентов фильтра Калмана, для чего формируют девять обучающих последовательностей, назначают шесть коэффициентов фильтра, подлежащих настройке, и критерий качества J1 в виде взвешенной среднеквадратической ошибки (СКО) ориентации по крену и тангажу, усредненную по времени и по множеству всех девяти обучающих последовательностей, причем оптимизацию коэффициентов алгоритма осуществляют в три этапа, первый из которых заключается в численной минимизации критерия качества minJ1 и определении коэффициентов {a1, b1, k1, q11, q21, q31} для полетов в спокойной атмосфере, σ(n*)<Δn, где σ - СКО измерений перегрузок n, второй этап заключается в численной минимизации критерия качества minJ1 и определении коэффициентов {a2, b2, k2, qn, q22, q32} для полетов в условиях турбулентности, когда σ(n*)≥Δn, а третий этап определяет процедуру вычисления дисперсий d, q1, q2, q3, удовлетворяющую с достаточной точностью полетам, как в спокойной атмосфере, так и в турбулентности, путем линейной интерполяции коэффициентов фильтра по результатам первого и второго этапов и текущим значениям σ(n*), n*.

Сущность изобретения поясняется чертежами, где на фиг. 1 представлена дисперсия ошибок наблюдения di, зависящая от текущего измерения модуля перегрузки и являющаяся функцией n*, на фиг. 2 и на фиг. 3 графически представлены сравнительные результаты моделирования прототипа и заявленного устройства.

Суть работы способа излагается ниже.

Фильтр Калмана строится с учетом структуры измерений кажущихся ускорений. Вектор состояния кроме крена и тангажа включает скорость полета V относительно земли.

i - номер дискретного момента времени. Уравнения объекта имеют вид

- интенсивность шумов,

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

Вектор наблюдения содержит перегрузки по трем связанным осям ЛА.

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

Для этого в модели наблюдений (3) ковариационная матрица ошибок наблюдений принимается в виде

Здесь дисперсии ошибок наблюдения di зависят от текущего измерения модуля перегрузки и являются функцией n* (см. фиг. 1).

,

Обозначим априорное и апостериорное нормальные распределения для i-го шага, где ,

Ниже приведен алгоритм оценивания, который представляется фильтром первого порядка приближения, выполняющим рекуррентное вычисление апостериорного распределения по априорному распределению и текущему измерению Zi:

,

,

.

,

Здесь - оценка вектора наблюдений по априорному распределению вектора состояния.

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

,

.

Степень влияния слагаемых в правых частях (8) зависит от режима полета.

На режиме прямолинейного горизонтального полета с постоянной скоростью имеет место nx=sin(ϑ), ny=cos(ϑ)cos(γ), n2=-cos(ϑ)sin(γ). Данные соотношения используются в простейших вариантах коррекции, когда ускорения, создаваемые ЛА, значительно меньше гравитационных.

Слагаемые (V2ωyzVy)/g, (VxωzxVz)/g, (VyωxyVx)/g обусловлены появлением кориолисовых сил и имеют значимость при разворотах ЛА.

Слагаемые , , имеют значимость при появлении линейных ускорений по связанным осям ЛА.

В рамках вектора состояния (1) предлагается учитывать наиболее значимые члены в (8). При относительно небольших углах атаки и скольжения скорость направлена в основном по строительной оси.

Тогда (8) представляется в упрощенном виде nx=sin(3)+Vlg,

.

В отличие от прототипа, предлагается в первом уравнении (10) дополнительно учитывать слагаемое .

Приближенность (10) и допущения (9) снижают точность учета составляющих кажущегося ускорения (8). Однако строгого выполнения (10) и (9) не требуется, в чем и состоит преимущество исходной идеи прототипа. Суть в том, что всякое отклонение модуля перегрузки от единицы и всякая неточность (10) учитываются снижением доверия к наблюдениям перегрузок путем увеличения дисперсий в ковариационной матрице Ri, в соответствии с заданным графиком (фиг. 1). При этом снижается интенсивность коррекции и, следовательно, снижаются ее ошибки.

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

Учитывая то, что изменение скорости ЛА относится к длиннопериодическому движению, производная скорости выделяется из оценки скорости с помощью сглаживающего фильтра нижних частот.

Здесь T - постоянная времени фильтра нижних частот.

Из рассмотрения Якобиана Hi в (7) следует, что оценивание скорости ЛА происходит при выполнении разворотов, когда присутствуют одна или обе угловые скорости ωz, ωy. При этом слагаемые ωxV/g, - ωyV/g в соотношениях для ny, nz (10) обеспечивают оценивание крена. Из первого уравнения в (10) следует, что слагаемое в выражении для влияет на оценивание тангажа.

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

С этой целью предлагается использовать измерение скорости системой воздушных сигналов (СВС). СВС формирует измерение истинной воздушной скорости VTA.

Современные СВС обладают достаточно высокой точностью.

Выделение производной выполняют аналогично (11) с помощью фильтра нижних частот

Заметим, что при этом постоянные рассогласования между земной и истинной воздушной скоростями не вносят ошибок в определение производной. Динамические ошибки измерения VTA на малых высотах взлета и посадки незначительны. Шумовые погрешности СВС сглаживаются фильтром. Поэтому с достаточной точностью правомерно положить

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

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

С другой стороны, поскольку свойства маятниковой коррекции в той или иной степени всегда зависят от вида движения ЛА, важным является использование данных, близких к реальным полетам.

Для оптимизации коэффициентов фильтра Калмана использовались процессы изменения параметров полетов, сформированных с помощью авиасимулятора, имитирующего все этапы полета от взлета до посадки с учетом маневрирования ЛА и дополнительных возмущений в виде турбулентности.

Коэффициенты фильтра (7) оптимизируют следующим образом. Для каждого полета формируют девять обучающих последовательностей.

Варианты знаков смещений нулей гироскопов представлены в таблице 1, где с0 - абсолютная величина смещения. Величина с0 задается с учетом класса точности располагаемых гироскопов.

Всего в алгоритме курсовертикали присутствует шесть коэффициентов, подлежащих настройке: q1, q2, q3 - диагональные элементы ковариационной матрицы возмущений Q, и a=dx, , - коэффициенты нелинейной функции d=d(n*), определяющей диагональные элементы ковариационной матрицы ошибок наблюдения R.

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

Здесь - среднеквадратическая ошибка оценивания тангажа: - среднеквадратическая ошибка оценивания крена: αϑ=0.5 и αγ=0.5 - весовые коэффициенты; J={a,b,k,q1,q2,q3} - множество из шести искомых коэффициентов алгоритма (7).

Идентификацию турбулентности, в смысле выявления ее наличия, выполняют по величине СКО n* на скользящем интервале небольшой длины, порядка 1-2 секунд. При превышении некоторого заданного порога σ(n*)≥Δn принимают решение о наличии турбулентности.

Оптимизацию коэффициентов алгоритма курсовертикали осуществляют в три этапа. 1. Численная минимизация критерия качества minJ1 и определение коэффициентов {a1, b1, k1, q11, q21, q31} для полетов в спокойной атмосфере, σ(n*)<Δn.

2. Численная минимизация критерия качества minJ1 и определение коэффициентов {а2, b2, k2, q12, q22, q32} для полетов в условиях турбулентности, σ(n*)≥Δn.

3. Определение процедуры вычисления дисперсий d, q1, q2, q3, удовлетворяющей с достаточной точностью полетам как в спокойной атмосфере, так и в турбулентности. Наиболее просто данная процедура реализуется с помощью линейной интерполяции коэффициентов фильтра по результатам этапов 1, 2 и текущим значениям σ(n*), n*.

Для исследования использовались данные полетов легкого самолета на авиасимуляторе. Как видно из результатов исследования (фиг. 2 и фиг. 3) в режиме маневрирования, ошибки определения углов крена и тангажа, с применением заявляемого способа коррекции бесплатформенной инерциальной навигационной системы, существенно уменьшились.

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

Похожие патенты RU2646954C2

название год авторы номер документа
Адаптивная бесплатформенная инерциальная курсовертикаль 2016
  • Заец Виктор Федорович
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Туктарев Николай Алексеевич
  • Гришин Дмитрий Викторович
  • Ахмедова Сабина Курбановна
  • Перепелицин Антон Вадимович
RU2647205C2
Малогабаритный навигационный комплекс 2016
  • Заец Виктор Федорович
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Туктарев Николай Алексеевич
  • Гришин Дмитрий Викторович
  • Ахмедова Сабина Курбановна
  • Перепелицин Антон Вадимович
RU2644632C1
СПОСОБ КОРРЕКЦИИ БЕСПЛАТФОРМЕННОЙ ИНЕРЦИАЛЬНОЙ НАВИГАЦИОННОЙ СИСТЕМЫ 2014
  • Заец Виктор Федорович
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Туктарев Николай Алексеевич
  • Гришин Дмитрий Викторович
RU2564380C1
БЕСПЛАТФОРМЕННАЯ ИНЕРЦИАЛЬНАЯ КУРСОВЕРТИКАЛЬ 2014
  • Заец Виктор Федорович
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Туктарев Николай Алексеевич
  • Горшенин Александр Анатольевич
  • Титова Юлия Олеговна
RU2564379C1
Комплексный способ навигации летательных аппаратов 2016
  • Заец Виктор Федорович
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Туктарев Николай Алексеевич
  • Гришин Дмитрий Викторович
  • Ахмедова Сабина Курбановна
  • Перепелицин Антон Вадимович
RU2646957C1
Адаптивный корректор углов ориентации для БИНС 2020
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Заец Виктор Федорович
  • Туктарев Николай Алексеевич
  • Ахмедова Сабина Курбановна
RU2749152C1
Адаптивный способ коррекции углов ориентации БИНС 2020
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Заец Виктор Федорович
  • Туктарев Николай Алексеевич
  • Ахмедова Сабина Курбановна
RU2754396C1
Малогабаритная адаптивная курсовертикаль 2016
  • Заец Виктор Федорович
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Туктарев Николай Алексеевич
  • Гришин Дмитрий Викторович
  • Ахмедова Сабина Курбановна
  • Перепелицин Антон Вадимович
RU2714144C2
Способ коррекции углов ориентации БИНС 2022
  • Кулабухов Владимир Сергеевич
  • Туктарев Николай Алексеевич
  • Заец Виктор Федорович
  • Цацин Александр Алексеевич
RU2796328C1
БЕСПЛАТФОРМЕННАЯ ИНЕРЦИАЛЬНАЯ СИСТЕМА ОРИЕНТАЦИИ НА "ГРУБЫХ" ЧУВСТВИТЕЛЬНЫХ ЭЛЕМЕНТАХ 2008
  • Салычев Олег Степанович
RU2382988C1

Иллюстрации к изобретению RU 2 646 954 C2

Реферат патента 2018 года Способ коррекции бесплатформенной инерциальной навигационной системы

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

Формула изобретения RU 2 646 954 C2

Способ коррекции бесплатформенной инерциальной навигационной системы (БИНС), при котором на основании сигналов, поступающих с акселерометров, входящих в состав инерциальной навигационной системы (ИНС), определяют модуль абсолютного ускорения, действующего на объект, на котором установлена ИНС, комплексируют сигналы, соответствующие угловой скорости и земной скорости объекта, с сигналами, соответствующими линейным ускорениям и преобразованными с учетом параметров полета объекта, и осуществляют адаптивную оценку крена и тангажа посредством фильтра Калмана, в котором коэффициент усиления изменяется в зависимости от текущих значений модулей перегрузки и линейной скорости, а также угловых скоростей, отличающийся тем, что дополнительно используют сигнал, соответствующий продольной скорости объекта, полученный от системы воздушных сигналов (СВС) в виде функции от динамического давления, и сигнал, соответствующий продольному ускорению, полученный путем дифференцирования с последующим сглаживанием сигнала скорости от СВС, а также производят оптимизацию коэффициентов фильтра Калмана, для чего формируют девять обучающих последовательностей, назначают шесть коэффициентов фильтра, подлежащих настройке, и критерий качества J1 в виде взвешенной среднеквадратической ошибки (СКО) ориентации по крену и тангажу, усредненной по времени и по множеству всех девяти обучающих последовательностей, причем оптимизацию коэффициентов алгоритма осуществляют в три этапа, первый из которых заключается в численной минимизации критерия качества minJ1 и определении коэффициентов {а1, b1, k1, q11, q21, q31} для полетов в спокойной атмосфере, σ(n*)<Δn, где σ - СКО измерений перегрузок n, второй этап заключается в численной минимизации критерия качества minJ1 и определении коэффициентов {а2, b2, k2, q12, q22, q32} для полетов в условиях турбулентности, когда σ(n*)≥Δn, а третий этап определяет процедуру вычисления дисперсий d, q1, q2, q3, удовлетворяющую с достаточной точностью полетам как в спокойной атмосфере, так и в турбулентности, путем линейной интерполяции коэффициентов фильтра по результатам первого и второго этапов и текущим значениям σ(n*), n*.

Документы, цитированные в отчете о поиске Патент 2018 года RU2646954C2

СПОСОБ КОРРЕКЦИИ БЕСПЛАТФОРМЕННОЙ ИНЕРЦИАЛЬНОЙ НАВИГАЦИОННОЙ СИСТЕМЫ 2014
  • Заец Виктор Федорович
  • Кулабухов Владимир Сергеевич
  • Качанов Борис Олегович
  • Туктарев Николай Алексеевич
  • Гришин Дмитрий Викторович
RU2564380C1
US 6408245 B1, 18.06.2002
СПОСОБ ПЕРЕРАБОТКИ МОНАЦИТА 2005
  • Вальков Александр Васильевич
  • Степанов Сергей Илларионович
  • Сергиевский Валерий Владимирович
  • Чекмарев Александр Михайлович
RU2323989C2
US 7036097 B1, 25.04.2006
РИВКИН С.С
Метод оптимальной фильтрации Калмана и его применение в инерциальных навигационных системах
- Л.: Судостроение, 1974, 219 с.

RU 2 646 954 C2

Авторы

Заец Виктор Федорович

Кулабухов Владимир Сергеевич

Качанов Борис Олегович

Туктарев Николай Алексеевич

Гришин Дмитрий Викторович

Ахмедова Сабина Курбановна

Даты

2018-03-12Публикация

2016-06-01Подача