
- •1 Анализ существующих конструкций прыгающих роботов
- •1.1 Прыгающие роботы, отличающиеся видом механизма позиционирования до прыжка
- •1.2 Прыгающие роботы, отличающиеся видом механизма прыжка
- •1.3 Прыгающие роботы, отличающиеся видом механизма позиционирования после прыжка
- •1.4 Технико-экономическое обоснование
- •2 Исследовательский раздел
- •2.1 Описание разрабатываемой конструкции
- •2.2 Кинематика системы
- •2.3 Модель взаимодействия робота с опорной поверхностью
- •2.4 Уравнения движения прыгающего робота
- •2.4.1 Статическое положение при двух точках опоры
- •2.4.2 Статическое положение при одной точке опоры
- •2.4.3 Прямолинейное движение робота с двумя точками опоры по шероховатой поверхности
- •2.4.4 Прямолинейное движение робота с одной точкой опоры по шероховатой поверхности
- •2.4.5 Поворот относительно точки а
- •2.4.6 Плоскопараллельное движение без отрыва корпуса от поверхности
- •2.4.7 Плоскопараллельное движение при отрыве корпуса от поверхности
- •2.5 Алгоритм моделирования одного прыжка робота
- •2.6 Исследование движения робота
- •3 Расчетно-конструкторский раздел
- •3.1 Энергетический расчёт приводов
- •3.2 Расчет пружины
- •3.3 Трехмерные модели разработанных мехатронных узлов
- •4 Система автоматического управления приводом кулачка
- •4.1 Структурная схема сау
- •4.2 Определение передаточных функций
- •4.3 Исследование непрерывной сау
- •4.4 Настройка пид - регулятора
- •4.5 Определение передаточных функций разомкнутой и замкнутой системы
- •4.6 Критерий устойчивости Гурвица
- •4.7 Критерий устойчивости Найквиста
- •4.8 Критерий устойчивости Михайлова
- •5 Цифровая система автоматического управления
- •5.1 Система управления роботом
- •5.2 Функциональная схема цсау
- •5.3 Выбор электронных компонентов
- •5.3.1 Микроконтроллер
- •5.3.2 Драйвер двигателей
- •5.3.3 Энкодеры
- •5.3.4 Модуль беспроводной передачи данных
- •5.4 Принципиальная схема устройства
- •5.5 Алгоритм управления
- •5.6 Исследование цифровой сау
- •5.6.1 Моделирование цифровой системы
- •5.6.2 Исследование цифровой системы на устойчивость
- •Библиографический список
4.3 Исследование непрерывной сау
Проведём моделирование системы автоматического управления средствами программного пакета MATLAB. Воспользуемся расширением данного программного продукта – средой моделирования Simulink. Используя встроенные средства среды Simulink, получим график переходного процесса системы, при воздействии на неё единичного ступенчатого сигнала (рисунок 4.2.).
Рисунок 4.2 Модель системы автоматического управления в среде Simulink
Рисунок 4.3 График переходного процесса системы при воздействии на неё единичного ступенчатого сигнала
Из графика можем определить следующие параметры система автоматического управления:
величина статической ошибки – 0,002 %;
время переходного процесса – 14 с;
колебательность отсутствует;
коэффициент перерегулирования – 0%.
Исходя из этих данных, можно сделать вывод о том, что система автоматического управления не соответствует техническому заданию (по пункту время переходного процесса) и нуждается в корректировке. В качестве корректирующего звена выберем ПИД (пропорционально-интегрально-дифференциальный) регулятор.
4.4 Настройка пид - регулятора
Для настройки ПИД регулятора – определения значений пропорционального, дифференциального и интегрального коэффициентов – воспользуемся встроенными средствами среды Simulink.
Подбор коэффициентов будем осуществлять с помощью блока NCD OutPort. Включим его в схему, как показано на рисунке 4.4.
Рисунок 4.4 Схема, собранная для настройки ПИД регулятора
Значения коэффициентов, полученных оптимизацией в блоке NCD OutPort:
Kp = 0.99
Ki = 2.96
Kd = 0
После корректировки переходная функция удовлетворяет техническому заданию (рисунок 4.5).
Рисунок 4.5 Реакция системы на единичное ступенчатое воздействие
Получены следующие характеристики:
1) Время переходного процесса – 0.479 с.
2) Количество колебаний – 0.
3) Коэффициент перерегулирования – 0.
4) Статическая ошибка –0.
4.5 Определение передаточных функций разомкнутой и замкнутой системы
Определим передаточную функцию разомкнутой системы:
Wраз = Wус (p) ∙ Wдвигателя (p) ∙ Wредуктора (p) ∙ WПИД-регулятора (p)
Определим передаточную функцию замкнутой системы:
Х
арактеристическое
уравнение замкнутой системы имеет вид:
=
0
=
0
4.6 Критерий устойчивости Гурвица
Этот критерий позволяет определить устойчивость САУ, если характеристическое уравнение замкнутой системы представлено в виде:
Формулировка критерия: чтобы САУ была устойчива, необходимо и достаточно, чтобы определитель Гурвица и его диагональные миноры имели знаки, одинаковые со знаком первого коэффициента характеристического уравнения замкнутой САУ. При C0 > 0 для устойчивости САУ необходимо и достаточно выполнение условий:
;.
Определители диагональных миноров матрицы Гурвица больше нуля, следовательно, система устойчива.
4.7 Критерий устойчивости Найквиста
Критерий Найквиста – это частотный критерий, позволяющий судить об устойчивости САУ, замкнутой единичной обратной связью, по виду амплитудно-фазовой частотной характеристики разомкнутой системы.
Формулировка критерия: САУ устойчива в замкнутом состоянии, если годограф АФЧХ устойчивой разомкнутой системы не охватывает точки с координатами (-1, j0) на комплексной плоскости. Эта формулировка справедлива как для статических, так и астатических САУ, то есть систем, характеристическое уравнение которых содержит нулевой корень той или иной степени кратности.
Рисунок 4.6 Диаграмма Найквиста (АФЧХ)
Годограф АФЧХ устойчивой разомкнутой системы не охватывает точки с координатами (-1, j0) на комплексной плоскости (рисунок 4.6). Следовательно, система устойчива.