УДК 531.3
Вестник СПбГУ. Сер. 1. Т. 1 (59). 2014. Вып. 1
СТАБИЛИЗАЦИЯ ПОЛОЖЕНИЯ РАВНОВЕСИЯ МАТЕРИАЛЬНОЙ ТОЧКИ НА ТРЕХ КРИВОШИПНО-ШАТУННЫХ ОПОРАХ
С. М. Зуев
Санкт-Петербургский государственный университет,
Российская Федерация, 199034, Санкт-Петербург, Университетская наб., 7/9
Рассматривается механическая система, состоящая из тяжелой материальной точки, опирающейся на три невесомых кривошипно-шатунных опоры. Кривошипы приводятся в действие сервоприводами. Для данной системы, имеющей три степени свободы, решена задача кинематики, при которой по заданным координатам материальной точки находятся углы поворота кривошипов относительно осей сервоприводов. Для решения задачи динамики рассматривается механическая система с эквивалентными силами. В новой эквивалентной системе материальная точка опирается на три невесомых стержня переменной длины. Для этой системы решены задачи кинематики и составлены уравнения Лагранжа второго рода. Решаются прямая и обратная задачи динамики. Анализируется положение равновесия. Для его стабилизации вводится управление с обратной связью таким образом, чтобы линеаризованная система уравнений Лагранжа второго рода распались на три независимые системы относительно каждой из трех обобщенных координат. По теореме Ляпунова получены параметры обратной связи, обеспечивающие асимптотическую устойчивость положения равновесия. Приведены результаты численного расчета. Библиогр. 7 назв. Ил. 4.
Ключевые слова: кривошипно-шатунный механизм, уравнения Лагранжа, теорема Ляпунова об устойчивости по первому приближению, эквивалентная система сил.
1. Введение. Кривошипно-шатунный механизм часто используется в качестве опоры для платформы Стюарта [1]. Исследуемая механическая система является разновидностью параллельного манипулятора и широко применяется в машиностроении. В станкостроении платформа применяется для создания универсальных материало-обрабатывающих центров, 3Б-принтеров, погрузочных манипуляторов, летательных и автомобильных испытательных стендов и тренажеров. Различные модификации механизма Стюарта применяются для позиционирования активных поверхностей зеркал радиотелескопов [2]. Пространственная рама Тейлора, используемая в ортопедической хирургии для коррекции деформации костей и для лечения сложных переломов, также построена на базе платформы Стюарта. Много научных работ посвящено кинематике и динамике механизмов. В статье [3] изучается динамика платформы с общим видом уравнений связей. В работе [4] выведены уравнения всех поверхностей для множества достижимых положений платформы. Работа [5] представляет решение прямой и обратной задач кинематики; в ней изучена динамика платформы с учетом трения в шарнирах, а также рассмотрена модель с учетом динамического воздействия штоков. В монографии [6] движение платформы описывается с использованием специальной формы уравнений динамики систем твердых тел.
Следует заметить,что при исследовании платформы на кривошипно-шатунных опорах возникают трудности аналитической записи уравнений кинематики и, как следствие, уравнений динамики. В данной статье рассматривается упрощенная конструкция, в которой платформа сводится к материальной точке. При этом для позиционирования материальной точки достаточно применить три опоры. Рассматривается решение прямой и обратной задач динамики и описывается решение задачи устойчивости положения равновесия.
2. Постановка задачи. Рассмотрим материальную точку В, к которой с помощью сферических шарниров присоединены три шатуна ВО 1, ВО2, ВОз (см. рис. 1).
Рис. 1. Общая схема механизма.
Каждый шатун соединяется со своим кривошипом в точках О±, О2, Оз также с помощью сферических шарниров. Каждый кривошип в свою очередь насажен на ось шагового электродвигателя в точках А1,А2 , А3, которые являются вершинами правильного треугольника, вокруг которого можно описать окружность радиуса Я. Введем декартову систему координат О'хуг с началом в центре вышеуказанного треугольника. Ось О'г пусть направлена перпендикулярно плоскости А1А2Аз, оси О'х и О'у лежат в плоскости А1А2 А3, как показано на рис. 1.
Пусть длины всех кривошипов равны ё (А1О1 = А2О2 = А3О3 = в), а длины каждого шатуна равны I (ВО1 = ВО2 = ВО3 = I). Пусть материальная точка имеет массу т, все узлы кривошипно-шатунных опор веса не имеют. Решим прямую и обратную задачи кинематики и динамики этой механической системы, после чего исследуем положение равновесия на устойчивость.
3. Прямая и обратная задачи кинематики и динамики. Рассматриваемая механическая система имеет три степени свободы. Пусть материальная точка В имеет координаты (хь,уь,гь). Введем обозначения углов наклона кривошипов аг = АО'АгОг, г = 1, 2, 3. Под решением задачи кинематики будем понимать вычисление углов аг по заданным координатам (хь,уь,гь). Запишем координаты точек Аг и О г:
(п п \ / п п \
Дсо8-,-Дзт-,0) , Ао = (- Дсоэ -, - Дет —, 0 ) , А3 = (О, Я, 0), 6 6 / V 6 6 /
(п п \
(Я — с1 соэ а) соэ —, — (Я — с1 соэ а) эт —, 0 ) , 6 6 /
(п п \
— (Я — с1со$а) соэ — ,—(Я — с1со$а) 3111 —, 0 ) , = (0, Я, 0). 66
(1)
Запишем уравнения, означающие, что расстояния между точками Ог и точкой В
постоянны и равны 1:
(xd - Xb)2 + (yd - yb)2 + (zd - Zb)2 = I2, i = 1, 2, 3. (2)
Здесь xd, yd, zd — координаты точек Di, указанные в (1).
Решив эти уравнения, сможем записать зависимости а = ai(xb,уь,Zb). Задача легко решается аналитически с помощью пакета программ Maple, но решение получается слишком громоздким для данной статьи. Отметим, что в общем случае имеются два решения.
Выберем в качестве обобщенных координаты Xb,yb,Zb и перейдем к решению задач динамики. Ввиду сложности выражений а = а (хь,Уь, Zb) запись уравнений Лагранжа второго рода и последующее их интегрирование становятся трудновыполнимыми.
А1
Рис. 2. Общая схема платформы.
Введем в рассмотрение новую механическую систему с невесомыми штоками переменной длины. Штоки соединяют точку В с точками А\, А, Аз с помощью сферических шарниров. На рис. 2 штоки и силы Сх, С2, Сэ, с которыми они действуют на материальную точку, указаны штриховыми линиями. Пусть старая система сил (^1, ^2, Р) и новая (Сх, С2, Сэ, Р) будут эквивалентными. Для этого достаточно, чтобы их главные векторы сил были равны.
Пусть Сг = (С?, СУ, С?), ^ = ^вг, где векторы вг = (аг,Ьг,сг) являются единичными векторами, направленными вдоль шатунов. Координаты векторов вг легко вычислить при заданном положении точки В. Действительно, из (2) можно вычислить координаты точек Юг. Затем задача сводится к записи координат единичных векторов, направленных от точек Юг к точке В. Запишем равенства проекций главных векторов двух систем на оси О'хуг:
Е СХ = ¿) ^ аг, £ СУ = £ ^ Ьг, £ С* = ¿) ^ сг. (3)
г=1 г=1 г=1 г=1 г=1 г=1
Рассмотрим эти три равенства как систему уравнений относительно сил F¿. В результате решения получим
(~с263 + Ь2с3) Сх + (а3с2 - а2с3) + (~а3б2 + «2^3) (-Ь2С1 + с2&1) а3 + ( (1\с*2 + С1а2) Ь3 + (аф^ - 610,2) с3
Р _ (63С1 - 61С3) Сх + (а!С3 - С1а3) Су + (-сцбэ + Мз) ^ (-Ь2С1 + с2&1) а3 + (-Я1С2 + С1а2) Ь3 + (а^ - 610,2) с3 '
Рз =
(~62С1 + С2&1) + (~а!С2 + С1а2) + («162 ~ Мг) Сг (-62С1 + С261) аз + (-Я1С2 + С1Я2) Ьз + (0162 - сз
Здесь С* = £з=1 С*, = £3=1 С?, С2 = £з=1 С*.
Пусть задан закон движения материальной точки. Тогда можно найти закон изменения сил Сх, ^2, Сэ в новой механической системе, обеспечивающий заданное движение. В силу эквивалентности система сил (^1, ^2, Fэ, Р) будет также обеспечивать движение материальной точки по заданному закону.
Исследуем динамику новой механической системы со штоками переменной длины. Длины штоков определяются по формулам
и = у/(хь - 4)2 + (уь - У1У + (гъ - 4)2, ¿ = 1,2,3, (5)
где хга,уга, гга — координаты точек A¿. Пусть в качестве обобщенных координат будут выступать также координаты точки В: = хъ,д2 = Уъ,Чз = ¿Ъ Составим уравнения Лагранжа второго рода:
(I ГдТ\ дТ _ ^ . _ 1 2 з А \dqij %
где Т — кинетическая энергия системы, ^ — обобщенные силы. Пусть материальная точка В имеет массу т, штоки предполагаем невесомыми. Тогда кинетическая энергия системы будет иметь вид
з
т
» = 1,2,3. (7)
¿=1
Систему (6) перепишем в виде
тщ = (¿, г = 1, 2, 3. (8)
Для составления выражений обобщенных сил Q¿ напишем силы в проекциях на оси О'хуг. На точку В действует сила тяжести Р = (0, 0, —тд) и три силы, Сх, С2, Сэ, направленные вдоль штоков
= (9)
п
где гь и тга — радиус-векторы точек В и A¿.
Составим выражение элементарной работы на возможном перемещении системы:
з
¿А = —тдбдз + ]Т(С* ¿91 + СУ ¿92 + С\ ¿щ), (10)
¿=1
где ОХ, ОУ, О* —проекции сил на оси О'хуг. Теперь можно записать обобщенные силы, которые равны получившимся коэффициентам при независимых вариациях обобщенных координат :
3 3
-yz
Q1 = Е G, Q2 = Е G' Q3 = -mg + Y, GZ. (11)
k=1 k=1 k=1
Воспользуемся выражениями (9) и запишем обобщенные силы подробно:
Gi (qri + 1/2 Дл/З)
= —i „ =+
1 4
у/ (qi + 1/2 Д^З)2 + (42 + 1/2 R)2 + .
G*2 (<?i — 1/2 Да/3) G3gi
^(«7! - 1/2 Да/3)2 + («72 + 1/2 д)2 + ^ql + (q2-Rf+qi
п _gj (*?2 + 1/2 Д)_
^ (</! + 1/2 Д V3)2 + ((/2 + 1/2 Д)2 + <?з2 | <?2 (<?2 + 1/2 Д) | G3(q2-R)
^ - 1/2 Да/3)2 + («й + 1/2 Д)2 + ©2 Л/<712+<722 - 2<ЙД + Д2+(й2'
Q3 = —mg + + yJ(qi + í/2RVTí) + (</2 + 1/2 Д)2 + </з2 __С*2<7з__6*3(73
у/(Я1 - 1/2 Д^З)2 + (я2 + 1/2 Д)2 + <7з2 Л/<712 + ®2 -2(72Д + Д2+(?з2
Подставив (12) в (8), окончательно составим уравнения Лагранжа второго рода.
Перейдем к решению прямой и обратной задач динамики. Обобщенные координаты могут быть заданы как функции от времени qi = qi (£). В этом случае, решая систему (8), мы можем найти аналитически зависимость управляющих сил от времени: Gi = Gi (£). Наоборот, при заданном законе изменения управляющих сил как функций времени можно, решив систему дифференциальных уравнений (8), найти закон движения материальной точки Б.
Приведем пример расчета. Заставим колебаться материальную точку по оси О'г. Пусть R =1 (м), т =200 (кг), ql =0, q2 =0, q3 = 2+ 1/10БтРазрешив систему (8) относительно Оi, получим зависимости Gi (£):
_ то^ЮОД2 +400 + 40 sint + sin2 t (sint - 10 g) i = 12 3
i ~ ~ ' 20 +sint '
С помощью (4) можно найти силы, c которыми должны действовать шатуны из первой механической системы для осуществления заданного движения материальной точки. По найденным G¿ (t) можно вычислить траекторию движения материальной точки. Эта задача сводится к численному решению системы дифференциальных уравнений (8).
4. Стабилизация положения равновесия. Рассмотрим подробнее положение равновесия 93 = Н, 91 = 92 = 0. Из уравнений (8) найдем силы, обеспечивающие заданное положение:
О*
т ду/Ш+М
3Н
(13)
Для исследования поведения системы в окрестности положения равновесия введем малые приращения координат Дц^ и дополнительные малые управляющие силы ДО,: 91 = Д91, 92 = Д92, 9з = Н + Дцз, О, = О* + ДО,. Введем также безразмерные
ДО,
-. Тогда из уравнений Лагранжа (8) получим уравнения
управляющие силы и, первого приближения
Здесь
( Д91
Д92 \ Н + Д93,
О*
д = Ид + Оп.
(14)
И
(д{К2+2Ь2) 2к{П2 + Ъ?)
0 0
0
д(И2 + 2Ь?) 21г(Н2 + к2)
0
0 0
дЯ2
Н(Я2 + Н2)
/ л/здз а/ЗДз
и1 и2
\и3,
О
\
V
6Н
Дз 6/1
9 3
6Н
Дз 6/1
3
Нд
3/1 £
3
/
Если положить в системе (14) и1 = и2 = из = 0, то получим систему <7 = Ид, для которой из вида матрицы И очевидно, что колебания по обобщенным координатам «развязываются», и тривиальное решение будет экспоненциально неустойчивым.
Для обеспечения устойчивости необходимо ввести дополнительное управляющее воздействие. Запишем систему (14) в форме Коши:
^ = Ах + Вп, х = (щ, 91, 92, 92, 9з, 9з) Управление будем строить в виде обратных связей:
п = Кг.
(15)
(16)
Здесь К — постоянная матрица размера 3 х 6, подлежащая определению. Будем выбирать коэффициенты матрицы обратной связи таким образом, чтобы система разбилась на три независимые подсистемы, каждую из которых исследуем на устойчивость. Подставив (17) в (15), получим замкнутую систему
г = АХ + ВКг = (А + ВК) г = Сх.
(17)
д
0
п
Здесь матрица С имеет вид
0 1 0 0 0 0
С1 1 С1 2 С1 з С1 4 С1 5 С1 6
0 0 0 1 0 0
С2 1 С2 2 С2 з С2 4 С2 5 С2 ,6
0 0 0 0 0 1
Сз 1 Сз 2 Сз з Сз 4 Сз 5 Сз 6
С
Чтобы получить три независимые подсистемы, матрица С должна иметь блочно-( с 1 о о \
диагональный вид С = о с2 о , где С 1,С2, Сз — матрицы размерности 2 х 2.
V о о с з /
Для этого достаточно приравнять нулю следующие коэффициенты:
С1,з = С1,4 = С1,5 = С1,6 = 0,
С2,1 = С2,2 = С2,5 = С2,6 = 0, Сз,1 = Сз,2 = Сз,з = Сз ,4 = 0.
(18)
Рассмотрим систему (18) как систему 12 алгебраических уравнений относительно 18 неизвестных —искомых коэффициентов матрицы К. Возьмем в качестве независимых 6 коэффициентов ] = 1,6; остальные выразим через них с помощью системы (18). Таким образом, система к = Ск расщепляется на три подсистемы. Запишем их характеристические уравнения:
det (С— ЕЛ) =0, Л2 + + ^
0,
1, 2, 3,
(19)
где ¿н, — получившиеся коэффициенты при Л и
Л2
соответственно. Для устойчивости тривиального решения системы необходимо и достаточно, чтобы действительные части корней характеристических уравнений были бы отрицательными [7]. Так будет, если все коэффициенты характеристических уравнений (19) будут одного знака.
Следовательно, для устойчивости требуется положительность всех коэффициентов ¿2^, что позволит получить следующие ограничения на коэффициенты >3 = 1,6, обеспечивающие асимптотическую устойчивость тривиального решения системы (14) и (8):
к1,1 < -
л/3 Д2 + 2Ь?
Тд(д2 + ъ?у
к1 4 < 0, &1 5 < —
, 2 < 0, , 3 < — R2
у/1 Д2 + 2Ь?
К^2 + К2)'
2 R(R2 + К2)' к1 ,6 < 0.
(20)
Приведем пример. Пусть R = 1 (м), К = 2 (м), т =200 (кг) и приложены управляющие силы Gi = О*. Возмутим тривиальное решение, положив qз = К + 0.1, ql = q2 =0 при 4 = 0. На рис. 3 показан результат численного решения дифференциального уравнения (8) для qз(t).
Теперь введем обратную связь и так, чтобы Gi = О* + О*и^ При этом должны удовлетворяться условия (20): = —10, г = 1,6.
После численного интегрирования уравнений (8) получим график зависимости qз(t), показывающий асимптотическую устойчивость тривиального решения (см. рис. 4).
Таким образом, был изучен вопрос об устойчивости положения равновесия новой механической системы с тремя штоками переменной длины. Для исходной механической системы с кривошипно-шатунными опорами значения сил с обратными связями, обеспечивающими ассимптотическую устойчивость, можно найти по формулам (4), где С = С* + в^щ.
Заметим, что в случае, если имеем дело с платформой, а не с материальной точкой, решение с заменой на эквивалентную систему усложняется. Если будем, анало-
гично предыдущему, рассматривать систему со штоками, то подобрать силы в штоках эквивалентными кривошипно-шатунному механизму не удастся. Это связано с тем, что необходимо иметь одинаковый главный вектор сил и вместе с этим одинаковый главный момент, в то время как точки приложения сил остаются неизменными.
Литература
1. Stewart D. A platform with six degrees of freedom // Proceedings of the Institution of Mechanical Engineers. London, 1965. Vol. 180. N 15. P. 371-385.
2. Александров В. В., Локшин Б. Я., Л. Гомес Е. Л., Салазар И. Х. Стабилизация управляемой платформы при наличии ветровых возмущений // Фундамент. и прикл. матем. 2005. Т. 11. Вып. 7. C. 97-115.
3. Ершов Б. А., Трифоненко Б. В. Движение твердого тела при действии управляющих связей // Вестн. Ленингр. ун-та. 1985. №8. С. 52-56.
4. Adkins F.A., Haug E.J. Operational envelope of a spatial Stewart platform // Trans. ASME. J. Mech. Des. 1997. Vol.31. N368. P.330-332.
5. Harib K., Srinivasan K. Kinematic and dynamic analysis of Stewart platform-based machine tool structures // Robotica. Vol.21. N05. 2003. P. 541-554.
6. Зегжда С. А., Солтаханов Ш. Х., Юшков М. П. Уравнения движения неголономных систем и вариационные принципы механики. СПб.: Изд-во С.-Петерб. ун-та, 2002. 276 с.
7. Меркин Д. Р. Введение в теорию устойчивости движения. М.: Наука, 1976. 320 с.
Статья поступила в редакцию 24 октября 2013 г.
Сведения об авторе: Зуев Сергей Михайлович —аспирант; [email protected]
EQUILIBRIUM STATE STABILISATION OF MATERIAL POINT ON THREE CRANK-AND-RODS SUPPORTS
Sergei M. Zuev
St.Petersburg State University, Universitetskaya nab., 7/9, St. Petersburg, 199034, Russian Federation; sergeiy@pochtamt. ru
Mechanical system consisting of a heavy-weight material point, which is based on the three weightless crank-connecting rod bearing is considered. Cranks are driven by servo motors. For this system with three degrees of freedom, has solved the kinematics task, which given the coordinates of a material point with help of the cranks rotation angles relative to the axis servo drives. To solve the dynamics problem the mechanical system with equivalent forces is considered. In the new equivalent system material point is based on three weightless rods with variable lengths. For this system kinematics problems is solved and the Lagrangian equation of the second kind is derived. Direct and inverse dynamics problems are resolved. The state of equilibrium is considered. The linearized system of the second kind Lagrange equations is split into three independent equations with respect to each of all generalized coordinates. By the Lyapunov theorem received feedback parameters, providing the asymptotic stability of the equilibrium position. The calculation results are presented. Refs 7. Figs 4.
Keywords: crank mechanism, the Lagrange equations, Lyapunov's theorem on stability in the first approximation, equivalent system of forces.