Нелинейная динамика. 2017. Т. 13. № 2. С. 227-241. Полнотекстовая версия в свободном доступе http://nd.ics.org.ru Б01: 10.20537/па1702006
ОРИГИНАЛЬНЫЕ СТАТЬИ
УДК: 531.383 М8С 2010: 34К11
Компенсация погрешностей и учет нелинейности колебаний вибрационного кольцевого микрогироскопа в режиме датчика угловой скорости
Д. А. Маслов, И. В. Меркурьев
Исследуется динамика резонатора вибрационного кольцевого микрогироскопа в разомкнутом и в компенсационном режимах функционирования датчика угловой скорости. Используется математическая модель вынужденных колебаний тонкого упругого резонатора, учитывающая разночастотность, разнодобротность, параметры управляющих воздействий на резонатор и коэффициент нелинейности. При помощи метода усреднения Крылова — Боголюбова исследована динамика резонатора в медленных переменных, измеряемых электронным контуром прибора. Получены формулы для определения угловой скорости при нелинейных колебаниях резонатора с алгоритмической компенсацией указанных дефектов при работе гироскопа в разомкнутом режиме функционирования датчика угловой скорости. Приведены управляющие сигналы, учитывающие дефекты гироскопа при работе гироскопа в компенсационном режиме датчика угловой скорости. Проведено численное моделирование процесса определения угловой скорости в рассматриваемых режимах функционирования гироскопа.
Ключевые слова: вибрационный кольцевой микрогироскоп, датчик угловой скорости, нелинейные колебания, компенсация дрейфа
Получено 09 января 2017 года После доработки 15 апреля 2017 года
Работа выполнена при финансовой поддержке РФФИ (проекты № 16-01-00772-а, № 16-08-01269-а).
Маслов Дмитрий Александрович MaslovDmA@mpei.ru Меркурьев Игорь Владимирович MerkuryevIV@yandex.^
Национальный исследовательский университет «МЭИ» 111250, Россия, г. Москва, ул. Красноказарменная, д. 14
Введение
В настоящее время вопросам совершенствования микромеханических гироскопов, работающих в режиме датчика угловой скорости, уделяется большое внимание [1—3]. Гироскопы такого типа находят широкое применение в автомобильной электронике, медицинской технике, робототехнике, в товарах широкого потребления. Микромеханические гироскопы с кольцевым резонатором производит фирма Silicon Sensing (Великобритания). Разработкой и исследованием таких гироскопов занимается Мичиганский университет [4, 5] и Институт электроники Китайской академии наук [6], лаборатория микросистем Национального исследовательского университета МИЭТ [7], Раменское приборостроительное бюро [8], АО «Инерциальные технологии «Технокомплекса» [9], Санкт-Петербургский государственный университет аэрокосмического приборостроения [10].
В [7] разработана математическая модель колебаний кольцевого микрогироскопа в разомкнутом режиме функционирования датчика угловой скорости и представлены результаты численного моделирования. В работе [10] проведено исследование динамики кольцевого микрогироскопа, работающего в режиме датчика угловой скорости. Дан анализ технических характеристик микромеханического волнового гироскопа как единой микромеханической системы, содержащей механическую часть (резонатор) и электронные модули. Рассмотрены вопросы возбуждения и управления колебаниями резонатора для достижения требуемых характеристик по чувствительности, линейности и рабочей полосе частот пропускания прибора. Датчик угловой скорости на базе данного микрогироскопа рассматривается также в [11]. Однако в этих работах не рассматривается алгоритмическая и силовая компенсация дефектов резонатора.
В данной работе ставится задача компенсации погрешностей вибрационного кольцевого микрогироскопа, вызванных нелинейностью колебаний резонатора и его дефектами, при работе гироскопа в режиме датчика угловой скорости.
Уравнения нелинейных колебаний резонатора
Рассмотрим кольцевой микромеханический гироскоп [7], резонатор которого представляет собой тонкое упругое кольцо 2, связанное с основанием 1 с помощью торсионов 3 (рис. 1).
Осевая линия резонатора в недеформированном состоянии представляет собой окружность радиусом R. Колебания резонатора возбуждаются и регистрируются системой управляющих и измерительных контуров. Каждый контур образован двумя ближайшими тор-
12 3
Рис. 1. Кольцевой микромеханический гироскоп.
сионами и участком резонатора с окружным размером п/4. Ток, протекающий по контуру, находящемуся в постоянном магнитном поле, вызывает силы Ампера, возбуждающие колебания.
Вторая основная форма колебаний тонкого упругого кольцевого резонатора представляет собой суперпозицию двух нормальных форм (стоячих волн колебаний), которые повернуты относительно друг друга на угол п/4. В режиме вынужденных колебаний с помощью системы управляющих контуров возбуждается первичная нормальная форма колебаний резонатора. При вращении основания гироскопа возникает вторичная нормальная форма, пучности которой совпадают с узлами первичной нормальной формы. Как показано в работах [12, 13], в разомкнутом режиме амплитуда вторичной нормальной формы пропорциональна угловой скорости основания гироскопа, то есть гироскоп является датчиком угловой скорости.
Предположим, что основание 1 (рис. 1) вращается относительно оси, перпендикулярной его плоскости, с угловой скоростью О, которую в дальнейшем будем считать малой по сравнению с резонансной частотой и колебаний упругого кольца. Кроме того, пусть О будет медленной функцией времени. Система дифференциальных уравнений, описывающая динамику резонатора в одномодовом приближении, имеет вид [13, 14]
где f и д — обобщенные координаты основной формы колебаний резонатора в двух фиксированных точках, отстоящих друг от друга под углом в 45°, с* и и* — параметры позиционных сил, Ь* = Ь* 8ш4а, Ь** = Ь* 008 4а и Ь3 = Ь 8т4в, Ьс = Ьоо8 4в — компоненты, характеризующие упругую и вязкую анизотропию соответственно, Ь* и Ь — модули разноча-стотности и разнодобротности, а и в — углы ориентации главных осей жесткости и главных осей диссипации относительно отсчетных осей, 7 = и/Q — коэффициент демпфирования, Q — добротность колебательного контура, V = 8О/5 — параметр, характеризующий угловую скорость, £* — коэффициент нелинейности, и*, и*, и|, и4 — нормализованные сигналы управления колебаниями резонатора, пропорциональные силам, ио — частота внешнего гармонического возбуждения основной моды колебаний резонатора, точкой обозначено дифференцирование по времени Ь. В уравнениях (1) опущены слагаемые, пропорциональные квадрату угловой скорости основания и угловому ускорению основания.
Методики определения коэффициентов уравнений (1) без учета нелинейности представлены в работах [11, 14], а с учетом коэффициента нелинейности — в [15, 16]. Нелинейные эффекты в волновом твердотельном гироскопе рассматривались в [12, 13, 17].
Сигналы управления и*,...,и4 полагаются медленно изменяющимися функциями времени. В частном случае управления по разомкнутому контуру функции и*, ...,и** являются константами. В компенсационном режиме функционирования значения и*,...,и4 медленно изменяются в виде обратной связи по измерению медленных переменных р\, д\, Р2, Ц2. Будем полагать, что частота внешнего воздействия близка к резонансной частоте колебательного контура, то есть
где Л — поправка к частоте, которая вводится для настройки резонансного режима работы гироскопа на подвижном основании.
(1)
и0 = и + Л, Л ^ и
Решение системы (1) имеет колебательный характер с характерной резонансной частотой и порядка 10 кГц. При отсутствии возмущений в правой части (1) решение системы будет чисто гармоническим. Малые возмущения вызваны инструментальными погрешностями изготовления резонатора, неравномерным демпфированием колебаний, гироскопическими силами и нелинейностью, присущей гироскопам класса обобщенного маятника Фуко [14]. Малые позиционные и скоростные силы в правой части уравнений (1) приводят к малому изменению резонансной частоты на величину порядка 1 Гц, что позволяет применить асимптотические методы исследования задачи. К системе (1) применим метод усреднения Крылова-Боголюбова [18]. Для этого приведем ее к стандартному виду посредством перехода от переменных f, f, g, g к медленным переменным pi, qi, p2, q2 по следующим формулам:
f = p1 sin u0t + q1 cos u0t, f = p1u0 cos u0t — q1u0 sin u0t,
(2)
g = p2 sin u0t + q2 cos u0t, g = p2u0 cos u0t — q2u0 sin u0t.
Подставляя (2) в (1), разрешая полученную систему уравнений относительно медленных переменных p1, q1, p2, q2 и проводя осреднение по явно входящему времени [13, 14], приходим к системе уравнений движения в медленных переменных p1, q1, p2, q2 в первом приближении метода осреднения:
2q 1 = —Yq1 + щ — bcq1 + hcP1 + cp1 — bsq2 + h.sp2 + np2 — 2Ap1 — vq2 + (h, 2p 1 = —YP1 + U2 — bcP1 — hcq1 — cq1 — bsP2 — hsq2 — nq2 — vp2 + 2Aq1 + k 2q 2 = —Yq2 + U3 + bcq2 — hcp2 + cp2 — bsq1 + hsP1 — np1 — 2Ap2 + vq1 + £k3, 2p 2 = —Yp2 + U4 + bcp2 + hcq2 — cq2 — bs'p1 — hsq1 + nq1 + vp1 + 2Aq2 + k
(3)
где к1 = -р\Е — д2Х, к2 = д\Е — р2Х, кз = -р2Е + ^Х, = д2Е + р\Х, Е = 3(д2 + р\ + + ?2 + Р2)/4, X = (р2^1 — Р152)/2 — нелинейные слагаемые модели, являющиеся первыми интегралами свободной системы, с = с*/и, и = и* /и, Н8 = Н**/и, Нс = Ь*/и, £ = £*/и, Пг = и*/и (г = 1,...,4).
Сигналы управления и1 ,...,щ являются входными сигналами системы (3), позволяющими стабилизировать амплитуды колебаний двух нормальных форм, а также провести точную резонансную настройку колебательного контура.
Отметим, что в электронном контуре гироскопа физически реализуется схема осреднения Крылова-Боголюбова: измеряемые индукционными датчиками высокочастотные функции времени f, д с помощью контуров обработки сигналов [13] представляются в виде (2). Таким образом, медленные переменные р1, 51, Р2, 52 системы (3) являются измеряемыми.
Уравнения динамики (3) будут использоваться далее для определения параметров гироскопа, для силовой и аналитической компенсации его погрешностей.
Динамика резонатора в разомкнутом режиме функционирования датчика угловой скорости
Вначале рассмотрим случай возбуждения первичных колебаний в разомкнутом режиме функционирования. Определим стационарные значения системы (3) при постоянных значениях управляющих сигналов: и1 = ио, и,2 = из = и4 = 0, где ио — заданная амплитуда входного воздействия для возбуждения первичной нормальной формы колебаний.
Для определения стационарных значений приравняем нулю правую часть дифференциальных уравнений (3)
- Y9i - bcQi + hc'pi + cpi - M2 + hsP2 + np2 - 2\pi - vq2 + Çki = -uo,
- YPi - bcPi - hcqi - cqi - bp - hsq2 - Щ2 - vp2 + 2Aqi + Çk2 = 0,
(4)
- Yq2 + bcq2 - hcP2 + cp2 - bsqi + hsPi - npi - 2Ap2 + vqi + Çk3 = 0,
- Yp2 + bcp2 + hcq2 - cq2 - bspi - hsqi + nqi + vpi + 2Aq2 + Çk4 = 0.
Рассмотрим сначала линейный случай (Ç = 0) и разрешим полученную систему алгебраических уравнений относительно pi, qi, p2, q2. В этом случае система неоднородных уравнений (4) является линейной, и если определитель ее матрицы отличен от нуля А = = det A = 0, то система имеет единственное решение, определяемое формулами
qi = Ai/A, pi = А2/А, q2 = А3/А, p2 = А4/А,
где Аг — определитель матрицы, полученной из матрицы системы заменой i-го столбца столбцом свободных членов.
Для исследования стационарного решения системы (4) удобно перейти к медленным переменным амплитуда - фаза A, B, ф:
qi = A sin p, pi = A cos p, q2 = B sin ф, p2 = B cos ф. (5)
Из (5) следует, что квадраты амплитуд имеют вид
A2 = q2 + p2 = ((Y - bc)2 + (c - 2A - К)2)и20/А,
c uo
B2 = q2 + p2 = ((v + bs)2 + (n - hs)2)и2/А.
На подвижном основании отношение амплитуд стационарных колебаний равно
B (v + bs)2 + (n - hs)2
А \/(7 - Ьс)2 + (с - 2Л - Ьс)2'
Если упругой Ь8, Ьс и вязкой анизотропией Ь8, Ьс резонатора, а также параметрами позиционных сил с и и можно пренебречь, то есть Ь8 = Ьс = Ь8 = Ьс = с = и = 0, то выражения для амплитуд принимают следующий вид:
Аа = в?+р?_ (72 + 4А2) г/,о
Y4 + 2 (4A2 + v2) y2 + (A2 - v2)2:
д2 2 i 2 V'2u0 & = Q2+P'2 =
Y4 + 2 (4A2 + v2) y2 + (4A2 - v2)2'
В случае неподвижного основания (у = 0) имеем А = и о / \Ау2 + 4А2, В = 0.
При резонансном совмещении частот (Л = 0) на неподвижном основании получим амплитуды колебаний резонатора: А = ио/7, В = 0. Учитывая, что коэффициент демпфирования 7 обратно пропорционален добротности колебательного контура Q, по измеренной амплитуде колебаний можно найти амплитуду входного воздействия ио.
Отметим, что увеличение амплитуды колебаний до заданного уровня может быть обеспечено за счет увеличения добротности колебательного контура и резонансной настройки колебательного контура.
На подвижном основании отношение амплитуд стационарных колебаний пропорционально модулю угловой скорости основания:
В _ V А ~
+ 4А2
Угловая скорость в этом случае определяется по формуле
v = BsJi2 + 4А2/Л
(6)
При нулевой частотной расстройке (А = 0) формула (6) с учетом обозначений совпадает с известной расчетной зависимостью для определения угловой скорости основания [13]
Q =
5 B_u¿ 8 AQ'
(7)
Таким образом, в режиме вынужденных колебаний гироскоп является датчиком угловой скорости.
Время выхода на режим установившихся колебаний при значении коэффициента демпфирования y = 17.6 c"1, которое получено [7] при ш = 8.80 • 104 c"1, Q = 5000, составляет примерно 0.5 с (рис. 2). Зависимости медленных переменных от времени определялись из системы (3) при равенстве нулю всех параметров, кроме коэффициента демпфирования 7 и сигнала и о. Пунктирная линия соответствует амплитуде колебаний А = \J qf + pf, а сплошная линия — амплитуде В = \J+ р2- Для нормализации использовалось максимальное характерное значение амплитуды колебаний. При построении решения задавались следующие начальные значения медленных переменных: qio = 0, pío = 0, q2o = 0.5, Р20 = 0.
А, В 1.0
0.8 0.6 0.4 0.2
y f
/ /
/ / \ /
/\
1 \ / \
0.2 0.4 0.6 0.8 1.0 t, с
Рис. 2. Выход на режим установившихся колебаний.
Отметим, что для вычисления угловой скорости с учетом нелинейности колебаний можно использовать формулы, получаемые из уравнений (4):
\J а\ + а|/ \J q\ +pj, v = ai/qi, v = a2/pi,
(8) (9) (10)
v
где
= ({X - Ьэ)Я1 + и3 + (-п + + (с - 2А - {Е - йс)р2 + (-7 + Ьс)52, а2 = ({X - Ьв)р1 + П4 + (п - + (-с + 2А + {Е + Ьс)52 + (-7 + Ьс)р2.
Если компонентами упругой Ь8, Ьс и вязкой анизотропии Ь8, Ьс резонатора, а также параметрами позиционных сил с и п и нелинейностью можно пренебречь, то есть Ь8 = Ьс = = Ь8 = Ьс = с = п = { = 0, то выражения для определения скорости основания (8) при из = =0 совпадает с формулой (6).
Если 51 > Р1, то желательно для повышения точности вычисления использовать формулу (9), а если р1 >51, то применять выражение (10).
Параметры 7, V, Ьс, Ь8, с, п, Нс, Ь8, и1, щ, из, и4, { определяются по методике, предложенной в [15, 16]. В качестве калибровочных уравнений используется система уравнений (4), записанная следующим образом:
Сх = й, (11)
где / 51 -52 -51 - 52 р 1 р2 р1 р2 1 0 0 0 0
С р1 - р2 - р 1 -р2 -51 -52 -51 -52 0 1 0 0 к2
52 51 52 - 51 р 2 - р 1 - р 2 р1 0 0 1 0 кз
V р2 р1 р2 - р1 - 52 51 52 -51 0 0 0 1 к4
х = (7, ( = (2Ар1, V, Ьс, Ь8, -2А51,2Ар2, с, п, -2А52)Т Ьс, Ь,8, и,1, и,2, из, — измеряемый вектор, к и 4, 1= {)т -р1Е - вектор - 52Х, к2 параметров, 51Е - р2Х,
кз = -Р2Е + 51Х, к.4 = 52Е + Р1Х.
В системе алгебраических уравнений (11) измеряемыми являются стационарные значения р1, 51, р2, 52, полученные при заданной частотной расстройке А.
Составляется переопределенная алгебраическая система уравнений из блоков (11), соответствующих заданной частотной расстройке. По методу наименьших квадратов получим оценку ж параметров математической модели
ж = (СТ С)-1 Ст (. Искомые оценки минимизируют сумму квадратов отклонений
5 = (( - Сх)Т (( - Сх)
и остаточную дисперсию.
Разработанная методика определения параметров гироскопа с учетом нелинейности колебаний кольцевого резонатора позволяет проводить испытания при больших амплитудах колебаний, при которых отношение сигнала к шуму достаточно высокое.
На рисунке 3 представлены экспериментальные и расчетные амплитудно-фазочастот-ные характеристики (АФЧХ) вибрационного кольцевого микрогироскопа [15]. Модули радиус-векторов (р1, 51)т и (р2, 52)Т равны амплитудам А и В, а фазы колебаний р и ф определяются положением этих векторов на плоскости. Как следует из рисунка 3а, экспериментальные и расчетные данные, полученные по результатам идентификации параметров линейной математической модели ВТГ, достаточно близки, однако имеется систематическая погрешность.
*
*
* *
*
Рп
(а)
(Ь)
Рис. 3. Амплитудно-фазочастотные характеристики микрогироскопа: а) экспериментальные данные и значения, рассчитанные по линейной модели, Ъ) экспериментальные данные и значения, рассчитанные по нелинейной модели. Кружком обозначены экспериментальные данные, а звездочкой — значения, рассчитанные по математическим моделям.
На рисунке 3Ь экспериментальная и расчетная АФЧХ, полученная по результатам идентификации параметров нелинейной математической модели микрогироскопа, практически совпадают. В [15] показано, что учет коэффициента нелинейности позволяет уменьшить остаточное среднеквадратическое отклонение <г в 3.2 раза. Это указывает на то, что при достаточно больших амплитудах колебаний резонатора учет нелинейности значительно повышает точность определения параметров вибрационного кольцевого микрогироскопа. Учет найденных параметров и коэффициента нелинейности позволит повысить точность прибора за счет работы его при больших амплитудах колебаний резонатора.
Формулы (8), (9), (10), в отличие от (6), учитывают алгоритмически значения дефектов резонатора и нелинейность колебаний, что позволяет измерять скорость при больших амплитудах, при которых отношение сигнала к шуму выше. Применение этих формул позволит увеличить диапазон измеряемой угловой скорости (полосы пропускания гироскопа). Таким образом, использование предложенных формул позволит повысить точность гироскопа, работающего в разомкнутом режиме функционирования датчика угловой скорости.
Управление движением резонатора в компенсационном режиме датчика угловой скорости
Рассмотрим функционирование микрогироскопа в режиме датчика угловой скорости компенсационного типа. В этом случае задается первичная возбуждающая волна с заданным значением амплитуды колебаний. Из-за вращения основания возникает вторая пульсирующая волна, пучности которой располагаются под углом п/4 к пучностям первичной возбуждающей волны. Целью управления является возбуждение и поддержание заданной амплитуды колебаний первичной возбуждающей волны и полная компенсация колебаний
второй пульсирующей волны. Сигналы управления, необходимые для компенсации, позволяют определить угловую скорость основания гироскопа.
Зададим программные значения амплитуд колебаний: А = В = 0, где
р1 — заданные значения медленных переменных.
Пропорциональный регулятор. Вначале построим пропорциональный регулятор (П-регулятор). Зададим управление и1,...,щ в виде обратной связи по измерению медленных переменных pi, qi, p2, q2:
v,i = bcqi - (c + hc - \)pi + bgQ'2 - (hs + n)p2 + £(EPi + Xq2) - Кi {qi - Щ), u2 = (c + hc - \)qi + bcPi + {hs + n)q2 + bsp2 + £{~eQi + Xp2) ~ Ki {Pi ~ Pi), из = bsqi - (hs - n)pi - bcq2 + (-c + hc + X)P2 + Î(-Xqi + Ep2) - Kiq2, U4 = (hs - n)qi + bspi - (-c + hc + X)q2 - bcp2 + Ç(-Xpi - Eq2) - Kp,
где Ki — коэффициент усиления в цепи обратной связи.
Подставляя (12) в (3), получаем уравнения замкнутой системы управления:
сц = {-{Кг + 7)gi + vq2 + КхЩ) /2, pi = {-{Ki + 7)pi + vp2 + A'iPi) /2, q?2 = (-^qi - (Ki + 7)q2) /2, p2 = (-^pi - (Ki + 7)p2) /2.
(12)
(13)
Для исследования устойчивости замкнутой системы дифференциальных уравнений (13) построим характеристическое уравнение
((в + Ki + 7)2 + V2 )2 = 0
и найдем его корни
вi,2 = -(Ki + y + iv), вэ;4 = -(Ki + y - iv).
Так как коэффициент Ki и коэффициент демпфирования y принимают только положительные значения, действительные части корней характеристического уравнения отрицательны. Следовательно, решение системы асимптотически устойчиво.
Таким образом, решение замкнутой системы (13) можно представить в виде суммы асимптотически устойчивого решения, зависящего от начальных условий qi(0) = qio, pi(0) = = РЮ) <72(0) = q2o, р2{0) = р2о, и программных значений q1, р1,
qiu = [qio cos vt + q2o sin vi + K\(v sin vi — (K1 + 7) eos vt)qi/P],
Piu = е_(А1+7^/2 [pío eos vt + p2o sin vt + K\ {v sin vt — (K\ +7) eos vt)p1/P], q2u = [q20 eos vt — qw sin vi + K\(v eos vt + (ii'i + 7) sin vt)q1/P],
P2u = [p2o eos vt — pw sin vt + ii'i (v eos vt + (ii'i + 7) s'mvt)pi/P],
и частного решения
<7i* = Kiq^Ki + 7 )/P, g2* = -Kiq^i/P, Pi* = Kip^Ki + 7 )/P, j92* = -Kip^i/P,
где P = v2 + (Ki + y)2.
(14)
Анализ установившегося решения (14) показывает, что имеется статическая ошибка регулирования, вызванная наличием угловой скорости основания. Значения установившихся амплитуд колебаний отличаются от программных значений на величину, зависящую от коэффициента усиления К\, угловой скорости основания V и коэффициента демпфирования 7.
Отметим, что отношение установившихся значений (14) пропорционально угловой скорости основания:
Р2* _ <72* _ V р 1* ~ <71* ~~ К\ +7'
Таким образом, оценка угловой скорости основания V может быть произведена по измерениям установившихся значений:
(15)
Точность определения угловой скорости основания зависит от уровня случайных и систематических погрешностей в измерениях медленных переменных.
Приведенные выше формулы для расчета компенсационного режима подтверждаются результатами моделирования (рис. 4, 5), которое проводилось при близких к существующим конструктивным параметрам гироскопа [7] с кольцевым резонатором радиуса Я = 3 мм. Пусть гироскоп находится на подвижном основании, вращающемся с постоянной угловой скоростью О = 300 °/с. При построении решения зададим следующие числовые значения параметров системы: К\ = 500 с-1, = 1, р1 = 0, дю = 0, рю = 1, 520 = 0.6, Р20 = 0.3.
92, Р2 1.0
0.8 0.6 0.4 0.2
1
1 \
\ \
1 \ \ \
\ \ \ \
\\ ч
0.01 0.02 0.03 0.04 0.05 4, с
0.01 0.02 0.03 0.04 0.05 с
Рис. 4. Зависимость медленных переменных от времени 7 (переменные рх, р2 — сплошная линия, 41, 42 — пунктирная).
0.03 0.04 (а)
0.05 г, с
-10
(Ь)
Рис. 5. Зависимость расчетной скорости от времени (а) и невязка в измерениях угловой скорости (Ь).
Время выхода на режим установившихся колебаний составляет примерно 0.02 с (рис. 4). Значения д\, в установившемся режиме не совпадают с заданными значениями медленных переменных, то есть имеется статическая ошибка регулирования, вызванная наличием угловой скорости основания. Отклонения д\, д2 вызывают дрейф, который компенсируется управляющими сигналами (12). Из рисунка 5, на котором представлена зависимость угловой скорости основания от времени, рассчитанная по второй формуле (15), видно, что время функциональной готовности прибора существенно сокращается.
Применение в обратной связи пропорционального регулятора позволит существенно сократить время функциональной готовности прибора к работе.
Пропорционально-интегральный регулятор. Далее построим пропорционально-интегральный регулятор (ПИ-регулятор), позволяющий устранить статическую ошибку регулирования. Зададим управление и1,...,щ в виде обратной связи по измерению медленных переменных р\, д1, р2, д2:
и 1 = Ьсдг - (с + ]гс)р1 + Ъ3д2 - (]г8 + п)р2 + ЦЕрх + Хд2) - Кг {дг - дг) - К2 J{gl-gl) (Йь
о
г
и2 = (с + Нс)д 1 + Ъср1 + {Н3 + п)д2 + Ь3р2 + £(-£<? 1 + Хр2) - Кг {р1 -р^- К2 J{р1 -р^ (Мъ
о
г
из = М1 - (Ь - п)р1 - Ьсд2 + (-С + Ис)р2 + £(-Хд1 + Ер2) - Кд - К2^ д2^1, (16)
о
г
и4 = (Ье - п)д1 + ЬеР1 - (-с + Нс)д2 - ЬсР2 + £(-Хр1 - Ед2) - К1Р2 - К2 !Р2^1,
о
где К1 и К2 — коэффициенты усиления в цепи обратной связи.
Для исследования замкнутой системы управления введем новые переменные
г г г г
¿1 = J (<?1-<?1)<Й1, 22 = ! (:Р1-Р1)М1, 23 = Jg2<ЙЬ Z4 = Jp2dtl о о оо
и соответствующие дифференциальные уравнения
¿1=51-5!, ¿2=р1~р1, ¿3=92, ¿4 = Р'2 с начальными условиями
21(0) = 22(0) = 2з(0) = 24(0) =0. Подставляя (16) в (3), получим уравнения замкнутой системы управления:
Я1 = (-?<?1 - М + гщ2 - К151 - К2г 1 + КхЩ,) /2,
Р1 = {~7Р1 + М1 + ир2 - Кт - К2г2 + К\р1,) /2,
<?2 = (-7д2 - Ар2 - ид1 - Кд - К223,) /2, (17)
Р2 = (-7Р2 + Ад2 - ^р1 - К1р2 - К224) /2,
¿1=51-51, ¿2=^1-^1, ¿3 = 52, ¿4=^2.
г
Коэффициенты усиления К\, выберем из условия обеспечения заданной степени устойчивости замкнутой системы. Таким образом, решение замкнутой системы (17) можно представить в виде суммы асимптотически устойчивого решения, зависящего от начальных условий и программных значений рг, и стационарного частного решения
¿1* = -
<71* =91, Ри=Р1, <?2* = О, Р2* = о, >Фг + 791 1Р1 - Щ\
К
¿2* = -
К2
¿3* = -
К2
¿4* = —
ур 1 К2
(18)
Анализ установившегося решения (18) показывает, что статическая ошибка регулирования скомпенсирована. Таким образом, оценка угловой скорости основания V может быть произведена по измерениям установившихся значений ¿з*, ¿4* из (18):
г
'<2 [
V = -— / д2 т 1, 91 1 о
V = / Р2 (Й1.
р1 J о
(19)
Как и ранее, точность определения угловой скорости основания зависит от уровня случайных и систематических погрешностей в измерениях медленных переменных.
Кроме того, заметим, что при достаточно большой угловой скорости основания потребуются значительные управляющие сигналы для компенсации амплитуды второй нормальной формы и, как следствие, увеличатся дополнительные погрешности системы управления.
Отметим также, что параметры, характеризующие частотную расстройку Л и коэффициент демпфирования 7, могут быть оценены по измерениям ¿1*, ¿2*:
т, Р 1*2* + 91*1*
7 = -А2-_2 _2-:
Я+ 91
Л = —К2
¿1*Р1 - ¿2*91 Р21 + 9?
Приведенные выше формулы для расчета компенсационного режима подтверждаются результатами моделирования (рис. 6, 7, 8), которое проводилось при близких к существующим конструктивным параметрам гироскопа [7] с кольцевым резонатором. При построении решения зададим следующие числовые значения параметров системы: К1 = 500 с-1, К2 = = 500 с-2, 7}1 = 1 ,Р\= 0, 9ю = 0, рю = 1, 920 = 0.6, Р20 = 0.3. На рисунках 6, 7 представлены графики переходных процессов по медленным переменным прибора компенсационного типа. Переходные процессы носят апериодический характер, а установившиеся значения соответствуют заданным дг = 1, рг = 0.
91, Р1 1.0,
0.8
0.6
0.4
0.2
\ X \ /
\ / \ /
/ \ / \
/ \
91 1.000
0.995
0.990
0.985
0.980
0.975
У /
/ /
/ /
/ 1
1 1
1
0.01 0.02 0.03 0.04 0.05 с
6
10 Ь, с
Рис. 6. Зависимость медленных переменных от времени £ (переменная р\ — сплошная линия, ел пунктирная).
г
42, Р2 0.6
0.5
0.4
0.3
0.2
0.1
10
1
\ \
\ \
1 \ \ \
\ \ \ \
\ч
42, Р2 -0.005 -0.010 -0.015
/
/ /
/ /
/ 1
1 1
1
с
0.01 0.02 0.03 0.04 0.05 с
Рис. 7. Зависимость медленных переменных от времени Ь (переменная р2 — сплошная линия, 92 — пунктирная).
300 250 200 150 100 50
П, °/4 12 14 16 18 20
0.1 0.2 0.3 0.4 с (а)
-10(>' /
-аб о /
-/300 /
(-400
I
и с
(Ь)
Рис. 8. Зависимость расчетной скорости от времени (а) и невязка в измерениях угловой скорости (Ь), рассчитанные по формуле (19) — пунктирная линия, а по формуле (20) — сплошная.
Через промежуток времени, равный примерно 0.02 с (рис. 6, 7), медленные переменные приближаются к значениям (14), содержащим статическую ошибку регулирования. В дальнейшем статическая ошибка регулирования компенсируется. Оценим время выхода на установившийся режим колебаний как время, необходимое для уменьшения в 100 раз амплитуды затухающей составляющей. В этом случае время выхода на режим установившихся колебаний составляет 1.65 с (рис. 6Ь).
Для исследования точности определения угловой скорости основания было проведено математическое моделирование управления волновой картиной колебаний без учета случайных погрешностей в измерениях первичных измерительных сигналов (рис. 8). Учитывая, что после 0.02 секунды = 0, а переменная д2 изменяется незначительно (рис. 7), принимаем 52 = 0. Из третьего уравнения системы (17) получаем формулу для вычисления скорости при 51 = 0:
и = - ^(К + 7)92 - К2 152^/91- (20)
Результаты оценки угловой скорости совпадают с заданным значением угловой скорости основания. Как видно из рисунков 8а и 8Ь, время готовности прибора к измерению скорости существенно сокращается при использовании формулы (20). Анализ рисунка 8Ь показывает, что невязка между заданной скоростью и рассчитанной по формулам (19) и (20) после подавления квадратурной волны колебаний уменьшается с течением времени.
Применение в обратной связи пропорционально-интегрального регулятора, предложенных управляющих сигналов, а также формул (8), (15), (20) позволит повысить точность гироскопа и уменьшить время его готовности.
Заключение
Разработаны алгоритмы определения угловой скорости гироскопа в разомкнутом режиме функционирования с учетом его параметров и нелинейности колебаний резонатора. Для реализации компенсационного режима измерения приведены управляющие сигналы, учитывающие как дефекты гироскопа, так и нелинейности. Предложена формула, сокращающая время готовности прибора к измерению скорости. Учет нелинейности колебаний резонатора в приведенных алгоритмах и при формировании управляющих сигналов позволит повысить отношение сигнала к шуму, а следовательно, и точностные характеристики гироскопа за счет увеличения амплитуды колебаний резонатора.
Список литературы
[1] Пешехонов В. Г. Современное состояние и перспективы развития гироскопических систем // Гироскопия и навигация, 2011, №1, с. 3-17.
[2] Acar C., Shkel A. MEMS vibratory gyroscopes: Structural approaches to improve robustness. New York: Springer, 2009. 260 pp.
[3] Басараб М.А., Лунин Б. С., Матвеев В. А., Фомичев А. В., Чуманкин Е.А., Юрин А. В. Миниатюрные волновые твердотельные гироскопы для малых космических аппаратов // Вестн. МГТУ им. Н.Э.Баумана. Сер. Приборостроение, 2014, №4, с. 80-96.
[4] Xia D., Yu C., Kong L. The development of micromachined gyroscope structure and circuitry technology // Sensors, 2014, vol. 14, no. 1, pp. 1394-1473.
[5] Ayazi F., Najafi K. A HARPSS polysilicon vibrating ring gyroscope //J. Microelectromech. Syst., 2001, vol. 10, no. 2, pp. 169-179.
[6] Liu J., Chen D., Wang J. Fabrication and test of an electromagnetic vibrating ring gyro based on SOI wafer // J.Electron. (China), 2014, vol.31, no. 2, pp. 168-173.
[7] Тимошенков С. П., Анчутин С. А., Плеханов В. Е., Кочурина Е. С., Тимошенков А. С., Зуев Е. В. Разработка математического описания кольцевого резонатора микрогироскопа // Нано- и микросистемная техника, 2014, №5, с. 18-25.
[8] Гребенников В. А., Минаев Ю.А., Аксенов К. С. Вибрационный вакуумный микрогироскоп: Патент РФ 2518379C1 (2014).
[9] Редькин С. П. Математическая модель температурной скорости дрейфа твердотельного волнового гироскопа // Авиакосмическое приборостроение, 2014, №5, с. 9-13.
[10] Северов Л. А., Пономарев В. К., Панферов А. И., Овчинникова Н.А. Структура и характеристики волнового микромеханического датчика угловой скорости с кольцевым резонатором // Гироскопия и навигация, 2014, №3, с. 59-72.
[11] Гавриленко А. Б., Меркурьев И. В., Подалков В. В., Сбытова Е. С. Динамика микромеханических систем. Москва: МЭИ, 2016. 60 с.
[12] Журавлёв В. Ф., Климов Д. М. Волновой твердотельный гироскоп. Москва: Наука, 1985. 125 с.
[13] Меркурьев И. В., Подалков В. В. Динамика микромеханического и волнового твердотельного гироскопов. Москва: Физматлит, 2009. 228 с.
[14] Журавлёв В.Ф. Задача идентификации погрешностей обобщенного маятника Фуко // Изв. РАН. МТТ, 2000, №5, с. 186-192.
[15] Маслов А. А., Маслов Д. А., Меркурьев И. В. Идентификация параметров волнового твердотельного гироскопа с учетом нелинейности колебаний резонатора // Приборы и системы. Управление, контроль, диагностика, 2014, №5, с. 18-23.
[16] Маслов А. А., Маслов Д. А., Меркурьев И. В. Способ определения параметров волнового твердотельного гироскопа: Патент РФ 2544308 (2015).
[17] Маслов А. А., Маслов Д. А., Меркурьев И. В. Нелинейные эффекты в динамике цилиндрического резонатора волнового твердотельного гироскопа с электростатической системой управления // Гироскопия и навигация, 2015, №2, с. 71-80.
[18] Боголюбов Н.Н., Митропольский Ю. А. Асимптотические методы в теории нелинейных колебаний. Москва: Наука, 1974. 503 с.
Compensation of errors taking into account nonlinear oscillations of the vibrating ring microgyroscope operating in the angular velocity sensor mode
Dmitry A. Maslov1, Igor V. Merkuryev2
1,2National Research University "Moscow Power Engineering Institute" ul. Krasnokazarmennaya 14, Moscow, 111250, Russia 1MaslovDmA@mpei.ru, 2MerkuryevIV@yandex.ru
The dynamics of a vibrating ring microgyroscope resonator with open-loop and closed feedback is investigated. We use a mathematical model of forced oscillations for thin elastic resonator, taking into account the nonlinearity coefficient, uneven stiffness, difference in Q-factors and control impact parameters. Using the Krylov - Bogolyubov averaging method, the resonator dynamics in slow variables measured by microgyroscope electronics has been investigated. Formulas with algorithmic compensation of the above defects for determining the angular velocity of the resonator under nonlinear oscillations and without feedback have been obtained. Control signals taking into account the defects are presented for feedback of the microgyroscope operating in the compensation mode of the angular velocity sensor. Numerical modeling of angular velocity determination in the operation modes considered has been carried out.
MSC 2010: 34K11
Keywords: vibrating ring microgyroscope, angular velocity sensor, nonlinear oscillations, drift compensation
Received January 09, 2017, accepted April 15, 2017
Citation: Rus. J. Nonlin. Dyn., 2017, vol. 13, no. 2, pp. 227-241 (Russian)