02.04.2014 Views

Inverzna Newton-Eulerjeva dinamicna analiza

Inverzna Newton-Eulerjeva dinamicna analiza

Inverzna Newton-Eulerjeva dinamicna analiza

SHOW MORE
SHOW LESS

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

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!