Научная статья на тему 'ГРАФОАНАЛИТИЧЕСКИЙ МЕТОД ОПТИМАЛЬНОГО СИНТЕЗА КОНТУРА МАЯТНИКОВОЙ КОРРЕКЦИИ ГИРОСКОПИЧЕСКИХ ВЕРТИКАЛЕЙ'

ГРАФОАНАЛИТИЧЕСКИЙ МЕТОД ОПТИМАЛЬНОГО СИНТЕЗА КОНТУРА МАЯТНИКОВОЙ КОРРЕКЦИИ ГИРОСКОПИЧЕСКИХ ВЕРТИКАЛЕЙ Текст научной статьи по специальности «Электротехника, электронная техника, информационные технологии»

CC BY
24
5
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
КОМПЛЕКСИРОВАНИЕ / КОМПЛЕМЕНТАРНЫЙ ФИЛЬТР / ГИРОВЕРТИКАЛЬ / МАЯТНИКОВАЯ КОРРЕКЦИЯ / ОПТИМАЛЬНЫЙ СИНТЕЗ / ГИРОСКОП / МАЯТНИКОВЫЙ ЧУВСТВИТЕЛЬНЫЙ ЭЛЕМЕНТ / АКСЕЛЕРОМЕТР

Аннотация научной статьи по электротехнике, электронной технике, информационным технологиям, автор научной работы — Лукин К. О., Кривошеев С. В.

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

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

Похожие темы научных работ по электротехнике, электронной технике, информационным технологиям , автор научной работы — Лукин К. О., Кривошеев С. В.

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

GRAPHICAL-ANALYTICAL METHOD FOR OPTIMAL SYNTHESIS OF PENDULUM CORRECTION CONTOUR OF VERTICAL GYROS

A graphical-analytical method of optimal synthesis of pendulum (positional) correction contour for gyroscopic verticals on a movable base is presented, the model of the gyro is reduced to a complementary filter. The variance of the complementary filter error is used as an optimality criterion. Characteristics of the gyroscope drift in the form of white noise and zero instability are determined from the Allan variation, and the satellite errors are determined from the spectral power density of horizontal acceleration, determined with the account for assumed operating conditions. Determination of the optimal correction time constant and the maximum permissible gyroscope drift parameter at a given gyro accuracy, taking into account the moving object dynamics, is carried out using a specially formed graph with the axes "correction time constant - gyro drift parameter". The proposed method can be used for both analytical and power vertical gyros.

Текст научной работы на тему «ГРАФОАНАЛИТИЧЕСКИЙ МЕТОД ОПТИМАЛЬНОГО СИНТЕЗА КОНТУРА МАЯТНИКОВОЙ КОРРЕКЦИИ ГИРОСКОПИЧЕСКИХ ВЕРТИКАЛЕЙ»

ПРИБОРЫ НАВИГАЦИИ NAVIGATIONAL INSTRUMENTS

УДК 531.383

DOI: 10.17586/0021-3454-2023-66-8-660-670

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

К. О. Лукин*, С. В. Кривошеев

Казанский национальный исследовательский технический университет им. А. Н. Туполева-КАИ,

Казань, Россия KirilLO.Lukin@yandex.ru

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

Ключевые слова: комплексирование, комплементарный фильтр, гировертикаль, маятниковая коррекция, оптимальный синтез, гироскоп, маятниковый чувствительный элемент, акселерометр

Ссылка для цитирования: Лукин К. О., Кривошеев С. В. Графоаналитический метод оптимального синтеза контура маятниковой коррекции гироскопических вертикалей // Изв. вузов. Приборостроение. 2023. Т. 66, № 8. С. 660—670. Б01: 10.17586/0021-3454-2023-66-8-660-670.

GRAPHICAL-ANALYTICAL METHOD FOR OPTIMAL SYNTHESIS OF PENDULUM CORRECTION CONTOUR OF VERTICAL GYROS

K. O. Lukin*, S. V. Krivosheev

A. N. Tupolev Kazan National Research Technical University, Kazan, Russia Kirill.O.Lukin@yandex.ru

Abstract. A graphical-analytical method of optimal synthesis of pendulum (positional) correction contour for gyroscopic verticals on a movable base is presented, the model of the gyro is reduced to a complementary filter. The variance of the complementary filter error is used as an optimality criterion. Characteristics of the gyroscope drift in the form of white noise and zero instability are determined from the Allan variation, and the satellite errors are determined from the spectral power density of horizontal acceleration, determined with the account for assumed operating conditions. Determination of the optimal correction time constant and the maximum permissible gyroscope drift parameter at a given gyro accuracy, taking into account the moving object dynamics, is carried out using a specially formed graph with the axes "correction time constant — gyro drift parameter". The proposed method can be used for both analytical and power vertical gyros.

Keywords: complexing, complementary filter, vertical gyro, pendulum correction, optimal synthesis, gyro, pendulum sensitive element, accelerometer

© Лукин К. О., Кривошеев С. В., 2023 JOURNAL OF INSTRUMENT ENGINEERING. 2023. Vol. 66, N 8

For citation: Lukin K. O., Krivosheev S. V. Graphical-analytical method for optimal synthesis of pendulum correction contour of vertical gyros. Journal of Instrument Engineering. 2023. Vol. 66, N 8. P. 660—670 (in Russian). DOI: 10.17586/0021-3454-2023-66-8-660-670.

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

В аналитических гировертикалях комплексирование выполняется численно, в частности, с использованием комплементарного фильтра (КФ) [1, 2], фильтра Калмана [3—5] и фильтра Маджвика [6]. Синтез КФ заключается в выборе общей частоты среза для фильтров низкой (ФНЧ) и высокой частоты (ФВЧ). КФ может быть реализован не только в классическом виде для углов Эйлера—Крылова, но и для параметров ориентации в виде направляющих косинусов [1] и кватернионов [2].

Иногда горизонтальными поперечными ускорениями просто пренебрегают (например, в [4] для фильтра Калмана), оставляя модель только белого шума. В таком случае синтез схож со способами синтеза КФ на основе фильтра Винера или фильтра Калмана первого порядка [7, 8], где дрейф гироскопа и ошибки МЧЭ описываются белыми шумами. Однако тогда остается неясным принцип выбора характеристик белого шума ошибок МЧЭ при использовании гировертикали на подвижном объекте (подробнее этот аспект рассмотрен в разделе „Пример").

Выбор параметров контура маятниковой коррекции с учетом динамики подвижного объекта не рассматривался в работах [1, 4, 6, 8]. Из известных методов настройки можно привести, например, уменьшение крутизны контура коррекции при увеличении модуля измеренного акселерометрами ускорения [9, 10] и оптимизацию крутизны контура по результатам экспериментов [10, 11].

На взгляд авторов, наиболее технически целесообразным методом синтеза контура коррекции является использование статистических характеристик сигналов гироскопа и МЧЭ, как, например, в [12]. В настоящей работе рассмотрен синтез контура маятниковой коррекции по типу КФ как наиболее универсальный и вычислительно простой способ комплексирова-ния. Предлагается графоаналитический метод выбора точности гироскопа и оптимального значения постоянной времени коррекции Т КФ с учетом параметров динамики подвижного объекта.

Постановка задачи. Без потери общности рассмотрим комплексирование для определения угла крена в аналитической гировертикали. Аналитическая гировертикаль состоит из датчика угловых скоростей (ДУС), ось чувствительности которого установлена по продольной оси X подвижного объекта, и МЧЭ в виде блока акселерометров с осями чувствительности по поперечной 2 и нормальной У осям подвижного объекта.

Угол крена по сигналам блока акселерометров ум определяется по выражению

Гa ^

У м = arctg

az

ay

V У

= arctg

g sin y + a cos у g cos y- a sin y J

(1)

где ay, az — показания акселерометров по соответствующим осям; g — ускорение свободного падения; a — горизонтальное поперечное ускорение; у — истинный угол крена. Заменой переменных tg Лум = a/g (где Лум — ошибка МЧЭ) преобразуем выражение (1) к виду

g sin у + a cos у

Ум = arctg

í g sin ------ у Л Г sin(y + Лум) Л

g cos у-a sin у

= arctg

cos(У + ЛУм )

= у + Лу м. (2)

м/J

Угол крена по гироскопу (ДУС) уг определяется интегрированием сигнала мгновенной угловой скорости ДУС с учетом начального значения у0 :

г г

уг т + уо =| (у + Шдр т + уо, (3)

о о

где шх = у + юдр — мгновенная угловая скорость, измеряемая ДУС; шдр — угловая скорость

дрейфа ДУС (гироскопа).

С целью комплексирования сигналов МЧЭ и гироскопа (ДУС) в виде КФ применяют комбинацию ФНЧ для сигнала МЧЭ (2) и ФВЧ с той же частотой среза (постоянной времени), что и ФНЧ, для сигнала ДУС (3). Вычисленный угол крена ув определяется с помощью КФ в виде

у, ум +-21-уг =Х+^м. + = у+_А^ + ^ , (4)

в Тр +1 м Тр +1 г Тр +1 Тр +1 Тр +1 Тр +1

где Т — постоянная времени коррекции; р — комплексная переменная в преобразовании Лапласа (символ дифференцирования). Таким образом, полезный сигнал не искажается в КФ, ошибки МЧЭ усредняются в ФНЧ, а дрейф гироскопа не имеет тенденции к накоплению после прохождения ФВЧ.

Ошибки МЧЭ Аум на подвижном объекте можно условно разделить на две составляющие: низкочастотные, например порождаемые виражом, и высокочастотные, порождаемые качкой или динамикой самого МЧЭ. Ошибки первого типа не усредняются в КФ, а гировертикаль „уходит" к кажущейся вертикали. Для их устранения используются дополнительные технические средства, например, выключатели коррекции или методы компенсации действия ускорений [13—15]. В расчетах используется нормальный режим, в котором ошибки МЧЭ не имеют составляющих с частотами, приближающимися к нулю, и являются малыми (до нескольких градусов).

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

Ставится задача оптимального синтеза КФ для аналитической гировертикали, а именно выбора постоянной времени коррекции Т , а также определения требуемой точности гироскопа с учетом заданной точности гировертикали и динамики подвижного объекта в нормальном режиме. В качестве критерия оптимальности принимается дисперсия £>кф ошибки

КФ. При этом будем считать ошибки гироскопа и МЧЭ некоррелированными, откуда общая дисперсия ошибки КФ в соответствии с (4) вычисляется как сумма дисперсий ошибок гироскопа (ДУС) и МЧЭ

А<ф = Дув-у] = Бт + . (5)

Предлагаемый метод расчета. Учитывая, что в нормальном режиме Аум «1, следовательно, Аум « а / g, а также, что ошибка МЧЭ из-за действия поперечного ускорения много больше шума самого датчика, ошибки МЧЭ могут быть аппроксимированы с помощью спектральной плотности мощности поперечного ускорения (ш) [16] в виде

2Батпш2

(ш) = 2

1 + 'тш + п( 'ш)2 которой соответствует формирующий фильтр

Р (Р) = /V 2тп°а

(6)

(7)

пр + тр +1

где ш — круговая частота; Ба — дисперсия горизонтального поперечного ускорения;

2 2 —1 2 2 —1 т = 2д(д + то ) ; п = (д + то ) ; д — параметр затухания; то — резонансная частота; ' —

мнимая единица.

Тогда дисперсию ошибки МЧЭ можно найти [ 16] аналитически по передаточным функциям формирующего фильтра (7) и ФНЧ в составе КФ (4):

( . 2 Л

Б =

1

у —X)

1

Тр +1

Р (Р)

ё ш

р='ш

g 2(Т2 + Тт + п)

(8)

Дисперсия ошибки гироскопа после прохождения КФ определяется выражением

Бг = Б

ш

др

Тр +1

Т

= Б

ш

др

Тр +1

Т2

(9)

Необходимо определить дисперсию выражения

ш

др

Тр +1

что означает найти дисперсию

угловой скорости дрейфа, усредненную ФНЧ за время Т. Для этого используем метод вариации Аллана [17]. Конечно, вариация Аллана не является, строго говоря, дисперсией, а усреднение по ней происходит не с помощью апериодического звена первого порядка. Однако с

шд

достаточной для данного расчета точностью можно оценить дисперсию выражения

др

равной вариации Аллана, тогда выражение (9) примет вид

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

Бг «а^ (Т)Т2,

Тр +1

(10)

где аав (Т) — вариация Аллана угловой скорости гироскопа.

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

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

Бг ^(ш)Т2, (11)

2

где Одд (ш) — вариация угловой скорости дрейфа в районе пологой части графика вариации Аллана. Дисперсия ошибки КФ, найденная по выражению (5), с учетом (8), (11) принимает вид

о о пН

Акф = + = Т ^ (ш) + , 2 I-7. (12)

g (Т + Тт + п)

Точки экстремума критерия оптимальности (12) определяет уравнение

д 2 пБа (2Т + т )

—Д<ф = 2Та2нн (ш)--->— = 0, (13)

дТ g2 (Т2 + Тт + п)2

которое для реализации предлагаемого метода рационально представить кривой, характеризующей зависимость анн(ш) от Т :

( ) 4,пРа (2Т + т)

%н(ш) = Д- / 2-Г. (14)

^/2Tg(T2 + Тт + п)

Найденные значения экстремумов, соответствующие кривой (14), будут означать минимум функции £>кф при положительной второй производной выражения (12):

-д22Нкф = 2анн(ш) + 2пБа (зТ2 + 3Тт + т2 - п)_2 (т2 + Тт + п) 3 > 0. (15)

дТ ^ / \ /

Докажем, что кривая (14) удовлетворяет условию (15) при любых Т > 0, анн (ш) > 0, тогда должно выполняться следующее выражение:

пБа (2Т + т) > пПа (3Т2 + 3Тт + т2 - п)

2Tg2 (Т2 + Тт + п)2 g2 (Т2 + Тт + п)3

_3

0,5пБа (8Т3 + 9Т2т + 3Тт2 + тп)Т-1g_2 (т2 + Тт + п) > 0 при т > 0, п > 0 .

Далее определим границы областей параметров Т, анн (ш) — уравнения изолиний — по максимально допустимому среднеквадратическому отклонению (СКО) ошибки КФ акф = л]Нкф по выражению (12):

(ш) = Т^

°кф2 _ 2(Т2ПВ; +). (16)

g (Т + Тт + п)

Для наглядного пояснения предлагаемого метода схематично представим выражения (14) и (16) на рис. 1, а в координатах Т, анн (ш) для общего случая. Точки пересечения изолиний (16) и

оптимальной кривой (14) — £1 и Е2 — показывают максимально допустимый дрейф для заданных акф1 и акф2 . Все точки под изолиниями (16) соответствуют дисперсии, меньшей, чем на соответствующей изолинии. Отрезки ОА1 и ОА2 показывают значения постоянной Т, при которых значения акф! и акф2 получить невозможно ввиду недостаточного усреднения ошибки МЧЭ.

Рис. 1

Выражение, схожее с (13), было получено в [12], где предлагается решить уравнение численным способом и отбросить корни, не имеющие физического смысла, а причиной ошибки гироскопа является вращение Земли. Однако для определения точек минимума среди экстремумов необходимо рассмотреть вторую производную (что более важно для случая белого шума). Для предлагаемого метода не требуется решение выражений (13) и (15), соответствующих первой и второй производным, или использование численных методов оптимизации.

При преобладании белого шума в дрейфе гироскопа в рабочей зоне вариация Аллана имеет наклон -1/2 [17], а значение выражения (10) определяется

DT « N2T, (17)

где N — случайное блуждание угла (angular random walk) по девиации Аллана [17]. По аналогии с выражением (14) могут быть получены уравнения кривой оптимума N от T

фРа (2T + m) ;

N =

g (t2 + Tm + n) '

(18)

аналогично выражению (15) — условие положительности второй производной

a-

2

dT

2D^ = -2nDa (3T2 + 3Tm + m2 -n

)g-2(

T^ +Tm + n) 3 >0,

чему соответствует ограничение в области Т > 0, N > 0 (второй корень квадратного уравне ния всегда отрицателен, поэтому не рассматривается)

T > -3m + v 12n - 9mz

= T'.

(19)

По аналогии с уравнением (16) могут быть получены уравнения изолиний одинакового СКО акф ошибки КФ и в случае белого шума

N =

V

nDa

кф

g 2(T2 + Tm + n) J

(20)

На рис. 1, б схематично отображены выражения (18)—(20) для общего случая. Точки £1, Е2 и А1, А2 соответствуют случаю нестабильности нуля на рис. 1, а. Точки Zl и 22 находятся на одной отметке белого шума N, при этом 21 лежит в зоне Т < Т', что означает локальный максимум, поэтому в качестве решения выбирается 22. Для значений белого шума N выше точки С отсутствуют экстремумы дисперсии Лкф .

Таким образом, по пересечению линий оптимума и изолиний с заданным СКО ошибки КФ на графиках определяются максимально допустимые значения нестабильности нуля и белого шума, на основании которых выбирается гироскоп. Далее, по построенным графикам и

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

Силовая гироскопическая вертикаль. Предлагаемый метод может быть применен при синтезе контура коррекции силовой гировертикали ввиду того, что математически динамика силовой гировертикали [18] по оси прецессии совпадает с уравнением КФ.

На рис. 2 показана силовая гировертикаль (контур стабилизации условно не показан) на подвижном объекте. Здесь обозначено: 2 — поперечная ось подвижного объекта; 2'^ —

проекция поперечной оси объекта на плоскость местного горизонта; 2гу — ось подвеса ги-роузла; Ур — нормаль к плоскости наружной рамки; Н — вектор кинетического момента

гироузла; У — нормальная ось подвижного объекта; У^ — местная вертикаль; а — угол

между осью подвеса гироузла 2ту и плоскостью горизонта; ДУ — датчик угла; У — усилитель; МК — мотор коррекции; ГУ — гироузел; НР — наружная рамка.

Рис. 2

Рассмотрим прецессионное уравнение относительно оси подвеса гироузла

Н а + К (а + Аум) +М др = 0,

где К — крутизна контура коррекции (общий коэффициент передачи датчика угла, усилителя и мотора коррекции); Мдр — возмущающий момент по оси подвеса гироузла (момент

дрейфа). Измеряемый угол крена уи в данном случае с учетом Т = Н/К, шдр = Мдр/Н выражается как

АУм , Тш

Уи =У"а = У+-

др

(21)

Тр +1 Тр +1

Выражение (21) для силовой гировертикали соответствует выражению (4) для КФ.

Пример. В качестве примера рассмотрим расчет КФ для аналитической микромеханической гировертикали (в виде блока акселерометров и ДУС) с маятниковой коррекцией на подвижном основании. Предполагается, что при эксплуатации спектральную плотность поперечных горизонтальных ускорений можно аппроксимировать по выражению (6) с параметрами ^Та = 0,51 м/с2, д = 3 рад/с, то = 1 рад/с

(ш) =

0,0316ш

2

10"2 ш4 + 0,16ш2 +1

(22)

Спектральная плотность мощности по выражению (22) показана на рис. 3, где / — частота. Необходимо определить требуемую точность ДУС и синтезировать КФ для определения угла крена с точностью не менее окф = 0,1° .

(м/с2)2/Гц 0,08

0,06

0,04

0,02

0,00

0 1 2 3 / Гц

Рис. 3

Сначала условимся, что по вариации Аллана наибольший вклад в дрейф ДУС, среди которых производится выбор, вносит белый шум. Отобразим на рис. 4, а выражения (18)—(20), сплошные кривые — линии оптимума, пунктир — изолинии СКО ошибки КФ. Оптимальная кривая (18) и изолиния (20) для окф = 0,1° пересекаются в точке Т = 16 с, N = 1,2 ° / >/ч .

а) б)

N, °/-у/ч

4

3 2 1

0

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

Рис. 4

При синтезе КФ путем преобразования фильтра Винера или Калмана первого порядка можно воспользоваться формулой [8]:

T = WgN, (23)

где Vrw — случайное блуждание скорости акселерометра (velocity random walk). Аппроксимация ошибок МЧЭ Аум белым шумом в большинстве случаев дает либо заниженную оценку

(в предположении, что белый шум ошибки МЧЭ равен белому шуму самого датчика), либо завышенную, если определять белый шум от максимальной ошибки МЧЭ по наихудшему сценарию. Так, если в качестве ошибки МЧЭ — при том же значении белого шума гироскопа N = 1,2 ° / >/ч — принять белый шум самого микромеханического датчика равным

Frw = 10_3 (м/с)/>/ч , то постоянная времени T = 0,005 с по формуле (23) получится слишком

маленькой для компенсации колебаний основания (окф = 2,95°). Если, например, по наихудшему сценарию предположить ошибку МЧЭ в виде белого шума c параметром VRW, соответствующим спектральной плотности A(v) белого шума, ограниченного на полосе частот динамики подвижного объекта f =Qj /2тт = 3 Гц (см. рис. 3), со СКО, равным дисперсии Da по выражению (22):

i ш1 fi

— f A(ffl)dv = f A( f )df = 2A( f )fi = Da, (24)

2л J v,

-®i ~fi

то спектральная плотность белого шума определится по выражению (24) A(f) = Da /2f =

2 2 2

= 4,14 40"" (м/с у /Гц . Это соответствует случайному блужданию скорости Vrw = VA(f) = 12,2 (м/с)/>/ч (перевод единиц измерения спектральной плотности белого

шума „ (м/с2)2/Гц " в случайное блуждание скорости „(м/с)/>/ч " приведен в стандарте [19]). Тогда по формуле (23) постоянная времени T = 59 с получается завышенной (окф = 0,154°) .

Заметим, что требование по значению белого шума не более N = 1,2 ° />/ч выполняется даже для бюджетных микромеханических гироскопов. Тогда проверим выбор в предположении, что основной вклад в дрейф вносит нестабильность нуля. Отобразим уравнения (14) и (16) на рис. 4, б. Максимально допустимое значение нестабильности нуля (ш) = 19,4 °/ч

для заданной погрешности окф = 0,1° при постоянной времени T = 13c уже накладывает более существенное ограничение на точность ДУС.

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

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

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

1. Mahony R., Hamel T., Pflimlin J.-M. Nonlinear complementary filters on the special orthogonal group // IEEE Trans. on Automatic Control. 2008. Vol. 53, N 5. P. 1203—1218. DOI: 10.1109/TAC.2008.923738.

2. Valenti R. G., Dryanovski I., Xiao J. Keeping a good attitude: a quaternion-based orientation filter for IMUs and MARGs // Sensors. 2015. Vol. 15, N 8. P. 19302—19330. DOI: 10.3390/s150819302.

3. Kang D., Jang C., Park F. C. Unscented Kalman filtering for simultaneous estimation of attitude and gyroscope bias // IEEE/ASME Trans. on Mechatronics. 2019. Vol. 24, N 1. P. 350—360. DOI: 10.1109/TMECH.2019.2891776.

4. Sabatini A.M. Kalman-filter-based orientation determination using inertial/magnetic Sensors: Observability Analysis and Performance Evaluation // Sensors. 2011. Vol. 11, N 10. P. 9182—9206. DOI: 10.3390/s111009182.

5. Ассад А., Халиф В., Шуаиб И. Новый адаптивный нечеткий обобщенный фильтр Калмана для оценивания ориентации при отсутствии GPS-сигналов // Гироскопия и навигация. 2019. Т. 27, № 2(105). С. 3—27. DOI: 10.17285/0869-7035.2019.27.2.003-027.

6. Madgwick S. O. H., Harrison A. J. L., Vaidyanathan R. Estimation of IMU and MARG orientation using a gradient descent algorithm // IEEE Intern. Conf. on Rehabilitation Robotics. Switzerland, Zurich, 2011. P. 1—7. DOI: 10.1109/ICORR.2011.5975346.

7. Brown R. G., Hwang P. Y. C. Introduction to random signals and applied Kalman filtering. John Wiley & Sons, 1997.

8. Матвеев В. В. Анализ комплементарных фильтров при построении бескарданной гировертикали // Изв. ТулГУ. Технические науки. 2019. № 8. С. 153—164.

9. Yoo T. S., Hong S. K., Yoon H. M., Park S. Gain-scheduled complementary filter design for a MEMS based attitude and heading reference system // Sensors. 2011. Vol. 11 4. P. 3816—3830. DOI: 10.3390/s110403816.

10. Качанов Б. О., Гришин Д. В., Ахмедова С. К. и др. Адаптация маятниковой коррекции бесплатформенной гировертикали летательного аппарата к условиям полета // Гироскопия и навигация. 2016. Т. 24, № 4(95). С. 25—34. DOI: 10.17285/0869-7035.2016.24.4.025-034.

11. Poddar S., Narkhede P., Kumar V. et al. PSO Aided Adaptive Complementary Filter for Attitude Estimation // J. Intel. Robot. Syst. 2017. Vol. 87. P. 531—543. DOI: 10.1007/s10846-017-0507-8.

12. Ривкин С. С. Статистический синтез гироскопических устройств. Л.: Судостроение, 1970. 422 с.

13. Аль-Мансур А., Шуаиб И., Джафар А., Потапов А. А. Аналитический алгоритм оценки пространственного положения и курса объекта // Гироскопия и навигация. 2019. Т. 27, № 1(104). С. 72—92. DOI 10.17285/08697035.2019.27.1.072-092.

14. Пат. 2253091 РФ. Способ коррекции аналитических гировертикалей усеченного состава / А. М. Боронахин, В. И. Гупалов, А. В. Мочалов. Заявл. 30.12.2002; опубл. 27.05.2005. Бюл. № 15.

15. Пат. 2719241 РФ. Гироскопический маятник / С. В. Кривошеев, К. О. Лукин. Заявл. 13.06.2019; опубл. 17.04.2020. Бюл. № 11.

16. Бесекерский В. А., Попов Е. П. Теория систем автоматического регулирования. М.: Наука, 1966. 992 с.

17. IEEE Std 952-2020. IEEE Standard Specification Format Guide and Test Procedure for Single-Axis Interferometric Fiber Optic Gyros. DOI: 10.1109/IEEESTD.2021.9353434

18. Бесекерский В. А., Фабрикант Е. А. Динамический синтез систем гироскопической стабилизации. Л.: Судостроение, 1968. 351 с.

19. IEEE Std 1293-2018. IEEE Standard Specification Format Guide and Test Procedure for Linear Single-Axis, Nongyroscopic Accelerometers. DOI: 10.1109/IEEESTD.2019.8653544.

Сведения об авторах

Кирилл Олегович Лукин — аспирант; Казанский национальный исследовательский технический

университет им. А. Н. Туполева-КАИ, кафедра автоматики и управления; E-mail: Kirill.O.Lukin@yandex.ru Сергей Валентинович Кривошеев — канд. техн. наук, доцент; Казанский национальный исследовательский технический университет им. А. Н. Туполева-КАИ, кафедра автоматики и управления; E-mail: ksv-ap2-au-kai@mail.ru

Поступила в редакцию 28.02.2023; одобрена после рецензирования 28.03.2023; принята к публикации 22.06.2023.

REFERENCES

1. Mahony R., Hamel T., Pflimlin J.-M. IEEE Trans. on Automatic Control, 2008, no. 5(53), pp. 1203-1218, DOI: 10.1109/TAC.2008.923738.

2. Valenti R.G., Dryanovski I., Xiao J. Sensors, 2015, no. 8(15), pp. 19302-19330, DOI: 10.3390/s150819302.

3. Kang D., Jang C., Park F.C. IEEE/ASME Trans. on Mechatronics, 2019, no. 1(24), pp. 350-360, DOI: 10.1109/TMECH.2019.2891776.

4. Sabatini A.M. Sensors, 2011, no. 10(11), pp. 9182-9206, DOI: 10.3390/s111009182.

5. Ammar A., Khalaf W., Chouaib I. Gyroscopy and Navigation, 2019, no. 3(10), pp. 131-146.

6. Madgwick S.O.H., Harrison A.J.L., Vaidyanathan R. IEEE Intern. Conf. on Rehabilitation Robotics, Switzerland, Zurich, 2011, pp. 1-7, DOI: 10.1109/ICORR.2011.5975346.

7. Brown R.G., Hwang P.Y.C. Introduction to random signals and applied Kalman filtering, John Wiley & Sons, 1997.

8. Matveev V.V. News of the Tula State University. Technical sciences, 2019, no. 8, pp. 153-164. (in Russ.)

9. Yoo T.S., Hong S.K., Yoon H.M., Park S. Sensors, 2011, no. 4(11), pp. 3816-3830, DOI: 10.3390/s110403816.

10. Kachanov B.O., Grishin D.V., Akhmedova S.K., Tuktarev N.A., Kulabukhov V.S. Gyroscopy and Navigation, 2016, no. 4(24), pp. 25-34, DOI: 10.17285/0869-7035.2016.24.4.025-034. (in Russ.)

11. Poddar S., Narkhede P., Kumar V. et al. J. Intel. Robot. Syst., 2017, vol. 87, pp. 531-543, DOI: 10.1007/s10846-017-0507-8.

12. Rivkin S.S. Statisticheskiy sintez giroskopicheskikh ustroystv (Statistical Synthesis of Gyroscopic Devices), Leningrad, 1970, 422 p. (in Russ.)

13. Al Mansour M., Chouaib I., Jafar A., Potapov A.A. Gyroscopy and Navigation, 2019, no. 2(10), pp. 77-89.

14. Patent RU 2253091, Sposob korrektsii analiticheskikh girovertikaley usechennogo sostava (A Method for Correcting Analytical Gyro-Verticals with a Truncated Composition), A.M. Boronakhin, V.I. Gupalov, A.V. Mochalov, Priority 30.12.2002, Published 27.05.2005, Bulletin 15. (in Russ.)

15. Patent RU 2719241, Giroskopicheskiy mayatnik (Gyroscopic Pendulum), S.V. Krivosheev, K.O. Lukin, Priority 13.06.2019, Published 17.04.2020, Bulletin 11. (in Russ.)

16. Besekersky V.A., Popov E.P. Teoriya sistem avtomaticheskogo regulirovaniya (Theory of Automatic Control Systems), Moscow, 1966, 992 p. (in Russ.)

17. IEEE Std 952-2020. IEEE Standard Specification Format Guide and Test Procedure for Single-Axis Interferometric Fiber Optic Gyros, 2020, DOI: 10.1109/IEEESTD.2021.9353434.

18. Besekersky V.A., Fabrikant E.A. Dinamicheskiy sintez sistem giroskopicheskoy stabilizatsii (Dynamic Synthesis of Gyroscopic Stabilization Systems), Leningrad, 1968, 351 p. (in Russ.)

19. IEEE Std 1293-2018. IEEE Standard Specification Format Guide and Test Procedure for Linear Single-Axis, Nongyroscopic Accelerometers, 2019, DOI: 10.1109/IEEESTD.2019.8653544.

Data on authors

Kirill O. Lukin

Sergey V. Krivosheev

Post-Graduate Student; A. N. Tupolev Kazan National Research Technical University, Department of Automation and Control; E-mail: Kirill.O.Lukin@yandex.ru PhD, Associate Professor; A. N. Tupolev Kazan National Research Technical University, Department of Automation and Control; E-mail: ksv-ap2-au-kai@mail.ru

Received 28.02.2023; approved after reviewing 28.03.2023; accepted for publication 22.06.2023.

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