Скачать

Построение и исследование динамической модели портального манипулятора

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

1. Моделирование динамики манипулятора

1. Методы построения динамической модели манипулятора

Динамическая модель манипулятора может быть построена на основе использования известных законов ньютоновской или лагранжевой механики. Результатом применения этих законов являются уравнения, связывающие действующие в сочленениях силы и моменты с кинематическими характеристиками и параметрами движения звеньев. Таким образом, уравнения динамики движения реального манипулятора могут быть получены традиционными методами Лагранжа – Эйлера или Ньютона – Эйлера. С помощью этих двух методов получен ряд различных форм уравнения движения, эквивалентных в том смысле, что они описывают динамику движения одной и той же физической системы.

Вывод уравнений динамики движения манипулятора методом Лагранжа – Эйлера отличается простотой и единством подхода. В рамках предположения о том, что звенья представляют собой твердые тела, этот подход приводит в общем случае к системе нелинейных дифференциальных уравнений второго порядка. Уравнения Лагранжа – Эйлера обеспечивают строгое описание динамики состояния манипулятора и могут быть использованы для разработки усовершенствованных законов управления в пространстве присоединенных переменных. В меньшей степени они используются для решения прямой и обратной задач динамики. Прямая задача состоит в том, чтобы по заданным силам и моментам определить обобщенные ускорения, интегрирование которых позволяет получить значения обобщенных координат и скоростей. Обратная задача динамики заключается в том, чтобы по заданным обобщенным координатам, скоростям и ускорениям определить действующие в сочленениях манипулятора силы и моменты.

С целью получения более эффективных с вычислительной точки зрения алгоритмов можно использовать уравнения Ньютона – Эйлера. Вывод уравнений движения манипулятора методом Ньютона – Эйлера прост по содержанию, но весьма трудоемок. Результатом является система прямых и обратных рекуррентных уравнений, последовательно применяемых к звеньям манипулятора. С помощью прямых уравнений последовательно от основания к схвату вычисляются кинематические характеристики движения звеньев, такие, как линейные и угловые скорости и ускорения, линейные ускорения центров масс звеньев. Обратные уравнения позволяют последовательно от схвата к основанию вычислить силы и моменты, действующие на каждое из звеньев. Наиболее важный результат такого подхода состоит в том, что время, необходимое для вычисления обобщенных сил и моментов прямо и пропорционально числу сочленений, но не зависит от реализующейся в процессе движения конфигурации манипулятора. Это позволяет реализовывать простые законы управления манипулятором в реальном времени.

Низкая вычислительная эффективность уравнений Лагранжа – Эйлера обусловлена в основном тем, что для описания кинематической цепи используются матрицы преобразования однородных координат. Уравнения Ньютона – Эйлера обладают большей вычислительной эффективностью, что связано с их рекуррентной природой. Однако такие рекуррентные уравнения не обладают “аналитичностью”, столь полезной при синтезе управления в пространстве состояний. Для синтеза законов управления желательно иметь в распоряжении замкнутую систему дифференциальных уравнений, точно описывающих динамику движения манипулятора.

В связи с тем что для построения модели динамики переходных процессов и дальнейшего анализа полученных уравнений необходима аналитическая форма, решено использовать для получения уравнений динамики метод Лагранжа – Эйлера.

2. Уравнения динамики манипулятора

Уравнения Лагранжа второго рода для голономной системы с степенями свободы, которым отвечают обобщенные координаты (j = 1,2,…,), имеют вид

где – функция Лагранжа, разности кинетической Т и потенциальной П энергий системы; – обобщенные силы управляющих приводов, приведенные к j-ой обобщенной координате: они имеют размерность моментов, если – угол поворота, или сил, если – линейное перемещение.

С учетом того, что и , перепишем уравнение (1.1) в виде

где , .

В последних равенствах через обозначены внешние обобщенные силы, вызванные весом звеньев и груза, удерживаемого в захватном устройстве. При наличии внешнего воздействия – силы , приложенной к захватному устройству, в правую часть равенства для надо добавить член , характеризующий это воздействие:

Используем выражение (1.2) для вывода уравнений динамики манипулятора. Рассматривая исполнительный механизм манипулятора как систему из твердых тел, запишем его кинетическую энергию T в виде суммы кинетических энергий звеньев:

В свою очередь величину определим по формуле (3)

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

Выражение (1.5) принимает наиболее простой вид, если за полюс звена принять его центр инерции; величина будет равна нулю и выражение (1.5) упростится:

Кроме того, в большинстве случаев звенья манипулятора представляют собой твердые тела, обладающие симметрией относительно трех ортогональных осей, проведенных через центр инерции. Напомнив правило разметки осей систем координат, связанных со звеньями, в соответствии с которым одна из осей системы совпадает с осью звена (вектором ), а две другие образуют с ней правую триаду, получим при помещении точки в центр инерции (см. рис. 1.1) оси полученной системы становятся главными осями инерции и тензор вектора в точке имеет вид диагональной матрицы

моменты инерции относительно осей в которой определяются выражениями

и для звеньев заданной конфигурации являются известными константами. При отсутствии осевых симметрий тензор инерции звена в точке характеризуется матрицей

центробежные моменты в которой определяются выражениями

и также являются известными константами.

Определим вектор скорости центра инерции звена i через проекции на оси связанной с ним системы координат как

или через проекции на оси неподвижной системы осей в виде

По аналогии с введем вектор угловой скорости звена

и запишем равенство (1.6) в развернутой форме для случая, когда звенья манипулятора обладают симметрией относительно главных осей инерции. Для этого подставим выражения , , из (1.7), (1.11), (1.13) в (1.6) и получим

При использовании вектора скорости центра инерции в форме (1.14) выражение

с учетом которого равенство (1.4) принимает вид

2. Построение динамической модели переходных процессов манипулятора МРЛ-901П

2.1 Модель переходных процессов в манипуляторе МРЛ-901П

М
одель портального манипулятора МРЛ-901П представлена на рис. 2.1. Деформирующимися элементами в манипуляторе являются: зубчатый ремень, обозначенный пружиной; консольная часть, на которой имеется сосредоточенная масса m. Деформация поперечной консоли обозначена на схеме углом . Исходными данными для расчета такой модели будут: значение подвижной массы m, плечо приложения этой массы l, а также коэффициент натяжения зубчатого ремня, определяемый как отношение прогиба ремня к его длине и влияющий на жесткость, и демпфирование модуля линейного перемещения.

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

Рассматриваемая модель имеет три степени свободы, обозначим независимые обобщенные координаты как , и . Для описания данной модели воспользуемся уравнением Лагранжа второго рода:

где T кинетическая энергия системы; Q  обобщенная сила; k  количество степеней свободы.

Кинетическая энергия системы с тремя степенями свободы является однородной квадратичной формой обобщенных скоростей (5):

Коэффициенты являются функциями координат , и .

Предположим, что обобщенные координаты отсчитываются от положения равновесия, где .

Располагая коэффициенты по степеням и пологая для упрощения записи , получим:

Потенциальная энергия системы:

При этом учитываем, что в положении равновесия обобщенные силы также обращаются в нуль.

В (2.4) для упрощения приняты следующие обозначения:

, , , , , .

Для составления дифференциальных уравнений свободных колебаний в форме уравнений Лагранжа второго рода, выразим потенциальную энергию через обобщенные координаты. Рассмотрим равновесие системы, на которую действуют силы …,. Потенциальная энергия в состоянии устойчивого равновесия имеет минимум, равный нулю, а при вызванном действием сил отклонении от него выражается квадратичной формой вида (2.4).

Элементарная работа всех сил действующих на систему, по принципу возможных перемещений должна быть равна нулю:

Замечая, что

а также приравнивая к нулю коэффициенты при независимых вариациях , и , получаем три уравнения:

Здесь , и  обобщенные силы для системы сил …,, уравновешивающих потенциальные силы, возникающие при отклонении системы из положения равновесия . Заменяя в (2.6) производные потенциальной энергии их выражениями согласно (2.4), получим систему уравнений, определяющих значение координат , и в положении равновесия:

причем , и .

Решение системы (2.7) имеет вид:

где

.

На систему действуют обобщенные силы, которыми являются инерционные силы и силы сопротивления движению. Обычно в сложных системах в целях упрощения (4, 5) силу сопротивления принимают пропорциональной первой степени скорости движения. С целью упрощения условимся, что угол мал и координаты массы m можно записать как . Поэтому на основании кинетостатики можем записать:

где  обобщенная сила,  коэффициент сопротивления пропорциональный первой степени скорости движения массы m. Так как масса собственно консоли манипулятора МРЛ-901П меньше массы закрепленных на ней рабочих головок, захватов и деталей, для упрощения примем условие, что точка исследования колебаний (практически  рабочий орган манипулятора) совпадает с точкой приложения сосредоточенной массы m.

Сила действует на все звенья манипулятора следовательно:

Коэффициенты в (2.7) будем определять из того, что согласно (2.11) звенья можно рассматривать независимо друг от друга. Положим сначала, что действует только по координате , затем только по координате и наконец только по координате , тогда в выражение (2.7) можно переписать:

таким образом , используя (2.9) находим:

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

где , и жесткости звеньев по координатам , и соответственно.

Подставляя (2.14) , (2.11) и (2.10) в (2.8) получим:

Для решения этой системы нужно выразить скорость и ускорение массы m через их составляющие:

Поскольку в манипуляторе суммарную жесткость удобно экспериментально определять, прикладывая соответствующее усилие к его рабочему органу, и так как в конечном итоге необходимо определить положение массы m, координаты которой выражаются как , то для этого достаточно сложить уравнения в выражении (2.15):

или:

где С суммарная жесткость звеньев манипулятора.

Анализ показывает, что величина C является переменной и зависит от плеча приложения l сосредоточенной массы m.

Преобразуя (2.18), получаем уравнение описывающие переходный процесс в системе:

Уравнение (2.19) легко решается классическим способом при следующих начальных условиях:

где  скорость рабочего органа манипулятора в момент выхода на конечную точку.

Выражение (2.19) представляет собой линейное дифференциальное уравнение второго порядка. Будем искать частное решение уравнения в виде:

где и  произвольные постоянные, которые могут быть определены из начальных условий: при t = 0; и  корни характеристического уравнения:

Решение уравнения (2.22) будет иметь вид:

Определим произвольные постоянные и , решая систему уравнений:

Решение системы (2.24) будет иметь вид:

если учесть (2.20) то:

подставляя (2.26) в (2.21) и с учетом (2.23) имеем:

где  реальная часть;  мнимая часть.

Тогда разделяя реальную и мнимую части в (2.27) получим:

Учитывая что:

имеем:

Преобразуя (2.30) получим решение уравнения (2.19):

Прологарифмируем выражение (2.31) предварительно подставив в него значение допустимой погрешности позиционирования:

где  допустимая погрешность позиционирования.

Преобразуя (2.32) получим выражение для определения времени переходного процесса:

Для расчета жесткости C и коэффициента демпфирования в модели используются экспериментально полученные зависимости. В частности коэффициент демпфирования определяется по осциллограмме затухания колебаний рабочего органа.

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

2.2 Анализ переходных процессов в манипуляторе МРЛ-901П

Источниками возникновения переходных процессов в манипуляторе МРЛ-901П являются: зубчатая ременная передача линейного модуля манипулятора и его свободная консоль.

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

Анализ результатов показывает, что натяжение зубчатого ремня существенным образом влияет на коэффициенты демпфирования модуля линейного перемещения: так при увеличении начального натяжения ремня от минимального значения  = 0,03778 до максимального  = 0,00667 (в исследуемых приделах) коэффициент демпфирования уменьшается в 3 раза. Таким образом, можно сделать вывод о том, что демпфирование линейного модуля с зубчатой ременной передачей может задаваться и варьироваться в широких пределах, как на этапе конструирования, так и в процессе его эксплуатации.

Анализ результатов исследований показывает, что смещение рабочего органа манипулятора МРЛ-901П вдоль свободной консоли, также как и

увеличение начального натяжения ремня, вызывает уменьшение коэффициентов демпфирования, что существенно (в 2…3 раза) увеличивает время полного затухания собственных колебаний рабочего органа (см. табл. 2.1 и 2.2), и, как следствие снижает реальную производительность.

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

Комплексные исследования демпфирующих свойств манипулятора осуществлялись с целью установления численной зависимости коэффициента демпфирования от величины начального натяжения ремня и смещения рабочего органа вдоль консоли. В качестве функции отклика выбиралась линейная модель. База данных для построения плана экспериментов сведена в табл. 2.

Основные уровни и интервалы варьирования выбирались на основе результатов зондирующих экспериментов, а также исследований жесткости и точносных параметров манипулятора МРЛ-901П.

Матрица планирования и результаты экспериментов сведены в табл. 2.4.

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

Поверхность отклика представлена на рис. 2.2. Выражение (2.34) позволяет получить численное значение коэффициента демпфирования, необходимое для расчета продолжительности переходного процесса при позиционировании.

Экспериментальные исследования времени переходного процесса осуществлялись при помощи комплекта виброизмерительной аппаратуры АВ-44, вибродатчик которой крепился на рабочем органе манипулятора.

2.3 Определение жесткости звеньев манипулятора МРЛ-901П

Жесткость звеньев манипулятора МРЛ-901П определялась по экспериментальным замерам деформации консоли манипулятора при действии на нее определенного усилия.

Результаты исследования жесткости приведены в таблице 2.5. По этим данным были построены график зависимости деформации от смещения рабочего органа (рис. 2.3) и график зависимости деформации от натяжения зубчатого ремня (рис.2.4).

2.4 Исследование быстроходности манипулятора

Быстроходность манипулятора характеризуется временем перемещения рабочего органа в требуемую точку. Теоретические предпосылкиуказывают, что непосредственное влияние на величину этого времени оказывают совместные механические характеристики (СМХ) электроприводов манипулятора.

Иcследование СМХ осуществлялось путем анализа тахограмм движения манипулятора МРЛ-901П, зарегистрированных самописцемН338Д/1.Статистически обработанные результаты экспериментов сведены в таблицу 2.6 и представлены в графическом виде на рис. 2.5.

Анализ экспирементальных данных показывает, что связь силы тяги, а, следовательно, и допустимого ускорения со значением достигнутой скорости существенно нелинейна. Для определения квазиоптимальных режимов движения манипулятора необходимо связать параметры a и V аналитическим выражением.

Представим каждое значение СМХ в виде разности , где  статическая тяговая синхронизирующая сила, а  потери тяговой силы, зависящие от скорости движения манипулятора.

Такая запись СМХ имеет то очевидное приемущество, что для каждого конкретного образца манипулятора указанной модели могут быть введены уточнения формулы путем измерения одного лишь значения .

Следовательно, определение эмпирической формулы CМХ сводится к отысканию зависимости . Воспользовавшись способом отыскания эмпирических формул, приведенным в (7), легко установить, что экспериментальные точки наиболее точно отображают линейную зависиюсть на полулогарифмической функцональной координатной сетке. Из этого следует, что выражение может быть описано логарифмической функцией. Из

Результаты исследований совместной механической характеристики манипулятора МРЛ