Professional Documents
Culture Documents
Dinamika Robota
Dinamika Robota
Postoje dvije osnovne metode određivanja jednadžbi kretanja, odnosno dinamičkog modela
robota, a to su Lagrangeova i Newton-Eulerova metoda. Obe metode opisuju dinamike
manipulatora u zglobnom prostoru. Prva metoda opisuje dinamičko ponašanje manipulatora na
osnovu rada i energije upotrebom generaliziranih koordinata. Sve radne i prinudne sile se
automatski eliminiraju primjenom ove metode, a rezultantne jednadžbe su općenito izražene
pomoću pomaka i momenata zglobova.
[]λ1
λn
=q
(1.1)
Generalizirane sile su sile koje djeluju na zglobove manipulatora, odnosno, sile koje preostaju
nakon uklanjanja inercijalnih sila i sile teže, pri čemu su inercijalne sile povezane sa kinetičkom
energijom robotske ruke, a gravitacijske sile sa potencijalnom energijom.
Kinetička energija ovisi o položaju i brzini manipulatra ( q , q̇ ), a potencijalna energija ovisi samo
o položaju (q), tj. Zakretu robotske ruke. Korištenjem lagrangeove funkcije, jednadžba kretanja
manipulatora poprimit će sljedeći oblik:
d δ δ (1.3)
L ( q , q̇ )− L ( q , q̇ )=ζ i ,i=1 ,… ,n
dt δ q̇i δ qi
gdje je T l kinetička energija segmenta i, a T m kinetička energija motora koji osnažuje segment i.
i i
segmenta i.
gdje je ml masa segmenta. Kao rezultat navedenog, brzina zamišljene tačke zgloba može se
i
napisati kao:
ṗi= ṗl +ω i × r ii
(1.8)
¿ ṗl + S (ω i)r i
i
Gdje ṗl i ω ipredstavljaju respektivno linijsku brzinu centra mase i ugaonu brzinu segmenta.
i
Uvrštavanjem izraza (1.8) u (1.5) dobivaju se slijedeći doprinosi kinetičkih energija uslijed
translacijskog i rotacijskog kretanja:
Translacijsko. Doprinos je :
❑
1 (1.9)
∫ ṗ T ṗ ρdV = 12 ml ṗ Tl ṗ l
2V i i i i i
li
Međusobno. Doprinos je :
( ) ( )
❑ ❑
1 1
2 ∫ ṗTi S(ωi) r i ρdV =2 ṗ Ti S (ω i)∫ ( pi− pl ) ρdV
2V li
2 V li
i
∫ pi ρdV =¿ pl ∫ ρdV ¿ i
Vl i
Vl i
Rotacijsko. Doprinos je :
(∫ )
❑ ❑
1 1
∫ r T ST (ωi )Si ( ωi )r i ρdV = 2 ωTi
2V i
T
S ( r i ) Si ( r i ) ρdV ω i
li Vl i
Dobiva se
❑
1 1 (1.10)
2V
∫ r Ti ST (ωi )Si ( ωi )r i ρdV = ω Ti I l ωi
2 i
li
Matrica
[ ]
∫ (r 2iy +r 2iz ) ρdV −∫ rix r iy ρdV −∫ r ix r iz ρdV
I l = −∫ r ix r iy ρdV ∫ ( r 2ix +r 2iz ) ρdV −∫ r iy r iz ρdV
i
[ ]
I l xx −I l xy −I l xz (1.11)
i i i
¿ −I l xy I l yy −I l yz
i i i
−I l xz −I l yz I l zz
i i i
je simetrična i predstavlja tenzor inercije relativno u odnosu na centar mase segmenta i izraženog
u koordinatama sistema baze. Tenzor inercije određuje raspodjelu mase krutog tijela. Matrica
(1.11) se sastoji od šest različitih volumnih integrala pri čemu se izrazi na dijagonali te matrice
nazivaju momenti inercije, a preostali vandijagonalni izrazi su produkti inercije. Budući da je
pozicija segmenta i ovisna o konfiguraciji manipulatora to je i tenzor inercije, mjeren u odnosu
na ishodište koordinatnog sistema baze, također ovisan o konfiguraciji manipulatora. Ugaona
brzina ω i izražena je u koordinatama baze.
Međutim, za računanje ugaone brzine segmenta i izražene u koordinatama sistema centra mase
segmenta potrebno je koristiti matricu rotacije na slijedeći način:
i T
ω i=Ri ω i
1 T 1 T i T (1.12)
ω I ω= ω R I R ω
2 i l i 2 i i l i ii i
Ako se osi koordinatnog sistema centra segmenta i podudaraju s koordinatama tačke određene
vektorom pi, tada su produkti inercije jednaki nuli i tenzor inercije relativno u odnosu na centar
mase je dijagonalna matrica. Prema tome, ukupna kinetička energija segmenta i, koja obuhvata
i translacijska i rotacijska kretanja, jednaka je
1 T 1 T i T (1.14)
T l = ml ṗ i ṗ l + ωi Ri I l R i ωi
2 i
2 i i i
ml ṗi ṗl + ωi Ri I l Ri ω i
n T T i T
(1.15)
T l=∑ i i i
i=1 2
gdje je doprinos stupaca matrice Jacobiana brzini zglobova uzet u obzir na trenutni segment i.
J P =[ J P 1 … J Pi 0 … 0 ] (1.18)
( li ) ( li ) ( li)
(l )
i
{
J O = 0 za translacijski zglob
z j−1 za obrtni zglob
j
(1.21)
gdje su p j−1 vektor pozicije ishodišta koordinatnog sistema j−1 i z j−1 jedinični vektor duž osi z
istog koordinatnog sistema, respektivno.
Uzimajući u obzir izraze (1.14) – (1.19), izraz za ukupnu kinetičku energiju segmenta i (1.14)
postaje:
1 1 T lT (1.22)
T l = ml q̇ J (P ) J (P ) q̇ + q̇ J (O ) Ri I l R i J (O) q̇
T l T l i i i
i T l i
i
2 i
2 i
Kinetička energija motora koji pokreće zglob i može se izračunati na formalno analogan način
onome provedenom za segment manipulatora. Razmatat će se tipičan slučaj rotirajućeg
električnog motora (koji može pokretati i rotirajuće i translacijske zglobove uz upotrebu
odgovarajućih prijenosnijh mehanizama). Pretpostavlja se da je stator motora smješten na
segment manipulatora (masi segmenta pridodaje se masa statora), tako da se računa samo
kinetička energija rotora.
gdje je m m masa rotora, ṗm označava linijsku brzinu centra mase rotora, I m je tenzor inercije rotora
i i i
Neka ϑ m označava ugaonu poziciju rotora. U slučaju upotreve krutih prijenosnika dobiva se
i
slijedeća relacija:
k r q̇ i=ϑ˙m
i i
(1.24)
U skladu s pravilom kompozicije ugaonih brzina i relacije, ukupna ugaona brzina rotora je:
ω m =ω i−1 +k r q̇i z m
i i i
(1.25)
Gdje je ω i−1 ugaona brzina segmenta i-1 na koji je motor smješten, i z m označava jedinični i
vektor duž osi motora. Da bi napisali kinetičku energiju rotora kao funkciju zglobova varijabli,
neophodno je izraziti linijsku brzinu centra mase rotora-slično u (1.16) kao
( mi ) (1.26)
ṗm =J P q̇
i
J P =[ J P 1 … J Pi 0 … 0 ] (1.27)
( mi ) (mi ) ( mi )
{
( mi ) Z j−1 za translacijski zglob (1.28)
JP =
j
Z j−1 × ( p m − p j −1 ) za obrtni zglob
i
Gdje je p j−1 vektor pozicije ishodišta koordinatnog sistema relativno u odnosu na zglob j−1.
( ) mi
Komponenta Jacobiana J P =0 u izrazu (1.27), jer je centar mase rotora uzet da leži duž osi
j
rotacije. Ugaona brzina u (1.25) može se napisati kao funkcija zglobovskih varijabli, tj.,
ω m =J (O ) q̇ (1.29)
mi
i
{
( ) li (1.31)
J (O )= J O j=1 , … ,i−1
m i
j
j
k r z j−1 j=1 i
Za računanje druge relacije u (1.31) dovoljno je poznavati komponente jediničnog vektora osi
rotacije rotora z m s obzirom na koordinatni sistem baze. Kinetička energija robota i može se
i
napisati kao
1 1 (1.32)
T m = mm q̇ T J (Pm )T J (Pm ) q̇+ q̇T J (Om ) T Rm I mm R Tm J (Om ) q̇
i i i i i
2i i
2 i i
1
n
1
n
(1.33)
T = ∑ ∑ b ij ( q ) q̇ i q̇ j = q̇T B ( q ) q̇
2 i=1 j=1 2
Gdje je
n
(1.34)
B ( q )=∑ ( ml J P J P + J O Ri I l Ri J O + mm J P )
(l i ) T (l i ) (li ) T i T (l i ) ( mi ) T ( mi ) ( mi ) T mi T (mi )
i i i
J P + JO Rm I m Rm J O
i i
i=1
Simetrična
Pozitivno definitna
Ovisna o konfiguraciji (općenito)
gdje je g0 vektor gravitacijskog ubrzanja u koordinatnom sistemu baze (npr. ako je osa z
vertikalna), pri čemu je g koeficijent ubrzanja sile teže, čija standardna vrijednost iznosi:
g0 =9.80665 m/s . pl , pm su vektori položaja centara masa segmenta i i rotora motora i u odnosu
2
i i
na koordinatni sistem baze. Slično relaciji (1.36) dobiva se izraz za potencijalnu energiju rotora
motora:
1
n n n
(1.39)
L ( q , q̇ )=T ( q , q̇ )−U ( q )= ∑ ∑ b ij ( q ) q̇ i q̇ j + ∑ ( ml gT0 pl ( q ) +m m gT0 p m ( q ) )
2 i=1 j=1 i=1
i i i i
Korištenjem dobivene Lagrangeove funkcije, jednadžba kretanja manipulatora poprima slijedeći
oblik:
d ∂ L ( q , q̇ ) d ∂ T ( q , q̇ )
n n
d b ij n n n
∂ b ( q) (1.40)
= =∑ bij ( q ) q̈ j +∑ q̇ j=∑ b ij ( q ) q̈ j + ∑ ∑ ij q̇ k q̇ j
dt ∂ q̇i dt ∂ q̇i j=1 j=1 dt j=1 j=1 k=1 d qk
∂T ( q , q̇ ) 1 n n ∂ b jk ( q ) (1.41)
= ∑∑ q̇ q̇
∂ q̇ i 2 j=1 k=1 d q i k j
( )
∂U ( q )
n
∂ pl (q) ∂ pm ( q ) (1.42)
=−∑ m l g0
T T
+m m g0 j j
d qi j=1 d qi j
d qi j
n
¿−∑ ( ml g T0 J (Pi) ( q )+ mm g T0 J (Pi ) ( q ) )=g i ( q )
lj mj
j j
j=1
Gdje je
∂ bij 1 ∂ b jk (1.44)
hijk = −
∂ qk 2 ∂ qi
Uzimajući u obzir sve navedeno, jednadžbe kretanja (1.43) mogu se napisati u kompaktnom
matričnom obliku, predstavljajući dinamički model zglobovskog prostora, na sljedeći način:
( ∂b ij 1 ∂ b jk
)
n n
¿∑ ∑ − q̇ q̇
j=1 k=1 ∂ qk 2 ∂ qi k j
Gornja jednadžba se može dalje napisati kao:
∂ bij
(
∂ bik 1 ∂ b jk
)
n n n n n
1 1
∑ cij q̇ j= ∑ ∑
2 j=1 k=1 ∂ q k
q̇ q̇
k j + ∑ ∑ − q̇ q̇
2 j=1 k =1 ∂ q j 2 ∂ qi k j
j=1
( )
1 ∂ bij ∂ bik ∂ b jk (1.48)
c ijk = + +
2 ∂ q k ∂ q j ∂ qi
Elementi c ijk nazivaju se Christoffelovi simboli prve vrste. S obzirom na svojstvo simetrije
matrice B, vrijedi da je:
Izbor matrice C vodi ka određivanju prvog važnog svojstva jednadžbe kretanja (1.45), a to je da
je matrica
N ( q , q̇ )= B ˙( q )−2 C ( q , q̇ ) (1.50)
kososimetrična.
w T N ( q , q̇ ) w=0 (1.51)
∂ bij
( )
∂ bik ∂ b jk
n n
1 1
c ij = ∑
2 k=1 ∂ q k
q̇ k + ∑ −
2 k =1 ∂ q j ∂ qi k
q̇
(
∂ bik ∂ b jk
)
n
1 1
¿ ḃij + ∑ − q̇
2 2 k=1 ∂ q j ∂ q i k
( )
n
∂b jk ∂ bik (1.52)
nij = ḃij −2C ij =∑ − q̇
k=1 ∂ qi ∂ q j k
Promatranjem izraza (1.52) slijedi sljedeća jednakost:
nij =−n ji
Može se lahko pokazati da izraz (1.53) vrijedi za bilo koji izbor matrice C, budući da je on
rezultat principa očuvanja energije (hamilton). Na osnovu ovog principa, ukupan iznos
vremenske derivacije kinetičke energije je uravnotežen sa snagom koju generiraju sve sile koje
djeluju na zglobove manipulatora. Nasuprot tome, izraz (1.51) vrijedi samo za pojedinačan izbor
elemenata matrice C, kako je definirano u (1.47) i (1.48).