способ определения коэффициентов модели инструментальных погрешностей навигационной системы

Формула изобретения

СПОСОБ ОПРЕДЕЛЕНИЯ КОЭФФИЦИЕНТОВ МОДЕЛИ ИНСТРУМЕНТАЛЬНЫХ ПОГРЕШНОСТЕЙ НАВИГАЦИОННОЙ СИСТЕМЫ, основанный на вычислении значений коэффициентов, отличающийся тем, что коррекцию значений коэффициентов осуществляют путем равномерного перемещения блока чувствительных элементов из одного фиксированного положения в другое, одновременно осуществляя измерение действующих на блок чувствительных элементов значений ускорений и угловых скоростей в дискретные моменты времени, умножение измеренных значений ускорений и угловых скоростей самих на себя и друг на друга в соответствии с принятой моделью погрешностей, умножение полученных значений ускорений, угловых скоростей и их произведений на коэффициенты модели погрешностей, суммирование полученных произведений в соответствии с принятой моделью погрешностей, измерение углов поворота блока чувствительных элементов, вычисление в каждый дискретный момент времени независимых значений угловой скорости и ускорения по измерительным осям, вычисление независимых суммарных погрешностей навигационной системы путем вычитания из значений ускорений и угловых скоростей, полученных с блока чувствительных элементов, значений ускорений и угловых скоростей, полученных независимым путем, вычитание вычисленных независимых суммарных погрешностей из значений погрешностей, полученных в соответствии с принятой моделью погрешностей, вычисление новых значений коэффициентов.

Описание изобретения к патенту

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

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

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

Однако для определения коэффициентов модели необходимо совершать разворот блока ЧЭ в n фиксированных положений (n 5), что требует достаточно большого времени на определение коэффициентов (t 60 мин).

Целью изобретения является сокращение времени на выполнение операции определения коэффициентов.

Цель достигается тем, что в предлагаемом способе осуществляются равномерное перемещение блока ЧЭ из одного фиксированного положения в другое, измерение действующих на блок ЧЭ значений ускорений и угловых скоростей в дискретные моменты времени, умножение измеренных значений ускорений и угловых скоростей самих на себя и друг на друга для получения квадратов, кубов.

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

Устройство содержит блок 1 ЧЭ навигационной системы, выходы которого соединены с входами первого 2 и второго 3 блоков умножения, выходы первого блока 2 умножения соединены с входами второго блока 3 умножения, а выходы блока 3 соединены с входами первого сумматора 4, выходы которого соединены с первыми входами второго сумматора 5, вторые входы которого соединены с выходами блока 6 вычитания, а выходы с одними входами блока 7 вычисления коэффициентов, выходы которого соединены с вторыми входами второго блока 3 умножения, первые входы блока 6 вычитания соединены с выходами блока 1 ЧЭ, а вторые с выходами блока 8 вычисления независимых ускорений и угловых скоростей, вход которого соединен с выходом измерителя 9 угла поворота, блока 1 чувствительных элементов, вторые входы блока 7 соединены с выходами блока 10 хранения, входы которого соединены с выходами блока 1 ЧЭ и блока 2 умножения.

Устройство работает следующим образом.

Выполнение операций по определению коэффициентов модели погрешностей осуществляется в точке с известными g и широтой

Гиростабилизированная платформа с блоком ЧЭ или блок ЧЭ бесплатформенной навигационной системы на специальном поворотном столе совершает разворот из одного фиксированного положения в другое. В процессе осуществления равномерного перемещения блока 1 ЧЭ в дискретные моменты времени измеряют значения ускорений W_х и угловых скоростей _x которые затем поступают на входы первого 2 и второго 3 блоков умножения и на входы блока 6 вычитания и блока 10 хранения. В блоке 2 умножения происходит умножение значений ускорений W_х и угловых скоростей _xcамих на себя (и друг на друга при работе с тремя акселерометрами и гироскопами для получения квадратов, кубов и перекрестных значений ускорений и угловых скоростей) в соответствии с принятой моделью погрешностей W_х², W_х³, _x ² (для трех акселерометров и гироскопов W_хW_y, W_хW_z, W_yW_z, Wх², Wх³ и т.д. в зависимости от принятой модели погрешностей).

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

С₁W_х, С₂W_х², С₃W_х²,

С_{4 x} C_{5 x}² С₆W_х, С_{7 x} поступают в первый сумматор 4, где происходит суммирование значений произведений в соответствии с принятой моделью погрешностей и получение суммарных значений погрешностей для акселерометров и гироскопов

Z =

Полученная суммарная погрешность поступает на первый вход второго сумматора 5, на второй вход которого поступают независимо вычисленные значения суммарных погрешностей гироскопов и акселерометров.

Вычисление этих суммарных погрешностей выполняется следующим образом. При равномерном перемещении платформы из одного фиксированного положения в другое измеряют углы поворота платформы в каждый дискретный момент времени, вычисляют в эти моменты времени независимые значения угловой скорости и ускорения _x ^н и W_x ^н, причем, вычисляя _x ^н, учитывают и угловую скорость вращения Земли на данной широте и при данном наклоне блока 1 ЧЭ и скорость вращения самой платформы, которую нетрудно найти, зная угол поворота и время, затрачиваемое на это, а W_х^н= g_o sin где угол наклона измерительной оси акселерометра. Операции вычисления выполняются в блоке 8 вычисления независимых ускорений и угловых скоростей, на входы которого поступает значение угла наклона платформы с блока 1 ЧЭ и с измерителя 9 угла поворота, а также эталонные значения g и . Полученные значения _x^н и W _х^нпоступают в блок 6 вычитания, на входы которого поступают _x и W_х c выходов гироскопов и акселерометров блока 1 ЧЭ. На выходе блока 6 формируются независимые значения суммарных погрешностей Z^Н= =- которые поступают на вторые входы второго сумматора 5, на выходе которого получаются значения ошибок как разность суммарных погрешностей

Z Z^н.

Эти значения поступают в блок 7 вычисления коэффициентов модели погрешностей, где, используя известные градиентные процедуры, осуществляется вычисление на каждом такте новых уточненных значений коэффициентов модели и использование их в блоке 3, при этом для организации градиентной процедуры вычисления коэффициентов на вторые входы блока 7 поступают значения ускорений, угловых скоростей и их произведений из блока 10 хранения, получаемые на каждом такте опроса с выхода блока 1 ЧЭ (с гироскопов и акселерометров) и блока 2 (произведения самих на себя и друг на друга значения квадратов, кубов ускорений и угловых скоростей, перекрестные значения). Цикл уточнения коэффициента модели повторяется n раз, где n число дискретных моментов времени опроса блока 1 ЧЭ.

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

W_х K₁W_х + K₂W_x² + K₃W_x³ + K₄W_у + K₅W_хW_y + K_{6 x}+ K_{7 x}²)

_x= K₁W_y K₂W_x + K₃W_xW_y + K_4x (1)

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

Структура процесса формирования оценки погрешности вида (1) на выходе ДПНИ может быть представлена на (K+1) шаге в виде

(k+1) H(k+1)(k+1), (2) где (k+1)= [W_x; _x] cуммарная погрешность ДПНИ, полученная на входе принятой модели погрешностей (для одного гироскопа и акселерометра).

(k+1)=[C; C] где C_Wx [K₁K₂K₃K₄K₅K₆K₇]

С _x [K₁K₂K₃K₄] вектор коэффициентов принятой модели погрешностей (количество элементов вектора зависит от вида принятой модели погрешностей;

Н(К+1) матрица наблюдений, составленная из ускорений, угловых скоростей и их произведений самих на себя и друг на друга соответственно.

H(k+1)

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

Подстройку коэффициентов С(К+1) можно выполнить, применяя достаточно простые градиентные процедуры, основанные на задании среднеквадратической функции потерь вида

M[²(k)] [)]², (3) где (k) выражение (2), полученное на выходе модели погрешностей;

Z(k) суммарная погрешность, полученная независимым путем по данным, определенным с высокой точностью в месте проведения операции по уточнению коэффициентов калибровки (с известными g и ).

Функция (3), представляющая собой дисперсию на выходе модели, описывающей погрешности ДПНИ, может быть представлена в следующем виде:

М[ ²(k)] M[Z(k) H(k)C(k)]² (4)

Она минимизируется относительно коэффициентов С(k). Оптимальный вектор коэффициентов может быть определен как путем решения уравнения Винера-Хопфа, так и используя МНК. Однако особенность навигационной системы в том, что невозможно получить ансамбль реализации для вычисления дисперсии, приходится работать с единичной реализацией, получаемой на выходе блока ЧЭ. В этом случае для уточнения коэффициентов целесообразно использовать алгоритм Impoy дл мгновенного значения дисперсии (3)

C(k+1) C(k) + 2 Н^T(k) (k), (5) где коэффициент сходимости, определяющий устойчивость и скорость адаптации, подбирается обычно экспериментально.

Величина (k) в выражении (5) есть разность [z(k)-(k)] Найти значение Z(k) можно следующим образом.

Одновременно с измерением в дискретные моменты времени значений ускорений и угловых скоростей с ДПНИ W_х и _x осуществляется измерение величины угла разворота платформы с помощью измерителя угла поворота (датчика угла на оси вращения блока ЧЭ или внешнего измерителя) за период дискретности (опроса ДПНИ). Определяется истинное отклонение оси чувствительности акселерометра от вертикали места калибровки и находится независимое значение ускорения в дискретные моменты времени

W_x^Н g_o ^.sin где угол отклонения оси чувствительности от вертикали места. Одновременно определяется угловая скорость перемещения платформы с блоком ЧЭ, которая суммируется с угловой скоростью вращения Земли в точке калибровки (для известного ) _x^н. Разность

-== z(k) (6) есть независимая суммарная погрешность навигационной системы. Отсюда величина (k) имеет вид

(k) z(k)-(k).

Cравнение результатов определения коэффициентов модели погрешностей с использованием для вычисления коэффициентов простых градиентных процедур и способа, взятого за прототип, показало, что в предлагаемом способе достигается та же точность оценивания коэффициентов, что в способе-прототипе, но за время, равное 1-2 мин (в прототипе 60 мин).