Документация

Введение

Роботы являются комплексными электромеханическими системами, где несколько электроприводов используются, чтобы управлять перемещением ясно сформулированных структур.

Это тематическое исследование представляет моделирование и симуляцию шести манипуляторов робота степеней свободы. Две основных модели соединений созданы с помощью бесщеточных дисков двигателя постоянного тока, которые соединяются с остальной частью манипулятора через редукторы скорости. Система управления, которая состоит по существу из двух циклов управления положения, создается с Simulink^® блоки. Внутренняя скорость и циклы управления крутящего момента уже включены в модель диска. Остальная часть манипулятора и его загрузки представлена двумя Simulink нелинейные модели, один для каждого электропривода.

Операция соединений с помощью типичных траекторий симулирована, и результаты представлены.

Описание манипулятора робота

Робот, рассмотренный в этом примере, является шестью манипуляторами робота степеней свободы общего назначения (GMF S-360) типа рычажного устройства параллелограмма. Шесть Манипуляторов Робота Степеней свободы показывают структуру робота и его рабочей области. Робот имеет шесть осей. Эти три оси (_Θ1, _Θ2, _Θ3) показанный на рисунке для расположения руки, и другие (α, β, γ) для ориентации исполнительного элемента конца. В горизонтальной плоскости робот может покрыть 300 дуг степени (_Θ1 =-150 ° к _Θ1 = 150 °).

Оси робота управляются бесщеточными двигателями постоянного тока, которые моделируются постоянным магнитом синхронные двигатели, питаемые инверторами PWM (модель диска AC6). Редукторы скорости типа пояса и коробки передач используются, чтобы передать крутящий момент от двигателей до соединений.

Системы управления положения для соединений 1 и 2

Мы рассмотрим в частности два первых соединения (ось 1 и ось 2), которые управляют целым роботом и его загрузкой. Первая ось использует бесщеточный двигатель постоянного тока на 2 кВт и 1:130 редуктор скорости. Вторая ось использует бесщеточный двигатель постоянного тока на 1 кВт и 1:100 редуктор скорости. Бесщеточный Диск двигателя постоянного тока для Управления Положением Соединения Робота показывает упрощенную схему системы управления положения для одной ссылки робота.

Система управления состоит из трех циклов управления, соединенных в каскадной настройке: внешний цикл положения включает внутренний цикл регулировки скорости и самый внутренний текущий цикл управления. Премьер-министр синхронный двигатель питается трехфазным инвертором PWM, действующим в управляемом текущим образом режиме. Схема полевой ориентации используется, чтобы разъединить переменные так, чтобы потоком и крутящим моментом могла отдельно управлять прямая ось статора текущие _{идентификаторы} и квадратурная ось текущие _IQ, соответственно. Квадратурная ось текущие ссылочные _IQ* (который представляет команду крутящего момента) обеспечивается циклом регулировки скорости. Прямая ось текущие ссылочные _{идентификаторы}* сохранена равной 0.

Скорость/датчик положения используется, чтобы предоставить информацию, запрошенную циклами управления скорости и положения. Положение ротора также требуется для преобразования координат (dq к abc).

Каждая остальная часть электроприводов структуры робота, включая другие ссылки и загрузку, через редуктор скорости.

Моделирование систем управления положения робота

Целая система приводов для двух первых соединений робота, включая электроприводы, редукторы скорости, эквивалентные загрузки и контроллеры доступна в Управлении Осью Робота Используя Бесщеточный пример Дисков двигателя постоянного тока.

Бесщеточные диски двигателя постоянного тока представлены двумя AC6 (PM Синхронный Электропривод), блоки. Этот блок моделирует полный бесщеточный диск двигателя постоянного тока включая постоянный магнит синхронный двигатель (PMSM), инвертор IGBT, контроллер скорости и токовый контроллер. Входные параметры AC6 являются командами скорости, и выходные параметры являются частотой вращения двигателя, которые питаются входные параметры редукторов скорости.

Редукторы скорости моделируются двумя блоками Speed Reducer. Входные параметры для этих блоков являются скоростями двигателей, и выходные параметры являются крутящими моментами с низкоскоростных сторон, которые применяются к модели структуры робота. Редукторы скорости характеризуются их отношением и инерцией и жесткостью и затуханием валов ввода и вывода.

Валы выхода редукторов скорости соединяются с _T1 и входными параметрами _T2 блока Robot, который представляет остальную часть структуры робота. Этот блок вычисляет эффективный крутящий момент, отраженный к каждому соединению. Для каждого соединения (пронумеровал i), мы можем рассмотреть глобально другие эффекты ссылок как одну загрузку, отражающуюся к соединению крутящий момент, который состоит из трех терминов

где _Θi является объединенным угловым положением, _Цзи является инерцией, _Ci является центробежным и Кориолисовым коэффициентом, и _Gi является гравитационным коэффициентом.

Модель Robot создана с блоками Simulink.

В этой схеме параметры _J1, _C1, _G1, _J2, _C2 и _G2 являются функциями объединенных положений. Реализуйте их при помощи полиномов или интерполяционных таблиц.

Объединенными положениями _Θ1 и _Θ2 управляют внешние циклы управления, которые обеспечивают _Θ1 и _Θ2, чтобы следовать за ссылками, наложенными траекториями манипулятора. Различные алгоритмы могут использоваться для этих циклов управления. Самые популярные единицы являются пропорционально-производным, вычисленным крутящим моментом, и адаптивный. В этом примере пропорционально-производные контроллеры реализованы для обеих осей.

Тестовые траектории кубического полинома для движения робота сгенерированы блоком Trajectory Generator.

Тестовые траектории состоят из перемещения от положения 6 до положения 3 в рабочей области (_Θ2 варьирующийся от-π/4 до π/4) при вращении вокруг оси 1 от одного положения до другого (_Θ1 варьирующийся от-π/6 до π/6). Параметры, которые будут заданы для этого блока, являются исходным положением [_Θ1ini, _Θ2ini], конечное положение [_Θ1fin, _Θ2fin], и время перемещения. Следующий рисунок показывает изменения структуры робота во время запрограммированного перемещения.

Изменение инерции из-за изменений структуры отражается к оси 1 как инерция, варьирующаяся в зависимости от _Θ2 (от 215 kgm² к 340 kgm² передача минимумом 170 kgm²). Инерция, отраженная к оси 2, является константой (_J2 = 50 kgm²). Эти изменения инерции представлены нелинейными функциями, реализованными в блоке Robot.

Отслеживание эффективности электроприводов

Тестовые траектории, описанные выше, составляют одну из самых требовательных траекторий для электропривода первых и вторых соединений. Они используются здесь, чтобы оценить эффективность отслеживания двух систем электропривода.

В примере манипулятор запрограммирован, чтобы вращаться от-30 ° до 30 ° в течение 1,5 секунд, и в то же время рука перемещена от заднего положения (_Θ2 =-45 °) к самой усовершенствованной позиции (_Θ2 = 45 °). Симуляция запущена с помощью временного шага 1 мкс.

Ответы манипулятора и электроприводов 1 и 2 отображены на трех осциллографах, соединенных с выходными переменными блоков Robot и AC6.

Во время перемещения объединенные положения _Θ1 и _Θ2 следуют за наложенными кубическими траекториями с низкой ошибкой отслеживания.

Бесщеточные диски двигателя постоянного тока ведут себя очень хорошо во время тестовых траекторий. Напряжение на шине DC обеспечено на относительно постоянных уровнях во время замедления двигателей. Разработанные крутящие моменты пропорциональны амплитудам моторных токов. Это демонстрирует хорошую операцию ориентированных на поле алгоритмов управления.