ДИФФЕРЕНЦИАЛЬНЫЕ УРАВНЕНИЯ И
ПРОЦЕССЫ УПРАВЛЕНИЯ N. 4, 2023 Электронный журнал, рег. Эл. N ФС77-39410 от 15.04.2010 ISSN 1817-2172
http://diffjournal, spbu. ruf e-mail: jodiff@mail.ru
Управление в нелинейных системах
Нелинейная динамика контура первичных колебаний МЭМС-гироскопа при действии систем фазовой автоподстройки частоты и автоматической регулировки усиления
B.C. Игумнова1, А.В. Лукин1, И.А. Попов1, Н.В. Кузнецов2'3, М.Ю.
Лобачев2, Я. В. Беляев4
1
Санкт-Петербург, Россия
2
Россия
3
4
Россия lukin_av@spbstu.ru
Аннотация. В настоящей работе проводится исследование динамики первичных колебаний высокодобротного микромеханического резонатора - чувствительного элемента МЭМС-гироскопа RR-типа - при действии различных реализаций системы фазовой автоподстройки частоты, работающей совместно с системой автоматической регулировки усиления электростатического привода. Исследование динамики объекта выполняется как численно, так и аналитически - с применением метода осреднения. Получены условия устойчивости стационарного режима в линейном приближении. Рассмотрены вопросы точности различных методов численного решения дифференциальных уравнений контура первичных колебаний. Исследовано влияние механической нелинейности резонатора на динамику резонатора и системы управле-
ния. Предложена реализация схемы ФАПЧ пониженного порядка, не содержащая паразитного сигнала двойной частоты на выходе фазового детектора. Проанализированы выходные характеристики систем управления (быстродействие, полоса захвата и др.) и сделаны качественные выводы об особенностях взаимодействия динамики механического колебательного звена и контура ФАПЧ-АРУ.
Ключевые слова: МЭМС-гироскоп, первичные колебания, ФАПЧ, АРУ. 1 Введение
Принцип работы микромеханического вибрационного гироскопа состоит в передаче механической энергии между двумя формами колебаний чувствительного элемента (ЧЭ), вызванной действием сил инерции Кориолиса. В простейшем случае ЧЭ состоит из одной подвижной массы - твердого тела на упругих подвесах - с двумя ортогональными рабочими формами колебаний. В режиме измерения угловой скорости электростатическим двигателем возбуждаются гармонические колебания по первичной оси. В линейном приближении амплитуда вызванных силой Кориолиса вторичных колебаний пропорциональна величине компоненты угловой скорости подвижного объекта вдоль оси чувствительности датчика.
Высокие требования к стабильности работы резонансных датчиков (в частности - чувствительных элементов микроэлектромеханических вибрационных гироскопов) приводят к необходимости применения систем управления с обратной связью, обеспечивающих постоянство амплитуды колебаний резонатора и его частотную настройку на резонанс. Первая из названных задач, как правило, решается с помощью системы автоматической регулировки усиления [1, 2, 3, 4]. Для решения второй задачи широкое распространение получили системы фазовой автоподстройки частоты [5, 6, 7, 8, 9, 10, И, 12, 13, 14, 15, 16].
Математическое моделирование динамики МЭМС резонаторов в условиях работы подобных систем управления представляет значительный теоретический и прикладной интерес. Различным аспектам этой проблемы посвящено большое число научных работ. В [17] проведено аналитическое исследование стационарных колебательных процессов для механически линейного резонатора с учетом действия системы АРУ. В [18] изучена динамика резонатора при действии системы ФАПЧ. Найдена область устойчивости требуемого резонансного режима колебаний в пространстве параметров системы управ-
ления. Прямым численным методом выполнены расчеты динамики резонатора при учете нелинейности упругой восстанавливающей силы. Качественное исследование динамики механически линейного резонатора при совместном действии систем АРУ и ФАПЧ выполнено в [19, 20, 21]. Одним из наиболее перспективных и современных решений для борьбы с острыми пиками амплитудно-частотных характеристик, а именно с амплитудными срывами, является использование параметрического возбуждения, которое характеризуется плавным пологим откликом резонансной кривой [22, 23].
Настоящая работа посвящена исследованию динамики чувствительного элемента высокодобротного вибрационного микромеханического гироскопа в контуре ФАПЧ и АРУ, а также исследованию вопросов подбора параметров управления с точки зрения ряда критериев качества работы контура генерации колебаний. Для построения системы в медленных переменных использован метод осреднения. Получены условия устойчивости найденных стационарных режимов. Приведены выводы по основным характеристикам системы: быстродействие, полоса захвата, а также устойчивость к изменению параметров системы управления.
В разделе 2 даётся описание и принцип действия рассматриваемого микромеханического гироскопа Ш1-типа. В разделе 3 построена полная система уравнений движения ЧЭ в контурах ФАПЧ-АРУ, к которой применён метод усреднения для получения системы в медленных переменных. В разделе 4 динамика ЧЭ рассмотрена в контуре оригинальной ФАПЧ-АРУ в геометрически линейной и нелинейной постановках. Введение модифицированной схемы ФАПЧ-АРУ и соответствующие результаты приведены в разделе 5. Сравнительный анализ выбора параметров и выходных характеристик двух систем управления приведён в разделе 6.
2 Постановка задачи
В наиболее простом случае микромеханический вибрационный гироскоп (ММВГ) содержит одну подвижную массу (ПМ), динамика которой позволяет определить действующую на систему силу инерции Кориолиса и, следовательно, компоненту угловой скорости подвижного объекта вдоль оси чувствительности. Электростатическим приводом возбуждаются колебания по первичной оси Z, при возникновении угловой скорости из-за сил Кориолиса возникают вторичные колебания вокруг оси X. Амплитуда вторичных колебаний по оси X, вызванных силой Кориолиса, пропорциональна угловой
скорости вокруг оси чувствительности У.
В качестве примера конкретной конструкции ММВГ приведем датчик с двумя крутильными степенями свободы, разработанный АО «Концерн «ЦНИИ «Электроприбор» [24, 25, 26, 27, 28]. Чувствительный элемент гироскопа ЯЯ-типа совершает крутильные движения вокруг осей первичных колебаний (ПК) и вторичных колебаний (ВК). Схемы датчика и чувствительного элемента представлены на рисунках 1а и 16.
датчик угла
Рис. 1: Схема ММВГ (а) и чувствительный элемент (ротор): 1- ротор; 2 - анкер; 3 - упругий подвес; 4 - электродная структура (ЭС) первичной оси; 5 - отверстия дня стоннеров (б)
Системы генерации первичных колебаний, в частности, системы ФАПЧ-АРУ могут иметь различные реализации [29]. Рассматриваемая схема контуров ФАПЧ и АРУ имеет вид, представленный на рисунке 2.
Рис. 2: Схема ФАПЧ и АРУ
Схема ФАПЧ содержит фазовый детектор, который внутри себя имеет фильтр нижних частот (ФНЧ), регулятор и опорный генератор, управляемый напряжением (ГУН) [7, 30, 31, 32]. Схема представляет собой замкнутую систему управления, задача которой состоит в обеспечении требуемой разности фаз между выходным сигналом преобразователя емкость-напряжение датчика перемещений резонатора и опорным сигналом ГУН. Амплитудный канал, реализующий схему АРУ, состоит из амплитудного детектора, ФНЧ и ПН-регулятора.
3 Математическая модель системы в контурах ФАПЧ и АРУ
Рассмотрим ось первичных колебаний гироскопа с учётом т.н. геометрической нелинейности, вызванной конечностью поля деформаций элементов упругого подвеса при движении подвижной массы. Уравнение движения первичных колебаний имеет вид [21]:
Л 7 + Ь7 7 + к717 + к7з73 = Fe. (1)
где 7 - амплитуда первичных колебаний (ПК), </7 - момент инерции вокруг оси Z, Ь7 - коэффициент демпфирования системы по оси ПК, к71, к7з - линейные и кубические компоненты жесткости упругого подвеса, Ее - момент сил электростатического гребенчатого привода - генератора первичных колебаний. Параметры механической системы, полученные путем математического моделирования и натурных испытаний для гироскопа разработки АО «Концерн «ЦНИИ «Электроприбор», приведены в таблице 1 [21].
Таблица 1: Параметры механической системы
Параметр Величина Единицы измерения
Момент инерции относительно оси Ог, J7 6.9573 ■ 10-13 k 2
Собственная частота вращения вокруг оси Ог, /7 8093.7772 Hz
Добротность вокруг оси Ог, QY 60000 dimensionless
Коэффициент демпфирования, 67 4.4226 ■ 10-13 kg/s
Линейная компонента жесткости, к1\ 0.0018 kg/s2
Кубическая компонента жесткости, к7з 0.0044 kg/s2
Математическая модель динамики по оси ПК в системе ФАПЧ-АРУ описывается следующей системой уравнений [19, 33]:
Y + cdi + U Y + ßl3 = Acos6 6 = Uo + Kvco z z = KfLLy
y = \PLL (Kgy cos 6 - y) (2)
A = kAgc (Xo - r) + B
p
B = K/gc (Xo - r)
'tt .2
Г = AAGC( 2 |y |- r),
где с^ = У, Щ = У , в = У3- Параметры контуров ФАПЧ и АРУ: в - фа-
и-у 1
за ГУН (щ = в - мгновенная частота ГУН), г - сигнал управления ГУН, у - выходной сигнал фазового детектора, щ - собственная (свободная) частота ГУН, Кусо - пропорциональный коэффициент усиления ГУН, Крьь _ интегральный коэффициент усиления регулятора, Кс, Хрьь - коэффициент передачи и частота полюса ФНЧ ФАПЧ, А - выходной сигнал схемы АРУ, В - сигнал управ ления АРУ, г - оценка текущей амплитуды колебаний, - пропорциональный и интегральный коэффициенты регулятора схемы АРУ, ДАсс - частота полюса ФНЧ АРУ, Х0 - требуемая (заданная) амплитуда стационарных колебаний.
Для качественного (параметрического) исследования динамики системы применим метод усреднения [19]. Представим искомое решение для механического звена в виде:
Y = a(t) cos [0(i) + ф(г)] , (3)
где a(t) - амплитуда, 9(t) + ф(t) - мгновенная фаза колебаний. Мгновенная фаза ГУН равна в, поэтому ф - разность фаз между резонатором и ГУН.
Дифференцируя (3), получим
Y = —aв sin (в + ф) + a cos (в + ф) - аф sin (в + ф). (4)
Потребуем
a cos (в + ф) — аф sin (в + ф) = 0, (5)
тогда
7 = -¿0sin (в + ф) - авsin (в + ф) - ав (в + ф) cos (в + ф). (6) Отметим, что динамика фазы ГУН описывается простым уравнением:
в = Kvco KfLLy. (7)
Переменная в является «быстрой» и может рассматриваться как нормализованное время. Следуя процедуре метода усреднения, подставим (3), (4) и (6) в (2), выразим из первого уравнения (2) и (5) а, ф и усредним правые части системы по явно входящему «времени» 9. Таким образом мы придем к автономной системе дифференциальных уравнений, описывающей эволюцию медленных переменных а, ф, z , y, B,r:
B sin ф + KAGC (Xo - r) sin ф + Cd (uq + Kvco a + Kvco KfLLya
PLLn
a =
2 (uq + Kvcoz)
Ф =
(uq + Kvco z)2 - Uy
a +
в + kAgc (Xq - r ) cos ф - 3ea3
2a (uq + Kvcoz)
z = KPLLy
?) = -XPLL (y - KG a cos ф) B = K/GC (Xq - r )
r = Л
AGC
(a - r).
(8)
Возможным стационарным периодическим режимам системы (2) соответствуют неподвижные точки (положения равновесия) динамической системы (8):
П
Уо = 0, Го = Хо, ¿о = Xo, фо = ± ^. Стационарные значения z определяются из уравнения
0)
2 2 3 2 (uq + KvcoZo) - U,i: - -вХо = 0
(10)
Наконец,
Во = с3Х0 [що + Кусо ¿о] . (11)
Основной интерес представляет решение, для которого ф0 = — | и ¿0 имеет знак вди (ы7 — ш0).
Анализ устойчивости рассматриваемого стационарного режима выполняется путем вычисления собственных значений якобиана правой части системы (8) в данной неподвижной точке. Для линейного резонатора (в = 0) область устойчивости в пространстве параметров характеризуется условиями:
AGC
TSÄGC . T/-AGC ( „ , \ fcd \AGC\ KT <KTMAX = Cd +--' IT + А 1
nCd + Л 2+ А )
Cl (\PLL , Cd\ KPLL < KPLL _Cd \Л + 2 )
(12)
KgKvco Xo
В реальных расчетах значения КАсс и Кр11 брались внутри области устойчивости, т.е. КААсс = КАА<с • К^Млх и Крьь = Крьь • К^Мах^ гДе КАсс и Крьь находятся в интервале (0; 1), обеспечивая стабильную работу контуров управления.
Подбором параметров контуров управления можно получить различные стратегии настройки совместной работы контуров ФАПЧ и АРУ. Например, возможны следующие комбинации:
1) «Быстрый» ФАПЧ (с большими коэффициентами управления) и «медленный» АРУ (с малыми коэффициентами управления);
2) «Медленный» ФАПЧ и «быстрый» АРУ;
3) Промежуточный вариант, когда процессы в контурах ФАПЧ и АРУ протекают в одном масштабе времени.
Графически проиллюстрируем третий случай настройки контуров ФАПЧ и АРУ. В таблице 3 приведены используемые параметры контуров управления нелинейной системой. Зависимости амплитуды первичных колебаний и частоты ГУН в медленных переменных, построенные на основе уравнений (8), приведены на рисунке 3.
1 с
Рис, 3: Амплитуда первичных колебаний и частоты ГУН в медленных переменных
На рисунке 3 отмечены три характерные точки для различных стадий выхода на стационарный режим. Значения амплитуды возбуждения А будут использованы далее в уравнениях (13) и (14) для построения мгновенных резонансных кривых и фазо-частотных характеристик системы.
Для механического звена исследуемой системы, которое представляет собой осциллятор Дуффинга, с помощью метода многих масштабов была получена система уравнений в медленных переменных [34]:
А = _ ^ А +1 АИзгпу
7 7 (13) А х = (£— 1)А-'— 8 А + 2 Ащгсоех-',
где А7 - амплитуда колебаний в медленных переменных, ~ фаза колебаний в медленных переменных, О - частота внешнего воздействия.
В итоге уравнение резонансной кривой имеет вид:
4 А: + (О — 1 — 3А?)2А:. = 1 (14)
4щ2 7 8 VI 4 щ6
1 1
7 8 ' 4
Численное интегрирование уравнений (13) позволяет получить установив-
шийся стационарный режим, который с позиции теории нелинейных динамических систем является положением равновесия и может быть продолжен по параметру с помощью численной процедуры, реализованной в программном комплексе Ма1соп1 [35].
На рисунках 4-5 приведены амплитудно-частотные характеристики (АЧХ) и фазо-частотные характеристики (ФЧХ) осциллятора Дуффинга (модели, описывающей механическую часть исследуемой системы) для трёх выбранных моментов времени и положение текущей точки реального динамического процесса на одном графике.
Рис. 4: Мгновенные резонансные кривые системы и соответствующие значения амплитуды колебаний
Рис. 5: ФЧХ системы и соответствующие значения фазы колебаний
Как видно из рисунков 4-5 мгновенные резонансные кривые и фазо-частотные характеристики видоизменяются при действии различных значений амплитуды внешнего воздействия. Контуры ФАПЧ и АРУ в каждый момент времени постепенно настраиваются на резонансный пик системы, что можно увидеть для третьей точки графика 3.
В дальнейшем в качестве рабочей принимается стратегия настройки системы управления колебаниями, соответствующая случаю быстрой работы контура АРУ и относительно медленной работы контура ФАПЧ: в этом случае минимизируется сложность динамики замкнутой системы по причине слабости взаимного влияния контуров подстройки амплитуды и фазы воздействия электростатического привода.
4 Динамика системы в оригинальном контуре ФАПЧ
4.1 Механически линейная модель
Рассмотрим колебания первичной оси в механически линейной постановке (в = 0). В таблице 2 приведём параметры контуров управления линейной системой. Принято, что полюса ФНЧ систем ФАПЧ и АРУ равны друг другу Алас = Арьь■
Таблица 2: Парамет
эы контуров управления
Qz fo KG KVCO Apll K agc KC K AGC p к PLL KC
60000 8092 1 104 fY/10 0.02 106 0.2
Существенной особенностью рассматриваемой системы является высокая добротность механического звена, что, как показано в [33], приводит к росту сложности структуры бассейнов притяжения требуемых стационарных динамических режимов системы «резонатор-контур управления» и связанным с этим трудностям аналитического и численного исследования.
На рисунке 6 представлено сравнение результатов моделирования изначальной системы уравнений (2) с решением системы уравнений в медленных переменных (8) с помощью метода Рунге-Кутты 4-5 порядков, который реализован встроенной функцией ос!е45 в МаНаЬ.
Rotor displacement (ode45)
0 2 4 6 8 10 12 14 16 18 20 t,c
8096
8095
8094 •
8093
8092
0 2 4 6 8 10 12 14 16 18 20 t,c
Рис, 6: Сравнение прямого численного интегрирования и асимптотического решений
Соответствующие параметры контуров ФАПЧ и АРУ представлены на рисунке 7.
VCO frequency
Magnitude of the input
8093 8092
- - -
4
0 2 4 6 £
12 14
Controller output
r ,
AGC control signal
: • :
0246£
Estimation of amplitude of 7
0 2 4 E
0246£
а) Параметры контура ФАПЧ б) Параметры контура АРУ
Рис, 7: Параметры контура ФАПЧ и АРУ
Из рисунка 6 видно, что результаты сравнения двух методов решения имеют определённое расхождение. Вопросам точности численного решения подобных систем посвящен ряд работ [36, 37, 38]. В версии Ма11аЬ2022 [39] появилась реализация метода Рунге-Кутты 8-9 порядков с повышенной точностью функцией ос1е89. Результаты моделирования с использованием этого решателя представлены на рисунке 8.
809E
8094
20
20
4
20
О 2 4 б 8 10 12 14 16 18 20
t,
Рис, 8: Сравнение прямого численного интегрирования и асимптотического решений
Соответствующие параметры контуров ФАПЧ и АРУ представлены на рисунке 9.
Magnitude of the input
t, с
Controller output
IV W\A 1\1\Г Л Л АЛЛ чА/V "VX/x.
\l 1 \l\i J V w
V »
Phase Detector output
1000C
с
2 4 б E
AGC control signal
Estimation of amplitude of 7
а) Параметры контура ФАПЧ б) Параметры контура АРУ
Рис, 9: Параметры контура ФАПЧ и АРУ
Видно, что повышение точности численного решения дифференциальных уравнений даёт полное соответствие результатов прямого интегрирования изначальной системы уравнений (2) и решения системы уравнений в медленных переменных (8). Установлено, что полоса захвата для линейной модели от от-счётного значения свободной частоты /0 = 8092 Гц находится в промежутке [-17 Гц; • 13 Гц].
20
t. с
20000
t. с
t, с
20
t, с
t. с
4.2 Механически нелинейная модель
Как показано в работе [21] упругий подвес ММВГ обладает определенной нелинейностью упругой характеристики. Важность этого фактора особенно сильно проявляется для высокодобротных резонаторов, к числу которых относится и колебательный контур первичной оси ММВГ. Поэтому дальнейшим шагом исследования динамики ЧЭ является учёт нелинейности механического звена (в = 0).
В таблице 3 приведены параметры контуров управления нелинейной системой. Принято, что полюса ФНЧ равны друг другу Хаос = хрьь-
Таблица 3: Парамет
зы контуров управления
Qz fo KG Kvco apll K agc KC K AGC p K PLL KC
60000 8093 1 4000 fj/10 0.02 104 0.9
Как отмечено выше, схемы низкого порядка численного интегрирования системы дифференциальных уравнений непригодны для интегрирования исходной системы (2), поэтому в дальнейшем будет применяться метод высокого порядка. На рисунке (10) представлено сравнение результатов моделирования изначальной системы уравнений (2) с решением системы уравнений в медленных переменных (8) с помощью метода Рунге-Кутты 8-9 порядков.
Rotor displacement (ode89)
0 5 10 15 20 25
t, с
Рис. 10: Сравнение прямого численного интегрирования и асимптотического решений
Соответствующие параметры контуров ФАПЧ и АРУ представлены на рисунке 11.
VCO frequency
Magnitude of the input
Estimation of amplitude of 7
■
а) Параметры контура ФАПЧ б) Параметры контура АРУ
Рис, 11: Параметры контура ФАПЧ и АРУ
Наблюдается полное соответствие результатов прямого интегрирования изначальной системы уравнений (2) и решения системы уравнений в медленных переменных (8). Установлено, что полоса захвата для нелинейной модели при отсчётном значении собственной частоты /0 = 8093 Гц составляет диапазон [-7 Гц; • 5 Гц].
С практической точки зрения выход на большие углы первичных колебаний позволяет получить более сильный сигнал с вторичной оси колебаний, что значительно упрощает обработку этого сигнала для извлечения угловой скорости подвижного объекта. На рисунке 12 показаны результаты моделирования для требуемых значений амплитуды первичных колебаний 3° и 5°. Для достижения амплитуды первичных колебаний 5° возникла необходимость из-
менить два параметра К£ = 0.001, К£ = 103 от референсных значений таблицы 3.
Rotor displacement (ode89)
Rotor displacement (ode89)
8160 8140 8120 8100 8080
J
VCO frequency (odc8£
-5 -10
8200 8180 8160 8140 8120 8100
10 15 20 25
t, с
VCO frequency (odc89)
N
а) Выход амплитуды на 3е
b) Выход амплитуды на 5е
Рис. 12: Сравнение прямого численного интегрирования и асимптотического решений
10
со 0
10 15
t. с
20
25
30
10
15
20
25
t. с
t, с
Механически нелинейная система является существенно более сложной с точки зрения управления колебаниями [40]. Как видно из рисунков 10 и 12 в выходной характеристике частоты ГУН наблюдаются небольшие нежелательные остаточные осцилляции, которые влияют на точность измерения угловой скорости объекта. Несмотря на рост вклада «паразитных» нелинейных слагаемых механической природы, наблюдается стабильная работа контура управления.
В таблице 4 приведена оценка эффективности работы контуров управления АРУ и оригинальной ФАПЧ с точки зрения быстродействия, точности выхода частоты ГУН и диапазона полосы захвата в рабочий режим.
Таблица 4: Оценка эффективности работы контуров управления АРУ и оригинальной
ФАПЧ
Параметр сравнения Линейная модель Механически нелинейная модель
Минимальный размах по частоте ГУН ±0.02 Гц ±0.07 Гц
Время выхода в рабочий режим 20 с 25 с
Полоса захвата в рабочий режим от заданного значения /0 [-17 Гц; +13 Гц] [-7 Гц; +5 Гц]
Величина минимального размаха по частоте оценивается на основании остаточных осцилляций в характеристике частоты ГУН, которая равняется разнице между максимальным и минимальным значением частоты в почти установившемся режиме. Из сравнения двух схем можно сделать следующие выводы: при учете свойственной системе механической нелинейности наблюдаем рост амплитуды остаточных осцилляций вокруг резонансного значения частоты, большее время выхода на стационарный режим и значительно меньшую полосу захвата системы ФАПЧ в рабочий режим [41, 42].
Из представленных выше результатов можно увидеть, что для систем с высокой добротностью наблюдается длительный выход на установившийся режим работы с нужной частотой ГУН и амплитудой колебаний. Это связано с двумя факторами: во-первых, в рассмотренной модели контура ФАПЧ отсутствует пропорциональное звено в регуляторе, которое позволяет ускорить работу контура управления; во-вторых, в выходном сигнале фазового детектора помимо полезного сигнала, используемого для настройки требуемой разности фаз, также присутствует паразитная гармоника в виде синуса двойной частоты, которая нивелируется ФНЧ, но полностью исключить это высокочастотное колебание не удаётся. В связи с этим, далее будет представлена модифицированная схема ФАПЧ, которая позволяет избавиться от
нежелательной высокочастотной составляющей в выходном сигнале фазового детектора и при этом не использовать ФНЧ.
5 Динамика системы в модифицированном контуре ФАПЧ
Отличием модифицированной схемы являются явное вычитание синуса двойной частоты, что даёт возможность не использовать ФНЧ в составе фазового детектора, и введение ПИ-регулятора в состав контура ФАПЧ. Преимуществами данной схемы является понижение порядка системы на единицу и, как покажут результаты далее, частота ГУН сходится к заданному значению значительно быстрее за счёт введения пропорционального звена в регулятор.
Схема с модифицированной схемой ФАПЧ представлена на рисунке 13.
Рис. 13: Схема модифицированной ФАПЧ и АРУ
Математическая модель оси ПК в модифицированной системе ФАПЧ-АРУ описывается следующей системой уравнений:
7 + С<Л + Ч + в!3 = Асеев
в = + Куоо(г + крьькс(7 - гетв) сов в)
г = КрььКс(>у - гетв) сов в
А = К^ (Хо - г) + В (15)
В = к/сс (Хо - г)
г = ААоС (2171- г) ,
где КР11 - пропорциональный коэффициент регулятора схемы ФАПЧ, у на
схеме означает выход фазового детектора без фильтра нижних частот у = Ко(7 - гетв)сеев.
5.1 Механически линейная модель
Рассмотрим колебания первичной оси в линейной постановке (5 = 0). В таблице 5 приведены основные параметры контуров управления, используемые при численных расчётах динамики системы.
Таблица 5: Ларамст
зы контуров управления
Яг /с Кс Куоо Алао К лао Ко К лао Р Крьь р Крьь г
60000 8092 1 4000 //10 0.9 108 2 20
На рисунке 14 представлены результаты моделирования системы уравнений (15) с помощью численной процедуры интегрирования встроенной функцией ос1е89 в Ма11аЬ.
Рис. 14: Амплитуда первичных колебаний и частота ГУЛ
Соответствующие параметры контуров ФАПЧ и АРУ представлены на рисунке 15.
РР^
4 4
VCO frequency
Û.15 Û.2 Û.25 Û.3 Û.35
t, С
Controller output
5
t, С
Phase Detector output
Û.25 Û.3
t, С
Û.45 Û.5
Magnitude of the input
Û.15 Û.2 Û.25 Û.3 Û.3'
t, с
AGC control signal
_
2 t, с
Estimation of ampUtude of 7
Û.25 Û.3 Û.35
t, с
Û.45 Û.5
а) Параметры контура ФАПЧ б) Параметры контура АРУ
Рис. 15: Параметры контура ФАПЧ и АРУ
Из графиков видно, что выход на заданный установившийся режим наступает через 0.5 с, что значительно быстрее, чем для системы, в которой был использован изначальный контур ФАПЧ. Установлено, что полоса захвата для линейной модели от отсчётного значения /0 = 8092 Гц находится в промежутке [-4 Гц; • 8 Гц].
5.2 Механически нелинейная модель
Теперь рассмотрим колебания первичной оси в нелинейной постановке (в = 0
пользуемые при численных расчётах динамики системы.
Таблица 6: Ларамет
эы контуров управления
Qz Jo KG Kvco AAGC K AGC KC К AGC p KPLL p KPLL г
60000 8092 1 104 Jy/10 0.9 108 3.5 20
На рисунке 16 представлены результаты моделирования системы уравнений (15).
Û.35
Rotor displacement
820C с 8150
к-
0 0.05
VCO frequency
.15 0.2 0.25 0.3 0.35
t, с
0.45 0.5
Рис, 16: Амплитуда первичных колебаний и частота ГУН
Соответствующие параметры контуров ФАПЧ и АРУ представлены на рисунке 17.
VCO frequency
11
t, с
Controller output
t, с
Phase Detector output
Magnitude of the input
Дддд/Vwww^v^.---
t, с
AGC control signal
lita
Iß
t, с
Estimation of amplitude of 7
а) Параметры контура ФАПЧ б) Параметры контура АРУ
Рис. 17: Параметры контура ФАПЧ и АРУ
Полоса захвата для нелинейной модели от отсчётного значения /0 = 8092
Гц находится в промежутке [-2 Гц; • 35 Гц]. На рисунках 18а) и 186) приве-
3° 5°
X C
8250
8050
8000
t, с
t, с
Rotor displacement
Rotor displacement
5
cT 0
cc
^ -5 -10
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
t, С
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
t, С
8600 -8500 -у 8400 -t" 8300 I ■Ф 8200 I 8100 8000 I-
VCO frequency
VCO frequency
8400 8200 8000 -
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
t,C
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
t, С
а) Выход амплитуды на 3° б) Выход амплитуды на 5°
Рис. 18: Амплитуда первичных колебаний и частота ГУН
Из графиков видно, что система сохраняет устойчивость при более высоких значениях угла колебаний первичных колебаний. По результатам моделирования были сделаны следующие выводы:
1) Увеличение Кр11 приводит к уменьшению осцилляций вокруг установившегося решения для 9.
2) Увеличение Кс приводит к уменьшению выходного значения по 9.
3) Увеличение Крьь приводит к увеличению значений по 9 в переходном процессе.
4) Для стабильной работы контура в нелинейной постановке необходимо увеличить Кусо и Крьь.
В таблице 7 приведена оценка эффективности работы контуров управления АРУ и модифицированной ФАПЧ с точки зрения быстродействия, точности выхода частоты ГУН и полосы захвата в рабочий режим.
Таблица 7: Оценка эффективности работы контуров управления АРУ и модифицировап-ной ФАПЧ
Параметр сравнения Линейная модель Механически нелинейная модель
Минимальный размах по частоте ГУН ±0.13 Гц ±0.44 Гц
Время выхода в рабочий режим 0.5 с 0.5 с
Полоса захвата в рабочий режим от заданного значения /0 |-4 Гц; -8 Гц| |-2 Гц; —35 Гц|
По сравнению с контуром управления с оригинальной ФАПЧ для моди-
10
10
-5
-10
8800
8600
7800
фицированной схемы контуров управления наблюдается больший размах по частоте ГУН (для линейной модели ±0.13 Гц, для нелинейной ±0.44 Гц), меньшее время выхода в рабочий режим - 0.5 с, и ширина зоны затягивания имеет сильно выраженный несимметричный характер диапазона значений свободной частоты.
6 Сравнение двух контуров управления
В таблице 8 приведём основные рекомендации по выбору параметров контуров управления для обеих постановок, а также наблюдения за эволюцией динамики основных выходных характеристик системы.
Таблица 8: Сравнение параметров контуров управления
Оригинальная система ФАПЧ Модифицированная система ФАПЧ
Я, = 60000 Я, = 60000
крьь = [0.2; 0.9] крьь = [5;20],Кррьь = [2; 10]
Ко = [1;106] Ко = [1; 102 ]
Куса = [4 ■ 103; 104] Куса = [4 ■ 103; 104]
Арьь = /7 /10, ААОС = Арьь Ааос = //10
кАос = 0.02 КАос = 0.9
КрАос = 106 КАос = ю8
Полоса захвата для линейной модели от отечётного значения /0 = 8092 Гц находится в промежутке [-17 Гц; +13 Гц]. Полоса захвата для линейной модели от отечётного значения /0 = 8092 Гц находится в промежутке [-4 Гц; +8 Гц].
Полоса захвата для нелинейной модели от отечётного значения /0 = 8093 Гц находится в промежутке [-7 Гц; +5 Гц]. Полоса захвата для нелинейной модели от отечётного значения /0 = 8092 Гц находится в промежутке [-2 Гц; +35 Гц].
Выход на 1.5°, 3°, 5° Выход на 1.5°, 3°, 5°
Время выхода на рабочий режим для ли-20 Время выхода на рабочий режим для ли-0. 5
Время выхода на рабочий режим для 25 Время выхода на рабочий режим для 0. 5
Минимальный размах по частоте ГУН для линейной модели ±0.02 Гц Минимальный размах по частоте ГУН для линейной модели ±0.13 Гц
Минимальный размах по частоте ГУН для нелинейной модели ±0.07 Гц Минимальный размах по частоте ГУН для нелинейной модели ±0.44 Гц
В таблице 8 приведены диапазоны изменения параметров систем управления, а также из таблицы можно сделать несколько выводов: контур управления АРУ-оригинальная ФАПЧ имеет практически симметричную полосу
захвата, существенное время выхода в рабочий режим (20 с и 25 с) и небольшой размах по частоте ГУН (для линейной модели ±0.02 Гц, для нелинейной ±0.07 Гц), в то время как контур управления АРУ-модифицированная ФАПЧ имеет несимметричную полосу захвата, малое время выхода в рабочий режим (0.5 с) и несколько больший размах по частоте ГУН (для линейной модели ±0.13 Гц, для нелинейной ±0.44 Гц).
7 Заключение
В настоящей работе проведено исследование динамики первичных колебаний высокодобротного микромеханического резонатора - чувствительного элемента МЭМС-гироскопа RR-типа - при действии различных реализаций системы фазовой автоподстройки частоты, работающей совместно с системой автоматической регулировки усиления электростатического привода. Исследование динамики объекта выполнено как численно, так и аналитически - с применением метода осреднения. Получены условия устойчивости стационарного режима в линейном приближении. Рассмотрены вопросы точности различных методов численного решения дифференциальных уравнений контура первичных колебаний. Исследовано влияние механической нелинейности резонатора на динамику резонатора и системы управления. Предложена реализация схемы ФАПЧ пониженного порядка, не содержащая паразитного сигнала двойной частоты на выходе фазового детектора. Проанализированы выходные характеристики систем управления (быстродействие, полоса захвата и др.) и сделаны качественные выводы об особенностях взаимодействия динамики механического колебательного звена и контура ФАПЧ-АРУ.
8 Поддержка
Исследование выполнено за счет гранта Российского научного фонда № 2171-10009, https://rscf.ru/project/21-71-10009/
Список литературы
[1] Alper S. Е., Sahin К. and Akin T. An Analysis to Improve Stability of DriveMode Oscillations in Capacitive Vibratory MEMS Gyroscopes. IEEE 22nd
International Conference on Micro Electro Mechanical Systems., 2009, pp. 817-820, doi: 1Û.11Û9/MEMSYS.2ÛÛ9.48Û55Û8.
[2] Dong L. and Avanesian D. Drive-Mode Control for Vibrational MEMS Gyroscopes. IEEE Transactions on Industrial Electronics, vol. 56, no. 4, pp. 956-963, 2009, doi: 1Û.11Û9/TIE.2ÛÛ8.2Û1ÛÛ88.
[3] Zhu H, Jin Z., Hu S., Ma W., Liu Y. Drive mode control for MEMS gyroscopes with electrostatically tunable structure. International Conference on Manipulation, Manufacturing and Measurement on the Nanoscale. -IEEE, 2013. - pp. 273-276, doi: 1Q.11Û9/3M-NAN0.2Q13.673743Q.
[4] Nesterenko T. G. et al. Amplitude control system of drive-mode oscillations of MEMS gyroscopes. IOP Conference Series: Materials Science and Engineering. Vol. 516. No. 1. IOP Publishing, 2019. doi: 10.1088/1757-899X/516/1/Û12ÛÛ9.
[5] Wu H., Yang H., Yin T., Zhang, H. Stability analysis of MEMS gyroscope drive loop based on CPPLL. Asia Pacific Conference on Postgraduate Research in Microelectronics and Electronics, 2011, pp. 45-48.
[6] Demir A., Hanay M. S. Phase-locked loop based resonant sensors: A rigorous theory and general analysis framework for deciphering fundamental sensitivity limitations due to noise. arXiv preprint arXiv: 1903.06497. 2019.
[7] Люкшонков P. Г. Термокомпенсация в микромеханических гироскопах с контуром стабилизации амплитуды первичных колебаний: дис. - СПб, 2016.
[8] Leonov G. A. et al. Hold-in, pull-in, and lock-in ranges of PLL circuits: rigorous mathematical definitions and limitations of classical theory. IEEE Transactions on Circuits and Systems I: Regular Papers. 2015. Vol. 62. no. 10. pp. 2454-2464.
[9] Kuznetsov N. V., Leonov G. A., Seledzhi S. M. Phase Locked Loops Design and Analysis. ICINCO-SPSMC. 2008. pp. 114-118.
[10] Yuldashev R.V. et al. The conservative lock-in range for PLL with lead-lag filter and triangular phase detector characteristic. arXiv preprint arXiv:2112.01602. 2021.
[11] Aleksandrov K. D. et al. Computation of the lock-in ranges of phase-locked loops with PI filter. IFAC-PapersOnLine. 2016. Vol. 49. no. 14. pp. 36-41.
[12] Alexandrov K. D. et al. Pull-in range of the classical PLL with impulse signals. IFAC-PapersOnLine. 2015. Vol. 48. no. 1. pp. 562-567.
[13] Leonov G. A., Kuznetsov N. V. Nonlinear mathematical models of phase-locked loops. Stability and oscillations. Cambridge University Press, 2014.
[14] Kuznetsov N. V. et al. Nonlinear analysis of classical phase-locked loops in signal's phase space. IFAC Proceedings Volumes. 2014. Vol. 47. no. 3. pp. 8253-8258.
[15] Kuznetsov N. V. et al. Effects of PLL Architecture on MEMS Gyroscope Performance. Gyroscopy and Navigation. 2022. Vol. 13. no. 1. pp. 44-52.
[16] Kuznetsov N. V. et al. The Gardner Problem on the Lock-In Range of Second-Order Type 2 Phase-Locked Loops. IEEE Transactions on Automatic Control. 2023.
[17] M'closkey R. T., Vakakis A. Analysis of a microsensor automatic gain control loop. Proceedings of the 1999 American Control Conference (Cat. No. 99CH36251). IEEE, 1999. Vol. 5. pp. 3307-3311, doi: 10.1109/ACC.1999.782377.
[18] Sun X., Horowitz R., Komvopoulos K. Stability and resolution analysis of a phase-locked loop natural frequency tracking system for MEMS fatigue testing. J. Dyn. Sys., Meas., Control. 2002. Vol. 124. no. 4. pp. 599-605.
[19] Park S. et al. Oscillation control algorithms for resonant sensors with applications to vibratory gyroscopes. Sensors. 2009. Vol. 9. no. 8. pp. 59525967.
[20] Indeitsev D. A. et al. Nonlinear dynamics of MEMS resonator in PLL-AGC self-oscillation loop. Nonlinear Dynamics. 2021. Vol. 104. pp. 3187-3204.
[21] Indeitsev D. A. et al. Analysis of imperfections sensitivity and vibration immunity of MEMS vibrating wheel gyroscope. Nonlinear Dynamics. 2021. Vol. 105. pp. 1273-1296.
[22] Miller J. M. L. et al. Phase control of self-excited parametric resonators. Physical Review Applied. 2019. Vol. 12. no. 4. pp. 044053.
[23] Perl T. et al. Control of vibratory MEMS gyroscope with the drive mode excited through parametric resonance. Journal of Vibration and Acoustics. 2021. Vol. 143. no. 5.
[24] Nekrasov Y. A. et al. Improving the performance of the Russian RR-type MEMS gyro. 21st St. Petersburg International Conference on Integrated Navigation Systems. Elektropribor: St. Petersburg, 2014. pp. 285-293.
[25] Nekrasov Y. A., Pavlova S. V., Moiseev N. V. Optimization of electrode structure of RR-type MEMS gyro. 22nd Saint Petersburg International Conference on Integrated Navigation Systems, ICINS 2015-Proceedings. 2015. pp. 334-337.
[26] Baranova E. A., Evstifeev M. I., Eliseev D. P. Simulation of translational vibrations effect on torque-to-balance RR-type MEMS gyroscope. Gyroscopy and Navigation. 2018. Vol. 9. pp. 50-56.
[27] Kovalev A. Phase method for measuring the output signal of a single-mass MEMS gyroscope as a possibility of improving its performance. 2019 26th Saint Petersburg International Conference on Integrated Navigation Systems (ICINS). IEEE, 2019. pp. 1-5.
[28] Некрасов Я. А. и др. Влияние поступательных вибраций, ударов и акустических помех на характеристики микромеханического гироскопа. Ги-роскопия и навигация. 2016. Т. 24. по. 2. С. 56-67.
[29] Saggin F. Robust Control for MEMS gyroscopes: Diss. - Lyon, 2021.
[30] Шахгильдян В. В., Ляховкин А. А. Системы фазовой автоподстройки частоты. Рипол Классик, 1972.
[31] Гелиг А. X., Леонов Г. А., Якубович В. А. Устойчивость нелинейных систем с неединственным состоянием равновесия. 1978.
[32] Kuznetsov N. V., Leonov G. A., Seledzhi S. M. Analysis of phase-locked systems with discontinuous characteristics. IFAC Proceedings Volumes. 2006. Vol. 39. no. 8. pp. 107-112.
[33] Indeitsev D. A. et al. Nonlinear dynamics of MEMS resonator in PLL-AGC self-oscillation loop. Nonlinear Dynamics. 2021. Vol. 104. pp. 3187-3204.
[34] Найфэ А. Методы возмущений. M.: Мир, 1976. T. 456.
[35] Dhooge A., Govaerts W., Kuznetsov Y. A. MATCONT: a MATLAB package for numerical bifurcation analysis of ODEs. ACM Transactions on Mathematical Software (TOMS). 2003. Vol. 29. no. 2. pp. 141-164.
[36] Kuznetsov N. V. et al. Hidden attractors in dynamical models of phase-locked loop circuits: limitations of simulation in MATLAB and SPICE. Communications in Nonlinear Science and Numerical Simulation. 2017. Vol. 51. pp. 39-49.
[37] Bianchi G. et al. Limitations of PLL simulation: hidden oscillations in MATLAB and SPICE. 2015 7th International Congress on Ultra Modern Telecommunications and Control Systems and Workshops (ICUMT). IEEE, 2015. pp. 79-84.
[38] Blagov M. V. et al. Simulation of PLL with impulse signals in MATLAB: Limitations, hidden oscillations, and pull-in range. 2015 7th International Congress on Ultra Modern Telecommunications and Control Systems and Workshops (ICUMT). IEEE, 2015. pp. 85-90.
[39] Matlab L. Version 9.12. 0.1884302 (R2022a). 2022.
[40] Kuznetsov N. V. Theory of hidden oscillations and stability of control systems. Journal of Computer and Systems Sciences International. 2020. Vol. 59. pp. 647-668.
[41] Kuznetsov N. V. et al. Harmonic balance analysis of pull-in range and oscillatory behavior of third-order type 2 analog PLLs. IFAC-PapersOnLine. 2020. Vol. 53. no. 2. pp. 6378-6383.
[42] Kuznetsov N. et al. Nonlinear analysis of charge-pump phase-locked loop: the hold-in and pull-in ranges. IEEE Transactions on Circuits and Systems I: Regular Papers. 2021. Vol. 68. no. 10. pp. 4049-4061.
Nonlinear dynamics of the primary oscillation circuit of a MEMS gyroscope under the action of phase-locked loop and automatic gain
control systems
V.S. Igumnova1, A.V. Lukin1, I.A. Popov1, N.V. Kuznetsov2'3, M.Yu.
Lobachev2, Ya.V. Belyaev4.
1
Russia
2
3
Sciences, St.Petersburg, 199178 Russia
4
lukin_av@spbstu.ru
Abstract. In this work, we study the dynamics of primary oscillations of a high-Q micromechanical resonator - a sensitive element of an RR-type MEMS gyroscope - under the action of various implementations of a phase-locked loop system operating in conjunction with an automatic gain control system for an electrostatic drive. The study of the dynamics of the object is carried out both numerically and analytically - using the averaging method. Conditions for the stability of a stationary regime in a linear approximation are obtained. The questions of accuracy of various methods of numerical solution of differential equations of the circuit of primary oscillations are considered. The influence of the mechanical nonlinearity of the resonator on the dynamics of the resonator and the control system has been studied. An implementation of a low-order PLL circuit that does not contain a double-frequency spurious signal at the output of the phase detector is proposed. The output characteristics of control systems (speed, capture bandwidth, etc.) are analyzed and qualitative conclusions are drawn about the features of the interaction between the dynamics of a mechanical oscillatory link and the PLL-ARC circuit.
Keywords: MEMS gyroscope, primary oscillations, PLL, AGC.
Funding. The work was supported by the Russian Science Foundation, grant no. 21-71-10009, https://rscf.ru/en/project/21-71-10009/.