УДК 531/534: [57+61]
МОДЕЛИРОВАНИЕ УПРАВЛЯЕМОГО ДВИЖЕНИЯ ДВУНОГОГО АНТРОПОМОРФНОГО МЕХАНИЗМА
А.В. Чигарев1, А.В. Борисов2
1 Кафедра теоретической механики Белорусского национального технического университета, Беларусь, 220027, Минск, проспект Независимости, 65, e-mail: chigarev@rambler.ru
2 Кафедра высшей математики филиала Московского энергетического института, Россия, 214013, Смоленск, Энергетический проспект, 1, e-mail: borisowandrej@yandex.ru
Аннотация. C использованием лагранжева формализма и пакета «Ма^ета^са 6.0.3» получена система дифференциальных уравнений, моделирующих двуногую ходьбу одиннадцатизвенного стержневого механизма с деформируемыми элементами структуры. С целью получения оценок управляющих моментов в приведенных уравнениях была разработана методика пиктографической визуализации движений человека при ходьбе с использованием современных методов и средств видеосъемки. Приближенное решение обратной задачи динамики позволяет искать решение задачи управляемого движения (прямой задачи), используя найденные оценки. С целью получения модели, более адекватной реальным системам, учитывается деформируемость звеньев, что позволит учитывать рекуперацию энергии при естественной ходьбе. Известно, что протезирование, например, только одной ступни снижает энергоэффективность на четверть. Упругостью опорно-двигательной системы человека обусловлена также конечность скорости передачи импульсов при ударном контакте опорной ноги с поверхностью. На основе экспериментального определения оценок управляющих усилий существует возможность описания управления движением антропоморфного механизма с учетом деформируемости звеньев.
Ключевые слова: антропоморфный механизм, управляющие моменты, уравнения движения, упругие деформации, анимационная визуализация.
Введение
В настоящее время в конструировании антропоморфных механизмов различного назначения актуальной является задача создания энергоэффективных систем, устойчиво движущихся на двух ногах. Теоретическим и экспериментальным исследованиям в этом направлении посвящено много публикаций.
Одним из первых начал изучать процесс двуногого движения Н.А. Бернштейн [3, 4]. Он фиксировал движения человека методом циклосъемки. Этот метод после обработки позволяет определить координаты, углы различных конфигураций человека, а также скорости и ускорения. Моделирование движения ног человека проводилось с помощью шестизвенника.
Исследованиями в этом направлении занимались также сотрудники Центрального научно-исследовательского института протезирования и протезостроения, рассматривая данную проблему с позиций биомеханики и медицины [20, 24].
© Чигарев А.В., Борисов А.В., 2011
Чигарев Анатолий Власович, д.ф.-м.н., профессор, завкафедрой теоретической механики, Минск Борисов Андрей Валерьевич, к.т.н., доцент кафедры теоретической механики, Смоленск
09806267
В работах А.М. Формальского [25] развиты методы построения пяти- и семизвенных механизмов. Пятизвенный механизм состоит из пяти шарнирно сочлененных весомых звеньев, корпуса и двух одинаковых двухзвенных (бедро и голень) ног. В случае семизвенного механизма добавляются стопы, которые считаются невесомыми звеньями.
В работах [1, 2, 11, 12, 15, 17-19, 22, 23, 29-33, 37, 38, 41] описываются различные аспекты моделирования двуногой ходьбы, причем, как правило, авторы ограничиваются анализом механизмов с небольшим числом абсолютно твердых звеньев.
С развитием цифровых средств видеофиксации движений, анимационных возможностей, компьютерной техники стало возможным проводить численноаналитические исследования механизмов с большим числом звеньев, в том числе и с учетом их деформируемости [10, 21, 26, 36, 39, 40, 42].
Как известно, количество костей человека достигает 200, а степеней свободы 240, поэтому одним из путей приближения к реальности является учет как можно большего числа звеньев с упругими, упруго-вязкими свойствами, а также пластических свойств, что связано с накоплением повреждений, ползучестью и разрушением.
Целью работы является определение управляющих моментов для моделирования установившегося процесса ходьбы антропоморфного двуногого механизма и анимационной визуализации его движений.
Данная статья предлагает численно-аналитический метод моделирования двуногой ходьбы, сочетающий в себе данные экспериментов по визуализации процесса ходьбы и определению управляющих моментов реальных людей, применение формализма Лагранжа для получения математической модели с помощью пакета «Mathematica 6.0.3» [27].
Результаты сравниваются с данными, полученными ранее для моделей абсолютно жестких тел [5, 6], и с результатами других исследователей
[1, 11, 25].
Рассматривается возможность применения данных результатов для создания двуногих роботов.
Уравнения движения произвольной многозвенной динамической системы
С ДЕФОРМИРУЕМЫМИ ЭЛЕМЕНТАМИ СТРУКТУРЫ
Ранее авторами была создана и исследована математическая модель ходьбы антропоморфного механизма с абсолютно твердыми звеньями [5, 6]. Но при расчетах оказалось, что возникают слишком большие толчковые ускорения во время постановки ноги на опору. Силы, возникающие при постановке ноги на опору в такой модели, должны были бы привести к разрушению опорно-двигательного аппарата человека. Однако в реальности этого не наблюдается. Следовательно, подход к описанию ходьбы человека с помощью абсолютно жестких моделей не адекватен реальности. Поэтому необходимо учитывать в процессе ходьбы деформируемость звеньев, из которых состоит опорно-двигательный аппарат человека. Максимальные ускорения звеньев с учетом деформаций снижаются почти на порядок и соответствуют результатам, полученным другими авторами и с помощью других методов измерения [16].
При этом учитывается механизм рекуперации энергии, т.е. кинетическая энергия движения при постановке ноги не полностью диссипирует, а частично переходит в потенциальную энергию упруго деформирующихся звеньев, которая, в свою очередь, при смене опорной ноги частично преобразуется в кинетическую энергию при отталкивании. Скелет и составляющие его звенья работают как рекуператор энергии, преобразующий часть кинетической энергии движения в потенциальную энергию
упругого деформирования скелета и обратно. В этом одна из причин энергоэффективности походки человека по сравнению с антропоморфными роботами.
Это следует также учитывать при создании протезов, экзоскелетонов и, в конечном счете, антропоморфных роботов [11].
Если учитывать вязкость, то любое движение будет затухающим. Вязкость играет роль при больших скоростях и ускорениях. Поскольку при обычной ходьбе скорости незначительны, то в дальнейшем исследовании вязкостью пренебрегаем, учитывая только упругие деформации. При чисто упругой деформации возникают периодические колебания, что в реальных телах ведет к появлению и росту микроповреждений, усталости элементов скелета.
Рассмотрим модель ходьбы человека с учетом деформаций опорнодвигательного аппарата на основе одиннадцатизвенной механической системы. Все звенья предполагаются инерционными с массами тг- и моментами инерции I (/ = 1...11). Звенья системы соединяются на концах с помощью шарниров. В каждом подвижном соединении имеется возможность создания вращающего момента Мг(^).
За счет деформируемости отдельных элементов центр масс каждого звена изменяет свое положение и определяется через изменение длины звена. Координаты центров масс звеньев системы относительно выбранной системы отсчета определяются геометрическими соотношениями.
Для составления уравнений движения воспользуемся уравнениями Лагранжа
Л_
л
(дО
дді) ддг
- ^ = Qu (1)
где д - обобщенные координаты; Qi - обобщенные неконсервативные силы (і = 1, ..., п); Ь = Т- П.
Кинетическая энергия в обобщенных координатах имеет вид
Т = 2 Xт +д; ■ (2)
2 і .1 ^ * .1 дЯ, д )
Поскольку связи, наложенные на систему, стационарны, время не входит явно в уравнение связей и, следовательно, не входит явно в выражения, определяющие Г. В этом случае кинетическая энергия будет однородной квадратичной формой от обобщенных скоростей.
Для і-го звена кинетическая энергия имеет вид
2 т • 2
т = тж + 1л. (3)
2 2 ’
где т, - масса і-го звена; уСі - скорость центра масс і-го звена; I - момент инерции і-го звена относительно его центра масс; (рг. - угловая скорость і-го звена (і = 1, ., 11). Скорость центра масс уСі і-го звена найдем следующим образом:
Уа = У1а + Ууа. (4)
Вертикальная и горизонтальная составляющие скорости -го звена равны:
У ^ У = ЛУа1_ (5)
УхСі л ’ Ууа л • (5)
Тогда, подставляя выражения для скорости, получаем кинетическую энергию -го звена.
Запишем потенциальную энергию і-го звена (і = 1, ., 11):
Е
Пг = т,^уа + —
Ч -1,
2_________1о_
і,
V го J
(6)
2
Кинетическая энергия механизма складывается из кинетических энергий отдельных звеньев и корпуса.
Т = Ёт . (7)
г=1
Потенциальная энергия механизма складывается из потенциальных энергий отдельных звеньев и корпуса.
П = £ П(. (8)
г=1
Обобщенные силы Qi находятся обычным образом из элементарной работы 5А всех сил, приложенных к системе. Для потенциальных сил имеет место соотношение
„ дП
& = - ^ (9)
дЧг
где в число обобщенных координат входят углы, а в саму потенциальную энергию в общем случае - соответствующие моменты, умноженные на угловые координаты.
Подставляя Т, П, &г в уравнения Лагранжа, получаем уравнения движения динамической системы.
Модель и уравнения движения стержневой биомеханической системы с деформируемыми элементами структуры
Для исследования плоского движения биомеханической системы в одноопорной фазе введем неподвижную правую декартову систему координат xyz с началом в точке О и плоскостью ху, в которой происходит движение центра масс. Система имеет две трехзвенные весомые ноги, две двухзвенные весомые руки и весомый корпус. Все элементы структуры являются упругими, и длины стержней являются функциями времени: 1г = /() (г = 1, ..., 11). На рис. 1 схематично изображен механизм и введены соответствующие обозначения.
Пусть О1А1 = /1, А1В = /2, В1С = /3, В2С = /4, А 2В = /5, О2А2 = /б, CG = /7, DEl = /8, Е1Е1 = /9, DE2 = /10, Е2¥2 = /11 - длины звеньев биомеханической системы. Положение в одноопорной фазе однозначно определяется углами ф( и длинами стержней /г (г = 1, ..., 11), поэтому рассматриваемая система имеет двадцать две степени свободы. Обозначим через Мг моменты, развиваемые в г-ом шарнире (г = 1, ..., 11).
Центры масс находятся в точках: С1 - стопы опорной ноги, С2 - голени опорной ноги, С3 - бедра опорной ноги, С4 - бедра переносной ноги, С5 - голени переносной ноги, Сб - стопы переносной ноги, С7 - корпуса, С8, С10 - плеч, С9, С11 - предплечий. Их положения будем задавать в виде отношений длины от начала соответствующего звена до центра масс ко всей длине звена через множители пг (г = 1, ..., 11), (0 < пг < 1) (если все звенья перенумеровать по номерам индексов у соответствующих углов). Такой способ задания положений центров масс предпочтительней, так как для человека положения центров масс конечностей определяются эмпирическим путем и задаются в процентном отношении одной части звена к другой [17], кроме того, он позволяет учесть изменение положения центра масс во время движения через известные деформации звена.
С помощью т1, тб; т2, т5; т3, т4; т8, т10; т9, т11; т7 обозначены массы стопы, голени, бедра, плеч, предплечий и корпуса соответственно. Моменты инерции соответственно обозначены как /1-/11. Правую и левую конечности механизма будем считать разными.
Рис. 1. Модель плоского движения стержневой механической системы с изменяемой
геометрией звеньев в одноопорной фазе
При расчетах и моделировании движения биомеханической системы все вышеприведенные характеристики берутся равными соответствующим экспериментальным данным человека.
Так как активных внешних сил нет, то движение происходит только под действием внутренних сил и внешних реакций. Связь в точке О1 реализуется в виде идеального шарнира и является двусторонней, или удерживающей. Предполагаем, что переносимая нога свободная и к ней не прикладываются никакие внешние силы. Обозначения действующих в суставах моментов соответствуют обозначениям углов. Моменты, действующие в системе, изображены на рис. 2. Согласно методу декомпозиции механизм изображен в разделенном на составные звенья виде.
Составим выражение для элементарной работы 5A всех сил, приложенных к системе.
5A = (Ml — М2)5ф! + (M2 — Мз)5ф2 + (M3 — Му)5фз +(— M5 + М4)8ф4 +
+ (M5 — M6^5 +(M6^6 +(M4 + .^^у)5ф7 +(— M9 + .^^Обфд +(^^9)5ф9 + (10)
+ (- Mii + Mlo)5фlo +(Mii^n.
Отсюда получаем обобщенные силы. Для краткости запишем обобщенные силы только для первого звена. Всего таких сил 22.
Q1 = - gl1(m + m2 + m3 + m1n1)cosф1 + M1 - M2,
Q12 = - — + - g(m + m2 + m3 + т^^тфь (11)
l1 li
10 10
Подставляя (3), (6) в (1), получим систему уравнений движения
антропоморфного одиннадцатизвенного механизма, описывающую изменение угловых координат звеньев и колебаний длин звеньев механизма. Уравнения получены с использованием символьных методов системы компьютерной математики «Mathematica 6.0.3», что гарантирует правильность математических выкладок [5, 9, 14].
Поскольку полученные уравнения движения антропоморфного механизма существенно нелинейны и весьма громоздки, контроль правильности полученных уравнений осуществлялся с помощью общих теорем динамики [5]. В итоге эти уравнения совпали. Достоверность была проверена с помощью уравнений работы [25]: были получены уравнения пятизвенного (с весомыми конечностями) и семизвенного (с невесомыми стопами) механизмов. С помощью предельного перехода уравнения, полученные для данной модели, также совпали с уравнениями [25].
Отметим, что система дифференциальных уравнений, которая была записана для модели с абсолютно твердыми звеньями [5], не имела существенно более простого вида и также была нелинейной, хотя и менее громоздкой, и решалась численными методами.
Приведем первые уравнения. Структура других уравнений аналогична.
(I1 + l12(m + m2 + m3 + m1n12)) ф1 + l1l2(m + m3 + m2n2)cos^ - ф2) ф2 +
+ l1l3(m + m3n3)cos^ - ф3) ф3 - l1l4mncos^1 - ф4) ф4 - l^mgcos^ - ф5) ф5 +
+ l^m,cos^l - фб) ф6 + lllym^cos^l - фу) ф7 + lll8mrcos(фl - фв) ф8 +
+ ll^m^cos^l - ф9) ф9 + llllomrcos(фl - фю) ф10 + lllnm^cos^l - фП) ф11 +
+ lll2(m + m3 + m2n2)sin^l - ф2) |^ф2 j + lll3(m + m3n3)sin^l - ф3)|^ф3 j -
(12)
- /i^mnsm^i - ф4)^ф4 J - /i^mgsin^i - фз)|^ф5 J + hkmsm^i - фб)|^фб J +
+ /i^m^in^i - ф7) |^ф7 j + /l/8mrsin(фl - ф8) |^ф8 j + /l/9mpSІn(фl - ф9) |^ф9 j +
+ /1/ют^т(ф1 - фю) |ф10 | + /l/llmpsin(фl - фП) ^ф„ | +
+ g/1(m + т2 + т3 + m1n1)cosф1 + 2/1(т + т2 + т3 + т1п12) /1 ф1 +
+ 2/1(т + т3 + m2n2)cos(ф1 - ф2) /2 ф2 + 2/1(т + m3n3)cos(ф1 - ф3) /3 ф3 -
- 2/lm„cos(фl - ф4) /4 ф4 - 2/тё^(ф1 - ф5) /5 ф5 - 2Лт,^(ф1 - фб) /б фб +
+ 2/1mkcos(ф1 - ф7) /7 ф7 + 2/1mrcos(ф1 - ф8) /8 ф8 + 2/1mpcos(ф1 - ф9) /9 ф9 +
+ 2/lmrcos(фl - фю) /10 ф10 + 2/lmpCOs(фl - фц) /11 ф11 - /1(т + т3 + т2т) х
х sin(ф1 - ф2) / 2 - /1(т + m3n3)sin(ф1 - ф3) / 3 + /1тп^т(ф1 - ф4) / 4 +
+ /lmgsin(фl - ф5) / 5 - /1т,^т(ф1 - фб) / б - Дт^Пф - фу) / 7 -- /1mrsin(ф1 - ф8) / 8 - /1т^т(ф1 - ф9) / 9 - /1т^т(ф1 - ф10) /10 -- /lmpsin(фl - фи) /11 = М1 - М2;
/2(т + т3 + m2n2)sin(фl - ф2) ф2 + /3(т + mзnз)sin(фl - ф3) ф3 - /4m„sin(фl - ф4) ф4 -
- /5mgsin(фl - ф5) ф5 + /5т^т(ф1 - фб) фб + /7т^т(ф1 - ф7) ф7 + /8т^т(ф1 - ф8) ф8 +
+ /9mpsin(фl - ф9) ф9 + /ют^т(ф1 - фю) ф10 + /llmpsin(фl - фп) ф11 -
- /2(т + т3 + т2П2)^(ф1 - ф2) |ф2 ^ - /3(т + mзnз)cos(фl - ф3) |^ф3 | +
+ /4тп^(ф1 - ф4)|ф4^ + /5mgCOs(фl - ф5)|ф5 ^ - /бm,cos(фl - фб)|^фб| -
- /7mkcos(фl - ф7)|ф71 - ктг^(ф1 - ф8)|ф81 - /9mpCOs(фl - ф9)|ф91 -
- /юmrcos(фl - фю)^ф10| - /llmpCOs(фl - фп) |ф„ ^ + g(m + т2 + т3 + mlnl)sinфl -
- 2/1(т + т2 + т3 + т1п12) I ф1 | + 2(т + т3 + т^^Пф - ф2) / ф2 +
(13)
+ 2(т + т^^Пф - ф3) /3 ф3 - 2mnsin(ф1 - ф4) /4 ф4 - 2mgsin(ф1 - ф5) /5 ф5 -
- 2т^т(ф1 - фб) /б фб + 2т^т(ф1 - ф7) /7 ф7 + 2т^т(ф1 - ф8) /8 ф8 +
+ 2mpsin(фl - ф9) /9 ф9 + 2т^т(ф1 - фю) /10 ф10 + 2mpsin(фl - фП) /11 ф11 +
+ (т + т3 + m2n2)cos(ф1 - ф2) / 2 + (т + m3n3)cos(ф1 - ф3) / 3 - mncos(ф1 - ф4) / 4 -
- mgcos(ф1 - ф5) / 5 + т, cos(ф1 - фб) / б + mkcos(ф1 - ф7) / 7 + mrcos(ф1 - ф8) / 8 +
+ mpcos(ф1 - ф9) /9 + mrcos(ф1 - ф10) /10 + mpcos(ф1 - ф11) /11 - — + +
/1 /12
.. 10 ^
+ (т + т1 + т2 + т3 + т1п12) /1 = 0,
где т = т1 + т2 + т3 + т7 + 2 т8 + 2 т9, тг = т8п8 - т8 - т9, тр = т9(п9 - 1), тп = т1 + т2 + т3 - т3п3, mg = т1 + т2 - т2п2, т, = т1(п1 - 1), тк = т7п7 + 2(т8 + т9)п7^.
2
2
2
Таким образом, составлены уравнения, описывающие изменение угловых переменных и длин стержней одиннадцатизвенной механической системы с деформируемыми элементами, моделирующей движения человека. Уравнения движения механизма в одноопорной фазе представляют собой систему 22 нелинейных дифференциальных уравнений.
Общее решение системы уравнений движения зависит от сорока четырех произвольных постоянных, поэтому для однозначного определения движения требуется задать начальные условия движения. Для угловых координат имеют место формулы (14), для колебаний длин звеньев - (15).
фі І-о = Фі°; Ф21=0 -ф2; Фз І=0 -фЗ; Ф4 І=0 -ф4; Фз І=0 =ф“; Фб I=0 = ф0;
і 2 1 ° I 2 1 2 1 °
ф7 |і-о ф7 ; ф8 |і-о = ф8 ; ф9 |і-о = ф9 ; ф1° |і-о = ф1° ; ф11 |і-о =ф11;
ф1 1=о = ®1 ; Ф 2 [=о -®2’ ф3 |і-о = ®3> Ф 4 |і-о =®4> ф5 |і-о = ®5> фб |і-о -®6’
ф7 |і-о -®7’ ф8 [-о = ®8> ф9 [=о = ®9> ф12 [-о =®12’ ф11 |і-о =®11>
1 1=0 = 11° ; 12 [=о = 12° ; 13 I =о = 13° ; 14 I =о = 14° ; 15 [-о = 15° ; 1б [-о = 1б° ;
1 [ =о = 17° ; 18 \(=о = 18° ; 1 9 =о = 19° ; 112|,=о = 112° ; 111 I =о = 111°';
(14)
11„; 12
і-о = 17„; 1
і-о = 18„ ; 19
і-о = 1 % ; 112
= 15
і-о
= 112„ ; 111
= А ; іб
^ б
і-о
=
-
(15)
Предполагаем, что влияние начальных условий на походку быстро исчезает и можно рассматривать установившееся движение, поэтому выполняются условия периодичности
ф»(0=ф«(*+т) (» = 1, ..., 11) (1б)
(17)
и условия повторяемости
Ф1 (і)-Фб(і + х*) ф2(і)-Фз(і + х*) Фз(і)-Ф4(і + х*),
Ф8 (0-Ф12 (і + Т* )і Ф9 (і)-Фп (і + Т* )
(вторая нога и рука в точности повторяют движение первой с запаздыванием на
время X ).
Когда нога ставится на опору, скорость и ускорение скачком изменяются. В процессе ходьбы переносимая нога становится опорной и наоборот.
Таким образом, формулируется прямая задача динамики - решить полученную систему уравнений с заданной правой частью, которую находим из эксперимента. Определив экспериментально моменты, используем эти результаты в полученных уравнениях и рассмотрим установившийся процесс ходьбы.
Проанализируем один из возможных вариантов учета деформируемости звеньев. Будем считать, что звенья ноги являются двухкомпонентными композитами. Одна компонента имеет упругие модули кости, другая - упругие модули хрящевой ткани. Эффективные модули звеньев рассчитываем по формулам схемы Фойхта
ЕФ - Ег(1)С(1) + Ег(2)С(2), С(1) + С(2) - 1,
(18)
где Е»(а) - модуль Юнга для а =1 - кости, для а = 2 - хрящевой ткани »-го звена,
С(а) - объемные концентрации кости (а - 1)
С V л
п _______ кости
(1) - V
\ звена у
, хрящевой ткани (а - 2)
( V л
п ______ ткани
(2) - V
звена
і-о
і-о
і-о
і-о
і-о
і-о
Для схемы Рейсса имеем
с^ с
7-Я
= (1) + -^. (19)
Ек Е Е
Е» Е»(1) »(2)
Истинное значение модуля Юнга »-го звена Е» находится между нижней (Рейсса) и верхней (Фойхта) границами:
Е»к < Е» < Е»Ф. (20)
Оценка модулей упругости по Хиллу [3б] определяется согласно формуле
ЕН = 1(Е^ + ЕФ). (21)
2
Полученные значения ЕН подставим в уравнения динамики (12), (13).
Кости человека при движении не испытывают предельных нагрузок и значительных деформаций (не более 1% [13]). Однако в данной работе учитываются не только деформации костей, но и деформации, связанные с наличием мышечной ткани, сухожилий, суставов, и они больше, чем деформации кости. В общем случае каждый из этих компонентов во время нагрузок и связанных с ними деформаций является нелинейным, но если распределить деформации по всему звену, то эти усредненные деформации в первом приближении будем считать линейными. Исходя из этого упрощения воспользуемся в первом приближении для учета деформаций законом Гука, согласно которому удлинение стержня при упругой деформации пропорционально действующей на стержень силе:
17 Ег8г А7
Fi = -у-»-А/,., (22)
/0»
где Fi - сила, действующая на конце ,-го стержня, /0» - длина ,-го недеформированного стержня, - площадь поперечного сечения ,-го стержня, А/» - изменение длины ,-го стержня, А/» = /» - /0»; Е» - модуль Юнга для /-го стержня.
Выражая изменение длины стержня, получаем выражение для деформации
звена:
¥/„. , ч
(23)
Е&
Таким образом, создана механико-математическая модель стержневой биомеханической системы, моделирующая опорно-двигательный аппарат человека и состоящая из одиннадцати деформируемых элементов. Составлены уравнения движения, сформулированы начальные условия, условия контакта и условия непрерывности.
Экспериментальное определение управляющих воздействий
Была проведена съемка движений людей по разработанной авторами методике [39]. Идея фиксации кинематических характеристик движений принадлежит Бернштейну [4], однако в настоящее время с развитием аппаратной базы и современных цифровых технологий она значительно усовершенствована [35]. Для каждого участника эксперимента были определены линейные и инерционные характеристики звеньев кинематической цепи опорно-двигательного аппарата [8]. Их движения записывались с помощью системы видеокамер [7]. Эксперимент проводился на базе Смоленской государственной академии физической культуры, спорта и туризма. В эксперименте принимали участие студенты-спортсмены, профессионально владеющие техникой спортивной ходьбы.
Кадры кинограмм содержат много лишней информации, не нужной для исследования кинематики и динамики движения человека, поэтому возник вопрос об удалении лишней информации и сохранении информации только о движениях звеньев человека.
Исходя из этого появилась необходимость разработки методики моделирования движения человека в виде многозвенной системы. Методику назвали пиктографической визуализацией - вместо изображения человека создается его схематическая модель в виде многозвенного механизма. Движение управляется данными, которые взяты из кинограмм, или данными, которые поставляет программа, решающая дифференциальные уравнения движения.
Анимационное моделирование человека проведено одиннадцатизвенным механизмом, рассмотренным выше.
К достоинству моделирующей программы следует отнести то, что в качестве управления координатами она использует данные из файла. Благодаря этому она становится универсальной, а различия сводятся к методам формирования файла.
Предложенная методика может использоваться для пиктографического моделирования разнообразных движений.
Чтобы определить моменты в суставах, необходимо дифференцировать угловые координаты и длины звеньев механической системы. По полученным экспериментальным точкам строятся аналитические кривые. Пользуясь сплайновой интерполяцией полиномами третьей степени, можно получить первые и вторые непрерывные производные для всего времени движения.
Поскольку бег, ходьба, приседание и т.п. являются циклическими движениями, достаточно рассмотреть один период.
Далее построим для одного шага ряд графиков экспериментально определенных углов в зависимости от времени и графики построенных интерполяционных функций (рис. 3, а). На рисунке приведены графики углов наклона стопы и голени опорной ноги.
Рис. 3. Зависимости от времени за период одного шага: а - угла поворота, б - угловой скорости, в - углового ускорения (индекс 2 относится к голени опорной ноги,
3 - к бедру опорной ноги)
Мм
1500
100С
500
50С
0
Рис. 4. Зависимости управляющих моментов для стержневой механической системы с деформируемыми звеньями от времени за один период шага: М2 - коленный сустав опорной ноги, М3 - тазобедренный сустав опорной ноги
Дифференцируя интерполяционные функции, находим угловую скорость и угловое ускорение (рис. 3, б, в).
С увеличением темпа ходьбы (обычной) на 38% (с 82 до 114 шагов в минуту) среднее значение угловой скорости в голеностопном суставе составило 66% по сравнению с соответствующими значениями при медленном темпе ходьбы.
По сравнению с четвероногими нога человека испытывает двойную нагрузку при опоре и ходьбе. При этом при каждом шаге стопа испытывает ударные нагрузки, соответствующие (18-20)^, т.е. максимальная ударная нагрузка на стопу при обычной ходьбе в два раза превышает ускорение стартующего космического корабля.
Огромное толчковое ускорение до 70% гасится благодаря сводчатому строению стопы. В итоге на голень действует только (6-7^, на бедро (4-5^, на таз (3-4^, до головы доходит (0,5-1^ ускорения.
Подставляя полученные интерполяционные функции в систему дифференциальных уравнений, выведенных выше, получаем выражения для управляющих моментов. Управляющие моменты необходимо рассчитывать в то время, когда одна нога опорная, другая переносится, и наоборот. Так как ходьба является циклическим движением, то достаточно рассмотреть один период. Стартовые эффекты не исследуются. В итоге получены зависимости, приведенные на рис. 4.
Полученные моменты не являются монотонными функциями. Результат расчета показывает, что среднее значение момента в целом убывает. В центре шага движение идет по инерции, момент в среднем равен нулю. Острые углы и колебания относительно нуля - результат аппроксимации.
Управление носит импульсный характер в начале и конце шага, а в середине фазы идет по инерции, что согласуется с [25].
Видно, что зависимости моментов для опорной ноги подобны, а их максимальные значения убывают по мере подъема от коленного до тазобедренного суставов.
Таким образом, решена обратная задача динамики.
Энергия упругой деформации звеньев механической системы при движении
Работа внешней силы ¥, запасаемая в упругом стержне в процессе деформирования и возвращаемая при разгрузке (диссипация отсутствует), равна [28]
(24)
где с/ - жесткость /-го звена, s/ - удлинение /-го звена.
В процессе ходьбы при постановке ноги на опору происходит преобразование кинетической энергии в потенциальную энергию деформации скелета, которая при смене ног упруго отдается при отталкивании. Изменение кинетической энергии:
Т/2 - Т/1 = Зд. (25)
В результате расчетов получаются следующие значения: Wl = 2,25 Дж, W2 = 2,25 Дж, Wз = 1,47 Дж - для опорной ноги. Все остальные значения имеют максимальные значения не более 0,1 Дж и меньше, поэтому здесь они не приводятся.
Решение системы дифференциальных уравнений движения
На основе решения прямой задачи динамики создана анимационная модель антропоморфного механизма, движущаяся на экране компьютера. Управление движением можно осуществить двумя методами:
1. В качестве моментов используем данные, полученные из кинограмм. Сопоставляя решение системы с исходными кинограммами, можно проверить корректность всей процедуры моделирования движения антропоморфных механизмов. Для такого сопоставления используем визуализацию движений с помощью методики пиктографической визуализации. Результаты совпадают, что свидетельствует о корректности проведенных исследований и достоверности полученных результатов.
2. Моменты задаются исходя из каких-то других соображений (принципа минимума энергии и т.д.).
Во всех рассматриваемых случаях уравнения движения являются системой нелинейных дифференциальных уравнений второго порядка. В связи с большим размером и существенной нелинейностью системы уравнений весьма сложно провести даже численный расчет процесса шага. Численное решение методом Рунге-Кутта проводилось в «Ма&етШ/еа 6.0.3». Параметры системы брались равными соответствующим параметрам моделируемого человека. Задавались начальные условия исходя из данных эксперимента в начале шага.
В результате решения системы дифференциальных уравнений движения по найденным зависимостям углов от времени созданы анимационные модели движения. Представим несколько кадров соответствующих анимационных пиктографических моделей движения антропоморфного механизма (рис. 5), а также зависимости углового перемещения, скорости и ускорения для звеньев механизма, получающиеся в результате решения системы дифференциальных уравнений движения (рис. 6).
В результате решения системы дифференциальных уравнений движения с заданными управляющими моментами получены зависимости угловых перемещений от времени. По ним проведено анимационное моделирование движения. Сопоставляя с
Рис. 6. Зависимости углового перемещения (а), скорости (б) и ускорения (в) (слева направо в строках) от времени для решения системы уравнений (везде индексы 2 относятся к голени
опорной ноги, 3 - к бедру опорной ноги)
анимационными моделями, полученными непосредственно с помощью данных кинограмм и кадров кинограмм, видно, что расчетное движение аналогично реальному, и это достаточно убедительно доказывает правильность расчетов и корректность всей процедуры моделирования.
Анализируя построенные зависимости угловых перемещений от времени (см. рис. 3, 6), выявим, что, несмотря на совпадение в целом, возникают отдельные небольшие максимумы и минимумы, которых не было в исходном движении. Это можно объяснить несовершенством предложенной методики фиксирования локомоций человека, так как незначительные изменения, происходящие кратковременно, не были зафиксированы. Однако несмотря на это предложенная модель в целом хорошо описывает движение систем с деформируемыми элементами структуры.
Выводы
1. Определенные экспериментально моменты подтверждают выводы А.М. Формальского об импульсном управлении движением.
2. Решение прямой задачи численно достаточно надежно подтверждает возможность использования выбранных интерполяционных методов.
3. Применение пиктографического метода визуализации движения позволяет упростить систему, сведя ее к системе с сосредоточенными параметрами.
Благодарности
Работа выполнена в рамках и при финансовой поддержке гранта Президента Российской Федерации № МК-2524.2008.1.
Список литературы
1. Белецкий В.В. Двуногая ходьба: модельные задачи динамики и управления. - М.: Наука, 1984. -288 с.
2. Бербюк В.Е. Динамика и оптимизация робототехнических систем. - Киев: Наукова Думка, 1989. -192 с.
3. Бернштейн Н.А. О построении движений. - М.: Медгиз, 1947. - 252 с.
4. Бернштейн Н.А. Избранные труды по биомеханике и кибернетике. - М.: СпортАкадемПресс, 2001. -296 с.
5. Борисов А.В. Составление уравнений движения одиннадцатизвенного антропоморфного механизма при помощи общих теорем с абсолютно твердыми и деформируемыми звеньями // Науч. тр. Междунар. науч.-практ. конф. ученых МАДИ(ГТУ), МСХА, ЛНАУ (29-30 июня 2004 г.). - 2004. -Т. 4. - С. 104-110.
6. Борисов А.В. Построение движений антропоморфных механизмов с использованием информации об управлении в суставах, полученной от человека. // Человек, здоровье, физическая культура и спорт в изменяющемся мире: XIII Междунар. науч.-практ. конф. по проблемам физического воспитания учащихся. - Коломна, 2003. - Т. 1. - С. 160-161.
7. Борисов А.В. Методика съемки циклических движений спортсменов // Сб. науч. тр. молодых ученых. - Смоленск: СГИФК, 2004. - Вып. 11. - С. 16-21.
8. Борисов А.В. Методы определения длин конечностей и звеньев человека с расчетом инерционных характеристик // Науч. тр. Междунар. науч.-практ. конф. ученых МАДИ(ГТУ), МСХА, ЛНАУ (5-6 января 2004 г.). - М., 2004. - Т. 4. - С. 77-90.
9. Веретенников В.Г. Теоретическая механика. Вывод и анализ уравнений движения на ЭВМ. - М.: Высш. шк., 1990. - 174 с.
10. Воронов А.В. Анатомическое строение и биомеханические характеристики мышц и суставов нижней конечности. - М.: Физкультура, образование и наука, 2003. - 203 с.
11. Вукобратович М. Шагающие роботы и антропоморфные механизмы. - М.: Мир, 1976. - 541 с.
12. Вукобратович М., Стокич Д. Управление манипуляционными роботами: теория и приложения. - М.: Наука, 1985. - 384 с.
13. Дубровский В.И., Федорова В.Н. Биомеханика. - М.: Владос-Пресс, 2003. - 672 с.
14. Дьяконов В.П. Mathematica 5.1/5.2/6 в математических и научно-технических расчетах. - М.: СОЛОН-ПРЕСС, 2008. - 744 с.
15. Загревский В.И. Программирование обучающей деятельности спортсменов на основе имитационного моделирования движений человека на ЭВМ: автореф. дисс. ... д-ра физ.-мат. наук. -Томск, 1992.
16. Зациорский В.М., Каймин М.А. Биомеханика ходьбы. - М.: 1978. - 65 с.
17. Зациорский В.М., Аруин А.С., Селуянов В.Н. Биомеханика двигательного аппарата человека. - М.: Физкультура и спорт, 1981. - 143 с.
18. Зинковский А.В., Макаров Н.В., Шолуха В.А. Компьютерный анализ адекватных моделей антропоморфных локомоций, 1990. - С. 56-60.
19. Зинковский А.В., Шолуха В.А. Антропоморфные механизмы, моделирование, анализ и синтез движений. - Л.: СПбГТУ, 1992. - 71 с.
20. Морейнис И.Ш., Гриценко Г.П., Левит С.Г. Биомеханический анализ ходьбы в норме и на протезах. - М.: ЦНИИПП, 1971. - С. 7-16.
21. Новожилов И.В., Кручинин П.А., Копылов И.А. Математическое моделирование сгибательно-разгибательных движений нижних конечностей при изменении вертикальной позы человека. - М.: Изд-во механико-математического факультета, 2001. - 52 с.
22. Прилуцкий Б.И., Зациорский В.М. Нахождение усилий мышц человека по заданному движению. -Н. Новгород, 1993. - С. 81-123.
23. Третьяков В.П., Штарк М.Б., Шульман Е.И. Принципы построения и функционирования проблемноориентированных программных систем автоматизации исследований в экспериментальной биологии на основе микроЭВМ и КАМАК //Автометрия. - 1986. - № 3. - С. 3-22.
24. Фарбер Б.С., Витензон А.С., Морейнис И.Ш. Теоретические основы построения протезов нижних конечностей и коррекции движения. - М.: ЦНИИПП, 1995. - 302 с.
25. Формальский А.М. Перемещение антропоморфных механизмов. - М.: Наука, 1982. - 368 с.
26. Чигарев А.В., Михасев Г.И., Борисов А.В. Биомеханика. - Минск: Изд-во Гревцова, 2010. - 284 с.
27. Чигарев А.В., Кравчук А.И., Кравчук А.С. Основы системы Mathematica 6.0. Задачи и решения. -Минск: Технопринт, 2008. - 136 с.
28. Циглер Ф. Механика твердых тел и жидкостей. - М.; Ижевск: РХД, 2002. - 912 с.
29. Capozzo A. A general computing method for the analysis of human locomotion // Journal of Biomechanics. - 1975. - Vol. 18. - P. 307-370.
30. Dul J., Jonson G.E., Shiavi R., Townsend M.A. Muscular synergism - II. A minimum-fatigue criterion for load sharing between synergist muscles // Journal of Biomechanics. - 1984. - Vol. 17. - P. 675-684.
31. Dul J., Townsend M.A., Shiavi R., Jonson G.E. Muscular synergism - I. On criteria for load sharing between synergist muscles // Journal of Biomechanics. - 1984. - Vol. 17. - P. 663-673.
32. Dunfield D.L., Read J.F. Determination of reaction rates by using cubic spline interpolation // The Journal of Chemical Physics. - 1972. - Vol. 57, No. 5. - P. 2178-2183.
33. Hemami H. Modelling, control, and simulation of human movement // CRC Critical Reviews in Biomedical Engineering. - 1988. - Vol. 13, No. 1. - P. 1-34.
34. Hill R. The mathematical theory of plasticity. - Oxford: University Press, 1983.
35. http://www.biomotionlab.ca/
36. Kedzior K., Zagrajek T. A biomechanical model of the human musculoskeletal system. - Wien, New York: Springer-Verlag, 1997. - P. 125-153.
37. Laughlin T.M., Dillman C.J., Lardner T.J. Biomechanical analysis with cubic spline functions // Research Quarterly for Exercise and Sport. - 1978. - Vol. 48, No. 3. - P. 569-581.
38. Lumb J.R. Computer simulation of biological systems // Molecular and Cellar Biochemistry. - 1987. -Vol. 73. - P. 91-98.
39. Morecki A. Modeling and simulation and walking robot locomotion. -Wien, New York: Springer-Verlag, 1997. - P. 1-79.
40. Nordin M., Frankel H. Basic biomechanics of the musculoskeletal system. - London: Lippicot Williams & Wilkins, 2001. - 467 p.
41. Schenau I., Van G.J., Bakker K.A. Energy cost of speed-skating and efficiency of work against air resistance // Journal of Biomechanics. - 1976. - Vol. 40, No. 4. - P. 584-4591.
42. Voronov A.V., Lavrovsky E.K., Zatsiorsky V.M. Modelling of rational variants of the speed-skating technique // Journal of Sport Sciences. - 1995. - Vol. 13, No. 2. - P. 153-170.
SIMULATION OF CONTROLLED MOTION OF THE BIPEDAL ANTHROPOMORPHIC MECHANISM
A.V. Chigarev (Minsk, Belarus), A.V. Borisov (Smolensk, Russia)
Using Lagrangian description and the package «Mathematica 6.0.3», the system of differential equations modelling bipedal walking of the eleven-linked rod mechanism with deformable structural elements was obtained. To estimate the controlling moments in the obtained equations, the picture visualization technique of human motions during walking was designed using contemporary methods and means of videoanalysis. The approximate solution of the inverse problem of dynamics allows us to look for the solution of the controlled motion problem (direct problem) using the obtained estimations. To obtain more realistic model, the link deformability is taken into account that basically should give the possibility to consider the energy of recuperation during natural walking. It is known that the prosthetics of only one foot, for example, reduces power efficiency by a quarter. A finite time of impulse transfer speed during the impact of the supporting foot with a surface is also due to the elasticity. It is possible to describe the control of the anthropomorphic mechanism taking into account the deformability of links on the basis of experimental estimations of control efforts.
Key words: anthropomorphic mechanism, control moments, equations of motion, elastic deformations, animated visualization.
Получено 12 марта 2011