Управление в технических системах
УДК 531.3 DOI: 10.14529/^сг160403
ВЕКТОРНЫЙ И СКАЛЯРНЫЙ ВИДЫ УРАВНЕНИЙ
ДЛЯ РЕШЕНИЯ ЗАДАЧ ДИНАМИКИ ПЛАТФОРМЫ СТЮАРТА
И.В. Войнов, А.И. Телегин, Д.Н. Тимофеев
Южно-Уральский государственный университет, филиал в г. Миассе
Рассмотрена платформа Стюарта на неподвижном корпусе, состоящая из корпуса, жестко связанного с землей, платформы и шести одинаковых устройств подвеса платформы к корпусу. Каждое устройство подвеса состоит из трех тел: основания, направляющей и штанги. Вывод уравнений динамики и формул вычисления динамических реакций подвеса рассмотрен в ранних статьях авторов. Здесь эти формулы повторно используются при выводе искомых уравнений платформы Стюарта. В первом утверждении доказана формула разложения на связанные оси направляющих сил динамических реакций в шаровых шарнирах, связывающих платформу с концами штанг. Во втором утверждении доказаны формулы вычисления движущих сил штанг. В третьем утверждении доказаны формулы вычисления динамических реакций в сочленениях подвесов. Все полученные расчетные формулы явно содержат геометрические, кинематические и инерционные параметры подвижных тел, позволяющие решать задачи синтеза этих параметров для достижения желаемых динамических свойств платформы Стюарта. Явный векторный и скалярный виды системы дифференциально-алгебраических уравнений для решения второй задачи динамики подготовлены для их повторного использования в математических моделях платформы Стюарта на подвижном (несущем) корпусе, которые необходимы в исследованиях влияний управляемых движений несомого тела на динамику несущего тела. С целью проверки на отсутствие описок и ошибок в полученных расчетных формулах рассмотрены три примера, в которых анализируются частные случаи движения тел рассматриваемой системы. Для движения платформы на трех подвесах в вертикальной плоскости из доказанных формул, как их частный случай, получены ожидаемые формулы для вычисления движущих сил и очевидные уравнения геометрических связей. Во втором примере из этих формул, как частный случай, получены уравнения динамики двух подвесов, связанных в концах штанг вращательным шарниром, и соответствующие очевидные уравнения геометрических связей. В третьем примере для движения штанг вдоль горизонтальной прямой из уравнений второго примера получено очевидное уравнение, следующее из второго закона Ньютона.
Ключевые слова: задачи динамики, платформа Стюарта, движущие силы, динамические реакции.
Введение
Интерес к исследованию кинематики, статики и динамики платформы Стюарта возрос с появлением роботов со «змеевидной» схемой построения, а также летательных аппаратов, в которых за счет управления несомой платформой Стюарта можно осуществлять самобалансировку несущего корпуса, а также управлять его ориентацией. Следует отметить, что в известных нам научных публикациях отсутствуют математические модели платформы Стюарта, записанные в аналитическом виде с явно выраженными обобщенными координатами, геометрическими и инерционными параметрами всех тел. Это связано с проблемами аналитического вывода уравнений динамики (УД) систем трех и более тел известными классическими методами (Лагранжа, Аппеля, Гамильтона и других) из-за громоздкости необходимых аналитических вычислений и преобразований. Новые формализмы вывода УД систем твердых тел (СТТ) [1] и выписывания формул вычисления динамических реакций в их подвижных сочленениях позволяют преодолеть указанное препятствие. Например, в статье [2] выведены УД и получены формулы вычисления динамических реакций в сочленениях цепочки трех тел со сферической системой координат. В рассматри-
ваемой платформе Стюарта шесть таких цепочек тел выполняют функцию управляемого подвеса платформы к неподвижному корпусу. Полученные в статье [2] расчетные формулы здесь используются в искомых решениях первой задачи динамики и в уравнениях второй задачи динамики платформы Стюарта, которая моделируется системой девятнадцати подвижных тел.
1. Используемые определения и обозначения
Исследуемая СТТ состоит из корпуса, жестко связанного с землей, платформы и шести одинаковых устройств подвеса платформы к корпусу. Каждое устройство подвеса (рис. 1) состоит из трех тел: основания, направляющей и штанги. Корпус и i-е основание (/' = 1, 2, ..., 6) образуют вращательную кинематическую пару, ось которой неподвижна относительно корпуса (рис. 2). Основание и направляющая образуют вращательную кинематическую пару, ось которой поворачивается вместе с основанием и перпендикулярна оси предшествующей пары. Направляющая и штанга образуют поступательную кинематическую пару. Конец каждой штанги образует шаровой шарнир с платформой. С телами СТТ жестко связаны правые ортогональные системы координат (СК).
Рис. 1. Кинематическая и расчётная схемы СТТ
Рис. 2. 3D-модель платформы Стюарта (случай N = 6)
Введем обозначения для тел подвеса и их СК: Orxryrzr - абсолютная СК (АСК), жестко связанная с неподвижным корпусом; Ooix0{y0iz0i - СК, жестко связанная с i-м основанием; At, B¡, D¿ -координаты точки 00i в АСК; Onixniynizni - СК, жестко связанная с i-й направляющей, и °oí = °ní; °sixsiysizsi - СК, жестко связанная с i-й штангой, и xsi = xni, ysi = -z„¿, zsi = y„¿, 0si = Csi, где Csi - центр масс (ЦМ) i-й штанги; qoi - угол поворота i-го основания вокруг оси 0oizoi, откладываемый от оси 0гхг до оси 0oixoi; qni - угол поворота i-й направляющей и штанги вокруг оси 0nizni, откладываемый от оси 0oixoi до оси 0nixni; qsi =0niCsi - расстояние от точки 0oi =0ni до ЦМ i-й штанги Cs¿; 0ri - центр шарового шарнира, связывающего платформу с i-й штангой; L¿ = 0ni0ri - управляемая длина i-й штанги; ms - масса штанги; тп - масса направляющей; т0 - масса основания; а„ - расстояние от точки 0ni до ЦМ направляющей; - момент инерции основания относительно оси 0oizoi; Jn - моменты инерции i-й направляющей относительно осей 0nixni, 0niyni; J£, - моменты инерции i-й штанги относительно осей 0síxsi, 0sizsi; Fs¿ - сила, действующая на i-ю штангу со стороны i-й направляющей; F¿ = zsi • Fs¿ = yni • Fs¿ -движущая сила i-й штанги, развиваемая приводом штанги относительно i-й направляющей; M„¿ -момент силы относительно точки 0ni, действующей на i-ю направляющую со стороны i-го основания; M0¿ - момент силы относительно точки 0oi, действующей на i-е основание со стороны корпуса; Moi = zoi • M0¿ - момент силы относительно оси 0oizoi; Mni = zni • M„¿ - момент силы относительно оси 0nízni. Заметим, что i-е основание и направляющая не имеют приводов, т. е. Moi = 0 и Mni = 0.
Для платформы введем следующие обозначения: тр - масса; Ср - ЦМ; 1р - центральный тензор инерции; хр, ур, zp - координаты ЦМ в АСК; - абсолютная угловая скорость.
Назовем параметрами платформы Стюарта (I II 1С) следующие величины: положения шарниров - Ai,Bi,Di; состояния и ускорения подвесов - qoi, qoi, qoi, qni, qni, qni, qsi, qsi, qsi; управляемые длины подвесов - L¿; инерционные параметры - тр, Ip, ms, тп, а„, J¡^, J£, , J*,
Для сокращения записей введем следующие обозначения тригонометрических функций углов поворота основания и направляющей /-го подвеса:
s0¿ = c0¿ = cos(qoi), st = sin(qn{)9 ct = шs(qni).
2. Формулы вычисления динамических реакций и движущих сил штанг
С целью максимального обобщения рассуждений будем считать, что количество подвесов платформы к корпусу не фиксировано. Обозначим это количество через N. В примерах рассматриваются случаи N = 2, 3 (рис. 3, 4).
J- *
Рис. 3. Зй-модель СТТ случай N = 3 Рис. 4. Зй-модель СТТ случай N = 2
Утверждение 1. Реакции в связях платформы с концами штанг выражаются через ППС и движущие силы штанг по формуле
= -WinXni/^i + (Fis - РдУш + Miozni/SiLh (1)
где
Fis = msYni • (d2qSiYni/dt2 - g), (2)
^in = *ni • (Jqisi4oi^ni + Jyci4oiYni + Jqi4ni^ni)t + mqi^ni ' g , (3)
Mio = *oi • (JoRoi^oi + Jqisi4oi^ni + Jyci4oiYni + Jqi4ni^nôt — mqisi^ni ' g , (4)
Jqi =J£ +7sx + ™-sq*t,]y = j£ +Js, rnqi = mnan + msqsi. (5)
Доказательство. Для максимального повторного использования результатов статьи [2] мысленно разорвем шаровые шарниры, связывающие штанги с платформой, и заменим эти связи силами реакций. Тогда получим свободную платформу и отдельные подвесы. Подвес с номером i, изображенный на рис. 1, и СТТ статьи [2] полностью совпадают. Следовательно, совпадают их УД, т. е. здесь можно использовать расчетные формулы статьи [2] с учетом следующих переобозначений: Ч± = ЧоЬ 42 = 4ni, Чз = Vsb ™о2 = ™3 = , Я = /£ Уз = Я =J%, Уз = Я, /з = ,/f = /о,Jq = Jqi, s2 = st, c2 = Ci. В дальнейшем для обращения к формуле под номером к в статье под номером j будем использовать ссылку (¡.к).
Пусть - сила реакции, приложенная к концу i-й штанги Ori. Тогда по формуле (2.2) для штанги i-го подвеса получим ¥si + = ¥is, где выражается через ППС по формуле (2.6). Отсюда
Fri = Fis - Fs£. (6)
Выразим FSi через ППС и движущие силы штанг.
По формуле (1.2) для направляющей i-го подвеса получим Mni + L^ х Fr^ = где Min выражается через ППС по формуле (2.10). Отсюда, с учетом равенств (6), zni • Mni =0, L; = Liyni и обозначения f^ = — L^ х F^s получим
^nï • ^nï ^nï • ^t х FSÎ х Yni • FS( — LiYni х zni • Fsj • FSj — zni • fj.
Следовательно, xni • Fs^ — zni • fi/Lt.
Аналогично, по формуле (1.2) для основания i-го подвеса, получим + L^ х Fr^ = , где выражается через ППС по формуле (2.11). Отсюда с учетом (6), zoi • M0É = 0 получим zoi • = zoi • — zoi • L^ х (F^s — ¥si) = 0. Следовательно, с учетом обозначения
foi — — • Mi0 + z0i • Lj х Fis
получим
х • FSÎ = ^¿zot х Yni • FSÎ = Li sin qni zni • FSj = LjSjZnj • FSj = f0i или zni • ¥si = foi/(SiLi).
Таким образом, для проекций вектора Fs^ на оси СК i-й направляющей имеем выражения
Xnï • F5Ï — zni • fi/Li , yni • Fsj — Fi , zni • Fsj f0J(5jLj).
Следовательно, Fs¿ = (zni • f¿/L¿) xni + F¿ yni + (/oí/s¿b¿) zni и с учетом введенных обозначений Для f¿ и foi получим Fs¿ = [zni • (Min - L¿ x Fis)/Li]xni + F¡yni — zoi • (M¿0 - L¿ x ¥is)zni/siLi. Заметим, что -zni • L¿ x Fís = Líyní x zni • Fís = L{xni • Fís, —z0¿ x L¿ • F¿s = —L¿z0¿ x yni • F¿s = —L¿ sin qni zn¿ • F¿s = —L¿s¿zn¿ • F¿s.
Следовательно, Fs¿ = (z„¿ • M¿„/L¿ + xni • Fís) xni + F¿ yni — (zoi • Mio/siLi — zni • Fis)zni. Из тождества (xni • Fis) xni + (yni • Fis)yni + (zni • Fis)zni = Fis получим
fani • f¿S) ^ni + (7,ni • f¿S (Yni • ^is^Yni.
Следовательно,
^sí = f¿s — (Уni • ^is^Yni + FiYni + xni(zrn • ^in/^i) — zn¿(zo¿ • ^ío)/sí^í. С учетом выражений (2.6), (2.10), (2.11) получим
Fis = Уш • fis = msyni • (d2qsiyni/dt2 — g),
^in • Min Zni • (JqiSiqoiXni + JyCiqoiyni + JqiQni^ni^t ^qi^ni • Yni x 8,
Mi0 = zoi • Mi0 = zoi • Min +J*zoi • (qoizoi)'t + mazoi •zoixg =
Z0¿ • СJqi^iRoi^ni + Jy^i4oiYni + JqiRni^nôt ^qi^oi ' Ут x8+/ozo¿ • (4oizo¿)t . Отсюда по формуле (6) получим Fri = Fis — Fsi = —Minxni/Li + (Fis — Ft) yni + Mioïni/siLi, где величины Fís, Min, Mio вычисляются по формулам (2)-(4). Утверждение доказано.
Утверждение 2. Движущие силы Ft,F2, -^,FN штанг подвеса платформы удовлетворяют следующим векторным уравнениям
£f=1(F¿ — Fis)(y*xr + y?yr + yfzr) = Шр(о;ср — g) — I^=1(Minxni — Miozni/si)/Li, (7)
If=i№ — Fis)(yxixr + Уу1Уг + ïzi^r) = (IP • — Mxxr — Myyr — Mzzr, (8)
где
Coí^í , , SoiCi, y¿ CoiSi, yi C¿, y¿ 50¿S¿, (9)
xi=Ai—xp, yi=Bi—yp , zi = Di — zp, (10)
Jxi = y¿yf — z¿c¿, yyi = zty* — X&1, yzi = xici — y%y?, (11)
Mx = YJNi=1[Min(yixzi — ziSi — LiSoi) — Mio(yiCoi + Lix^)/si]/Li, (12)
My = Y!i=i[Min (ZiX* — XiX?) — Mio(Zisoi — Xicoi + Lisi)/si]/Li, (13)
Mz = [Min(xiSi — ytf — LiCoi) — Mi0(LiXf — yisoi)/si]/Li. (14)
Доказательство. Если Fri - сила реакции, приложенная к концу i-й штанги, то в точке Ori
к платформе будет приложена сила «—РГ(». Под действием сил «—РГ(» (I = 1,Ы) платформа движется поступательно относительно АСК и вращается вокруг своего ЦМ согласно известным УД свободного твердого тела
тр(ОгСр — = — £¿^=1 Fri , {¡р • = — СрОг1 х Fri. (15)
Подставим сюда выражение (1) силы реакции Fri. Тогда получим
\Мыхп[/и + ^ - - Ы[0гп[/з[и\ = тр(ОгСр - §), (16)
!Г=1 СрОп х [М1пхп1/Ь1 + - F¿s)y„¿ - М1огп1/з1Ь1] = {¡р • мр)[. (17)
Из разложений (2.23) имеем
^о^^Ху + $1УГ , уп1 + С{уг + S0¿S¿Zr,
Т-т Я01ХГ + C0¿Zr. Отсюда, с использованием обозначений (9), получим
+ ^¿Уг + Ут У( + ^¿Уг + У( ^г, ^т + . (18)
Из (16) и второго равенства выражений (18) получим искомое уравнение (7). Найдем выражения СрОГ1 х хП1, СрОГ1 х у„(, СрОГ1 х гп1. Из описания платформы Стюарта и рис. 1 следует, что мысленно разорванные геометрические связи имеют следующее аналитическое описание
ОгСр + СрОГ1 = 0Г001 + ,
где
ОгСр = хрхг + уруг + гргг, ОгОо1 = А1хг + В1уг + 01гг, ^г = 00[0Г( = y„¿, т. е. с учетом обозначения (10)
СрОг1 А1хг + В(УГ + ^¡Ъу + хрхг УрУг
= ¿гУш + (Л - Хр)хг + (вг - ур)уг + (£>г - гр)гг=Líy„£ + х£хг + угуг + г{гг. (19)
По формулам (18), (19) получим
СрОг1 X ХП1 + (Х£ХГ + У(Уу + ZíLr) X (х£ хг + ^¿уг + х£
х£ уг) + у£(х£ хг X; гг) + 2£(Х£ уг 5(ХГ) ¿¿(5о£хг + c0(Zr) = (Уг*Г - ^ - ¿¿50()хг + - x¿xf)yr + - у£х* - ¿¿с0^гг. Аналогично по формулам (18), (19) получим
СрОГ( х уП1 = (Х(ХГ + У(УГ + х (у*хг + С(УГ + у[^гг) = = х£(с£гг - у;2уг) + У( (у^хг - у?гг) + г^уХуг - с1хг) = = (У(УI - Ъс^Хг + (z¿y[x - x¿yf)yr + (х£с£ - у1у^С)гг. Аналогично
СрОг1 х ЪП1 + (Х(ХГ + У(УГ + х (50(ХГ + С012г)
^¿С0(УГ + У1(С0[ХГ + + Ь£(Х£ Хг + ^¿уг + Х£ 2Г)
= (У1Со1 + )хг + - + МОУг + - У(50()2г. Следовательно,
СрОГ( х [М(„х„(/Ь( + - - М(0г„(/5(Ь(] =
= [М£„(у£х(2 - ад - ¿£5о£)/1£ + - ^(5)(У(У? - г^ - М1о(У1сы + ¿¿х(Х)/5£1£]хг + + [М£„(2£х(х - х£х(2)Д£ + - - х£у(2) - М£о(адо£ - х£со£ + ^¡у^!^ +
+ [М£„(х^ - у£х* - Ь1со1)/Ь1 + (^ - ^(5)(Х£С( - у£у*) - М£о(1£х(2 - у^у^К. Отсюда, с учетом обозначений (11)—(14), получим искомое уравнение (8). Утверждение доказано.
Из двух векторных уравнений (7), (8) следует система шести скалярных линейных алгебраических уравнений относительно шести движущих сил штанг. Для этого достаточно скалярно умножить векторные уравнения (7), (8), например, на орты хг, уг, гг АСК, с учетом очевидных равенств х^ О^ , , О^ ^р.
Рассмотрим один из возможных вариантов вывода выражения (хг • 1р • . Используем для этого следующие обозначения: Срхрурхр - главная центральная СК платформы (СКП); - главный центральный тензор инерции платформы; Ар, Вр, Ср - главные моменты инерции платформы; рр, цр, гр - проекции мр на оси СКП; Хр = хр • хг, хр = хр • уг, Хр = хр • гг - направляющие косинусы (НК) оси Срхр относительно СК Срхгугхг; ур = ур • хг, у^ = ур • уг, у^ = ур • гг - НК оси СрУр относительно СК Срхгуггг; гр = гр • хг, = гр • уг, = гр • гг - НК оси Сргр относительно СК Срхгуггг. Тогда в СКП • = (Аррр, Врцр, Сргр) и
Х^ /р ^^р ^р ^^^ ^р I ^р I Ср ^^^ ?р. Следовательно,
(хг • • Мр). = Лр ХрРр + ВрУр Цр + ^р^'р^р + АрХр^р + #рУрЧр + Аналогично
(Уг • • Архр рр + ВрУр ^р + Cpzp тр + .ДрХр Рр + ВрУр ^р + СрЁр
^/р ^^р ^ ^р ^Ср ^р I ^р^р I Ср ^р ^р I ^р ^Ср ^^р I ^р ^^^ ^р I Ср ^^р ^р. Если известны проекции вектора на оси СК Срхгуггг, то тензор необходимо представить в СК Срхгуггг или перевести эти проекции в СК Срхгуггг. Затем достаточно выполнить операции выражения (хг • • и т. д.
3. Решения задач динамики
На практике, как правило, ось О]^ - вертикальна. Если при этом считать, что ось Оу АСК вертикальна, то § = -ду (|§| «9,81 м/с2) и формулы (2)-(4) принимают следующий вид [2]:
^ = - Ч^2^ - + (20)
Мщ =1Я1Чп1 + + С;, (21)
Мю = (/о +Л?¿ -/¿с2)Чо£ I 251(т8цз151цз1 +;¿c¿qí„¿)q0¿, (22)
где Jí = ]qi — —Js, Gi = —g(mnan + msqsi)Si. В дальнейшем будем использовать формулы (20)-(22).
Найдем формулы вычисления сил и моментов сил динамических реакций, действующих в сочленениях платформы Стюарта. В записи искомых формул используются выражения (2.6)-(2.11) с учетом следующих переобозначений: F3 = Fis, F2 = Fin, F1 = Fio, M3 = Mis, M2 = Min, M1 = Mio, x3 = xs¿ = xni, Уз = ys¿ = — zni, z3 = zsi = yni, mq = mqi = mnan + msqsi, mz=mn+ m^ m1 = m0 + mn + ms - масса подвеса.
Утверждение 3. Векторы сил динамических реакций в сочленениях i-го подвеса платформы Стюарта вычисляются по формулам
Fr¿ = —Minxni/Li + (Fis — Fi)yni + M^z^^L^ (23)
Fs¿ = msgy + msd2qsiyni/t2 — Fri, (24)
Fn¡ = (mn + ms)gy + d2mqiyni/t2 — Fri, (25)
F0¿ = Fni + m0gy. (26)
Векторы моментов сил динамических реакций относительно полюсов тел i-го подвеса платформы Стюарта вычисляются по формулам
Ms¿ = (J^siqoixni + JsCiRoiYni +J¡^iqni^ni)t- a(Mioxni/si + Minzni)/Li, (27)
Mni = {jqisi4oi^ni + Jyci4oiYni + Jqí4ní^ni)t ~ + — , (28)
M0Í=;0zq0¿y+Mn¿. 1 (29)
Доказательство. Формула (23) доказана в утверждении 1.
Из формулы (6) Fs¿ = Fís — Frí. Отсюда, с учетом (2.6), получим искомую формулу (24). По формуле (1.1) для i-й направляющей Fni + Fri = Fín, т.е. Fni = Fin — Frí. Следовательно, с учетом формулы (2.7) получим искомую формулу (25).
По формуле (1.1) для i-го основания Foi + Fri = Fio, т. е. Foi = Fio — Fri. Следовательно, с учетом формулы (2.8) получим Foi = (тп + ms)gy + d2mqiyni/t2 — Fri. Отсюда следует искомая формула (26).
По формуле (1.2) для i-й штанги Ms¿ + CsiOri X Fri = M¿s, т. е. Ms¿ = M¿s — ayni X Fri. С учетом формулы (23) получим
yni X Fri = Minzni/Li + Mioxni/siLi. (30)
Следовательно, с учетом формулы (2.7) и равенств xsi = xni, ysi = — zní, zsi = yni получим искомую формулу (27).
По формуле (1.2) для i-й направляющей Mni + L¿ X Fri = M¿„ , Mni = M¿„ — L¿yni X Fri. Следовательно, с учетом формулы (5.7) получим искомую формулу (28). По формуле (1.2) для i-го основания
M0¿ + L¿ X Fri = M¿0 =]z0q0iy+ Mín. M0¿ = J¿qoiy + Min — Liyni X Fr¿. Следовательно, с учетом формулы (5.7) получим искомую формулу (29). Утверждение доказано.
Формулам (23)-(29) можно придать скалярный вид. Для этого достаточно умножить эти формулы скалярно на орты той или иной СК. Например, проекции вектора Fri на оси связанной СК направляющей i-го подвеса вычисляются по формулам
Fri = xní • fr¿ = —Min/Li = —(Jqiqni — Jísícíq0í + 2ms4sí4ní4sí + ,
F-rí Yni • fr¿ Fis F¿ ws[qsi q0i RsíRni +
Frzí = im • Fr¿ = Mio/siLi = [(J5 +Jqi — Jicf)q¡oi + 2si(msqsisiqsi + Jiciqni)qoi]/siLi. Скалярный вариант системы уравнений (1), (2) содержит шесть нелинейных неоднородных обыкновенных дифференциальных уравнений второго порядка относительно 3N + 6 параметров, определяющих положение и ориентацию подвижных тел рассматриваемой СТТ. Для постановки второй задачи динамики, т. е. записи системы дифференциально-алгебраических уравнений, достаточно к этой системе присоединить уравнения геометрических связей платформы с N штангами. Эти уравнения имеют вид N векторных алгебраических уравнений (19). Их можно представить в виде системы 3N трансцендентных алгебраических уравнений относительно 3N + 6 параметров, определяющих положение и ориентацию подвижных тел рассматриваемой СТТ. Эта система получается из векторного уравнения (19) после его скалярного умножения на три некомпланарных вектора, например, на орты xr, yr, zr АСК.
Представим вектор Cp0ri в виде Cp0ri — , где pt - расстояние от ЦМ платформы до конца 7-й штанги, - орт вектора Cp0ri. Обозначим через pf, pf, pf направляющие косинусы орта Р( относительно АСК, т. е. pf = хг • р£, pf = уг • р£, pf = zr • р£. Теперь, умножив обе части уравнения (19) скалярно на орты АСК, получим следующую систему уравнений
ÎPiPi = — coisi^i + — хр ,
PiPf = CiLi + Bt — yp , (31)
PiPf = Saisit + Dt — zp ,i = 1,N.
Направляющие косинусы pf, pf, pf выражаются через углы ориентации платформы в АСК, например, через углы Эйлера или Брайнта по известным формулам [3].
4. Частные случаи платформы Стюарта
На рис. 2 изображена твердотельная 3D-модель платформы Стюарта, где неподвижный корпус и подвижная платформа представлены в виде круговой трисекции с поперечинами на концах. Вертикальный шток в центре корпуса жестко связан с землей. На краях каждой поперечины корпуса установлены цилиндрические шарниры основания и направляющей подвеса. На краях каждой поперечины платформы установлены шаровые шарниры, связывающие штанги с платформой.
На рис. 3 изображена твердотельная 3D-модель СТТ в вертикальной плоскости, соответствующая случаю N = 3, т. е. платформа в виде стержня связана с корпусом тремя подвесами, в каждом из которых отсутствует вращающееся вокруг вертикальной оси основание. Вместо шаровых шарниров связи платформы с концами штанг используются цилиндрические шарниры. Левый цилиндрический шарнир связей платформы со штангами - сложный. Правый цилиндрический шарнир связей направляющих с корпусом - сложный.
На рис. 4 изображена твердотельная 3D-модель СТТ в вертикальной плоскости, соответствующая случаю N = 2, где платформа заменена материальной точкой в центре сложного цилиндрического шарнира, связывающего штанги двух подвесов.
Рассмотрим уравнения (7), (8), (31) в случаях N = 3 (см. рис. 3) и N = 2 (см. рис. 4).
Пример 1. В случае N = 3, Orl — Or2, Bi — D^ — 0, qoi — 0, qoi = 0, 7 = 1, 2, 3, т. е. coi — 1, soi — 0. В этом случае zni — zr, rp — à, — dzr, pp=qp=0, где a - угол поворота платформы в вертикальной плоскости OrXrYr, откладываемый от оси ОгХг до оси Срр3.
По первой формуле (9) xf — сг. По четвертой формуле (9) yf = —sÉ. По формуле (4) Mio — 0. По третьей формуле (11) yzi — — хр)с; — ypSi. Следовательно, умножив скалярно уравнение (7) на хг и на уг, а уравнение (8) на zr, получим
— Xî=iC^î — Fis)si = шрхг • (OrCp — g) — Yii=iMinxr • xni/Li,
Tii=iC^î — Fis)ci = mpyr • (OrCp — g) — 2î=i Minyr • xni/Li, — Fis)yzi = zr • (lp • — Mz, где Mz — M(„(X(S( + ypCi — L()/L(. Теперь, учитывая равенства xr • g = —gxr • yr, yr • g = —g, x^ O^Cp — y^ O^Ср — "У~р, ^^ x^j — Cj, y^ x^j — Sj, /p (Op^ — где _J~p ммом^^еннт инерции платформы относительно оси Сргг, получим следующую систему трех линейных алгебраических уравнений относительно движущих сил штанг Ft, F2, F3. 2i=i siFi — ZÎ=I (siFis + ^inci/^i) — шрхр,
If=i CiFi — mp(yp + g) + — Minsi/Li), (32)
Ef=i yzi^i — J$ä + Zf=1 yZiFis — Mz, где, согласно (2), (3),
Fis — — q^tât + дс^ Min — Jqiqni + 2msqsiqniqsi + Gt. (33)
Из системы уравнений геометрических связей (31) для рассматриваемой СТТ получим
{PiPi — —sÎ^Î + Ai — Хр,
PiPf — с^ — Ур , Î — 1,3 , где ^ — 0,^2 — А3 — Л, p; — Ь. НК вектора СрОг1 — СрОг2 вычисляются по формулам
р* = хг • pj — cos(a + 180o) = — cos(a) = — ca,
pj — yr • P; = cos(a + 90o) = — sin(a) = — sa.
НК вектора Cp Or3 вычисляются по формулам
Рз = xr • Рз = cos(a) = = yr • р3 = cos(a + 270o) = sin (a) — sa.
Следовательно, система шести уравнений геометрических связей рассматриваемой СТТ имеет следующий вид
Í^ca = + хр > bca = s2L2 — А + хр , bca = —s3L3 + .Д — хр , (34)
bsa = ур — c-lL-l , bsa = Ур — c2L2 , bsa = c3L3 — ур .
Система девяти дифференциально-алгебраических уравнений (32), (34) для девяти параметров Хр, Ур, a, qni, qsi, i = 1, 2, 3, описывающих положения тел рассматриваемой СТТ, позволяет решать задачи динамики этой СТТ. Если заданы функции времени xp(t), yp(t), a(t), qni(t), qSí(t), согласованные со связями (34), то система трех линейных алгебраических уравнений (33) позволяет решить первую задачу динамики, т. е. найти функции F1(í), F2(t), F3(t). Если заданы функции времени Ft(t), F2(t), F3(í) и начальное состояние СТТ, то путем интегрирования системы (32) с учетом геометрических связей (34) решается вторая задача динамики, т. е. вычисляются Хр, Ур, a, qni, qsi, i = 1, 2, 3, как функции времени.
Пример 2. Пусть в СТТ из примера 1 платформа вырождается в материальную точку массой тр, и третий подвес отсутствует, т. е. имеет место СТТ на рис. 4. Тогда из системы (32) получается следующая система двух линейных алгебраических уравнений относительно движущих сил штанг F-¡_, F2.
(2¿=i síFí = 1í=i(SíFís + M¿„c¿/L¿) — mpxp , (35)
ll2=i CÍFÍ — mp(yp + g)+ I2=1(c¿F¿s — M¿„s¿/L¿).
Система четырех уравнений геометрических связей рассматриваемой СТТ следует из (34) с учетом равенств p¿ = 0 и имеет следующий вид
Í0 — si ¿i + х^ , 0 — s9Ln А + х^ ,
п 1 1 1 п i (36)
0 — yp — c1Lí ,0 — yp — c2L2 .
Пример 3. Рассмотрим частный случай СТТ из примера 2. Пусть в этой СТТ qnl — —90o, ^ ^ Чп2 — 90o, qni — 0, Lx + L2 — А (рис. 5). Тогда с1 — с2 — 0, — —1,
О =_0 s2 — 1, F¿s — msqsi, и первое уравнение системы примет вид
Рис. 5. Схема к примеру 3 £2=i s¿F¿ — ms £?=1 s¿qs¿ — mpxp. В этом состоянии возможно движение, в котором qs2 — — qsl, qsl — хр. Следовательно,
IíU S¿F¿ — —+ — Qsi + ^2) — ™p*p — —2msqsí — mpxp — —(mp + 2ms)xp, т. е. Ft — F2 — (mp + 2ms)xp, что соответствует 2-му закону Ньютона.
Заключение
Полученные символьные виды математических моделей платформы Стюарта позволяют решать весь спектр задач механики и управления движением платформы Стюарта относительно неподвижного корпуса, в том числе решать задачи синтеза явно выраженных конструктивных параметров платформы Стюарта, которые обеспечивают ей заданные свойства движений. Выведенные УД и формулы вычисления сил и моментов сил динамических реакций платформы Стюарта подготовлены к использованию в математической модели платформы Стюарта на свободном корпусе, где управляемая платформа обеспечивает заданное положение центра масс и желаемые значения некоторых элементов тензора инерции корпуса. УД и геометрические связи (42)-(46) частных случаев платформы Стюарта подготовлены для использования в учебном процессе и научных исследованиях в лаборатории «Ракетодинамика» Научно-образовательного центра (НОЦ) «Ракетостроение».
Литература
1. Телегин, А.И. Новый векторный вид уравнений динамики систем тел / А.И. Телегин // Вестник ЮУрГУ. Серия «Машиностроение». - 2014. - Т. 14, № 1. - С. 33-40.
2. Телегин, А.И. Математическое моделирование трехстепенного манипулятора / А.И. Телегин, Д.И. Читалов // Наука ЮУрГУ. - 2015. - С. 1716-1723. - http://lib.susu.ru/ftd?base=SUSU_ KONF&key=000537718&dtype =F&etype
3. Лурье, А.И. Аналитическая механика / А.И. Лурье. - М.: Физматгиз, 1961. - 824 с.
Войнов Игорь Вячеславович, д-р техн. наук, профессор, директор, Южно-Уральский государственный университет, филиал в г. Миассе; mail@miass.susu.ru.
Телегин Александр Иванович, д-р физ.-мат. наук, профессор, декан электротехнического факультета, Южно-Уральский государственный университет, филиал в г. Миассе; teleginai@susu.ru.
Тимофеев Дмитрий Николаевич, аспирант, лаборант, Южно-Уральский государственный университет, филиал в г. Миассе; goshanoob@mail.ru.
Поступила в редакцию 15 августа 2016 г.
DOI: 10.14529/ctcr160403
VECTOR AND SCALAR EQUATIONS TYPES TO SOLVE PROBLEMS OF THE DYNAMICS OF THE STEWART PLATFORM
I.V. Voynov, mail@miass.susu.ru, A.I. Telegin, teleginai@susu.ru, D.N. Timofeev, goshanoob@mail.ru
South Ural State University, branch in Miass, Chelyabinsk region, Russian Federation
The Stewart platform on the stationary body are considered. It consists of body, which rigidly connected to the ground, platform and six identical suspension devices for platform. Each suspension device consists of three bodies - the base, the guide and the rod. The solution of the dynamics equations and formulas of calculating the dynamic suspension reactions are discussed in earlier articles of authors. In this article the formulas are used in the derivation of equation for Stewart platform. The first assertion is proved a formula for expansion related to the axis of the guide forces of dynamic reactions in ball joints for connecting the platform to the ends of the rods. The second assertion is proved formulas for calculating the driving forces of rods. The third assertion is proved formulas for calculating the dynamic reactions in joints suspensions. All received formulas contains geometric, kinematic and inertial parameters of moving bodies. This allows to solve the problem of synthesis parameters to achieve the desired Stewart platform dynamic properties. Explicit types of vector and scalar systems of differential-algebraic equations for solving the second problem of the dynamics are prepared for re-use in mathematical models of Stewart platform on the mobile (carrier) body. These models are needed to investigate the influence of movements of the body carried by supporting body. Three examples are considered in order to verify the absence of errors in the calculation formulas. The particular cases of motion of the bodies of the system are analyzed in these examples. The formulas to calculate the driving forces and the obvious equation of geometric relations are obtained as a special case of the proven formulas for the motion of the platform on three hangers in the vertical plane. The equations of the dynamics for two hangers, connected at the ends of the rods with rotational hinge, and the corresponding apparent equation of geometric relations are obtained in the second example of these formulas, as a special case. The obvious equation for movement along a horizontal line rods that follows from Newton's second law are obtained in the third example.
Keywords: dynamics problems, Stewart platform, driving forces, dynamic response.
References
1. Telegin A.I. [New Vector Form of the Equations of Multibody System Dynamics]. Bulletin of South Ural State University. Ser. Mechanical Engineering, 2014, vol. 14, no. 1, pp. 33-40. (in Russ.)
2. Telegin A.I., Chitalov D.I. [Mathematical Modeling of the Three Stage Manipulator]. Available at: http://lib.susu.ru/ftd?base=SUSU_KONF&key=000537718&dtype=F&etype=pdf.
3. Lur'e A.I. Analiticheskaya mekhanika [Classical Mechanics]. Moscow, Fizmatgiz Publ., 1961. 824 p.
Received 15 August 2016
ОБРАЗЕЦ ЦИТИРОВАНИЯ
FOR CITATION
Войнов, И.В. Векторный и скалярный виды уравнений для решения задач динамики платформы Стюарта / И.В. Войнов, А.И. Телегин, Д.Н. Тимофеев // Вестник ЮУрГУ. Серия «Компьютерные технологии, управление, радиоэлектроника». - 2016. - Т. 16, № 4. -
С. 19-28. DOI: 10.14529/ctcr160403
Voynov I.V., Telegin A.I., Timofeev D.N. Vector and Scalar Equations Types to Solve Problems of the Dynamics of the Stewart Platform. Bulletin of the South Ural State University. Ser. Computer Technologies, Automatic Control, Radio Electronics, 2016, vol. 16, no. 4, pp. 19-28. (in Russ.) DOI: 10.14529/ctcr160403