- •Задание на разработку и исследование электромеханического следящего привода робота
- •1. Основные требования
- •2. Особые требования
- •3. Параметры манипуляционного механизма и требования к исполнительной системе робота
- •1.2.2. Силовой анализ манипуляционного механизма
- •1.2.3. Оценка мощности двигателя первого звена
- •1.2.4. Выбор двигателя привода первого звена
- •1.2.7. Построение приведённой диаграммы нагрузки
- •1.2.8. Тепловой расчёт двигателя первого звена
- •1.2.5. Определение требуемого передаточного отношения и марки редуктора
- •1.2.6. Проверка правильности выбора двигателя и редуктора
- •2. Синтез регулятора следящего привода
- •2.1. Анализ точности следящего привода и назначение требования к его компонентам
- •2.2. Выбор датчика положения
- •2.3. Синтез регуляторов следящего привода
- •2.3.1. Конкретизация требований к следящей системе, выбор её структуры
- •2.3.2. Оценка требуемых значений частот среза разомкнутого следящего привода и разомкнутых подсистем
- •2.3.3. Синтез подсистемы регулирования тока
- •2.3.4. Синтез подсистемы регулирования скорости
- •2.3.5. Синтез регулятора положения привода
- •2.4. Анализ процессов регулирования
- •2.5. Определение динамической моментной ошибки привода
- •2.6. Проверка соответствия требуемой точности
- •2.7. Дополнительные требования
- •3. Выводы
- •4. Список использованных источников информации
- •Приложение
2. Синтез регулятора следящего привода
2.1. Анализ точности следящего привода и назначение требования к его компонентам
Допустимая погрешность привода:
Определим допустимую динамическую и статическую погрешности:
Максимальная погрешность привода определяется по формуле:
где Мвн.max – максимальный внешний момент; с – коэффициент жёсткости пружины; σ – максимальный эквивалентный зазор (люфт) редуктора; Δдатч – дискретность датчика положения; δд.дин – динамическая ошибка привода; δд.м – динамическая моментная ошибка привода.
Тогда справедливы выражения:
и
При
том что:
Так как с = 32∙104 Нм/рад, Мвн.max = 137,89 Нм, то погрешность равна δ1доп = 4,3∙10-4 рад.
Считаем, что система управления манипулятором обеспечивает вычисление момента нагрузки и формирует корректирующее воздействие, которое на 95% компенсирует погрешность привода, обусловленную упругой податливостью редуктора.
Примем δ1доп = 2,15∙10-5 рад.
Определим погрешность, вызванную люфтом в редукторе:
Применим ПИ – регулятор скорости, чтобы не было постоянной моментной ошибки.
Так как момент маленький можем принять, что δ5доп = 0.
Допустимое значение:
При этом стоит учитывать что:
Целесообразно принять δ3доп << δ4доп, тогда предварительно примем δ3доп = 3∙10-7 рад,
δ4доп = 0,88∙10-5 рад.
2.2. Выбор датчика положения
Оценка требуемой разрешающей способности датчика с учётом учетверения количества импульсов с помощью квадратурного счётчика производится на основании зависимости:
Из этого следует, что разрешающая способность датчика равна:
Выбираем инкрементный энкодер ЛИР – 180: Nдатч = 32000 диск./об.; Δдатч = 4,9∙10-5 рад;
питание +5В; выходные сигналы – прямоугольные импульсы; максимальная частота вращения вала 10000 об/мин; масса 330 г.
Эквивалентный коэффициент передачи цепи обратной связи по положению:
Составляющая погрешности привода равно:
Для обработки сигналов энкодера выбираем компьютерную плату ЛИР–930–ISA–9pin–G1.
2.3. Синтез регуляторов следящего привода
2.3.1. Конкретизация требований к следящей системе, выбор её структуры
Структура системы контуров подчиненного регулирования изображена на рис.5.
Р
ис.5.
Структура системы контуров подчинённого
регулирования.
Система управления содержит три контура регулирования, которые вложены друг в друга. Самый внутренний – это контур регулирования тока, охватывающего его контура регулирования скорости, а главным является контур регулирования положения. На второй вход регулятора положения поступает задающее воздействие, формируемое управляющей ЭВМ. Это задающее воздействие несет информацию о желаемом положении вала двигателя.
Требования к следящей системе:
1) δд.доп δ4доп · ip = 0,88 ∙10-5 · 220 = 0,0019 рад;
2) Скоростная ошибка δск с максимальной рабочей скоростью должна быть не более δд.доп = 0,0019 рад;
3)
Время переходного процесса не более
4) Перерегулирование не более 20%;
При синтезе вместо реального движения рассматривается эквивалентное гармоническое движение, где эквивалентная круговая частота равна:
Эквивалентная амплитуда равна:
