2.2 Исследование линейной математической модели манипулятора
Анализ и синтез линейных систем, в настоящее время, производится одним из двух основных методов. Первый метод основывается на применении преобразований Лапласа, передаточных функциях, структурных схемах и графах, второй (метод пространства состояния) – на описании и моделировании систем в пространстве состояния.
В пространстве состояния непрерывные системы описываются системой дифференциальных уравнений первого порядка, которые называют уравнениями состояния. При этом используются методы матричного исчисления и векторного анализа.
В данной работе применим метод пространства состояния, используя рекомендации, данные в [43].
2.3 Расчёт АСУ электроприводом манипулятора по одной координате
Современные роботизированные сварочные комплексы включают в себя один или несколько сварочных промышленных роботов и один или два поворотных стола – позиционера. В отечественной промышленности для сварки применяют различные типы ПР, в том числе ПР серии «Универсал».
В данной работе под моделью манипулятора понимается модель механизма перемещения инструмента (электрода) сварочного робота “Универсал” по одной из координат X, Y или Z.
Механизм включает в себя:
выход системы управления;
электропривод перемещения, состоящий из контуров положения и скорости, и силовой части;
механическая часть механизма от выходного вала двигателя электропривода до мечта установки электродвигателя следующей координаты или места установки технологических приводов сварочного инструмента.
По принципу построения манипуляторы с управлением от ЭВМ и импульсной схемой преобразования сигналов управления асинхронным двигателем с частотно-токовым управлением (ЧТУ) являются дискретными системами автоматического управления (САУ), однако, учитывая, что реальная полоса пропускания манипулятора (
Основными нелинейностями манипулятора являются – ограничитель напряжения на выходе регулятора скорости, нелинейности преобразования сигнала в электроприводе с ЧТУ и механические люфты и ограничения механизмов перемещения платформы. Однако, если работу АСУ электроприводом рассматривать раздельно в режиме переноса инструмента (нелинейный режим с ограничением) и в режиме слежения за технологическим процессом (линейный режим) и пренебречь малыми, к тому же сглаживаемыми, нелинейностями преобразования сигналов в электроприводе, а также пренебречь малыми механическими нелинейностями (механическая часть тщательно обрабатывается и не включена в обратную связь контура управления), то каждый режим отдельно, в первом приближении можно считать линейным.
Данные предположения использованы при дальнейших расчётах.
Передаточная функция силовой части электропривода имеет вид:
где
где
Следовательно,
Подставив рассчитанные параметры в (2.3), получим:
2.4 Структурная схема манипулятора в режиме переноса инструмента
Данный режим работы манипулятора является нелинейным. Этот режим используется для быстрого переноса технологического инструмента (сварочного электрода) из исходной зоны – в рабочую. Структурная схема контура скорости для режима переноса инструмента показана на рис. 2.1.
В этом режиме ограничитель на выходе ПИ (пропорционально-интегрального) регулятора скорости входит в режим ограничения и тем самым размыкает обратную связь по скорости и остается только характерная для частотно-токового управления обратная связь через задатчик тока и контур тока.
Рисунок 2.1 – Структурная схема контура скорости в режиме переноса инструмента
Амплитуда тока статора в этом режиме формируется задатчиком тока пропорционально
где
Передаточная функция для этого режима:
где
Рассмотрим контур положения (КП), структурная схема которого в режиме переноса инструмента показана на рис. 2.2, где приняты следующие обозначения:
ЭС – элемент сравнения.
Рисунок 2.2 – Структурная схема КП в режиме переноса инструмента
В режиме переноса на привод подается сигнал номинальной скорости переноса
Передаточная функция в режиме переноса инструмента по положению равна:
Подставив численные значения в (2.9) и (2.10) получим:
При
При
При
При