1. Вступление
Статья входит в цикл публикаций, посвящённых созданию системы управления (СУ) электроприводом рулевой поверхности (РП) малогабаритной ракеты на FPGA.
Целью данной статьи является краткое изложение процесса разработки математической модели (ММ) робототехнической системы, которая описывает как электромеханическую часть, так и алгоритм управления, реализованный в цифровом устройстве - FPGA (Altera Cyclone IV). Логика, реализованная в FPGA, будет описана в следующей части.
Краткое содержание статьи:
описание конструкции электропривода
создание ММ привода
экспериментальное определение некоторых параметров электродвигателя
анализ результатов математического моделирования
2. Техническое задание
Необходимо реализовать СУ для уже существующего привода (есть только конструкция), которая должна удовлетворять следующим требованиям по динамике, точности и устойчивости:
время переходного процесса при повороте вала привода на 30 градусов не должно превышать
;
перерегулирование не должно превышать 15%
;
статическая ошибка не должна превышать
;
частота среза
при амплитуде входного сигнала
;
запас по фазе на частоте среза должен быть не меньше, чем
.
3. Описание конструкции привода
Для создания ММ необходимо понять, что из себя представляет конструкция привода. Механическая часть (рисунок 1) состоит из следующих элементов: исполнительного двигателя (ИД), в качестве которого используется коллекторный электродвигатель постоянного тока – ДПР 62-Н4-01; пятиступенчатого цилиндрического редуктора, на предпоследней ступени которого расположен потенциометрический датчик обратной связи (ДОС).
Первоначально данная конструкция входила в состав испытательного стенда, поэтому на выходной вал привода была установлена муфта для последующего присоединения датчика момента. Демонтаж этой муфты не представлялся возможным: резьба, соединяющая её с приводом посажена на клей. В этой связи в ММ будет учтен момент инерции, создаваемый муфтой.
![Рисунок 1 - Внешний вид привода рулевой поверхности Рисунок 1 - Внешний вид привода рулевой поверхности](https://habrastorage.org/getpro/habr/upload_files/007/cc8/a6c/007cc8a6cc5b9dbb89fa75d795aec9cc.png)
В состав приводной системы входит электронный блок, который состоит из цифрового устройства управления - FPGA, усилителя (плата-драйвер для электродвигателя) и внешнего АЦП.
![Рисунок 2 - Функциональная схема Рисунок 2 - Функциональная схема](https://habrastorage.org/getpro/habr/upload_files/729/0fe/259/7290fe2599edf6514b03db48e408aa0d.png)
4. Математическая модель привода
Математическая модель состоит из:
Редуктора
Электродвигателя
Потенциометра
АЦП
Вычислительного блока
Силовой платы
Помехи потенциометра
![Рисунок 3 - Математическая модель привода рулевой поверхности Рисунок 3 - Математическая модель привода рулевой поверхности](https://habrastorage.org/getpro/habr/upload_files/5e9/967/03f/5e996703f3a63daaa8f90c4196f23ac0.png)
Уравнения, описывающие данную модель:
Данная ММ не учитывает:
шарнирный момент – момент нагрузки, создаваемый воздушным потоком и прикладываемый к РП. Он пропорционален углу поворота РП относительно продольной оси ракеты: чем
угол, тем
шарнирный момент;
момент вязкого трения – момент, который прикладывается к твёрдому телу при его движении в жидкой или газообразной среде;
момент сухого трения – момент от трения в подшипниках, трения между шестернями и т.д.;
люфт редуктора;
Так как в паспортных данных двигателя отсутствуют некоторые параметры, для ММ необходимо определить:
передаточное число редуктора
момент инерции редуктора и муфты
момент инерции ротора двигателя
сопротивление обмотки двигателя
индуктивность
коэффициент противо-ЭДС двигателя
коэффициент момента
Момент нагрузки определяется произведением ускорения выходного вала электродвигателя на приведённый к валу двигателя момент инерции нагрузки (второй закон Ньютона для вращательного движения):
Момент инерции нагрузки состоит из суммы моментов инерции редуктора, муфты и аэродинамического руля:
Так как испытания проводились без аэродинамического руля, его момент инерции равен нулю. Необходимо определить приведённый к валу электродвигателя момент инерции редуктора и муфты.
4. 1. Редуктор
![Рисунок 4 - Кинематическая схема Рисунок 4 - Кинематическая схема](https://habrastorage.org/getpro/habr/upload_files/b2a/716/6aa/b2a7166aafea0f82cf7731f8c59204ad.png)
Цилиндрический пятиступенчатый редуктор на промежуточных валах (валы № 2, 3, 4, 5 на рисунке 4) имеет по две шестерни. Это сделано с целью уменьшения люфта, габаритов редуктора и достижения необходимого момента на выходном валу привода.
Определим передаточное число редуктора, а также его суммарный момент инерции.
4. 1. 1. Передаточное число редуктора
Чтобы вычислить передаточное число всего редуктора, необходимо рассчитать передаточные числа между всеми ступенями и перемножить их:
Передаточное число между двумя последовательно соединёнными зубчатыми колёсами определяется соотношением:
где количество зубьев и угловая скорость каждого i-ого зубчатого колеса.
Представленная конструкция редуктора позволяет определять передаточные числа визуально путём подсчёта количества зубьев каждого зубчатого колеса.
![Таблица 1 - Расчёт передаточного числа редуктора Таблица 1 - Расчёт передаточного числа редуктора](https://habrastorage.org/getpro/habr/upload_files/98a/546/d15/98a546d15d2bb5c93bb482bebccf2224.png)
4. 1. 2. Момент инерции редуктора и муфты
Для определения момента инерции редуктора, необходимо знать моменты инерции всех валов и зубчатых колёс в нём. Конструкция и размеры элементов редуктора известны. Так как они имеют форму диска, момент инерции будем определять по известной формуле (плотность стали примем равной – ):
![Рисунок 5 - Габаритный чертёж промежуточного вала редуктора Рисунок 5 - Габаритный чертёж промежуточного вала редуктора](https://habrastorage.org/getpro/habr/upload_files/15c/404/d06/15c404d066e3d7b1b233371c1aad64ac.png)
Каждый промежуточный вал в редукторе включает в себя по два зубчатых колеса (б - большое, м - маленькое). При вычислении момента инерции самого вала длина равна: .
Вычисления моментов инерции промежуточных валов редуктора и выходного вала с посаженной на него муфтой представлены в таблице №2 (все размеры приняты в миллиметрах).
![Рисунок 6 - Вид шестерни выходного вала Рисунок 6 - Вид шестерни выходного вала](https://habrastorage.org/getpro/habr/upload_files/333/66c/7c3/33366c7c32dc47477bc8ddcd117284ce.png)
Зубчатое колесо на выходном валу имеет форму сектора окружности (рисунок 6). Это даёт возможность уменьшить массу привода, а также поставить физическое ограничение хода выходного вала привода. Для упрощения вычисления момента инерции, масса этого зубчатого колеса была поделена на 5, так как она занимает сектор окружности примерно в .
![Таблица 2 - Вычисление момента инерции элементов редуктора Таблица 2 - Вычисление момента инерции элементов редуктора](https://habrastorage.org/getpro/habr/upload_files/40e/d2a/068/40ed2a0686879b38cb75242040cab4e4.png)
Чтобы привести распределённые моменты инерции всех элементов редуктора из таблицы №2 к одной оси вращения, необходимо электропривод свести к одномассовой системе с эквивалентным моментом инерции
. Эквивалентная одномассовая система электропривода, имеющая момент инерции
, вращается со скоростью электродвигателя
. Приведение моментов инерции к одной оси вращения производится на основании принципа сохранения кинетической энергии исходной многомассовой системы с распределенными моментами инерции (рисунок 4) и одномассовой системы с эквивалентным моментом инерции
:
разделим правую и левую части уравнения на , получим
С учётом (1) и рассчитанными значениями передаточных чисел между каждой ступенью редуктора (таблица 1) получим:
Момент инерции нагрузки, который состоит из момента инерции редуктора и муфты, прикреплённой к выходному валу, равен суммарному моменту инерции
за вычетом момента инерции двигателя
:
Таким образом, для ММ определены передаточное число редуктора и момент инерции нагрузки
. На практике слагаемыми, которые относятся к моментам инерции промежуточных шестерён редуктора (в уравнении (2)
), пренебрегают, так как их величины малы по сравнению с моментом инерции объекта управления (например, аэродинамический руль).
4. 2. Электродвигатель
Динамика двигателя постоянного тока (ДПТ) описывается известной системой уравнений:
где угловая скорость ротора относительно статора,
электромеханический момент,
момент нагрузки, передаваемый со стороны редуктора (момент нагрузки, приведённый к валу двигателя). Применим к системе уравнений преобразование Лапласа:
Преобразуем
гдеэлектрическая постоянная времени якоря. Из полученной системы построим структурную схему в Simulink.
![Рисунок 7 - Структурная схема электродвигателя Рисунок 7 - Структурная схема электродвигателя](https://habrastorage.org/getpro/habr/upload_files/a93/d6b/309/a93d6b3098f027a347aa40d545abec48.png)
Для ММ следует определить такие параметры, как: сопротивление обмотки двигателя, индуктивность обмотки
, момент инерции ротора
, коэффициент противо-ЭДС
и коэффициент момента
, так как в паспортных данных они отсутствуют.
4. 2. 1. Сопротивление
Сопротивление обмотки якоря двигателя было измерено мультиметром:
4. 2. 2. Индуктивность
Индуктивность обмотки рассчитана по формуле:
где для быстроходных машин,
для нормальных некомпенсированных машин,
для компенсированных машин. Примем
.
4. 2. 3. Момент инерции
Момент инерции ротора выбран по подобным двигателям, исходя из массо-габаритных характеристик:
4. 2. 4. Коэффициент противо-ЭДС
Коэффициент противо-ЭДС определён экспериментально по формуле:
Данная формула получается из уравнения (3) в установившемся режиме.
Эксперимент состоит в следующем:
датчик положения ротора (в данном случае потенциометр) через своеобразную муфту крепится к выходному валу двигателя так, как показано на рисунке 8.
Рисунок 8 - Соединение потенциометра с ротором двигателя на двигатель подаётся напряжение
;
мультиметром измеряется ток в установившемся режиме;
зная время полного оборота потенциометра (данные с него передаются на ПК), определяется скорость вращения двигателя по формуле
[рад/с]. На рисунке 9 показаны данные, считанные с потенциометра и переданные на ПК.
Рисунок 9 - Зависимости угла поворота ротора от времени при разных напряжениях двигателя определяется коэффициент противо-ЭДС по формуле:
меняется напряжение
и повторяются пункты 3 - 5.
Все вычисления сведены в таблицу 3:
![Таблица 3 - Экспериментальные данные для определения коэффициента противо-ЭДС Таблица 3 - Экспериментальные данные для определения коэффициента противо-ЭДС](https://habrastorage.org/getpro/habr/upload_files/031/5f8/346/0315f8346c41802fe08ec11a130e8d1c.png)
![Рисунок 10 - Зависимость коэффициента противо-ЭДС от напряжения двигателя Рисунок 10 - Зависимость коэффициента противо-ЭДС от напряжения двигателя](https://habrastorage.org/webt/rf/hf/cm/rfhfcmlbc0y5b_gnusel3mq6skk.png)
![Рисунок 11 - Регулировочная характеристики двигателя Рисунок 11 - Регулировочная характеристики двигателя](https://habrastorage.org/webt/-r/do/am/-rdoamenbfvsij2j1nvismkqdue.png)
Таким образом, среднее значение коэффициента противо-ЭДС .
При отрицательных напряжениях двигателя (вращение в другую сторону) данные будут идентичные. Построим регулировочную характеристику электродвигателя (рисунок 11).
Стоит отметить, что при малых напряжениях ротор двигателя вращаться не будет, так как всё напряжение падает на активном сопротивлении обмотки (появляется нелинейность в виде зоны нечувствительности). Ток в цепи очень мал и, следовательно, создаётся момент, недостаточный для преодоления сил трения в подшипниках и тд.
4. 2. 5. Коэффициент момента
Коэффициент момента определяется по формуле:
Однако в паспортных данных отсутствует пусковой ток. В двигателях постоянного тока обычно принимают коэффициент момента равным коэффициенту противо-ЭДС (доказано экспериментально), поэтому .
4. 3. Потенциометр
![Рисунок 12 - Габаритный чертёж СП5-21Б-1 Рисунок 12 - Габаритный чертёж СП5-21Б-1](https://habrastorage.org/getpro/habr/upload_files/04d/864/973/04d8649735a405bdde56c43d01faa4f7.png)
Потенциометр СП5-21Б-1 является многооборотным. Значит он преобразует входной угол в напряжение
, где нулевому угловому положению соответствует нуль вольт напряжения.
Потенциометр расположен на предпоследней ступени редуктора (рисунок 4), поэтому зависимость поворота вала потенциометра от поворота выходного вала привода имеет вид:
Выходной вал привода поворачивается на , следовательно, максимальные углы поворота потенциометра:
Следует физически расположить потенциометр так, чтобы нулю градусам поворота выходного вала привода соответствовало , по двум причинам:
для исключения скачков напряжения от 0 В до 5 В при переходах вала потенциометра по наименьшему расстоянию от минимального сопротивления к максимальному и наоборот (движение от одной чёрной точки к другой на рисунке 13);
Рисунок 13 - Внутреннее устройство потенциометра потенциометр совершает меньше одного оборота
при повороте выходного вала привода из минимального в максимальное положение.
Тогда формула для потенциометра примет вид:
где
Также необходимо перевести из радианной меры в градусную:
4. 4. Аналого-цифровой преобразователь
АЦП преобразует аналоговый сигнал в цифровой. MCP3201 имеет разрядность 12 бит, поэтому он имеет уровней квантования и описывается соотношением:
где опорное напряжение, которое задаёт диапазон оцифровываемых значений. В нашем случае
. Например, для нейтрального положения выходного вала привода
АЦП будет выдавать:
.
4. 5. Вычислительный блок
Оцифрованные данные поступают в цифровое устройство (в нашем случае FPGA), в котором происходят такие ключевые действия, как:
фильтрация данных с потенциометра;
вычисление угла рассогласования между требуемым углом поворота привода и текущим;
корректировка сигнала рассогласования при помощи ПИ-регулятора;
формирование широтно-импульсного сигнала (ШИС) и вычисление сигнала направления вращения электродвигателя.
![Рисунок 14 - Структурная схема вычислительного блока привода Рисунок 14 - Структурная схема вычислительного блока привода](https://habrastorage.org/getpro/habr/upload_files/e83/14f/00e/e8314f00e58d3221b4e28963f10e1aee.png)
В модели вычислительного блока учтены задержка обработки данных с АЦП и задержка формирования ШИМ сигнала . Задержка АЦП равна
период между выборками. Задержки определены при помощи HDL-моделирования по временным диаграммам (во время разработки алгоритма под FPGA для просмотра временных диаграмм сигналов использовалась программа GTKWave).
Перед фильтрацией оцифрованные данные с АЦП переводятся в знаковый вид:
где текущий угол поворота вала потенциометра в градусах. Индекс n говорит о том, что система цифровая.
4. 5. 1. Цифровой фильтр
Фильтрация данных с потенциометра происходит с помощью фильтра скользящего среднего. Он представляет собой сглаживающий фильтр с конечной импульсной характеристикой, который часто используется для сглаживания сигнала от кратковременных выбросов. Фильтрация скользящим средним выбрана по двум причинам:
простота программной реализации;
линейная фазо-частотная характеристика (постоянство времени запаздывания во всей полосе частот входных сигналов, время запаздывания зависит только от ширина окна).
В модели данный фильтр описывается соотношением:
где отфильтрованный сигнал,
ширина окна фильтрации (количество отсчётов или количество предыдущих значений угла, участвующих в фильтрации). В нашем случае
(почему выбрано именно такое значение, будет объяснено в следующей статье).
Период дискретизации фильтра, время обновления входного в фильтр значения, в математической модели выбрано, исходя из периода дискретизации АЦП:
.
Фильтр с каждым новым отсчётом:
запоминает текущее значение и параллельно сдвигает предыдущие
значение в следующие регистры памяти;
параллельно вычисляет сумму всех
значений на каждом такте моделирования;
делит сумму на ширину окна
.
![Рисунок 15 - Структурная схема фильтра скользящим средним Рисунок 15 - Структурная схема фильтра скользящим средним](https://habrastorage.org/getpro/habr/upload_files/c1d/fd8/35a/c1dfd835afb11bbe7af1b0a8ad6602a8.png)
Каждый "массив памяти" представляет собой последовательно соединённые блоки задержки и блоки сумматоров:
![Рисунок 16 - Структурная схема массива памяти фильтра Рисунок 16 - Структурная схема массива памяти фильтра](https://habrastorage.org/getpro/habr/upload_files/b6e/145/c63/b6e145c63ee5ca8709d2a3a4b9b7a5da.png)
Степень блока задержки указывает на то, что блок обновляет значение каждые
, где множитель
шаг моделирования в Simulink.
4. 5. 2. Вычисление угла рассогласования
Привод управляется по углу. Система управления работает по ошибке. Отфильтрованное значение текущего угла вычитается из требуемого угла поворота привода. Требуемый угол задаётся надсистемой (в нашем случае это блок управления ракетой).
Подразумевается, что это уже отфильтрованное значение угла поворота потенциометра,
требуемое значение, приведённое к диапазону углов потенциометра:
4. 5. 3. ПИ-регулятор
Чтобы оптимизировать переходный процесс, увеличить быстродействие, а также точность системы применяются регуляторы, которые корректируют определённым образом полученный сигнал рассогласования. В программной реализации наиболее простым регулятором является ПИ-регулятор, он описывается соотношением:
Но это уравнение справедливо для непрерывных функций - аналоговых систем. Существует несколько реализаций цифровых ПИ-регуляторов [3], одна из них описывается системой уравнений:
где коэффициенты пропорциональной и интегральной составляющих регулятора соответственно,
интегральная составляющая,
выходное, отрегулированное значение угла рассогласования.
![Рисунок 17 - Структурная схема цифрового ПИ-регулятора Рисунок 17 - Структурная схема цифрового ПИ-регулятора](https://habrastorage.org/getpro/habr/upload_files/5bc/dda/758/5bcdda7587261a784c1111333fc67d53.png)
Шаг интегрирования . Это связано с форматом слова данных в программной реализации на FPGA. При вычислениях используется формат числа с фиксированной точкой. Всего в слове данных 16 бит, из них: 1 бит под знак, 8 бит под целую часть (так как это минимальное количество бит, позволяющее вместить весь диапазон отклонения вала потенциометра:
), 7 бит под фиксированную часть. Минимальное число, которое можно представить при таком формате, в десятичной системе счисления:
Однако, этот показатель можно улучшить, в месте умножения увеличить ширину фиксированной части умножаемых чисел.
Выходное значение ПИ-регулятора имеет ограничение. Интегральная составляющая также ограничена. Коэффициенты
и
в процессе отладки варьировались, но окончательно в математической модели приняли значения:
.
4. 5. 4. ШИМ сигнал и сигнал направления вращения двигателя
Получен усиленный сигнал рассогласования угла . В зависимости от его знака и величины формируется два сигнала: широтно-импульсный сигнал (ШИС) и сигнал направления вращения
.
![Рисунок 18 - Схема регулирования напряжения двигателя при помощи сигнала ШИМ Рисунок 18 - Схема регулирования напряжения двигателя при помощи сигнала ШИМ](https://habrastorage.org/getpro/habr/upload_files/848/c24/71a/848c2471a5dd88897a76b0f76e45bbdd.png)
![Рисунок 18 - Схема регулирования напряжения двигателя Рисунок 18 - Схема регулирования напряжения двигателя](https://habrastorage.org/getpro/habr/upload_files/308/483/4ea/3084834ea37a163aa7d6ddcc600855b6.png)
ШИС (в мат. модели это сигнал) реализует управление мощностью, подводимой к электродвигателю, при помощи изменения среднего значения напряжения на двигателе. Управление напряжением происходит посредством коммутации ключевого элемента (КЭ) определённым образом (рисунок 18). А именно, если на протяжении некоторого периода времени
(период ШИМ) транзистор будет открыт , например, 50% от этого времени
, то на двигателе сформируется среднее напряжение, равное половине напряжения питания
. Управляющее напряжение
, которое отвечает за открытие и закрытие КЭ, определяется ШИС (рисунок 19): если ШИС
в цифровом виде равен логической единице, то
соответствует напряжению, переводящему КЭ в открытое состояние – течёт ток, иначе, если
, то
. Таким образом, напряжение на двигателе описывается следующим соотношением:
где коэффициент заполнения ШИС,
скважность ШИС.
Но где же связь между углом рассогласования и напряжением двигателя? Очевидно, что тайна кроется в коэффициенте заполнения ШИС. Если рассогласование угла максимально, то и к двигателю должно прикладываться максимальное напряжение
. И наоборот, если
, то
. Значит можно выразить отношение угла рассогласования и напряжения на двигателе следующим образом:
Ошибки студента
Далее будут рассуждения, которые также вошли в текущую математическую модель, но по сути, как оказалось из вычислений, они излишне и бессмысленны. Результаты модели не поменяются, если убрать эту часть.
Потенциометр обладает чувствительностью, так как его щуп при повороте совершает перемещение от одного витка резистивного вещества к другому (отрывается от поверхности одного витка и примыкает к другому). Это приводит к тому, что сопротивление и соответственно напряжение изменяются скачкообразно. В документации к потенциометру есть параметр электрической разрешающей способности: , по которому можно определить шаг изменения сопротивления при переходе от одного витка к другому. Примем среднее значение этого параметра
и определим шаг:
Значит за один оборот мы совершаемперехода между витками. Определим минимальный угол поворота, который потенциометр будет способен зафиксировать:
Минимальное изменение угла рассогласования такое же (можно проверить, подставив в формулы АЦП и т. д.), тогда шаг напряжения двигателя составит:
где шаг коэффициента заполнения. Теперь угол рассогласования преобразуется в коэффициент заполнения следующим образом:
В данной формуле можно сократить 282 и снова получится формула (4), поэтому эти действия были бессмысленны и, видимо, коэффициент заполнения не зависит от точности датчика. Главное - это соотношение текущего угла ко всему диапазону принимаемых углов.
![Рисунок 20 - Формирование ШИМ сигнала Рисунок 20 - Формирование ШИМ сигнала](https://habrastorage.org/getpro/habr/upload_files/147/590/1b4/1475901b49cdc3b89c3e04fee1eb9315.png)
Было принято решение не убирать из модели данную часть, так как в ПЛИС уже реализован именно этот алгоритм: сначала угол переводится в размерность счётчика , который отвечает за формирование опорного напряжения (рисунок 20), а потом выполняется сравнение полученного числа со значением счётчика и формируется ШИС. Рисунок для аналоговой системы, но суть такая же: цифровой счётчик считает до значения 282 и обнуляется, параллельно его значение сравнивается с текущим значением переведённого в размерность счётчика угла рассогласования (задающее напряжение).
Ещё следует определиться с периодом ШИМ. Во-первых, он должен быть хотя бы на порядок меньше, чем электрическая постоянная времени электродвигателя , чтобы двигатель не успевал реагировать на скачки напряжения (тока) и отрабатывал только среднее значение напряжения. Иными словами, электрическая постоянная времени двигателя определяет частоту входного гармонического напряжения, после которой двигатель отрабатывает этот сигнал с некоторой просадкой по мощности. Поэтому, если период ШИС будет минимум на порядок меньше, то просадка по мощности будет значительной. Двигатель будет нечувствителен (или мало чувствителен) к таким резким скачкам входного напряжения.
Тогда .
Во-вторых, транзисторы в силовой плате издают свистящие звуки, если частота ШИМ находится в пределах слышимых человеком частот: до. Поэтому пусть период ШИМ:
Сигнал направления вращения электродвигателя определяется знаком угла рассогласования:
4. 6. Силовая плата
Блок силовой платы имеет два входных сигнала – ШИС и направление вращения, на основе которых формируется выходной сигнал напряжения.
Силовая плата выполняет две функции:
изменяет направление вращения двигателя, коммутируя ключевые элементы определённым образом;
усиливает напряжение, подводимое к электродвигателю.
В эксперименте в качестве силовой платы использовался модуль драйвера управления двигателями Dual 15A H-Bridge DC Motor Driver 30A 3-36V (рисунок 21).
![Рисунок 21 - Внешний вид платы Dual 15A H-Bridge DC Motor Driver Рисунок 21 - Внешний вид платы Dual 15A H-Bridge DC Motor Driver](https://habrastorage.org/getpro/habr/upload_files/a32/663/ae7/a32663ae7a2d11fb2757b2284db8b697.png)
Данный драйвер рассчитан на подключение двух двигателей постоянного тока. Подразумевалось, что в проекте в будущем будет реализован алгоритм управления для второго привода, который должен будет имитировать нагрузку для исследуемого привода рулевой поверхности.
![Рисунок 22 - Принципиальная схема драйвера Рисунок 22 - Принципиальная схема драйвера](https://habrastorage.org/getpro/habr/upload_files/141/d1c/2bd/141d1c2bd6a9ba50300fcc5ce748d342.png)
Из принципиальной схемы видно, что в драйвере используется мостовая схема. Такая схема даёт возможность изменять полярность напряжения, подводимого к двигателю, и, как следствие, направление вращения двигателя. Какой именно метод коммутации КЭ реализован в алгоритме управления платой – сказать сложно, в документации данной информации не было. Можно предположить, что используется диагональный метод коммутации КЭ (рисунки 23 и 24), так как он наиболее безопасный (отсутствуют сквозные токи) и простой в реализации. При вращении в прямом направлениикоммутируются КЭ 1 и КЭ 4
. Когда
, открыты ключи 1 и 4, двигатель находится в двигательном режиме работы (рисунок 23, а-б). Когда
, все ключи закрыты, двигатель находится в генераторном режиме (рекуперация энергии в сеть) (рисунок 23, в-г).
![Рисунок 23 - Пути протекания токов при коммутациях КЭ в прямом и обратном направлениях вращения (а - прямое вращение, б - обратное вращение, в - режим рекуперации энергии в сеть при прямом вращении, г - режим рекуперации энергии в сеть при обратном вращении) Рисунок 23 - Пути протекания токов при коммутациях КЭ в прямом и обратном направлениях вращения (а - прямое вращение, б - обратное вращение, в - режим рекуперации энергии в сеть при прямом вращении, г - режим рекуперации энергии в сеть при обратном вращении)](https://habrastorage.org/getpro/habr/upload_files/1c7/b74/e12/1c7b74e127e42352c47bc8ec50325bf1.png)
![Рисунок 24 - Диаграмма состояний управляющих напряжений в зависимости от ШИС и направления вращения при коэффициенте заполнения D = 0,33 (33%) Рисунок 24 - Диаграмма состояний управляющих напряжений в зависимости от ШИС и направления вращения при коэффициенте заполнения D = 0,33 (33%)](https://habrastorage.org/getpro/habr/upload_files/40a/151/188/40a1511884ecfd2890d62cb35665ed68.png)
![Рисунок 25 - Структурная схема блока силовой платы Рисунок 25 - Структурная схема блока силовой платы](https://habrastorage.org/getpro/habr/upload_files/37b/73f/5bc/37b73f5bcfce1da8306aeb823a1a3010.png)
Драйвер описывается уже полученным уравнением (4). По сути он усиливает напряжение до 27 В. В математической модели логика его работы реализована очень упрощённо (рисунок 25).
Помеха потенциометра
На данном блоке долго останавливаться не будем. На рисунке 26 представлена его структурная схема, параметры приведены в скрипте (mat_model.mlx) репозитория проекта на GitHub.
![Рисунок 26 - Структурная схема блока помехи Рисунок 26 - Структурная схема блока помехи](https://habrastorage.org/getpro/habr/upload_files/8b2/01a/c95/8b201ac9569b7429c612689af8f746b1.png)
![Рисунок 27 - Место получения графиков при моделировании помехи Рисунок 27 - Место получения графиков при моделировании помехи](https://habrastorage.org/getpro/habr/upload_files/bde/e61/a36/bdee61a3662e97d4c86917328d73be5f.png)
Промоделировав в Simulink при требуемых углах, были получены результаты (рисунок 28). Помеха – величина постоянная, поэтому кажется, что при 1 градусе она больше, чем при 30, но это не так, ведь для 30 градусов масштаб другой.
![Рисунок 28 - Результаты моделирования влияния помехи (чёрный график - сигнал потенциометра, красный график - зашумлённый сигнал) Рисунок 28 - Результаты моделирования влияния помехи (чёрный график - сигнал потенциометра, красный график - зашумлённый сигнал)](https://habrastorage.org/getpro/habr/upload_files/bb3/90a/9db/bb390a9db4464508b77d094772452c5e.png)
5. Результаты математического моделирования
Система работает по воздействию: какой угол задали, такой и должен быть на выходе. Но так как в системе присутствуют нелинейности (цифровая система, насыщение электродвигателя, помеха и т. д.), выходной угол будет отличаться от требуемого. Для оценки этого отличия и динамических качеств на систему воздействуют тестовыми сигналами определённой формы.
5. 1. Ступенчатое воздействие (переходный процесс)
Промоделируем ступенчатое воздействие для требуемых углов.
![Рисунок 29 - переходный процесс системы Рисунок 29 - переходный процесс системы](https://habrastorage.org/getpro/habr/upload_files/07d/2c4/c6b/07d2c4c6bc04e91a56adaec1f81dc24c.png)
Видно, что система устойчивая. Также из графиков можно сделать вывод о перерегулировании, показателе колебательности и времени переходного процесса. Вычисления приведены для(
требуемый угол,
текущий угол поворота выходного вала привода). Перерегулирование:
Показатель колебательности:
где амплитуды требуемого и отработанного углов.
Время переходного процесса при повороте на 30 градусов составляет, что удовлетворяет требованиям.
При движении до 30 градусов видно, что привод вышел на максимальную скорость (наклон прямой = const) - это энергетический предел (насыщение по напряжению двигателя). Если бы напряжение питания двигателя было больше, то привод быстрее бы пришёл в требуемое положение.
![Рисунок 30 - Реакция системы при разных коэффициентах усиления Рисунок 30 - Реакция системы при разных коэффициентах усиления](https://habrastorage.org/getpro/habr/upload_files/179/b91/3d8/179b913d83b4175bed49823708d9795b.png)
При коэффициенте усиления перерегулирование превышает требуемое значение, при
все показатели в норме, однако полоса пропускания меньше, чем 14 Гц. Поэтому был выбран коэффициент усиления
.
5. 2. Гармоническое воздействие
При таком типе входного сигнала можно судить о быстродействии системы, иными словами, о её полосе пропускания. Чем больше полоса пропускания, тем привод более динамичный. Входной заданный угол изменяется по гармоническому закону:
При этом выходной угол до частоты среза будет изменяться тоже по гармоническому закону:
![Рисунок 31 - Реакция системы на гармоническое воздействие Рисунок 31 - Реакция системы на гармоническое воздействие](https://habrastorage.org/getpro/habr/upload_files/3cb/319/dd5/3cb319dd508f89cdfa6a253c9b62fdc4.png)
Чем больше частота , тем у привода меньше времени, за которое ему необходимо повернуться на угол
. И из-за того, что есть энергетическое ограничение, с увеличением частоты входного сигнала привод будет всё хуже его отрабатывать. Из задания необходимо, чтобы при требуемой амплитуде
частота среза системы была равна
. Частоту среза, как вариант, можно определять по ЛАФЧХ разомкнутой системы. На графике (рисунок 31) выделены некоторые значения, по которым можно определить проседание мощности выходного сигнала относительно входного и запаздывание по фазе.
5. 3. ЛАФЧХ
![Рисунок 32 - моделирование ЛАФЧХ Рисунок 32 - моделирование ЛАФЧХ](https://habrastorage.org/getpro/habr/upload_files/536/0e8/5be/5360e85beb90dae47d8adfbba7ee801d.png)
Частота среза (красный график) равна 14 Гц. Это было достигнуто при помощи подстройки коэффициента усиления ПИ-регулятора. Запас по фазе:
где фаза на частоте среза. Система устойчива на требуемой частоте среза и имеет запас по фазе
удовлетворяет требованиям.
5. 4. Фильтрация
![Рисунок 33 - Фильтрация зашумлённого сигнала с потенциометра при ширине окна - 32 Рисунок 33 - Фильтрация зашумлённого сигнала с потенциометра при ширине окна - 32](https://habrastorage.org/getpro/habr/upload_files/49c/8a8/906/49c8a8906c866280ca780b1553a1a926.png)
![Рисунок 34 - Зависимость момента двигателя от ширины окна Рисунок 34 - Зависимость момента двигателя от ширины окна](https://habrastorage.org/getpro/habr/upload_files/c61/340/756/c61340756b1340b5c378080b81bf0c39.png)
Из-за плохой фильтрации возникают пульсации тока в двигателе и, следовательно, момента. По этой причине выходной вал двигателя будет совершать высокочастотные колебания малой амплитуды – появится звук дребезга в редукторе.
![Рисунок 35 - Зависимость коэффициента заполнения ШИС от ширины окна фильтра Рисунок 35 - Зависимость коэффициента заполнения ШИС от ширины окна фильтра](https://habrastorage.org/getpro/habr/upload_files/257/7d2/ab8/2577d2ab87fed3571eca769def19c9b7.png)
6. Выводы
Разработана математическая модель системы автоматического регулирования, управление которой происходит по углу. Были экспериментально и теоретически определены её параметры, а также реализован алгоритм:
цифровой фильтрации;
цифрового ПИ-регулятора;
управления двигателем при помощи ШИМ сигнала.
Проведён поиск параметров, благодаря которым система стала удовлетворять техническому заданию. Также были проанализированы результаты математического моделирования.
В следующей статье будет подробно разобрана реализация данного алгоритма управления на FPGA и приведён сравнительный анализ экспериментальных данных с данными, полученными при моделировании работы приводной системы.
Ссылка на исходники: https://github.com/Dileon44/Actuator-Control-Electronics/tree/main