VDV-1418 (729267), страница 2
Текст из файла (страница 2)
Низкая вычислительная эффективность уравнений Лагранжа – Эйлера обусловлена в основном тем, что для описания кинематической цепи используются матрицы преобразования однородных координат. Уравнения Ньютона – Эйлера обладают большей вычислительной эффективностью, что связано с их рекуррентной природой. Однако такие рекуррентные уравнения не обладают “аналитичностью”, столь полезной при синтезе управления в пространстве состояний. Для синтеза законов управления желательно иметь в распоряжении замкнутую систему дифференциальных уравнений, точно описывающих динамику движения манипулятора.
В связи с тем что для построения модели динамики переходных процессов и дальнейшего анализа полученных уравнений необходима аналитическая форма, решено использовать для получения уравнений динамики метод Лагранжа – Эйлера.
-
Уравнения динамики манипулятора
Уравнения Лагранжа второго рода для голономной системы с n степенями свободы, которым отвечают обобщенные координаты
(j = 1,2,…,n), имеют вид
где
– функция Лагранжа, разности кинетической Т и потенциальной П энергий системы;
– обобщенные силы управляющих приводов, приведенные к j-ой обобщенной координате: они имеют размерность моментов, если
– угол поворота, или сил, если
– линейное перемещение.
С учетом того, что
и
, перепишем уравнение (1.1) в виде
В последних равенствах через
обозначены внешние обобщенные силы, вызванные весом звеньев и груза, удерживаемого в захватном устройстве. При наличии внешнего воздействия – силы
, приложенной к захватному устройству, в правую часть равенства для
надо добавить член
, характеризующий это воздействие:
Используем выражение (1.2) для вывода уравнений динамики манипулятора. Рассматривая исполнительный механизм манипулятора как систему из n твердых тел, запишем его кинетическую энергию T в виде суммы кинетических энергий звеньев:
В свою очередь величину
определим по формуле [3]
где
– масса звена i;
– скорость некоторой точки звена
, принятой за полюс;
– вектор радиус центра инерции звена в системе осей с ним связанных, начало которой совпадает с полюсом
;
– тензор инерции звена в точке
;
– вектор угловой скорости звена в принятой системе координат.
Выражение (1.5) принимает наиболее простой вид, если за полюс звена принять его центр инерции; величина
будет равна нулю и выражение (1.5) упростится:
Кроме того, в большинстве случаев звенья манипулятора представляют собой твердые тела, обладающие симметрией относительно трех ортогональных осей, проведенных через центр инерции. Напомнив правило разметки осей систем координат, связанных со звеньями, в соответствии с которым одна из осей системы
совпадает с осью звена (вектором
), а две другие образуют с ней правую триаду, получим при помещении точки
в центр инерции
(см. рис. 1.1) оси полученной системы
становятся главными осями инерции и тензор вектора в точке
имеет вид диагональной матрицы
моменты инерции относительно осей в которой определяются выражениями
и для звеньев заданной конфигурации являются известными константами. При отсутствии осевых симметрий тензор инерции звена в точке
характеризуется матрицей
центробежные моменты в которой определяются выражениями
и также являются известными константами.
Определим вектор скорости центра инерции звена i через проекции на оси связанной с ним системы координат как
или через проекции на оси неподвижной системы осей в виде
По аналогии с
введем вектор угловой скорости звена
и запишем равенство (1.6) в развернутой форме для случая, когда звенья манипулятора обладают симметрией относительно главных осей инерции. Для этого подставим выражения
,
,
из (1.7), (1.11), (1.13) в (1.6) и получим
При использовании вектора скорости центра инерции в форме (1.14) выражение
с учетом которого равенство (1.4) принимает вид
-
Построение динамической модели переходных процессов манипулятора МРЛ-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) находим:
Коэффициенты
,
и
определяют податливость звеньев манипулятора по координатам
,
и
соответственно. Выражая податливость звеньев через их жесткость, запишем:
где
,
и
жесткости звеньев по координатам
,
и
соответственно.














