ВУЗ: Не указан
Категория: Не указан
Дисциплина: Не указана
Добавлен: 22.04.2020
Просмотров: 3537
Скачиваний: 5
5 РАСЧЕТ ХАРАКТЕРИСТИК СЛЕДЯЩЕГО ПРИВОДА
5.1 Выбор схемы управления и элементов привода
Использование цифрового вычислительного устройства для управления электроприводом робота позволяет исключить из разрабатываемой конструкции датчик скорости, построив контур регулирования по скорости за счет дифференцирования сигнала с выхода ДУ. Таким образом, требуемый закон регулирования может быть реализован цифровым ПИД-регулятором. Податливость в этом случае равна нулю. Однако при использовании ПИД-регулятора в системе с обратной связью по положению при ступенчатом изменении установки происходит ступенчатое изменение ошибки рассогласования es, что приводит к возникновению на выходе дифференцирующего звена ПИД-регулятора импульсного сигнала большого значения и не обеспечивает плавное управление приводом робота, вызывая недопустимые скоростные перегрузки механических узлов робота.
Для устранения указанного недостатка следует формировать установку управления приводом по скорости с последующим ее интегрированием. Структурная схема приводится к схеме указанной в приложении А. Она соответствует системе управления с обратной связью по скорости, в которой на вход подается сигнал, пропорциональный скорости движения по траектории, и при этом на входе ПИД-регулятора формируется сигнал, пропорциональный ошибке по положению.
Для робота «Электроника НЦТМ-30» выберем двигатель постоянного тока, который наиболее полно удовлетворяет указанным требованиям при широтно-импульсном управлении. Оценка угла поворота, скорости и ускорения вала исполнительного двигателя необходима прежде всего для выбора мощности двигателя, так как при заданном характере нагрузок мощность определяется именно этими параметрами.
Оценка моментов нагрузки на исполнительной оси производится по формуле
(41)
где
—
коэффициент пропорциональности,
связывающий момент и частоту
вращения;
—
коэффициент пропорциональности,
связывающий момент и угол.
При этом требуемый пусковой момент должен удовлетворять условию:
(42)
где i — передаточное отношение редуктора; η— КПД редуктора от исполни- тельной оси до вала двигателя.
Первое слагаемое формулы (42) представляет собой динамический момент, обусловленный приведенным к исполнительной оси моментом инерции всех подвижных частей. Без учета редуктора имеем:
(43)
где Jдв — момент инерции двигателя;
Jн — момент инерции нагрузки всех подвижных частей манипулятора.
Слагаемое
—
момент, присущий исполнительным
органам, движущимся в вязкой жидкости
или газовой среде. Момент
создается
действием пружин, некоторыми кинематическими
связями. Момент трения Мт обычно
имеет постоянную величину и направлен
навстречу движению:
(44)
Статический момент сопротивления Мст не зависит от характеристик движения и может создаваться, например, грузом манипулятора.
Расчет максимального момента по формуле (41) дает завышенный результат, так как вероятность совпадения всех перечисленных моментов по модулю и знаку мала. Номинальный момент в первом приближении оценивают как среднеквадратичный:
(45)
Для роботов составляющие k0 и k00, как правило, отсутствуют.
Мощность двигателя, Вт, на выходной оси можно определить по формуле:
(46)
где 1,2-1,5 — коэффициент, учитывающий превышение действующего на двига- тель реального момента над статическим;
Мст + Мт — статический момент нагрузки двигателя, Н·м;
n — максимальная частота вращения исполнительного вала, об/мин.
Вопрос о выборе вида механической и регулировочных характеристик двигателей рассмотрен подробно в [6].
Механическая характеристика должна быть такой, чтобы во всех режимах работы момент Мдв, развиваемый двигателем, был больше статического момента нагрузки; она должна обеспечивать выполнение требований, предъявляемых к качеству привода, в частности быть жесткой и линейной. Жесткость (жесткая механическая характеристика — характеристика, у которой при значительном изменении момента частота вращения почти не изменяется) должна соответствовать требуемой ошибке от момента сопротивления на валу и параметрам передаточной функции. Линейность механической характеристики обеспечивает постоянство передаточной функции двигателя во всем диапазоне режимов работы двигателя.
Основным требованием к регулировочным характеристикам является их линейность во всем диапазоне изменения управляющего сигнала, что обеспечивает постоянство коэффициента передачи по управляющему сигналу. Кроме того, необходимо, чтобы регулировочная характеристика обеспечивала заданную кратность регулирования частоты вращения выходного вала исполнительного двигателя и устойчивую работу при минимальных скоростях управления.
Для улучшения механических и регулировочных характеристик в электроприводах применяют обратные связи.
Исходя из сформулированных требований для робота «Электроника НЦТМ-30», выбраны следующие двигатели:
-
в трех приводах поворота кисти используются три
двигателя постоянного тока ДПМЗО-Н2-04 [14]; -
в приводах локтя, плеча и механизма поворота —
двигатели постоянного тока ДПР72-Н2-02 [14].
К чувствительным элементам предъявляются следующие требования: линейность и однозначность статической характеристики, высокая чувствительность (крутизна) и разрешающая способность; стабильность характеристик во времени, отсутствие влияния нагрузки на статические характеристики, минимальная инерционность; минимальное влияние внешних факторов (температуры, вибраций); устойчивость к химическим воздействиям; простота и технологичность конструкции; взаимозаменяемость (повторяемость характеристик); удобство монтажа и обслуживания. Выбор типа чувствительного элемента определяется требованиями по точности системы, ее назначением и условиями эксплуатации.
Наиболее применимыми датчиками скорости и положения в роботах с цифровыми электроприводами являются фотоэлектрические датчики по принципу счета импульсов. Они обладают всеми указанными требованиями. В роботе «Электроника НЦТМ-30» используются фотоэлектрические датчики, конструктивно расположенные на валу двигателей, с разрешающей способностью 1024 (kд = 1024) импульса на один оборот двигателя, которая выбрана исходя из требуемой точности позиционирования робота.
5.2 Передаточная функция двигателя
Рассмотрим методику расчета параметров элементов электропривода на примере универсального сборочного робота « Электроника НЦТМ – 30 ».
В динамическом режиме поведение двигателя описывает основное уравнение электропривода:
(47)
где
- момент развиваемый
двигателем;
-
момент нагрузки;
-
КПД двигателя;
-
передаточное число радуктора;
-
угловое ускорение нагрузки;
- угловое
ускорение нагрузки, приведенное к валу
двигателя;
обозначим
- приведенный
момент инерции всех вращающихся частей
к валу двигателя.
Если угловая скорость вращения вала двигателя ω, то:
(48)
Выражение (4.1) примет вид:
(49)
Момент двигателя постоянного тока можно записать в виде:
(50)
Обмотка якоря электродвигателя обладает активным сопротивлением Rя и индуктивным Lя. Якорь двигателя вращается в магнитном поле статора, поэтому в нем наводится ЭДС, направленная встречно питающему напряжению (противоЭДС). Можно записать:
(51)
ЭДС генератора описывается уравнением:
(52)
Объединив в систему уравнения (49), (50), (51) и (52) и решив её, получим:
(53)
где ;
;
;
.
Отсюда передаточная функция двигателя по управлению равна:
(54)
5.3 Анализ способов решения задач синтеза дискретных САР
В настоящее время наибольшее распространение получили два способа ре-
шения задач синтеза дискретных САР. Первый способ основан на применении билинейного преобразования и построении желаемых логарифмических амплитудных и фазовых характеристик относительно псевдочастоты с последующим нахождением программ коррекции. По второму способу сначала определяют положения полюсов и нулей характеристического уравнения замкнутой САР, а уже по ним строят желаемые формы корневых годографов с последующим нахождением условий их взаимной компенсации. Кроме того, можно вычислить типы и параметры обратных связей по состоянию системы и ее выходному сигналу в виде динамических звеньев. Теоретической основой второго способа является векторно-матричный аппарат, позволяющий решать задачу синтеза, как при полном, так и неполном измерении фазовых координат. При этом необходимо выполнить проверку управляемости и наблюдаемости.
Первый способ обычно применяют при синтезе последовательных и параллельных корректирующих устройств, а второй – при синтезе устройств параллельной коррекции. Возможно объединение обоих способов; тогда выбор векторно-матричного уравнения желаемой САР осуществляют с помощью билинейного преобразования с последующим выбором нулей и полюсов замкнутой системы, а программу коррекции определяют в виде обратных связей. Данную задачу можно решить достаточно просто лишь при наличии одних полюсов. Если в характеристическое уравнение входят нули, то процедура синтеза значительно усложняется.
Постановка задачи синтеза данной системы по своей форме не отличаются от синтеза линейных непрерывных систем. В процессе ее решения также необходимо найти такую структуру и параметры системы, при которых обеспечивалось бы получение заданных техническими условиями запасов устойчивости, показателей качества и характеристик точности.
Синтез, основанный на построении желаемой логарифмической амплитудой и фазовой характеристик состоит в следующем:
- по требованиям точности строят низкочастотную часть желаемой ЛАЧХ
- с помощью номограмм Солодовникова по показателям качества м и tр определяют частоту среза, через которую проводят ЛАЧХ с наклоном–20 дб/дек;
- высокочастотную часть желаемой ЛАЧХ выбирают аналогично ЛАЧХ неизменяемой части;
- по точкам излома вычисляют желаемую ЛФЧХ и определяют запасы ус-
тойчивости по фазе и по модулю.
Техническое задание: необходимо разработать систему с заданными показателями запасов устойчивости, показателей качества и характеристик точности:
- перерегулирование 30%;
-
время переходного процесса tр 2,5 с;
-
колебательность М 2;
-
запас устойчивости по амплитуде L 6 дб, по фазе 30.
5.4 Расчет передаточной функции системы
Любая САР может быть разделена на изменяемую и неизменяемую части. К неизменяемой части принято относить исполнительные органы, усилители мощности и измерительные средства. Их обычно выбирают не только с учетом требований к точности и качеству процессов регулирования, но, в основном по надежности действия, массогабаритным характеристикам, стоимости, стойкости, влиянию агрессивной среды, взрывобезопасности и так далее. К изменяемой части системы относятся микропроцессоры, АЦП, ЦАП, передаточная функция микропроцессора зависит от управляющей программы и может меняться.
Поскольку изменяемая часть системы выполняет одну функцию – обработки поступающего сигнала и формирование управляющего сигнала, то передаточная функция всей изменяемой части будет определена передаточной функцией микропроцессора Wизм = Wацп. Wмп Wцап = 1.
Передаточная функция разомкнутой системы определиться как произведение передаточных функций элементов прямой цепи, после разрыва отрицательной обратной связи.
Подставляя в (53) значения передаточных функций неизменяемой части рассчитаем передаточную функцию разомкнутой системы, все расчеты здесь и далее произведены в MATHCAD 2001 Professional:
(55)
Передаточная функция замкнутой системы для задающего воздействия с учетом отрицательной обратной связи:
(56)
Определение устойчивости исходной системы. Для дальнейшего проектирования системы необходимо проверить исходную систему на устойчивость. Устойчивость исходной замкнутой системы определим по частотному критерию Михайлова.
Система будет устойчивой, если годограф D(j), начинаясь на действительной положительной полуоси, огибает против часовой стрелки начало координат, проходя последовательно n квадратов, где n – порядок системы.
Для определения устойчивости необходимо составить характеристическое уравнение передаточной функции разомкнутой системы (55), применимое к данному критерию:
D(p)=R(p)+Q(p) (57)
где R(p) – числитель передаточной функции разомкнутой системы;
Q(p) – знаменатель передаточной функции разомкнутой системы.
Заменяя в уравнении (55) p на j, и выделяя мнимую Im (D(j)) и действительную Re (D(j)) части на комплексной плоскости строится годограф D(j).
Как видно из рисунка 6 годограф, начинаясь на действительной положительной полуоси, огибает начало координат и проходит последовательно против часовой стрелки 6 квадрантов, нигде не обращаясь в 0, что указывает на устойчивость исходной системы.
5.5 Построение логарифмических характеристик неизменяемой части систе-
мы
5.5.1 П о с т р о е н и е Л А Ч Х н е и з м е н я е м о й ч а с т и с и с т е –
м ы. Исследование системы следует проводить по предельной системе, это объя-
стяется тем, что такт работы ВчУ, равный 2мс, много меньше постоянной времени
объекта управления (0,5-1,5 с)[20].
а
)
б)
Рисунок 6 - Годограф Михайлова, а) в области вблизи начала координат, б) общий вид годографа
По полученной выше передаточной функции строим график ЛАЧХ неизменяемой части системы, показанный на рисунке 7.