Inverzna Newton-Eulerjeva dinamicna analiza
Inverzna Newton-Eulerjeva dinamicna analiza
Inverzna Newton-Eulerjeva dinamicna analiza
Create successful ePaper yourself
Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.
Univerza v Ljubljani<br />
Fakulteta za elektrotehniko<br />
<strong>Inverzna</strong> <strong>Newton</strong>-<strong>Eulerjeva</strong> dinamična <strong>analiza</strong><br />
Laboratorijski praktikum<br />
Roman Kamnik<br />
Ljubljana, 2006.
Poglavje 1<br />
Momenti v sklepih gibajoče se osebe<br />
Vrtilne momente, ki delujejo v sklepih gibajoče se osebe, je moč določiti preko<br />
preračunavanja inverzne dinamike mišično-skeletnega mehanizma med gibanjem<br />
(Bresler and Frankel, 1950). Momente, ki delujejo v sklepu med dvema togima<br />
telesoma je moč določiti, če je znana kinematika gibanja obeh teles in če so poznane<br />
vse sile, ki na telesi delujejo. Tako je mogoče določiti momente med gibanjem<br />
osebe s pomočjo poenostavljenega mišično-skeletnega modela, ki ga tvorijo<br />
toga telesa segmentov povezana s poenostavljenimi sklepnimi povezavami. Za ta<br />
namen uporabljamo večsegmentni dinamični model. Primer modela s petnajstimi<br />
segmenti je predstavljen na sliki 1.1.<br />
V petnajstsegmentnem modelu, ki je predstavljen na sliki 1.1, so upoštevane<br />
naslednje poenostavitve:<br />
• stopala, golena, stegna, medenica, gornji del trupa, nadlakti, podlakti, roki<br />
v ožjem smislu in glava so predstavljena kot toga telesa,<br />
• sklepi med segmenti so predstavljeni kot preprosti kinematični pari, in sicer:<br />
– s sklepi z dvema rotacijskima prostostnima stopnjama gibanja so povezani<br />
gleženjski in zapestni sklepi,<br />
– s sklepi z eno rotacijsko prostostno stopnjo gibanja so povezani kolenski,<br />
komolčni, lumbosakralni in vratni sklepi,<br />
– kolčni in ramenski sklepi so povezani s sferičnimi sklepi s tremi prostostnimi<br />
stopnjami gibanja,<br />
• v določenih primerih, npr., ko se oseba z rokami opira na oporni pripomoček,<br />
ki se ne premika, lahko predpostavimo tudi simetrijo antropometričnih<br />
in kinematičnih parametrov glede na sagitalno ravnino.<br />
1
Glava<br />
Nadlaket<br />
Gornji del<br />
trupa<br />
Podlaket<br />
Roka<br />
Medenica<br />
Stegno<br />
Goleno<br />
Stopalo<br />
Slika 1.1: Primer petnajstsegmentnega mišično-skeletnega modela osebe<br />
1.1 Rekurzivna <strong>Newton</strong>-<strong>Eulerjeva</strong> inverzna dinamična<br />
<strong>analiza</strong><br />
V biomehanskih <strong>analiza</strong>h gibanja človeškega telesa se pogosto uporablja poenostavljen<br />
dinamični model, ki je definiran kot večsegmentni sistem togih teles konstantnih<br />
mas medsebojno povezanih z idealiziranimi sklepi. Gibanje sistema togih<br />
teles obravnava <strong>Newton</strong> <strong>Eulerjeva</strong> dinamična <strong>analiza</strong>, katere enačbe opisujejo<br />
posebej premo in rotacijsko gibanje vsakega segmenta v sistemu. <strong>Newton</strong>ova mehanika<br />
gibanja togega telesa temelji na treh osnovnih dejstvih:<br />
• Vsaka akcija ima za posledico enako nasprotno usmerjeno reakcijo. Torej,<br />
če telo A deluje na telo B s silo f in momentom τ , potem telo B deluje<br />
nazaj na telo A s silo −f in momentom −τ.<br />
• Vsota vseh sil, ki delujejo na telo, je enaka spremembi gibalne količine<br />
telesa.<br />
• Vsota vseh momentov, ki delujejo na telo je enaka spremembi vrtilne količine<br />
telesa.<br />
2
Na podlagi dejstva dva lahko zapišemo enačbo, ki opisuje premo gibanje togega<br />
telesa:<br />
d(mv)<br />
= f, (1.1)<br />
dt<br />
kjer je m masa segmenta, v hitrost gibanja težišča telesa in f vsota vseh sil, ki<br />
delujejo na telo. V primeru, da se masa telesa s časom ne spreminja se enačba<br />
(1.1) poenostavi v dobro znano obliko:<br />
f = ma, (1.2)<br />
kjer a = ˙v nastopa kot pospešek težišča telesa.<br />
Podobno je na podlagi dejstva tri moč zapisati izraz za rotacijsko gibanje telesa:<br />
d(I 0 ω 0 )<br />
= τ 0 , (1.3)<br />
dt<br />
kjer matrika I 0 predstavlja matriko vztrajnostnih momentov telesa, vektor ω 0 vektor<br />
kotnih hitrosti in vektor τ 0 vektor vsote momentov delujočih na telo. Vse<br />
veličine v enačbi (1.3) so izražene glede na osi osnovnega koordinatnega sistema<br />
in imajo zato pripisan indeks 0. V tem primeru pa vztrajnostni tenzor telesa I 0 ni<br />
konstanten in se spreminja z gibanjem telesa skupno s spreminjanjem orientacije,<br />
zaradi česar se krožno gibanje bistveno razlikuje od premega gibanja. Zato raje<br />
pripnemo relativni koordinatni sistem na telo in izrazimo matriko vztrajnostnih<br />
momentov I i glede na osi relativnega koordinatnega sistema. Ker je relativni koordinatni<br />
sistem fiksno pripet na telo, vztrajnostna matrika ne glede na gibanje<br />
telesa ostaja konstantna. Vztrajnostni matriki, izraženi v osnovnem ter relativnem<br />
koordinatnem sistemu, sta povezani z izrazom:<br />
I 0 = RI i R T , (1.4)<br />
v katerem matrika R predstavlja rotacijsko matriko, ki podaja orientacijo koordinatnega<br />
sistema pripetega na telo glede na osi osnovnega koordinatnega sistema.<br />
V postopku izpeljave <strong>Newton</strong>-Eulerjeve enačbe za rotacijsko gibanje je potrebno<br />
odvajanje vrtilne količine in s tem tudi rotacijske matrike R. Pri tej operaciji<br />
si pomagamo z vpeljavo antisimetričnih matrik, ki imajo nekatere ugodne<br />
lastnosti. Neka matrika M je antisimetrična, če zanjo velja:<br />
M T + M = 0 (1.5)<br />
V obliki antisimetrične matrike je možno zapisati tudi vektor. Vektorju a s<br />
komponentami [a x ,a y ,a z ] priredimo antisimetrično matriko z obliko:<br />
⎡<br />
0 −a z<br />
⎤<br />
a y<br />
M(a) = ⎣ a z 0 −a x<br />
⎦ (1.6)<br />
−a y a x 0<br />
3
Antisimetrična matrika M(a) izkazuje sledeče lastnosti, ki jih bomo koristno<br />
uporabili pri izpeljavi <strong>Newton</strong> Eulerjevih dinamičnih enačb:<br />
• Lastnost 1: Linearnost<br />
M(αa + βb) = αM(a) + βM(b) (1.7)<br />
• Lastnost 2: Produkt antisimetrične matrike M(a), ki opisuje vektor a, in<br />
poljubnega vektorja p je enak vektorskemu produktu vektorjev a in p.<br />
M(a)p = a × p (1.8)<br />
• Lastnost 3: Za primer ortogonalne rotacijske matrike R velja:<br />
RM(a)R T = M(Ra) (1.9)<br />
• Lastnost 4: Za ortogonalne matrike, kakršne so tudi vse rotacijske matrike,<br />
lahko dokažemo, da je odvod rotacije R enak produktu matrike R ter antisimetrične<br />
matrike, ki opisuje trenutni vektor kotne hitrosti relativnega koordinatnega<br />
sistema, ki rotira glede na osnovni koordinatni sistem:<br />
Ṙ = M(ω)R (1.10)<br />
Če zapišemo še povezavo med vektorjema kotnih hitrosti, izraženima glede na<br />
osnovni in relativni koordinatni sistem, ki je ω 0 = Rω i oz. ω i = R T ω 0 , lahko<br />
izrazimo vrtilno količino telesa h izraženo v osnovnem koordinatnem sistemu s<br />
pomočjo veličin izraženih v relativnem koordinatnem sistemu:<br />
h 0 = I 0 ω 0 = RI i R T Rω i = RI i ω i (1.11)<br />
Z odvajanjem vektorja vrtilne količine h 0 glede na enačbi (1.3) in (1.10) tako<br />
dobimo navor τ 0 , ki deluje na telo:<br />
τ 0 = ḣ0 = ṘI iω i + RI i ˙ω i = M(ω 0 )RI i ω i + RI i ˙ω i (1.12)<br />
Moment, ki deluje na telo pa je možno izraziti tudi glede na relativni koordinatni<br />
sistem:<br />
τ i = R T τ 0 = R T M(ω 0 )RI i ω i + R T RI i ω˙<br />
i = M(R T ω 0 )I i ω i + I i ˙ω i , (1.13)<br />
τ i = ω i × (I i ω i ) + I i ˙ω i (1.14)<br />
4
Enačbi (1.2) in (1.4) predstavljata temelj za rekurzivno obravnavo sil in momentov<br />
v sklepih n-segmentnega mehanizma. Rekurzivni postopek je zasnovan<br />
na opisu dinamičnega ravnovesja sil in momentov postopno za vsak segment posebej.<br />
V postopku rekurzivne obravnave segmenta za segmentom medsebojne<br />
učinke med segmenti, ki nastopajo v sklepih, obravnavamo s pomočjo zakona o<br />
akciji in reakciji. Slika 1.2 ponazarja grafično predstavitev veličin in parametrov,<br />
ki so pomembni za opis dinamičnega ravnovesja sil in momentov i-tega segmenta<br />
v večsegmentnem sistemu. Vse veličine in parametri so izraženi glede na lokalni<br />
koordinatni sistem segmenta, katerega izhodišče običajno izberemo v težišču segmenta.<br />
−f i+1<br />
−τ i+1<br />
sklep i + 1<br />
r i+1,ci<br />
Iα i<br />
ω i × I i ω i<br />
z i<br />
m i a ci<br />
y i<br />
r ext<br />
τ i<br />
f i<br />
r i,ci<br />
m i g<br />
sklep i<br />
f ext<br />
Slika 1.2: Grafična predstavitev sil in momentov, ki delujejo na segment i<br />
N-segmentnemu mišično-skeletnemu sistemu izberemo osnovni koordinatni<br />
sistem, ki mu pripišemo indeks 0 ter n lokalnih relativnih koordinatnih sistemov,<br />
za katere velja, da indeks i pripišemo koordinatnemu sistemu, ki je pripet na i-ti<br />
segment. V togem telesu, segmentu z indeksom i na sliki 1.2, nastopajo veličine:<br />
a ci - translacijski pospešek težišča segmenta i<br />
5
ω i - kotna hitrost i-tega koordinatnega sistema<br />
α i - kotni pospešek i-tega koordinatnega sistema<br />
g i - gravitacijski pospešek<br />
f i - sila, ki jo izvaja i − 1 segment na i-ti segment v sklepu i<br />
f i+1 - sila, ki jo izvaja i-ti segment na i + 1 segment v sklepu i + 1<br />
f ext - zunanja sila, ki deluje na i-ti segment<br />
τ i - navor, ki ga izvaja i − 1 segment na i-ti segment v sklepu i<br />
τ i+1 - navor, ki ga izvaja i-ti segment na i + 1 segment v sklepu i + 1<br />
R i+1<br />
i - rotacijska matrika, ki predstavlja rotacijo koordinatnega sistema i+1<br />
glede na i-ti koordinatni sistem<br />
R i o - rotacijska matrika, ki predstavlja rotacijo koordinatnega sistema i glede<br />
na osnovni koordinatni sistem<br />
m i - masa segmenta i<br />
I i - vztrajnostna matrika segmenta i, ki predstavlja vztrajnostne momente<br />
segmenta glede na osi lokalnega koordinatnega sistema i z izhodiščem v<br />
težišču segmenta<br />
r i,ci - vektor, ki kaže od središča sklepa i do težišča segmenta i<br />
r i+1,ci - vektor, ki kaže od središča sklepa i + 1 do težišča segmenta i<br />
r ext - vektor, ki kaže od prijemališča zunanje sile do težišča segmenta i<br />
Kot rečeno, <strong>Newton</strong>-<strong>Eulerjeva</strong> formulacija opisuje gibanje segmenta na podlagi<br />
ravnotežja sil in momentov, ki delujejo nanj. Enačbi ravnotežja sil in momentov<br />
se z uporabo enačb (1.2) in (1.4) za segment, ki je vpet med dva sklepa in na<br />
katerega deluje dodatna zunanja sila, glasita:<br />
f i − R i+1T<br />
i f i+1 + R iT<br />
0 f ext + m i g i = m i a ci (1.15)<br />
τ i − R i+1T<br />
i τ i+1 + f i × r i,ci + (R iT<br />
0 f ext ) × r ext − R i+1T<br />
i f i+1 × r i+1,ci =<br />
= I i α i + ω i × (I i ω i ) (1.16)<br />
6
V enačbi (1.16) ne nastopa sila gravitacije, ki ima prijemališče v težišču segmenta.<br />
Ker se v težišču nahaja tudi izhodišče lokalnega koordinatnega sistema,<br />
gravitacijska sila deluje z ročico nič in zato ne povzroča momenta na segment.<br />
Iz enačb (1.15) in (1.16) je razvidno, da je potrebno za določitev vektorjev<br />
momentov in sil v sklepu i poznati:<br />
• sile in prijemališče sil, ki delujejo na površini segmenta (f ext ,r ext,ci ),<br />
• položaj, hitrost ter pospešek gibanja koordinatnega sistema in s tem težišča<br />
segmenta (R i+1<br />
i ,R i o,a ci ,ω i ,α i ),<br />
• maso segmenta (m i ) ter položaje središč sklepov na segmentu (r i,ci ,r i+1,ci ),<br />
• vztrajnostno matriko segmenta (I i ),<br />
• ter sile in momente, ki delujejo v sosednjem sklepu (f i+1 ,τ i+1 ).<br />
Kinematične parametre in zunanje sile (alinei 1 in 2) je pri študijah gibanja<br />
človeka potrebno določiti neposredno z meritvami, medtem ko so parametri alinej<br />
3 in 4 značilni za človeško telo in jih je moč določiti s pomočjo antropometričnih<br />
podatkov dosegljivih v literaturi. <strong>Newton</strong>-<strong>Eulerjeva</strong> <strong>analiza</strong> je v osnovi rekurzivni<br />
postopek, ki ločeno obravnava segment za segmentom od začetnega do končnega,<br />
zato so sile in momenti sosednjega sklepa iz zadnje alineje določeni v predhodnem<br />
koraku postopka.<br />
7
1.2 Vztrajnostni parametri segmentov telesa<br />
Analiza dinamičnih parametrov gibanja človeškega telesa zahteva poznavanje mas<br />
in vztrajnostnih momentov posameznih segmentov telesa. Običajno vztrajnostne<br />
parametre povzamemo po literaturi (npr. [6]). Vztrajnostni moment masnega<br />
delca, ki rotira okrog neke osi, je določen kot produkt mase in kvadrata pravokotne<br />
razdalje do osi rotacije. Analogno je vztrajnostni moment telesa, ki rotira<br />
okrog neke osi a, določen kot vsota produktov infinitizimalnih mas in kvadratov<br />
njihovih razdalj do osi rotacije (i a = ∑ m i li 2 ). Enakovredno lahko izrazimo<br />
vztrajnostni moment telesa tudi kot produkt radija vrtenja (ang. radius of gyration)<br />
in celotne mase telesa (i a = mka). 2 V literaturi so za telo, ki ima v težišču<br />
fiksno pripet koordinatni sistem, podani trije vztrajnostni momenti glede na vrtenje<br />
okrog posameznih osi koordinatnega sistema. Če osi koordinatnega sistema<br />
potekajo vzdolž prostih osi so deviacijski momenti enaki nič in vztrajnostna matrika<br />
segmenta ima obliko:<br />
⎡ ⎤ ⎡<br />
⎤<br />
i x 0 0 mkx 2 0 0<br />
I = ⎣0 i y 0⎦ = ⎣ 0 mky 2 0 ⎦ (1.17)<br />
0 0 i z 0 0 mkz<br />
2<br />
Tabela 1.3 podaja mase segmentov, izražene v procentih celotne mase telesa,<br />
in faktorje radijev vrtenja, izražene v procentih celotne dolžine segmenta, povzete<br />
po De Levi. Gornji del trupa je avtor razdelil v dva dela in podal podatke za<br />
vsak del ločeno. Tako je masa gornjega dela trupa vsota obeh delov trupa ter<br />
vztrajnostni momenti vsota vztrajnostnih momentov obeh delov trupa. Parametri<br />
za oba ločena dela trupa so navedeni v tabeli pod parametri za gornji del trupa.<br />
8
Slika 1.3: Vztrajnostni parametri segmentov človeškega telesa<br />
9
1.3 Rekurzivni postopek izračuna sil in momentov<br />
v sklepih<br />
<strong>Newton</strong>-<strong>Eulerjeva</strong> inverzna dinamična <strong>analiza</strong> temelji na rekurzivnem izračunu sil<br />
in momentov v posameznih sklepih večsegmentne strukture. Postopek izračuna<br />
poteka od začetnega segmenta, ki je običajno v dotiku z okolico, preko segmentov<br />
vpetih med dva sklepa do končnega segmenta. Zunanje sile in momenti lahko<br />
delujejo na katerikoli segment v verigi s poljubnim prijemališčem, važno je le,<br />
da silo poznamo oziroma jo znamo izmeriti. Telo osebe, ki se opira na roke,<br />
tvori zaprto kinematično verigo, kar pomeni, da je struktura vsaj na dveh koncih<br />
v dotiku z okolico. Kinematična veriga osebe je razvejane oblike, ki jo tvorijo<br />
veje štirih ekstremitet. Zaradi tega sil in momentov po celotni verigi ni možno<br />
računati iz poljubne smeri, saj je sistem pri razvejitvi matematično nedoločen.<br />
Sile in momente zato za spodnji del telesa določimo iz smeri desnega stopala<br />
proti medenici, kjer v kolčnem sklepu preslikamo izračunane veličine z desnega<br />
sklepa v levega. Gornji del telesa pa obravnavamo iz smeri desne roke v ožjem<br />
smislu proti gornjemu delu trupa, kjer v ramenskih sklepih opravimo preslikavo<br />
izračunanih parametrov desnega sklepa v levi sklep. Celotni postopek izračuna<br />
je grafično ponazorjen na sliki 1.4. Obremenitve, ki nastopajo v lumbosakralnem<br />
sklepu so na ta način izračunane z dveh različnih smeri.<br />
10
središa<br />
sile in momenti<br />
v vratu<br />
Slika 1.4: Grafična ponazoritev <strong>Newton</strong>-Eulerjeve metode izračuna momentov v<br />
sklepih<br />
11
Literatura<br />
[1] L. A. Geddes, L. E. Baker, Principles of Applied Biomedical Instrumentation,<br />
[2] R. S. C. Cobbold, Transducers for Biomedical Measurements: Principles<br />
and Applications<br />
[3] D. A. Winter, Biomechanics of Human Movement Winter, John Wiley and<br />
Sons, New York, 1979.<br />
[4] R. Contini, Body Segment Parameters, Part ii. Artificial Limbs, Vol. 16, No.<br />
1, pp. 1-19, 1972.<br />
[5] V. Zatsiorsky, V. Seluyanov, The Mass and Inertia Characteristics of the<br />
Main Segments of the Human Body. Biomechanics VIII-B, edited by Matsui,<br />
H. and Kabayashi, K., pp. 1152-1159, Human Kinetics, Champaign,<br />
Illinois, 1983.<br />
[6] P. De Leva, Adjustments to Zatsiorksy-Seluyanov’s segment inertia parameters<br />
J. Biomech., vol. 29, pp. 1223-1230, 1996.<br />
12