Известия РАН. Механика твердого тела, 2021, № 2, стр. 72-87

УПРАВЛЕНИЕ ДИНАМИКОЙ СОСТАВНОЙ КОНСТРУКЦИИ СО ЗВЕНЬЯМИ ПЕРЕМЕННОЙ ДЛИНЫ

А. В. Борисов a*, И. Е. Каспирович b**, Р. Г. Мухарлямов b***

a Филиал ФГБОУ ВО НИУ “МЭИ” в г. Смоленске
Смоленск, Россия

b Российский университет дружбы народов
Москва, Россия

* E-mail: borisowandrej@yandex.ru
** E-mail: kaspirovich.ivan@mail.ru
*** E-mail: robgar@mail.ru

Поступила в редакцию 21.12.2019
После доработки 12.01.2020
Принята к публикации 14.01.2020

Полный текст (PDF)

Аннотация

Рассматривается моделирование механической системы с произвольным числом звеньев переменной длины, составленных из двух невесомых участков переменной длины и расположенного между ними массивного абсолютно твердого стержня. Рассматривается задача управления целенаправленным движением системы с произвольным количеством звеньев переменной длины. Управление осуществляется изменением длины невесомых участков звеньев и изменением углов между звеньями. Связь между звеньями реализуется двумя цилиндрическими шарнирами, обеспечивая значительную механическую прочность, простоту конструкции и расположения управляющих приводов. Составляется система дифференциальных уравнений движения и записывается в векторно-матричной форме записи.

В качестве примера использования разработанной модели рассматривается антропоморфная механическая система в виде лыжника-сноубордиста. В модели лыжника-сноубордиста учитывается неголономная связь лыжи с поверхностью. Составляется система дифференциальных уравнений движения и проводится анализ изменения уравнений при учете неголономной связи. Рассматривается численный пример моделирования движения лыжника-сноубордиста с использованием управления на основе метода стабилизации связи.

Ключевые слова: механическая система, звено переменной длины, произвольное число звеньев, система дифференциальных уравнений движения, управление, целенаправленное движение, возмущения связей, лыжник-сноубордист, лыжа, неголономная связь, звено переменной длины, шарнир

1. Введение. Исследованию динамики антропоморфных систем, моделируемых системой твердых тел, посвящено значительное число работ. Исследования ведутся по проектированию экзоскелетов и созданию антропоморфных роботов. Разработке экзоскелетов на основе системы твердых тел посвящены работы [1–5]. Моделирование антропоморфных роботов системами твердых тел рассматривается в работах [610]. Однако, практически во всех работах, для описания движения антропоида не используются звенья переменной длины и понятие связи. Построению алгоритмов составления уравнений динамики пространственной модели экзоскелета и антропоморфного робота посвящены работы [11, 12]. В [12] был предложен рекуррентный метод построения уравнений движений экзоскелета, содержащего звенья переменной длины и управляемого моментами в суставах. Реальные условия функционирования управяемых антропоморфных систем и экзоскелетов предполагают наличие действие сил трения и наличие неголономных связей. Использование уравнений неголономной динамики [13, 14] позволяет существенно сократить размерность системы. Задачи динамики систем с трением и с неголономными связями рассмотены в работах [1318]. В настоящей работе рассматривается модель антропоморфного механизма сложной конструкции, содержащего звенья переменной длины. Звеном переменной длины называется часть механизма между шарнирами-суставами, составляющая прямолинейную конструкцию, способную изменять расстояние между шарнирами-суставами, т.е. реализовывать растяжение-сжатие, но не подверженное деформациям изгиба и кручения.

В связи с тем, что задача моделирования неголономных систем явлется весьма сложной, для лучшего понимания модели, рассмотрим вначале модель звена переменной длины без учета неголономной связи. Отработаем на ней методику составления дифференциальных уравнений движения, получим обобщения дифференциальных уравнений движения и разработем методику составления для антропоморфной системы с произвольным числом звеньев. Далее рассмотрим задачу управления целенаправленным движением системы твердых тел, содержащей звенья переменной длины. Затем обобщим и перенесем полученные результаты на модель лыжника-сноубордиста, с учетом неголономной связи и управления движением такой неголономной модели с использованием метода стабилизации связей. Далее рассмотрим числовой пример для модели лыжника-сноубордиста с выбранным количеством звеньев и заданными числовыми параметрами.

2. Описание модели закрепленного звена переменной длины и постановка задачи. Введем неподвижную правую декартову систему координат Oxyz, в которой происходит движение механизма. Пусть стержень переменной длины имеет конструкцию, показанную на рис. 1. Звено АВ переменной длины, состоящее из двух невесомых частей изменяющих свою длину = ξ11(t) и = ξ12(t) и весомой абсолютно твердой части СD = l1 [2]. На рис. 1 схематично изображено звено переменной длины и введены соответствующие обозначения.

Рис. 1

Положение весомого участка звена зависит от трех параметров и однозначно определяется углами φ1(t), ψ1(t) и переменной длиной участка стержня ξ11(t). Рассматриваемая система имеет три степени свободы. Обозначим через M и M управляющие моменты, развиваемые в шарнире А. Продольную силу, действующую вдоль стержня на участке АС, обозначим F11, на участке DB, обозначим F12.

Длина звена складывается из суммы длин переменной части и постоянной длины:

(2.1)
$l(t) = {{l}_{1}} + {{\xi }_{{11}}}(t) + {{\xi }_{{12}}}(t)$

Масса участка звена постоянной длины m1 = ρ1l1, где ρ1 – плотность материала из которого изготовлена часть стержня постоянной длины. Участки звена, в которых реализуется переменность его длины ξ11(t) и ξ12(t), считаем невесомыми. Это означает, что момент инерции стержня относительно точки С, расположенной на конце весомого участка, не меняется.

Координаты бесконечно малой частицы весомого участка звена, отсчитываемые от точки А, записываются в виде:

(2.2)
${{x}_{1}} = (x + {{\xi }_{{11}}})C_{1}^{\psi }C_{1}^{\varphi },\quad {{y}_{1}} = (x + {{\xi }_{{11}}})C_{1}^{\psi }S_{1}^{\varphi },\quad {{z}_{1}} = (x + {{\xi }_{{11}}})S_{1}^{\psi }$
где $C_{1}^{\varphi }$ = cosφ1, $C_{1}^{\psi }$ = cosψ1, $S_{1}^{\varphi }$ = sinφ1, $S_{1}^{\psi }$ = sinψ1, х – расстояние от точки С до точки, задающей положение бесконечно малой частицы весомого участка СD звена АВ. Квадрат скорости частицы весомого участка СD равен:

(2.3)
${v}_{1}^{2} = \dot {\xi }_{{11}}^{2} + {{(x + {{\xi }_{{11}}})}^{2}}(\dot {\psi }_{1}^{2} + \dot {\varphi }_{1}^{2}{{(C_{1}^{\psi })}^{2}})$

Кинетическая энергия механизма, с учетом выражения момента инерции тонкого однородного стержня, если ось проходит через его конец

(2.4)
${{I}_{1}} = {{m}_{1}}l_{1}^{2}{\text{/}}3$
имеет вид:
(2.5)
$T = \frac{1}{2}\int\limits_0^{{{l}_{1}}} {{v}_{1}^{2}\rho dx = \frac{1}{2}} [{{m}_{1}}\dot {\xi }_{{11}}^{2} + {{\zeta }_{{11}}}(\dot {\psi }_{1}^{2} + \dot {\varphi }_{1}^{2}{{(C_{1}^{\psi })}^{2}})]$
где ζ11 = I1 + m1l1ξ11 + m1$\xi _{{11}}^{2}$

Потенциальная энергия звена записывается в виде:

(2.6)
$\Pi = g{{m}_{1}}({{l}_{1}}{\text{/}}2 + {{\xi }_{{11}}})S_{1}^{\psi }$

Составляя уравнения Лагранжа второго рода, получаем дифференциальные уравнения движения для модели одного подвижного звена переменной длины в трехмерном пространстве:

(2.7)
${{\zeta }_{{11}}}{{(C_{1}^{\psi })}^{2}}{{\ddot {\varphi }}_{1}} + 2{{m}_{1}}{{\lambda }_{{11}}}{{(C_{1}^{\psi })}^{2}}{{\dot {\xi }}_{{11}}}{{\dot {\varphi }}_{1}} - 2{{\zeta }_{{11}}}C_{1}^{\psi }S_{1}^{\psi }{{\dot {\varphi }}_{1}}{{\dot {\psi }}_{1}} = {{M}_{{1\varphi }}}$
(2.8)
${{\zeta }_{{11}}}{{\ddot {\psi }}_{1}} + {{\zeta }_{{11}}}C_{1}^{\psi }S_{1}^{\psi }\dot {\varphi }_{1}^{2} + 2{{m}_{1}}{{\lambda }_{{11}}}{{\dot {\xi }}_{{11}}}{{\dot {\psi }}_{1}} + g{{m}_{1}}{{\lambda }_{{11}}}C_{1}^{\psi } = {{M}_{{1\psi }}}$
(2.9)
${{m}_{1}}{{\ddot {\xi }}_{{11}}} - {{m}_{1}}{{\lambda }_{{11}}}{{(C_{1}^{\psi })}^{2}}\dot {\varphi }_{1}^{2} - {{m}_{1}}{{\lambda }_{{11}}}\dot {\psi }_{1}^{2} + g{{m}_{1}}S_{1}^{\varphi } = {{F}_{1}}$
где ζ11 = I1 + m1l1ξ11 + m1$\xi _{{11}}^{2}$, λ11 = ${{\xi }_{{11}}} + {{{{l}_{1}}} \mathord{\left/ {\vphantom {{{{l}_{1}}} 2}} \right. \kern-0em} 2}$, $C_{1}^{\psi }$ = cosψ1, $S_{1}^{\psi }$ = sinψ1.

Общее решение системы уравнений движения зависит от 6 произвольных постоянных, которые определяются заданными начальным условиями:

(2.10)
$\begin{gathered} {{\left. {{{\varphi }_{1}}} \right|}_{{t = 0}}} = {{\varphi }_{{{{1}_{0}}}}},\quad {{\left. {{{{\dot {\varphi }}}_{1}}} \right|}_{{t = 0}}} = {{{\dot {\varphi }}}_{{{{1}_{0}}}}},\quad {{\left. {{{\psi }_{1}}} \right|}_{{t = 0}}} = {{\psi }_{{{{1}_{0}}}}},\quad {{\left. {{{{\dot {\psi }}}_{1}}} \right|}_{{t = 0}}} = {{{\dot {\psi }}}_{{{{1}_{0}}}}} \\ {{\left. {{{\xi }_{{11}}}} \right|}_{{t = 0}}} = \xi _{{{{{11}}_{0}}}}^{{}},\quad {{\left. {{{{\dot {\xi }}}_{{11}}}} \right|}_{{t = 0}}} = \dot {\xi }_{{{{{11}}_{0}}}}^{{}}\quad \\ \end{gathered} $

Таким образом, получена система дифференциальных уравнений, описывающая динамику звена переменной длины.

Задача исследования заключается в создании математической модели механизмов, составленных из таких звеньев. Требуется записать систему дифференциальных уравнений движения в векторно-матричном виде для модели с произвольным конечным количеством звеньев и получить общие формулы для матриц, входящих в дифференциальные уравнения движения. Перенести полученные результаты на систему с неголономной связью. Провести исследование ее динамики, численным методом на основе метода стабилизации связи для выбранной в качестве примера модели лыжника-сноубордиста. Для этого необходимо получить решение системы дифференциальных уравнений движения с эмпирически определенными методами биомеханики параметрами системы, соответствующими опорно-двигательному аппарату реального лыжника и сноуборда. Результатом должна быть проверка возможности получения устойчивого движения механической модели лыжника-сноубордиста за счет неголономной связи.

3. Модель механизма с двумя звеньями переменной длины. Составим систему дифференциальных уравнений движения для механизма с двумя последовательными подвижными звеньями переменной длины (рис. 2).

Рис. 2

Система имеет два звена А1A2 и А2A3, состоящее каждое из двух невесомых частей изменяющих свою длину A1B1 = ξ11(t), C1A2 = ξ12(t), A2В2 = ξ21(t), C2A3 = ξ22(t) и весомых абсолютно твердых частей B1С1 = l1, B2С2 = l2 (рис. 2). Положение весомого участка B1С1 звена А1A2 зависит от трех параметров и однозначно определяется углами ψ1(t), φ1(t) и переменной длиной участка стержня ξ11(t). Положение весомого участка B2С2 звена А2A3 зависит от семи параметров и определяется углами ψ1(t), ψ2(t), φ1(t), φ2(t) и переменными длинами участков стержней ξ11(t), ξ12(t), ξ21(t). Обозначим через M, M – управляющие моменты, развиваемые в шарнире А1, через M, M – в шарнире А2. Продольную силу, действующую вдоль стержня на участке A1B1, обозначим F11, на участке C1A2, обозначим F12, на участке A2В2, обозначим F21.

Кинетическая энергия звена А1A2, совершающего вращательное движение вокруг неподвижного шарнира А1, имеет вид, аналогичный модели с одним звеном (2.5).

Для вычисления кинетической энергии звена А2A3 найдем скорость ${v}_{2}^{2}$. Весомый участок данного звена совершает сложное движение. В качестве полюса выберем точку А2. Определим квадрат ее скорости:

(3.1)
${v}_{{{{A}_{2}}}}^{2} = \lambda _{{12}}^{2}(\dot {\psi }_{1}^{2} + \dot {\varphi }_{1}^{2}{{(C_{1}^{\psi })}^{2}}) + \dot {\lambda }_{{12}}^{2}$
где λ12 = ${{\xi }_{{11}}} + {{l}_{1}} + {{\xi }_{{12}}}$, ${{\dot {\lambda }}_{{12}}}$ = ${{\dot {\xi }}_{{11}}}$ + ${{\dot {\xi }}_{{12}}}$

Тогда скорость $v_{2}^{2}$ бесконечно малой частицы участка звена А2A3 определяется в соответствии с теоремой о сложении скоростей.

(3.2)
$\begin{gathered} {v}_{2}^{2} = \lambda _{{12}}^{2}(\dot {\psi }_{1}^{2} + \dot {\varphi }_{1}^{2}{{(C_{1}^{\psi })}^{2}}) + \dot {\lambda }_{{12}}^{2} + {{({{\xi }_{{21}}} + {{x}_{2}})}^{2}}(\dot {\psi }_{2}^{2} + \dot {\varphi }_{2}^{2}{{(C_{2}^{\psi })}^{2}}) + \dot {\xi }_{{21}}^{2} + \\ \, + 2\{ [({{\xi }_{{21}}} + {{x}_{2}}){{{\dot {\lambda }}}_{{12}}}{{{\dot {\varphi }}}_{2}} - {{\lambda }_{{12}}}{{{\dot {\xi }}}_{{21}}}{{{\dot {\varphi }}}_{1}}]{{S}_{{12}}}C_{1}^{\psi }C_{2}^{\psi } + \\ \, + [({{\xi }_{{21}}} + {{x}_{2}}){{\lambda }_{{12}}}{{{\dot {\varphi }}}_{1}}{{{\dot {\varphi }}}_{2}} + {{{\dot {\lambda }}}_{{12}}}{{{\dot {\xi }}}_{{21}}}]{{C}_{{12}}}C_{1}^{\psi }C_{2}^{\psi } + \\ \, + ({{\xi }_{{21}}} + {{x}_{2}})({{\lambda }_{{12}}}{{{\dot {\varphi }}}_{1}}{{{\dot {\psi }}}_{2}}{{S}_{{12}}}C_{1}^{\psi }S_{2}^{\psi } + {{{\dot {\lambda }}}_{{12}}}{{C}_{{12}}}){{{\dot {\psi }}}_{2}}C_{1}^{\psi }S_{2}^{\psi } + {{{\dot {\lambda }}}_{{12}}}{{{\dot {\xi }}}_{{21}}}S_{1}^{\psi }S_{2}^{\psi } - \\ \, - {{\lambda }_{{12}}}[({{C}_{{12}}}S_{1}^{\psi }C_{2}^{\psi } - C_{1}^{\psi }S_{2}^{\psi }){{{\dot {\xi }}}_{{12}}} + \\ \, + ({{\xi }_{{21}}} + {{x}_{2}})({{S}_{{12}}}S_{1}^{\psi }C_{2}^{\psi }{{{\dot {\varphi }}}_{2}} - (C_{1}^{\psi }C_{2}^{\psi } + {{C}_{{12}}}S_{1}^{\psi }S_{2}^{\psi }){{{\dot {\psi }}}_{2}})]{{{\dot {\psi }}}_{1}}\} \\ \end{gathered} $
где λ12 = ${{\xi }_{{11}}} + {{l}_{1}} + {{\xi }_{{12}}}$, ${{\dot {\lambda }}_{{12}}}$ = ${{\dot {\xi }}_{{11}}}$ + ${{\dot {\xi }}_{{12}}}$, ${{C}_{{12}}} = \cos ({{\varphi }_{1}} - {{\varphi }_{2}})$, $S_{{12}}^{{}} = \sin \left( {{{\varphi }_{1}} - {{\varphi }_{2}}} \right)$

Кинетическая энергия второго звена является весьма громоздким выражением равно как и система дифференциальных уравнений движения, составленных с помощью уравнений Лагранжа второго рода, состоящая из восьми уравнений. Поэтому в качестве примера, поясняющего изменения, происходящие в системе уравнений, приведем только предпоследнее, седьмое уравнение полученной системы, соответствующее обобщенной координате ξ21 – нижнему невесомоу участку переменной длины второго звена.

(3.3)
$\begin{gathered} - {{m}_{2}}{{\lambda }_{{12}}}{{S}_{{12}}}C_{1}^{\psi }C_{2}^{\psi }{{{\ddot {\varphi }}}_{2}} - {{m}_{2}}{{\lambda }_{{12}}}({{C}_{{12}}}S_{1}^{\psi }C_{2}^{\psi } - C_{1}^{\psi }S_{2}^{\psi }){{{\ddot {\psi }}}_{1}} + \\ \, + {{m}_{2}}({{C}_{{12}}}C_{1}^{\psi }C_{2}^{\psi } + S_{1}^{\psi }S_{2}^{\psi })({{{\ddot {\xi }}}_{{11}}} + {{{\ddot {\xi }}}_{{12}}}) + {{m}_{2}}{{{\ddot {\xi }}}_{{21}}} - \\ \, - {{m}_{2}}{{\lambda }_{{12}}}{{C}_{{12}}}C_{1}^{\psi }C_{2}^{\psi }\dot {\varphi }_{1}^{2} - {{m}_{2}}{{\lambda }_{{21}}}(1 + \cos (2{{\psi }_{2}}))\dot {\varphi }_{2}^{2}{\text{/}}2 - \\ \, - {{m}_{2}}{{\lambda }_{{12}}}({{C}_{{12}}}C_{1}^{\psi }C_{2}^{\psi } + S_{1}^{\psi }S_{2}^{\psi })\dot {\psi }_{1}^{2} - {{m}_{2}}{{\lambda }_{{21}}}\dot {\psi }_{2}^{2} - \\ \, - 2{{m}_{2}}{{S}_{{12}}}C_{1}^{\psi }C_{2}^{\psi }({{{\dot {\xi }}}_{{11}}} + {{{\dot {\xi }}}_{{12}}}){{{\dot {\varphi }}}_{1}} + 2{{m}_{2}}{{\lambda }_{{12}}}{{S}_{{12}}}S_{1}^{\psi }C_{2}^{\psi }{{{\dot {\varphi }}}_{1}}{{{\dot {\psi }}}_{1}} - \\ \, - 2{{m}_{2}}({{C}_{{12}}}S_{1}^{\psi }C_{2}^{\psi } - C_{1}^{\psi }S_{2}^{\psi })({{{\dot {\xi }}}_{{11}}} + {{{\dot {\xi }}}_{{12}}}){{{\dot {\psi }}}_{1}} + g{{m}_{2}}S_{2}^{\psi } = {{F}_{{21}}} \\ \end{gathered} $
где λ1 = ${{\xi }_{{11}}} + {{l}_{1}}$, λ11 = ${{\xi }_{{11}}} + {{{{l}_{1}}} \mathord{\left/ {\vphantom {{{{l}_{1}}} 2}} \right. \kern-0em} 2}$, λ12 = ${{\xi }_{{11}}} + {{l}_{1}} + {{\xi }_{{12}}}$, λ2 = ${{\xi }_{{21}}} + {{l}_{2}}$, λ21 = ${{\xi }_{{21}}} + {{{{l}_{2}}} \mathord{\left/ {\vphantom {{{{l}_{2}}} 2}} \right. \kern-0em} 2}$, Cj = = cosφj, Sj = sinφj, j = 1, 2, $C_{{12}}^{{}} = \cos \left( {{{\varphi }_{1}} - {{\varphi }_{2}}} \right)$, $S_{{12}}^{{}} = \sin \left( {{{\varphi }_{1}} - {{\varphi }_{2}}} \right)$.

В дифференциальное уравнение (3.3) входит информация о движении первого звена, к которому прикрепляется рассматриваемое второе звено. Кроме того, в сравнении с аналигичным уравнением системы (2.9) для модели с одним звеном, в уравнении для модели с двумя подвижными звеньями (3.3) возникает достаточно много новых слагаемых, связанных с тем, что движение второго звена сложное.

4. Обобщение модели механизма на случай произвольного количества звеньев переменной длины. Рассмотрим многозвенную стержневую модель с n звеньями. Система имеет звенья переменной длины, конструкция которых была описана выше. Все длины стержней складываются из участка постоянной длины li (i = 1, …, n) и переменной длины ξiα = ξiα(t) (α = 1, 2 – номер невесомого участка переменной длины на звене). На рис. 3 изображена модель со звеньями переменной длины в одноопорной фазе движения и введены соответствующие обозначения.

Рис. 3

Положение однозначно определяется углами φi и участками переменной длины стержней ξiα. Рассматриваемая система имеет 4n – 1 степеней свободы, так как движение каждого звена описывается набором из четырех параметров: углов φi(t), ψi(t) и изменением длин невесомых участков ξi1(t), ξi2(t). При этом на конце последнего звена находится невесомый участок, который не оказывает влияния на движение звена, поэтому ξn2(t) не включается в обощенные координаты. Массы звеньев обозначим mi, моменты инерции звеньев относительно осей, проходящих через один из концов весомого стержня, перпендикулярно плоскости движения – Ii. Обозначим: Miφ, Miψ – моменты, развиваемые в i-м шарнире; Fiα – продольные силы, действующие вдоль i‑го стержня, обеспечивающие изменение его длины требуемым образом. Моменты и продольные силы являются управлением в данной механической системе.

Уравнения движения элементов n-звенной механической системы в одноопорной фазе представляют собой систему нелинейных дифференциальных уравнений, которые в матричной форме можно записать в виде:

(4.1)
$\begin{gathered} {{A}_{\kappa }}(\varphi ,\psi ,{{\xi }_{\alpha }})\ddot {\varphi } + {{B}_{\kappa }}(\varphi ,\psi ,{{\xi }_{\alpha }})\ddot {\psi } + \sum\limits_{\alpha = 1}^2 {{{C}_{{\kappa \alpha }}}(\varphi ,\psi ,{{\xi }_{\alpha }}){{{\ddot {\xi }}}_{\alpha }} + {{D}_{\kappa }}(\varphi ,\psi ,{{\xi }_{\alpha }})\dot {\Phi }\dot {\varphi }} \\ \, + {{E}_{\kappa }}(\varphi ,\psi ,{{\xi }_{\alpha }})\dot {\Psi }\dot {\psi } + 2\sum\limits_{\alpha = 1}^2 {{{F}_{{\kappa \alpha }}}(\varphi ,\psi ,{{\xi }_{\alpha }})\dot {\Phi }{{{\dot {\xi }}}_{\alpha }} + 2{{G}_{\kappa }}(\varphi ,\psi ,{{\xi }_{\alpha }})\dot {\Phi }\dot {\psi } + } \\ \, + 2\sum\limits_{\alpha = 1}^2 {{{H}_{{\kappa \alpha }}}(\varphi ,\psi ,{{\xi }_{\alpha }})\dot {\Psi }{{{\dot {\xi }}}_{\alpha }} + g{{K}_{\kappa }}(\psi ) = {{M}_{\kappa }}(\varphi ,\psi ,{{\xi }_{\alpha }})} \\ \end{gathered} $
где нижние индексы у матриц указывают на описание соответствующей обобщенной координаты: κ = 1, …, 4, где 1 соответствует обобщенной координате φ, 2 – ψ, 3 – ξi1, 4 – ξi2; φ = (φ1, …, φn)т, ψ = (ψ1, …, ψn)т – векторы углов; ξα = (ξ, …, ξnα)т – вектор переменных длин звеньев участка α (α = 1, 2); l = (l1, …, ln)т – вектор длин звеньев участков постоянной длины; $\dot {\varphi }$ – вектор угловых скоростей; $\ddot {\varphi }$ – вектор угловых ускорений; $\dot {\Phi }$ = diag(${{\dot {\varphi }}_{1}}$, …, ${{\dot {\varphi }}_{n}}$) – диагональная матрица; M, Fα – векторы управляющих моментов и сил на участке α (α = 1, 2) звена; A, B, Gα, Hα – матрицы, учитывающие инерционные свойства системы; C, Kα – матрицы, определяемые моментами силы тяжести; D1D2, E1, E2, Lα1, Lα2, Pα1, Pα2 – матрицы, учитывающие переменную длину звеньев.

Приведем, в качестве примера, формулу для матрицы А. Матрица А = (aij) является симметрической: aij = aji, поэтому достаточно привести для нее только диагональные и наддиагональные элементы, т.е., если i – номер строки, j – номер столбца, то i, j = 1, 2, …, n, при этом ji.

Элементы симметрической матрицы А имеют вид:

(4.2)
$\begin{gathered} {{a}_{{ij}}} = {{\delta }_{{ij}}}{{I}_{i}} + ({{l}_{i}} + {{\xi }_{i}}_{1} + (1--{{\delta }_{{ij}}}){{\xi }_{i}}_{2}) \times \\ \times \left( {{{m}_{j}}({{l}_{j}}{{{\tilde {\delta }}}_{{ij}}} + {{\xi }_{{j1}}}) + ({{l}_{j}} + {{\xi }_{{j1}}} + {{\xi }_{{j2}}})({{l}_{j}}{{\delta }_{{ij}}} + {{\xi }_{{j1}}}{{\delta }_{{ij}}} + {{\xi }_{{j2}}}{{\delta }_{{ij}}})\sum\limits_{k = j + 1}^n {{{m}_{k}}} } \right) \times \\ \times \,{\text{cos}}({{\varphi }_{i}}--{{\varphi }_{j}}){\text{cos}}{{\psi }_{i}}{\text{cos}}{{\psi }_{j}} \\ \end{gathered} $
где δij – символ Кронекера, тогда ${{\tilde {\delta }}_{{ij}}}$ – половинный антикронекер:

${{\delta }_{{ij}}} = \left\{ \begin{gathered} 1,\quad i = j \hfill \\ 0,\quad i \ne j \hfill \\ \end{gathered} \right.,\quad {{\tilde {\delta }}_{{ij}}} = \left\{ \begin{gathered} 0,\quad i = j \hfill \\ 1{\text{/}}2,\quad i \ne j \hfill \\ \end{gathered} \right.$

Матричная форма записи уравнений движения (4.1) является универсальной и может быть применена к описанию движения экзоскелета или антропоморфного робота с любым числом звеньев.

Дальнейшей задачей является разработка методов управления рассмотренными выше системами с произвольным числом звеньев переменной длины.

5. Управление целенаправленным движением системы твердых тел, содержащей звенья переменной длины. Система уравнений (4.1) содержит управляющие моменты ${{M}_{\kappa }}$ и силы ${{F}_{\kappa }}$, призванные обеспечить выполнение уравнений связей, наложеннных на обобщенные координаты и скорости:

(5.1)
$\begin{gathered} {{f}^{\mu }}\left( {q,t} \right) = 0,\quad {{g}^{\gamma }}\left( {q,{v},t} \right) = 0 \\ \mu = 1,\; \ldots ,\;m,\quad \gamma = m + 1,\; \ldots ,\;r,\quad r < 4n \\ \end{gathered} $

Здесь ${v} = {{dq} \mathord{\left/ {\vphantom {{dq} {dt}}} \right. \kern-0em} {dt}}$, $q = ({{q}^{1}}, \ldots ,{{q}^{{4n}}})$ – вектор обобщенных координат, соответствующих переменным φj, ${{\psi }_{j}}$, ${{\xi }_{{j1}}}$, ${{\xi }_{{j2}}}$, $j = 1,\; \ldots ,\;n$. В новых переменных дифференциально-алгебраические уравнения динамики замкнутой системы и уравнения возмущений связей запишутся в следующем виде:

(5.2)
$\begin{gathered} \frac{{d{{q}^{i}}}}{{dt}} = {{{v}}^{i}} \\ \frac{{d{{{v}}^{i}}}}{{dt}} = {{Q}^{i}}\left( {q,{v},t} \right) + \sum\limits_{s = 1}^S {{{b}^{{is}}}\left( {q,{v},t} \right){{u}_{s}}} \\ \end{gathered} $
${{q}^{i}}\left( {{{t}_{0}}} \right) = q_{0}^{i},\quad i = 1,\; \ldots ,\;4n$
(5.3)
${{y}^{\mu }} - {{f}^{\mu }}\left( {q,t} \right) = 0$
(5.4)
${{z}^{\rho }} - {{g}^{\rho }}\left( {q,{v},t} \right) = 0,\quad {{g}^{\mu }} = \frac{{d{{f}^{\mu }}}}{{dt}}$
(5.5)
$\begin{gathered} \frac{{d{{y}^{\mu }}}}{{dt}} = {{z}^{\mu }} \\ \frac{{d{{z}^{\rho }}}}{{dt}} = \sum\limits_{\mu = 1}^m {h_{\mu }^{\rho }\left( {q,{v},t} \right){{y}^{\mu }}} + \sum\limits_{\sigma = 1}^r {k_{\sigma }^{\rho }\left( {q,{v},t} \right){{z}^{\sigma }}} \\ \end{gathered} $
$\rho = 1,\; \ldots ,\;r$

Число S управляющих воздействий зависит от числа звеньев переменной длины, коэффициенты $h_{\mu }^{\rho }$, $k_{\sigma }^{\rho }$ уравнений (5.5) возмущений связей определяются из условий асимптотической устойчивости тривиального решения.

Из уравнений (5.2)–(5.5) следуют выражения управляющих воздействий

(5.6)
${{u}_{s}} = {{u}^{0}}u_{s}^{\tau } + u_{s}^{{v}}$

Здесь u0 – произвольная скалярная величина, $u_{s}^{\tau }$ вычисляется как определитель, первая строка которого состоит из величин ${{\delta }^{{sl}}} = 0$, $l \ne s$, ${{\delta }^{{ss}}} = 1$, $s,l = 1,\; \ldots ,\;S$, последующие строки составлены из элементов матрицы (gρs),

${{g}^{{\rho s}}} = \sum\limits_{i = 1}^{4n} {\frac{{\partial {{g}^{\rho }}}}{{\partial {{{v}}^{i}}}}{{b}^{{is}}}} $
и произвольных величин ${{g}^{{\kappa s}}}$, $\kappa = r + 1,\; \ldots ,\;S - 1$, которые не обращают в нуль величину определителя. Второе слагаемое определяется выражением

$u_{s}^{{v}} = - \sum\limits_{l = 1}^S {{{\delta }_{{sl}}}} \sum\limits_{\rho ,\sigma = 1}^r {{{X}_{i}}{{g}^{{\rho l}}}{{\omega }_{{\rho \sigma }}}(h_{\mu }^{\sigma }{{y}^{\mu }} + k_{\eta }^{\sigma }{{z}^{\eta }} + {{{\tilde {g}}}^{\sigma }})} ,$
${{\delta }_{{sl}}} = 0,\quad s \ne l,\quad {{\delta }_{{ss}}} = 1,\quad ({{\omega }_{{\sigma \rho }}}) = {{({{\omega }^{{\sigma \rho }}})}^{{ - 1}}},\quad {{\omega }^{{\sigma \rho }}} = \sum\limits_{l,s = 1}^S {{{g}^{{\sigma l}}}{{\delta }_{{ls}}}{{g}^{{\rho s}}}} $

Выражения (5.6) управлений соответствуют асимптотической устойчивости многообразия, определяемого уравнениями связей, и при дальнейшем уточнении коэффициентов уравнений возмущений связей позволяет обеспечить стабилизацию связей при численном решении уравнений динамики замкнутой системы [5 ] .

6. Модели лыжника-сноубордиста. В качестве примера решения прикладной задачи, модифицируем предложенный выше подход к моделированию системы с произвольным числом звеньев на случей антропоморфных систем с неголономными связями в виде лыжника-сноубордиста.

Модель лыжника-сноубордиста с одним подвижным звеном переменной длины, конструкция которого рассмотрена выше, представлена на рис. 4. Координаты крепления звена АВ к лыже xА, yА. Угол φ0 определяет направление лыжи относительно оси ОХ. Масса лыжи m0, момент инерции I0. Положение центра масс звена АВ определяется двумя углами: φ1 – углом между осью ОХ и проекцией звена AB на плоскость XOY, отсчитываемым от оси ОХ против часовой стрелки; ψ1 – углом между звеном AB и его проекцией на плоскость XOY, отсчитываемым от проекции звена AB на плоскость XOY против часовой стрелки и изменением его длины, координатами крепления звена к лыже xА, yА и переменными длинами участков стержня ξ11(t) и ξ12(t). Рассматриваемая система имеет семь степеней свободы. Остальные обозначения совпадают с рис. 1.

Рис. 4

В точке B имеется сосредоточенная масса mG, моделирующая корпус лыжника-сноубордиста, а звено АВ моделирует ноги в целом. Рассмотрим модель с двумя звеньями переменной длины. Нижнее звено моделирует ноги в целом сноубордиста, верхнее – корпус, точечная масса – голову (рис. 5). В дополнение к рис. 4 вводится звено А2А3, обозначения для которого совпадают с рис. 2. Положение звена А2А3 описывается углами φ2, ψ2 и участками переменной длины ξ21 и ξ22. Рассматриваемая система имеет одиннадцать степеней свободы. Такая модель является более реалистичной и ближе к биомеханическому прототипу, позвляя в совокупности моделировать нижние конечности и отдельно корпус.

Рис. 5

Рассмотрим модель с произвольным конечным количеством n звеньев переменной длины (рис. 6), с помощью которой можно моделировать динамику лыжника-сноубордиста с необходимой точностью. Количество степеней свободы такой механической системы определяется по формуле: 4n + 3.

Рис. 6

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

7. Составление системы дифференциальных уравнений движения с учетом неголономной связи. Рассмотрим модель с одним звеном переменной длины (рис. 4). Процедура получения выражения для кинетической энергии с использованием бесконечно малых участков стержня и интегрированием по весомому отрезку CD описана выше.

Кинетическая энергия всего механизма складывается из кинетической энергии лыжи, звена CD и сосредоточенной массы в точке В.

(7.1)
$Т = {{Т}_{0}} + {{Т}_{{CD}}} + {{Т}_{В}}$

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

(7.2)
$\begin{gathered} T = \frac{1}{2}[\theta ({{{\dot {x}}}^{2}} + {{{\dot {y}}}^{2}}) + {{I}_{0}}\dot {\varphi }_{0}^{2} + {{m}_{1}}\dot {\xi }_{{11}}^{2} + {{m}_{G}}{{({{{\dot {\xi }}}_{{11}}} + {{{\dot {\xi }}}_{{12}}})}^{2}} + \zeta (\dot {\psi }_{1}^{2} + \dot {\varphi }_{1}^{2}{{(C_{1}^{\psi })}^{2}})] + \\ \, + \dot {x}[({{m}_{1}}{{{\dot {\xi }}}_{{11}}} + {{m}_{G}}({{{\dot {\xi }}}_{{11}}} + {{{\dot {\xi }}}_{{12}}}))C_{1}^{\varphi }C_{1}^{\psi } - \\ \, - ({{l}_{1}}({{m}_{G}} + {{m}_{1}}{\text{/}}2) + {{m}_{1}}{{\xi }_{{11}}} + {{m}_{G}}({{\xi }_{{11}}} + {{\xi }_{{12}}}))(C_{1}^{\psi }S_{1}^{\varphi }{{{\dot {\varphi }}}_{1}} + C_{1}^{\varphi }S_{1}^{\psi }{{{\dot {\psi }}}_{1}})] + \\ \, + \dot {y}[({{m}_{1}}{{{\dot {\xi }}}_{{11}}} + {{m}_{G}}({{{\dot {\xi }}}_{{11}}} + {{{\dot {\xi }}}_{{12}}}))S_{1}^{\varphi }C_{1}^{\psi } + \\ \, + ({{l}_{1}}({{m}_{G}} + {{m}_{1}}{\text{/}}2) + {{m}_{1}}{{\xi }_{{11}}} + {{m}_{G}}({{\xi }_{{11}}} + {{\xi }_{{12}}}))(C_{1}^{\psi }C_{1}^{\varphi }{{{\dot {\varphi }}}_{1}} - S_{1}^{\varphi }S_{1}^{\psi }{{{\dot {\psi }}}_{1}})] \\ \end{gathered} $
где θ = m0 + m1 + mG – масса всего механизма в виде лыжника-сноубордиста вместе с лыжей, ногами и корпусом, ζ = I1 + m1ξ11(l1 + $\xi _{{11}}^{{}}$) + mG(l1 + ($\xi _{{11}}^{{}}$ + $\xi _{{12}}^{{}}$))2.

Сравнивая полученное выражение для кинетической энергии лыжника-сноубордиста (7.2) и отдельного звена (2.5) видно, что ее структура изменилась незначительно, только добавились слагаемые, соответствующие дополнительно введенным обобщенным координатам и массе лыжи и корпуса лыжника-сноубордиста.

Связь по поверхности контакта лыжи и снега является неголономной. Уравнение связи имеет вид:

(7.3)
$\dot {x}{\text{tg}}{{\varphi }_{0}} - \dot {y} = 0$

Траектория сноубордиста (рис. 4) описывается синусоидой

(7.4)
$y = A{\text{sin}}(kx),\quad \dot {y} = Ak{\text{cos}}(kx)$
где А – амплитуда траектории. Тогда уравнение связи принимает вид:
(7.5)
${\text{tg}}{{\varphi }_{0}}--Ak{\text{cos}}(kx) = 0$
и накладывает ограничение на вариации координат:

(7.6)
${\text{tg}}{{\varphi }_{0}} \cdot \delta x--\delta y = 0$

Для описания движения неголономной системы используем уравнения Рауса с множителями Лагранжа. В данном случае, на систему наложена одна неголономная связь (7.3). Система дифференциальных уравнений для модели, представленной на рис. 4 имеет вид:

(7.7)
$\begin{gathered} \theta {\text{s}}{{{\text{c}}}^{2}}{{\varphi }_{0}}\ddot {x} + ({{\eta }_{1}} + {{\vartheta }_{1}})(C_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - S_{1}^{\varphi })C_{1}^{\psi }{{{\ddot {\varphi }}}_{1}} - \\ \, - ({{\eta }_{1}} + {{\vartheta }_{1}})(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} + C_{1}^{\varphi })S_{1}^{\psi }{{{\ddot {\psi }}}_{1}} - ({{m}_{1}} + {{m}_{G}})(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - C_{1}^{\varphi })C_{1}^{\psi }{{{\ddot {\xi }}}_{{11}}} - \\ \, - {{m}_{G}}(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - C_{1}^{\varphi })C_{1}^{\psi }{{{\ddot {\xi }}}_{{12}}} - ({{\eta }_{1}} + {{\vartheta }_{1}})(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} + C_{1}^{\varphi })C_{1}^{\psi }\dot {\varphi }_{1}^{2} - \\ \, - ({{\eta }_{1}} + {{\vartheta }_{1}})(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} + C_{1}^{\varphi })C_{1}^{\psi }\dot {\psi }_{1}^{2} - 2({{\eta }_{1}} + {{\vartheta }_{1}})(C_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - S_{1}^{\varphi })S_{1}^{\psi }{{{\dot {\varphi }}}_{1}}{{{\dot {\psi }}}_{1}} + \\ \, + ({{m}_{1}} + {{m}_{G}})(C_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - S_{1}^{\varphi })C_{1}^{\psi }{{{\dot {\varphi }}}_{1}}{{{\dot {\xi }}}_{{11}}} + {{m}_{G}}(C_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - S_{1}^{\varphi })C_{1}^{\psi }{{{\dot {\varphi }}}_{1}}{{{\dot {\xi }}}_{{12}}} - \\ \, - 2({{m}_{1}} + {{m}_{G}})(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - C_{1}^{\varphi })C_{1}^{\psi }{{{\dot {\psi }}}_{1}}{{{\dot {\xi }}}_{{11}}} - 2{{m}_{G}}(C_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - S_{1}^{\varphi })C_{1}^{\psi }{{{\dot {\psi }}}_{1}}{{{\dot {\xi }}}_{{12}}} + \\ \, + \theta {\text{s}}{{{\text{c}}}^{2}}{{\varphi }_{0}}{\text{tg}}{{\varphi }_{0}}\dot {x}{{{\dot {\varphi }}}_{0}} = \theta {{g}_{1}} + {{R}_{x}} + {{R}_{y}}{\text{tg}}{{\varphi }_{0}} \\ \end{gathered} $
(7.8)
${{\ddot {\varphi }}_{0}} = 0$
(7.9)
$\begin{gathered} ({{\eta }_{1}} + {{\vartheta }_{1}})(C_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} - S_{1}^{\varphi })C_{1}^{\psi }\ddot {x} + {{\zeta }_{{11}}}{{(C_{1}^{\psi })}^{2}}{{{\ddot {\varphi }}}_{1}} + 2({{\eta }_{1}} + {{\vartheta }_{1}}){{(C_{1}^{\psi })}^{2}}{{{\dot {\xi }}}_{{11}}}{{{\dot {\varphi }}}_{1}} + \\ \, + 2{{\vartheta }_{1}}{{(C_{1}^{\psi })}^{2}}{{{\dot {\xi }}}_{{12}}}{{{\dot {\varphi }}}_{1}} - 2{{\zeta }_{1}}C_{1}^{\psi }S_{1}^{\psi }{{{\dot {\varphi }}}_{1}}{{{\dot {\psi }}}_{1}} + \\ \, + ({{\eta }_{1}} + {{\vartheta }_{1}})C_{1}^{\psi }C_{1}^{\varphi }{\text{s}}{{{\text{c}}}^{2}}{{\varphi }_{0}}\dot {x}{{{\dot {\varphi }}}_{0}} = {{M}_{{1\varphi }}} + {{R}_{x}}({{\xi }_{{11}}} + {{l}_{1}})\sin {{\varphi }_{1}} + {{R}_{y}}({{\xi }_{{11}}} + {{l}_{1}})\cos {{\varphi }_{1}} \\ \end{gathered} $
(7.10)
$\begin{gathered} - ({{\eta }_{1}} + {{\vartheta }_{1}})(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} + C_{1}^{\varphi })S_{1}^{\psi }\ddot {x} + {{\zeta }_{1}}{{{\ddot {\psi }}}_{1}} + {{\zeta }_{1}}C_{1}^{\psi }S_{1}^{\psi }\dot {\varphi }_{1}^{2} + 2({{\eta }_{1}} + {{\vartheta }_{1}}){{{\dot {\xi }}}_{{11}}}{{{\dot {\psi }}}_{1}} + \\ \, + 2{{\vartheta }_{1}}{{{\dot {\xi }}}_{{12}}}{{{\dot {\psi }}}_{1}} + g{{\eta }_{1}}C_{1}^{\psi } - \\ \, - ({{\eta }_{1}} + {{\vartheta }_{1}})S_{1}^{\varphi }S_{1}^{\psi }{\text{s}}{{{\text{c}}}^{2}}{{\varphi }_{0}}\dot {x}{{{\dot {\varphi }}}_{0}} = {{M}_{{1\psi }}} + {{R}_{x}}({{\xi }_{{11}}} + {{l}_{1}})\sin {{\psi }_{1}} + {{R}_{z}}({{\xi }_{{11}}} + {{l}_{1}})\cos {{\psi }_{1}} \\ \end{gathered} $
(7.11)
$\begin{gathered} ({{m}_{1}} + {{m}_{G}})(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} + C_{1}^{\varphi })C_{1}^{\psi }\ddot {x} + ({{m}_{1}} + {{m}_{G}}){{{\ddot {\xi }}}_{{11}}} + {{m}_{G}}{{{\ddot {\xi }}}_{{12}}} - ({{\eta }_{1}} + {{\vartheta }_{1}}){{(C_{1}^{\psi })}^{2}}\dot {\varphi }_{1}^{2} - \\ \, - ({{\eta }_{1}} + {{\vartheta }_{1}})\dot {\psi }_{1}^{2} + g{{m}_{1}}S_{1}^{\psi } + ({{m}_{1}} + {{m}_{G}})S_{1}^{\varphi }C_{1}^{\psi }{\text{s}}{{{\text{c}}}^{2}}{{\varphi }_{0}}\dot {x}{{{\dot {\varphi }}}_{0}} = {{F}_{1}} \\ \end{gathered} $
(7.12)
$\begin{gathered} {{m}_{G}}(S_{1}^{\varphi }{\text{tg}}{{\varphi }_{0}} + C_{1}^{\varphi })C_{1}^{\psi }\ddot {x} + {{m}_{G}}{{{\ddot {\xi }}}_{{11}}} + {{m}_{G}}{{{\ddot {\xi }}}_{{12}}} - {{\vartheta }_{1}}{{(C_{1}^{\psi })}^{2}}\dot {\varphi }_{1}^{2} - {{\vartheta }_{1}}\dot {\psi }_{1}^{2} + g{{m}_{G}}S_{1}^{\psi } + \\ \, + {{m}_{G}}S_{1}^{\varphi }C_{1}^{\psi }{\text{s}}{{{\text{c}}}^{2}}{{\varphi }_{0}}\dot {x}{{{\dot {\varphi }}}_{0}} = {{F}_{2}} \\ \end{gathered} $
где ζ1 = I1 + m1ξ11(l1 + $\xi _{{11}}^{{}}$) + mG(l1 + ($\xi _{{11}}^{{}}$ + $\xi _{{12}}^{{}}$))2, η1 = m111 + l1/2), ϑ1 = mG11 + l1 + + ξ12), θ = m0 + m1 + mG, θ1 = m1 + mG, $C_{1}^{\psi }$ = cosψ1, $S_{1}^{\psi }$ = sinψ1.

Были составлены также дифференциальные уравнения движения для сноубордиста с двумя звеньями переменной длины. Система дифференциальных уравнений для модели сноубордиста сохраняет вид (4.1). Однако, матрицы становятся матрицами следующего набора аргументов: Aκ(x, φ0, φ, ψ, ξα), нижние индексы у матриц указывают на описание соответствующей обобщенной координаты: κ = 1, …, 6, где 1 соответствует обобщенной координате x, 2 – φ0, 3 – φ, 4 – ψ, 5, 6 – ξα (α = 1, 2 – номер невесомого участка переменной длины на звене). Теперь в векторы обобщенных координат включаются дополнительные координаты: φ = (x, φ0, φ1, …, φn)т и ψ = (x, φ0, ψ1, …, ψn)т; ξα = = (x, φ0, ξ, …, ξnα)т; l = (x, φ0, l1, …, ln)т. $\dot {\Phi }$ = diag($\dot {x}$, ${{\dot {\varphi }}_{0}}$, ${{\dot {\varphi }}_{1}}$, …,${{\dot {\varphi }}_{n}}$), $\dot {\Psi }$ = diag($\dot {x}$, ${{\dot {\varphi }}_{0}}$, ${{\dot {\psi }}_{1}}$, …, ${{\dot {\psi }}_{n}}$) – диагональные матрицы.

Матрицы Aκ, Bκ и т.д. распадаются на блочные матрицы, с различными блоками, соответствующими первым двум обощенным координатам, и остальным обобщенным координатам, аналогично тому, как это было в модели антропоморфного механизма в безопорной и двухопорной фазах движения, рассмотренных в работе [10].

(7.13)

Были получены обобщения матриц для модели n-звенного лыжника-сноубордиста. Приведем, для примера, обобщающие формулы для матрицы А. Матрица А распалась на блоки, показанные в формуле (7.13). Верхний левый блок матрицы A (показанный сплошной линией), содержащий первые две строки и столбца дает уравнения, описывающие движение точки крепления ноги к лыже

(7.14)
${{a}_{{11}}} = \sum\limits_{k = 0}^n {({{m}_{k}} + {{m}_{G}}),\quad {{a}_{{22}}} = 1,\quad {{a}_{{2j}}} = {{a}_{{i2}}} = 0\quad (i = j \ne 2)} $

Формулу для части матрицы А блоков, содержащих информацию о движении лыжи и неголономной связи, показанных штрих-пунктирным выделением, запишем только для верхней строки, так как эти блоки являются симметрическими. Как и прежде i – номер строки,  j – номер столбца. Для верхнего правого блока: i = 1,  j = 3, 4, …, n, при этом a1j = ai1.

(7.15)
${{a}_{{1j}}} = ({{\eta }_{{j - 2}}} + {{\vartheta }_{{j - 2,2}}})(C_{{j - 2}}^{\varphi }{\text{tg}}{{\varphi }_{0}} - S_{{j - 2}}^{\varphi })C_{{j - 2}}^{\psi }$

Формула для части матрицы А блока, расположенного снизу справа и выделенного пунктиром, содержащего информацию об угловых переменных представим следующим образом. Часть матрицы А является симметрической, поэтому достаточно привести для нее только диагональные и наддиагональные элементы, т.е., если i – номер строки, j – номер столбца, то i, j = 1, 2, …, n, при этом  ji.

Элементы симметрического блока матрицы А имеют вид:

(7.16)
${{a}_{{ij}}} = ({{\delta }_{{ij}}}{{\zeta }_{j}}_{{--2}} + (1--{{\delta }_{{ij}}})({{\eta }_{j}}_{{--2}} + {{\vartheta }_{j}}_{{ - 2}}){\text{cos}}({{\varphi }_{i}}_{{--2}}--{{\varphi }_{j}}_{{--2}})){\text{cos}}{{\psi }_{i}}_{{--2}}{\text{cos}}{{\psi }_{j}}_{{--2}}$
где δij – символ Кронекера: δij = $\left\{ \begin{gathered} 1,\quad i = j, \hfill \\ 0,\quad i \ne j, \hfill \\ \end{gathered} \right.$

$\begin{gathered} {{\zeta }_{j}} = {{I}_{j}} + {{m}_{j}}({{\xi }_{{j1}}}({{l}_{j}} + {{\xi }_{{j1}}}) + {{l}_{{j + 1}}}(2({{\xi }_{{j1}}} + {{\xi }_{{j2}}}) + {{l}_{j}})) \\ + \,\sum\limits_{j = 1}^n {{{m}_{{j + 1}}}{{{({{\xi }_{{j1}}} + {{\xi }_{{j2}}})}}^{2}} + {{m}_{G}}{{{({{l}_{j}} + ({{\xi }_{{j1}}} + {{\xi }_{{j2}}}))}}^{2}},} \\ \end{gathered} $
${{\eta }_{j}} = {{m}_{j}}\left( {{{\xi }_{{j1}}} + {{l}_{j}}{\text{/}}2 + \sum\limits_{j = 1}^n {{{l}_{{j + 1}}}} } \right) + \sum\limits_{j = 1}^n {({{\xi }_{{j1}}} + {{\xi }_{{j2}}}),\quad {{\vartheta }_{j}} = {{m}_{G}}({{\xi }_{{j1}}} + {{l}_{j}} + {{\xi }_{{j2}}})} $

Остальные элементы: aji = aij. Эта формула аналогична выражению (4.2), однако, ввиду добавления элемнтов в модели и увеличившейся громоздкости записана в более компактных выражениях, а не в полностью выписанном виде.

Таким образом, на основании формулы (4.2) возможно построить выражение (7.16), что позволяет упростить получение системы дифференциальных уравнений движения.

8. Численное моделирование динамики лыжника-сноубордиста. Рассмотрим динамику модели, состоящей из двух звеньев. Для этого систему уравнений движения (7.7)–(7.12) и связей (7.3), (7.5) необходимо дополнить с целью удержания звеном околовертикального положения. Дополнительные связи позволяют однозначно определить управляющие воздействия, обеспечивающие заданное состояние звеньев.

Рассматрим следующий набор связей:

(8.1)
${{\varphi }_{1}} - {{\varphi }_{0}} = 0$
(8.2)
$\left( {{{\xi }_{{11}}} + {{l}_{1}}} \right)\sin {{\psi }_{1}} = {{l}_{c}}$
где lc – заданное значение совместной длины.

Неголономная связь (7.3) может быть учтена, применив метод Чаплыгина. Связь (8.1) можно сразу учесть в выражении для функции Лагранжа. Таким образом, связи (8.2) и (5.5) определяют управляющие воздействия для движения по ${{\varphi }_{0}}$, ${{\xi }_{{11}}}$ и ${{\psi }_{1}}$.

Для анализа полученной системы (7.7)–(7.12), (7.3), (7.5), (8.1) и (8.2) используется численное интегрирование при помощи разностной схемы первого порядка. Для получения устойчивого численного решения применяется метод стабилизации связей.

Рассмотрим значение отклонений численного решения от уравнений связей со временем, представленном на рис. 7, 8. По рисункам видно, что управляющее воздействие, полученное численным методом с учетом стабилизации связей обеспечивает почти вертикальное положение верхнего звена.

Рис. 7
Рис. 8

9. Заключение. Разработана динамическая модель системы твердых тел с произвольным числом звеньев переменной длины, соединенных между собой шарнирами. Предложен матричный метод записи системы дифференциальных уравнений движения и получены обобщающие формулы для матриц, одна из которых приводится в качестве примера. Поставлена задача управления такой системой на основе метода стабилизации связей.

В качестве примера использования разработанной механической системы предложена пространственная модель лыжника-сноубордиста с неголономной связью и звеньями переменной длины. Каждое звено переменной длины состоит из двух невесомых участков переменной длины и абсолютно твердого весомого звена между ними. Проведено численное моделирование управляемого движения лыжника-сноубордиста. Установлено, что метод стабилизации связи позволяет реализовывать управляемое, устойчивое, целенаправленное движение такой неустойчивой системой как лыжник-сноубордист. Результаты моделирования могут быть использованы в дальнейшем для решения задач управления антропоморфными системами с неголономными связями.

Работа выполнена при финансовой поддержке гранта РФФИ, проект № 19-08-00261 А, и Министерства образования и науки РФ по Программе повышения конкурентоспособности РУДН “5-100”.

Список литературы

  1. Вукобратович М., Христич Д. Управление антропоморфическими системами // Управление в пространстве. М.: Наука, 1976. Т. 2. С. 180–187.

  2. Иванов А.В. Исследование математической модели экзоскелетона нижних конечностей // Ломоносовские чтения: тезисы докладов науч. конф. (16–25 апреля 2012, Москва, МГУ имени М.В. Ломоносова). М.: Издательство Московского университета, 2012. С. 84.

  3. Лавровский Э.К., Письменная Е.В. Алгоритмы управления экзоскелетоном нижних конечностей в режиме одноопорной ходьбы по ровной и ступенчатой поверхностям // Мехатроника. Автоматизация. Управление. 2014. № 1. С. 44–51.

  4. Павловский В.Е. и др. Биомехатронный комплекс нейрореабилитации – концепция, конструкция, модели и управление // Препринты ИПМ им. М.В. Келдыша. 2014. № 111. 19 с. URL: http://library.keldysh.ru/preprint.asp?id=2014-111

  5. Механика и управление экзоскелетами нижних конечностей для нейрореабилитации спинальных больных / А.П. Алисейчик, И.А. Орлов, В.Е. Павловский, В.В. Павловский, А.К. Платонов // ХI Всероссийский съезд по фундаментальным проблемам теоретической и прикладной механики: аннотации докладов. (Казань, 20–24 августа 2015 г.). Казань: Издательство Академии наук РТ, 2015. С. 319.

  6. Формальский А.М. Об одном способе управления экзоскелетоном // Ломоносовские чтения: тезисы докладов науч. конф. (16–25 апреля 2012, Москва, МГУ имени М.В. Ломоносова). М.: Издательство Московского университета, 2012. С. 151–152.

  7. Формальский А.М. Перемещение антропоморфных механизмов. М.: Наука, 1982. 368 с.

  8. Белецкий В.В. Двуногая ходьба: модельные задачи динамики и управления. М.: Наука, 1984. 288 с.

  9. Бербюк В.Е. Динамика и оптимизация робототехнических систем. Киев: Наукова думка, 1989. 192 с.

  10. Охоцимский Д.Е. и др. Опыт проектирования многоцелевого гидравлического шагающего шасси // Механика и управление движением шагающих машин. 1995. № 2. С. 103–111.

  11. Борисов А.В. Механика пространственной модели экзоскелета и антропоморфного робота // Вопросы оборонной техники. Научно-технический журнал. Технические средства противодействия терроризму. Серия 16. Вып. 3–4. 2018. С. 46–55.

  12. Борисов А.В., Розенблат Г.М. Моделирование динамики экзоскелета с управляемыми моментами в суставах и переменной длиной звеньев с использованием рекуррентного метода составления дифференциальных уравнений движения // Известия РАН. Теория и системы управления. 2018. № 2. С. 148–174.

  13. Неймарк Ю.И., Фуфаев Н.А. Динамика неголономных систем. М. Наука, 1967. 519 с.

  14. Черноусько Ф.Л., Болотник Н.Н. Локомоция многозвенных систем на плоскости: динамика, управление, оптимизация. М.: Издательство ИПМех РАН (Препринт № 1128), 2016. 154 с.

  15. Мухарлямов Р.Г. Моделирование процессов управления, устойчивость и стабилизация систем с программными связями // Известия РАН. Теория и системы управления. 2015. № 1. С. 15–28.

  16. Каспирович И.Е., Мухарлямов Р.Г. Применение метода стабилизации связей к задачам неголономной механики // LII Всероссийская конференция по проблемам динамики, физики частиц, физики плазмы и оптоэлектроники: тезисы докладов. Москва, РУДН, 17–19 мая 2016 г. Москва: РУДН, 2016. С. 112–116.

  17. Борисов А.В., Мамаев И.С., Килин А.А. Избранные задачи неголономной механики. Москва–Ижевск: Институт компьютерных исследований, 2005. 289 с.

  18. Калёнова В.И., Карапетян А.В., Морозов В.М., Салмина М.А. Неголономные механические системы и стабилизация движения // Фундаментальная и прикладная математика. 2005. Т. 11. № 7. С. 117–158.

  19. Борисов А.В., Розенблат Г.М. Матричный метод составления дифференциальных уравнений движения экзоскелета и управление им // Прикладная математика и механика. 2017. Т. 81. № 5. С. 511–522.

  20. Борисов А.В. Дифференциальные уравнения движения плоских стержневых систем со звеньями переменной длины в безопорной и двухопорной фазах движения для моделирования опорно-двигательного аппарата человека, экзоскелета и антропоморфного робота // Международный научный теоретико-практический альманах 2017. Вып. 2. Смоленск, 2017. С. 153–165.

Дополнительные материалы отсутствуют.