Научный журнал
Фундаментальные исследования
ISSN 1812-7339
"Перечень" ВАК
ИФ РИНЦ = 1,749

ПОСТРОЕНИЕ УРАВНЕНИЙ ДИНАМИКИ ПЛОСКОГО ТРЕХЗВЕННИКА С ИСПОЛЬЗОВАНИЕМ БАЗИСНЫХ ФУНКЦИЙ ОБОБЩЕННЫХ КООРДИНАТ

Журавлев Е.А. 1 Багаутдинов И.Н. 1
1 ФГБОУ ВПО «Поволжский государственный технологический университет»
Для описания динамики плоского шарнирного механизма использованы уравнения Лагранжа второго рода. Коэффициенты квадратичной формы, выражающей кинетическую энергию, представляются в виде линейных комбинаций семи независимых тригонометрических функций обобщенных координат – базисных функций. Постоянные коэффициенты при этих функциях находятся из систем линейных уравнений, представляющих кинетическую энергию механизма в семи его конфигурациях при ненулевых значениях одной или двух из обобщенных скоростей. Для вычисления кинетической энергии звеньев используются локальные координаты векторов скорости и рекурсивные матричные преобразования. Полученная система дифференциальных уравнений динамики интегрируется численно методом Рунге ‒ Кутты в среде Mathcad. Эффективность предложенного способа формирования и решения динамических уравнений демонстрируется на примере решения прямой задачи динамики трехзвенного механизма.
плоский многозвенный механизм
уравнения Лагранжа
базисные функции
прямая задача динамики
1. Белоусов И.Р. Формирование уравнений динамики роботов-манипуляторов. Препринт ИПМ РАН № 45, 2002. – 28 с.
2. Босяков С. М. Кинематическое и динамическое моделирование механических систем. – Минск: БГУ, 2011. – 260 с.
3. Журавлев Е.А. Использование базисных функций для описания динамики манипулятора // Исследования. Технологии. Инновации: сб. статей; под ред. В.А. Иванова. – Йошкар-Ола: МарГТУ, 2011. – С. 107–110.
4. Курс теоретической механики / под ред. К.С. Колесников. – М.: Изд-во МГТУ им. Н.Э. Баумана, 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. – Р. 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.


Библиографическая ссылка

Журавлев Е.А., Багаутдинов И.Н. ПОСТРОЕНИЕ УРАВНЕНИЙ ДИНАМИКИ ПЛОСКОГО ТРЕХЗВЕННИКА С ИСПОЛЬЗОВАНИЕМ БАЗИСНЫХ ФУНКЦИЙ ОБОБЩЕННЫХ КООРДИНАТ // Фундаментальные исследования. – 2014. – № 8-1. – С. 32-36;
URL: https://fundamental-research.ru/ru/article/view?id=34502 (дата обращения: 16.10.2021).

Предлагаем вашему вниманию журналы, издающиеся в издательстве «Академия Естествознания»
(Высокий импакт-фактор РИНЦ, тематика журналов охватывает все научные направления)

«Фундаментальные исследования» список ВАК ИФ РИНЦ = 1.074