Scientific journal
Fundamental research
ISSN 1812-7339
"Перечень" ВАК
ИФ РИНЦ = 1,749

DERIVATION FLAT THREE-LINKS MECHANISM DYNAMIC EQUATIONS BY USING BASIC FANCTIONS OF GENERALIZED COORDINATES

Zhuravlev E.A. 1 Bagautdinov I.N. 1
1 Volga State University of Technology
1104 KB
Second order Lagrange equations are used for describing dynamics of planar mechanism with rotation joints. Kinetic energy quadratic form coefficients were represented by linear combinations of seven basic functions – trigonometric functions of the generalized coordinates. Coefficients at the basic functions determined from linear systems of equations representing the kinetic energy in seven mechanism configurations with nonzero values of one or two generalized velocities. Links kinetic energy calculation was using the local coordinates of the velocity vectors and recursive matrix transformations. The resulting system of dynamics differential equations is integrated numerically by Runge-Kutta method in software environment MathCAD. Efficiency of the proposed method demonstrated by example of numerical solution the direct dynamic problem for three-links mechanism.
planar multilink mechanism
Lagrange equations
basic functions
direct dynamics problem
1. Belousov I.R. Formirovanie uravnenij dinamiki robotov-manipuljatorov. Preprint IPM RAN no. 45, 2002. 28 р.
2. Bosjakov S.M. Kinematicheskoe i dinamicheskoe modelirovanie mehanicheskih sistem. – Minsk: BGU, 2011. 260 р.
3. Zhuravlev E.A. Ispol’zovanie bazisnyh funkcij dlja opisanija dinamiki manipuljatora // Issledovanija. Tehnologii. Innovacii: sb. statej pod red. V.A. Ivanova. Joshkar-Ola: MarGTU, 2011. рр. 107–110.
4. Kurs teoreticheskoj mehaniki / red. K.S. Kolesnikov. M.: Izd-vo MGTU im. N.Je. Baumana, 2005. 736 р.
5. Walker M.W., Orin D.E., Efficient Dynamic Computer Simulation of Robotic Mechanisms, Trans. ASME, J. Dynamic Systems, Measurement &Control, Vol. 104, 1982, pp. 205–211.

Методам построения уравнений динамики шарнирных многозвенных механизмов, являющихся механической основой манипуляционных систем промышленных роботов, посвящена обширная литература. Одна из основных целей авторов, работающих в этом направлении, – создание наиболее эффективных алгоритмов формирования динамических уравнений для таких механизмов. Сравнительный анализ [1] показывает существенную зависимость эффективности различных подходов от числа N звеньев кинематической цепи механизма и его геометрии; для N = 2−6 вполне приемлемым оказывается использование Лагранжевского описания динамики механизма.

В данной работе дифференциальные уравнения динамики механизма строятся на основе уравнений Лагранжа 2-го рода, в которых для выражения кинетической энергии использован набор линейно независимых тригонометрических функций обобщенных координат [3]. Использование таких функций существенно упрощает алгоритм формирования системы дифференциальных уравнений динамики механизма.

Построение математической модели

Рассматривается движение плоского трехзвенного механизма, шарнирно связанного с неподвижным основанием (рис. 1). Звенья 1, 2, 3 - абсолютно твердые тела, которые перемещаются в горизонтальной плоскости под действием моментов М1, М2, М3 в шарнирных сочленениях О1, О2, О3 (рис. 1). С каждым звеном свяжем локальную систему координат Оkxkyk, ось Оk xk которой проходит через оси сочленений звена, а для конечного звена (k = 3) направляется произвольно (рис. 1); О0x0y0 - неподвижная инерциальная система координат. Известны массы звеньев mk, положения их центров масс Ck, и центральные моменты инерции Ik относительно осей перпендикулярных плоскости движения; считаем эти оси главными осями инерции звеньев.

За обобщенные координаты приняты углы взаимного поворота звеньев q1, q2, q3, отсчитываемые против хода часовой стрелки (рис. 1).

pic_20.wmf

Рис. 1. Расчетная схема механизма

Кинетическая энергия Т механизма складывается из кинетических энергий его звеньев:

gyrav01.wmf (1)

где vk – скорость центра масс k-го звена, а

gyrav02.wmf (2)

‒ угловая скорость k-го звена в неподвижной системе отсчета О0 x0y0.

Кинетическая энергия рассматриваемой механической системы является положительно определенной квадратичной формой обобщенных скоростей, коэффициенты которой зависят от обобщенных координат [4]:

gyrav03.wmf

gyrav04.wmf (3)

Чтобы исследовать структуру выражений aij(q), представим скорости vk центров масс звеньев в виде рекурсивных соотношений:

gyrav05.wmf (k = 1, 2, 3);

gyrav06.wmf gyrav07.wmf (m = 1, 2), (4)

где gyrav08.wmf – радиус-векторы центров масс звеньев; gyrav09.wmf – радиус-векторы центров шарнирных сочленений звеньев; um – скорости центров сочленений Оm; ω– вектор угловой скорости k-го звена.

При использовании плоских систем координат Оkxkyk и двухкомпонентных векторов удобно представить (4) в матричной форме

gyrav10.wmf (k = 1, 2, 3);

gyrav11.wmf

gyrav12.wmf (m = 1, 2). (5)

Здесь координаты векторов скоростей vk и um представлены в локальных системах координат Оkxkyk и Оmxmym соответственно; gyrav13.wmf – матрица преобразования координат вектора из системы Оk−1xk−1yk−1 в Оkxkyk ; gyrav14.wmf – кососимметричная матрица угловой скорости k-го звена; gyrav15.wmf gyrav16.wmf Последовательно применяя (5), получаем:

gyrav17.wmf gyrav18.wmf

gyrav19.wmf

или в покомпонентной записи

gyrav20.wmf

gyrav21.wmf

gyrav22.wmf (6)

Используя (6), находим выражения для квадратов скоростей центров масс звеньев:

gyrav23.wmf gyrav24.wmf

gyrav25.wmf (7)

Равенства (7) (2) и (1) позволяют установить, что в выражении (3) для кинетической энергии механизма коэффициенты аij(q) при обобщенных скоростях могут содержать линейные комбинации только следующих семи линейно независимых функций обобщенных координат

α1 = 1, α2(q2) = cos q2; a3(q2) = sin q2;

α4(q3) = cos q3; α5(q3) = sin q3;

α6(q2, q3) = cos (q2 + q3);

α7(q2, q3) = sin (q2 + q3), (8)

которые назовем базисными функциями, т.е.:

gyrav26.wmf

(i, j = 1, 2, 3). (9)

Чтобы найти постоянные gyrav27.wmf в (9), воспользуемся приемом, предложенным в работе [5] для вычисления элементов матрицы инерции системы сочлененных тел.

Обозначим Tij(q) величину кинетической энергии механической системы, находящейся в произвольной заданной конфигурации q = (q1, q2, q3) и имеющей обобщенные скорости gyrav28.wmf gyrav29.wmf (k ≠ i, j). Значения Tij(q) нетрудно вычислить с помощью полученных ранее соотношений (1), (2) и (6). После этого числовые значения всех коэффициентов aij(q) можно последовательно найти, используя равенства

gyrav30.wmf gyrav31.wmf

gyrav32.wmf

gyrav33.wmf

gyrav34.wmf

gyrav35.wmf

следующие из (3).

Пусть найдены значения aij(q) для семи различных конфигураций рассматриваемой механической системы, тогда постоянные gyrav36.wmf (s = 1, …, 7) в разложении (9) можно найти, решая систему линейных алгебраических уравнений

gyrav37.wmf (l = 1, …, 7)

с ненулевым определителем

gyrav38.wmf,

где q1, ..., q7 – различные конфигурации манипулятора. Чтобы отыскать все gyrav39.wmf, учитывая симметрию коэффициентов aij(q), достаточно сформировать и решить 6 таких систем.

Для описания динамики механизма воспользуемся уравнениями Лагранжа 2-го рода:

gyrav40.wmf (i = 1, 2, 3), (10)

где Qi = M– обобщенные силы, равные моментам, действующим в сочленениях.

Вычисляем производные, входящие в левые части уравнений (8):

gyrav41.wmf

или, учитывая (9) и (8):

gyrav42.wmf (11)

где

gyrav43.wmf gyrav44.wmf

gyrav45.wmf gyrav46.wmf

С учетом (11) дифференциальные уравнения (9) принимают вид:

gyrav47.wmf (i = 1, 2, 3). (12)

Система трех обыкновенных дифференциальных уравнений 6-го порядка (12) с начальными условиями

gyrav48.wmf gyrav49.wmf (i = 1, 2, 3) (13)

является математической моделью, описывающей динамическое поведение плоского шарнирного трехзвенника при заданных моментах gyrav50.wmf в сочленениях.

Численная реализация модели

Для интегрирования полученной системы дифференциальных уравнений была использована явная конечно-разностная схема Рунге ‒ Кутты 4-го порядка с постоянным временным шагом. Размер шага интегрирования выбирался в ходе численных экспериментов. Дифференциальные уравнения динамики манипулятора (13) не являются разрешенными относительно вторых производных, поэтому на каждом временном шаге значения обобщенных ускорений gyrav51.wmf, gyrav52.wmf, gyrav53.wmf находились в результате решения линейной системы

gyrav54.wmf

где gyrav55.wmf – матрица инерции механизма; B – вектор правых частей уравнений (12).

В приводимом ниже примере расчета использовались следующие значения геометрических и инерционных параметров звеньев механизма: m1 = 10 кг, m2 = 10 кг, m3 = 8 кг; Lk = 1 м; gyrav56.wmf gyrav57.wmf gyrav58.wmf (k = 1, 2, 3).

Момент M1, действующий в сочленении O1, задавался в виде

gyrav59.wmf (13)

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

Для моментов, действующих в сочленениях O2 и O3, принималось соответственно:

gyrav60.wmf

gyrav61.wmf (14)

где с = 10 Н∙м/рад; m = 20 Н∙м/рад∙с−1.

Первые слагаемые в выражениях (14) соответствуют моментам упругой реакции сочленений, препятствующей взаимному повороту звеньев, зафиксированных в положениях q2 = q20, q3 = q30. Вторые слагаемые в (14) соответствуют моментам сил сопротивления пропорциональным угловым скоростям взаимного поворота звеньев.

Начальные значения обобщенных координат и скоростей механизма:

gyrav62.wmf gyrav63.wmf

(i = 1, 2, 3). (15)

На рис. 2 представлены результаты численного интегрирования уравнений (11) при начальных условиях (15) и обобщенных силах (13), (14).

pic_21.tif

Рис. 2. Изменение обобщенных координат трехзвенника: q1(t), q2(t), q3(t)

Кривые на рис. 2 изображают происходящие со временем изменения обобщенных координат q1, q2, q3 соответственно. Поведение механизма соответствует ожидаемому повороту на конечный угол. Наблюдаемое затухание колебаний обусловлено диссипативными моментами (14), действующими в сочленениях О2 и О3.

На компьютере с процессором Intel, имеющем рабочую частоту 2,8 ГГц при временном шаге интегрирования Δt = 0,02 с, расчет движения механизма продолжительностью 12 с в среде Mathcad 7.0 занимает около 1 с машинного времени.

Заключение

Предложенный способ формирования дифференциальных уравнений динамики плоского шарнирного многозвенного механизма позволяет избежать вывода громоздких символьных выражений [2] для вычисления элементов матрицы инерции, а также центробежных и гироскопических членов. В то же время в ходе численного интегрирования уравнений динамики расчет текущих значений всех членов и коэффициентов уравнений на каждом временном шаге выполняется по явно заданным конечным формулам без использования рекурсивных алгоритмов [5]. Представляется перспективным использование данного подхода для описания динамики плоских шарнирных механизмов с числом звеньев N > 3.

Работа выполнена в рамках задания № 2014/217 на выполнение государственных работ в сфере научной деятельности в рамках базовой части государственного задания Минобрнауки России.

Рецензенты:

Полянин И.А., д.т.н., профессор кафедры транспортных и технологических машин, ФГБОУ ВПО «Поволжский государственный технологический университет», г. Йошкар-Ола;

Сидыганов Ю.Н., д.т.н., профессор кафедры эксплуатации машин и оборудования, ФГБОУ ВПО «Поволжский государственный технологический университет», г. Йошкар-Ола.

Работа поступила в редакцию 15.05.2014.