Você está na página 1de 30

2.

CINEMTICA
2.1.

Representao de Posio e Orientao:

Sistemas Referenciais:

Para localizar um corpo rgido no espao tridimensional, um sistema referencial


associado ao mesmo.
Um referencial associado a um corpo rgido fixo no mesmo.
Qualquer ponto do corpo rgido possuir coordenadas invariantes no seu referencial
associado.
referencial ser identificado por uma letra entre chaves. Exemplo: {A}, {i}, etc.
Os referenciais so definidos por trs vetores unitrios ortogonais: x , y, z .

yB
{B}
yA

xB

{A}
XA

zB

zA

Figura 2.1. Representao da localizao de corpos rgidos por meio de referenciais.

Localizao de um Corpo Rgido em relao a um Referencial:

A localizao de um corpo rgido B em relao a um referencial qualquer {A}


definida pela localizao do seu referencial associado {B} em relao a {A}.
A localizao de {B} em relao a {A} completamente definida especificando:
a posio de {B} em relao a {A}
a orientao dos eixos de {B} em relao a os eixos de {A}.

Representao de posio de {B} em relao a {A}:


A posio de {B} em relao a {A} definida pelo vetor de posio APB ligando a
origem de {A} origem de {B}, expresso em coordenadas de {A}:
A

PB = [ ApBx

pBy

pBz]T

yB
{B}

xB

yA
A

PB

{A}

xA

zB

zA

Figura 2.2. Posio de um referencial {B} em relao a um referencial {A}.


Exemplo: considere dois referenciais {A} e {B} com a mesma orientao, com a
origem de {B} localizada a 5 unidades ao longo do eixo xA. Considere um ponto P,
expresso em {B} como BP = [2 2 1]T. Determine a posio de {B} em relao a {A}
bem como a representao do ponto P em {A}.
yA

yB
P

{A}
zA

xA

PB {B}

xB

zB

Figura 2.3. Posio em um referencial {B} transladado ao longo do eixo xA de {A}.


Soluo: A origem de {B} est localizada no ponto (5, 0, 0) em coordenadas de {A},
portanto, a posio de {B} em relao a {A} dada por:
A

PB = [5 0 0] T

Como os dois referenciais possuem a mesma orientao:


A

P = APB + BP = [5 0 0] T + [2 2 1] T = [7 2 1] T

Representao de orientao de {B} em relao a {A}:


A orientao de {B} em relao a {A} definida pela matriz de rotao ARB de
dimenso 3x3, ortogonal, cujos vetores colunas so os eixos unitrios de {B} expressos
em coordenadas de {A}:
A

RB = [ AxB

yB

zB]

y B
{B}
A

y B

x B

y A
A

{A}

x B
z B
x A

z A
A

z B
Figura 2.4. Orientao de um referencial {B} em relao a um referencial {A}.
A matriz ARB uma representao redundante de orientao, visto que possui nove
elementos que satisfazem a seis restries (os trs eixos so unitrios e ortogonais):
(AxB)T.AxB = 1

(AyB)T.AyB = 1

(AzB)T.AzB = 1

(AxB)T.AyB = 0

(AyB)T.AzB = 0

(AzB)T.AxB = 0

Portanto, a matriz ARB ortogonal, ou seja:


(ARB)-1 = ( ARB)T
Se dois referenciais {A} e {B} possuem a mesma origem, um ponto P expresso nos
referenciais {A} e {B} respectivamente como:
A

P = [Apx Apy Apz]T

P = [Bpx Bpy Bpz]T

Conhecendo a representao de P em {B}, BP, bem como a representao dos eixos de


{B} em {A}, possvel encontrar a representao de P em {A}, AP:
A

P = [BxAT.BP

yAT.BP

zAT.BP]T = [ BxA ByA BzA]T.BP AP = BRAT.BP = ARB.BP

De forma equivalente, BP = BRA.AP, portanto:

P = ARB.BP = ARB.BRA.AP

RB.BRA = I

RA = ( ARB)-1 = (ARB)T

Dados trs referenciais {A}, {B} e {C} com origens coincidentes, temos:
A

P = ARB.BP,

P = BRC.CP,

P = ARC.CP

P = ARB.BRC.CP ARC = ARB.BRC

A matriz ARB pode ser representada ento como ARB = ARC.CRB = ( CRA)T.CRB. Assim:
A

RB =

(CxA)T.CxB
(CyA)T.CxB
(CzA)T.CxB

(CxA)T.CyB
(CyA)T.CyB
(CzA)T.CyB

(CxA)T.CzB
(CyA)T.CzB
(CzA)T.CzB

Note que cada elemento da matriz representado pelo produto interno entre um eixo
unitrio de {A} e um eixo unitrio de {B}, sendo portanto igual ao cosseno do ngulo
entre eles. Por esta razo, a matriz de rotao ARB tambm chamada de Matriz de
Cossenos Diretores. Os valores dos cossenos diretores so independentes da escolha do
referencial {C}.
Exemplo: considere dois referenciais coincidentes, {A} e {B}. Suponha que {B} gira
um ngulo em torno do eixo AzB. Encontre a matriz de rotao ARB = R(z,):
yA

yB

xB

xA

zA, zB
Figura 2.5. Rotao em torno do eixo zA.
Da figura acima, atravs de simples relaes trigonomtricas, temos:
A

xB = [cos() sen() 0]T

RB = R(z,) =
A

yB = [-sen() cos() 0]T

cos()
sen()
0

-sen()
cos()
0

zB = [0 0 1] T

0
0
1

De forma anloga, para rotaes em torno dos eixos xA e yA, temos respectivamente:
RB = R(x,) =

1
0
0

0
cos()
sen()

0
-sen()
cos()

RB = R(y,) =

cos()
0
-sen()

0
1
0

sen()
0
cos()

Exemplo: considere dois referenciais coincidentes, {A} e {B}. Suponha que {B} gira
um ngulo em torno do eixo AzB. Considere um ponto P expresso em coordenadas de
{B}, BP. Encontre a representao do ponto P em coordenadas de {A}, AP:

yA

yB

py

xB
B

px

py

xA

zA, zB

px

Figura 2.6. Rotao de um ponto em torno do eixo z A.


Da figura acima, atravs de relaes trigonomtricas simples, temos:
B

px = Apx.cos() + Apy.sen()

py = Apy.cos() - Apx.sen()

pz = Apz

Resolvendo para Apx, Apy, Apz:


A

px = Bpx.cos() - Bpy.sen()

py = Bpx.sen() + Bpy.cos()

pz = Bpz

Que em notao matricial, como era de esperar, corresponde a:


A

px
A
py
A
pz

cos()
sen()
0

-sen()
cos()
0

0
0
1

px
py
B
pz

P = R(z,).BP

Outras representaes de orientao:


A matriz de orientao ARB representa a orientao de {B} em relao a {A} de modo
redundante, visto que seus nove elementos possuem seis relaes de dependncia (as
colunas de ARB so vetores unitrios e perpendiculares entre si). Assim, de forma
anloga especificao de posio, trs parmetros independentes so suficientes para
especificar orientao no espao tridimensional. Existem vrios esquemas e convenes
utilizados para fazer esta especificao. A seguir, apresentaremos alguns deles.
ngulos de Euler ZXZ:
Neste esquema, a orientao de {B} em relao a {A} representada por trs ngulos de
rotao (, , ), exercutados nessa ordem, respectivamente, em torno dos eixos z, x e z
de um referencial mvel, inicialmente coincidente com {A} e alinhado com {B} aps as
trs rotaes. A matriz de rotao equivalente a (, , ) dada por:
R = R(z,).R(x,).R(z,)
Definimos a seguinte nomenclatura: sen() = s , cos() = c. Assim:

zA,z

z'

z"

y'
yA

y
y'

yB
y

z",zB

xA

x'

x' ,x

xB

Figura 2.7. ngulos de Euler ZXZ.

R =

R =

c -s 0
s c 0
0
0 1

1 0 0
0 c -s
0 s c

c -s 0
s c 0
0
0 1

(c.c - s.c.s) (-c.s - s.c.c) (s.s)


(s.c + c.c.s) (-s.s + c.c.c) (-c.s)
(s.s)
(s.c)
(c)

Conhecendo-se a representao da orientao na forma de uma matriz de rotao R ,


possvel encontrar os ngulos de Euler ZXZ a partir de relaes entre os seus elementos.
Para evitar ambigidades, utilizaremos a funo arco-tangente definida nos quatro
quadrantes, atan2(a, b) = arg(a + j.b) = argumento do nmero complexo a + j.b, de tal
modo que = atan2(sen(), cos()) = atan2(k.sen(), k.cos()), com k > 0. Assim:
= atan2(R 13,-R23)

= atan2([R312+R322]1/2 , R33)

= atan2(R 31,R32)

Verifica-se que a soluo para os ngulos de Euler no nica. Existem dois conjuntos
de ngulos possveis dependendo do sinal da raiz quadrada. Tomando o sinal positivo, o
que equivale a limitar ao intervalo 0 , eliminamos esta ambigidade. Verificase tambm que, para = 0 ou = , a soluo degenera (ocorre uma diviso por zero), o
que resulta em infinitas solues. Isto ocorre porque as rotaes e ocorrem em torno
do mesmo eixo espacial e o angulo resultante da soma destes ngulos pode ser obtido de
infinitos pares (,) diferentes. Neste caso, necessrio arbitrar um deles. Assim:
Para = 0

+ = atan2(R 21,R11)

Para =

- = atan2(R 21,R11)

ngulos de Euler ZYZ:


De forma anloga ao caso anterior, neste esquema, a orientao de {B} em relao a
{A} representada por trs ngulos de rotao (, , ), executados nessa ordem,
respectivamente, em torno dos eixos z, y e z de um referencial mvel, inicialmente
coincidente com {A} e alinhado com {B} aps as trs rotaes. A matriz de rotao
equivalente a (, , ) dada por:
R = R(z,).R(x,).R(z,)

zA,z

z'
z"

y'
yA

y' ,y

xA

x x'

x'

z",zB
yB

x xB

Figura 2.8. ngulos de Euler ZYZ.

R =

R =

c -s 0
s c 0
0
0 1

c 0 s
0 1 0
-s 0 c

c -s 0
s c 0
0
0 1

(c.c.c - s.s) (-c.c.s - s.c)


(s.c.c + c.s) (-s.c.s + c.c)
(-s.c)
(s.s)

(c.s)
(s.s)
(c)

Usando a mesma metodologia do caso anterior, possvel obter a relao inversa, que
expressa os ngulos de Euler ZYZ em funo de uma matriz de rotao equivalente:
= atan2(R 23,R13)

= atan2([R312+R322]1/2 , R33)

= atan2(R 32,-R31)

Novamente, dois conjuntos de ngulos de Euler satisfazem a soluo. Tomando o sinal


positivo da raiz quadrada, o que equivale a limitar ao intervalo 0 , eliminamos
esta ambigidade. Da mesma forma do que no caso anterior, verifica-se tambm que,
para = 0 ou = , a soluo degenera (ocorre uma diviso por zero), o que resulta em
infinitas solues, as quais so devidas ocorrncia de duas rotaes em torno do
mesmo eixo. Assim:
Para = 0

+ = atan2(R 21,R11)

Para =

- = atan2(R 21,-R11)

ngulos de Euler ZYX:


De forma anloga aos casos anteriores, neste esquema, a orientao de {B} em relao a
{A} representada por trs ngulos de rotao (, , ), executados nessa ordem,
respectivamente, em torno dos eixos z, y e x de um referencial mvel, inicialmente
coincidente com {A} e alinhado com {B} aps as trs rotaes. A matriz de rotao
equivalente a (, , ) dada por:
R = R(z,).R(x,).R(z,)

R =

c -s 0
s c 0
0
0 1

c 0 s
0 1 0
-s 0 c

1 0
0
0 c -s
0 s c

(c.c)
(s.c)
(-s)

R =

(c.s.s - s.c)
(s.s.s + c.c)
(c.s)

zA,z

(c.s.c + s.s)
(s.s.c - c.s)
(c.c)

z'
z

y'
yA

xA

y' ,y

x x'

x'

zB z y
B

x,xB
Figura 2.9. ngulos de Euler ZYX.
Usando a mesma metodologia dos casos anteriores, possvel obter a relao inversa,
que expressa os ngulos de Euler ZYX em funo de uma matriz de rotao
equivalente:
= atan2(R 21,R11)

= atan2(-R31,[R322+R332]1/2)

= atan2(R 32,R33)

Novamente, dois conjuntos de ngulos de Euler satisfazem a soluo. Tomando o sinal


positivo da raiz quadrada, o que equivale a limitar ao intervalo -/2 /2,
eliminamos esta ambigidade. Da forma semelhante aos casos anteriores, verifica-se
tambm que, para = -/2 ou = /2, a soluo degenera (ocorre uma diviso 0/0), o
que resulta em infinitas solues, as quais so devidas ocorrncia de duas rotaes em
torno do mesmo eixo. Assim:
Para = -/2

+ = atan2(-R12,R22)

Para = /2

( - ) = atan2(R 12,R22)

Os ngulos de Euler ZYX so tambm chamados de ngulos de Rolamento,


Lanamento e Guinada (Roll, Pitch, Yaw), termos derivados dos movimentos de rotao
de naves ou aeronaves em torno dos seus eixos principais.
x

y
Figura 2.10. ngulos de Rolamento, Lanamento e Guinada: , , .

Representao equivalente ngulo/Eixo :


Neste esquema, a orientao de {B} em relao a {A} de forma redundante por meio
de quatro parmetros: as trs componentes (kx, ky, kz) de um eixo unitrio direcional k e
um ngulo de rotao em torno deste eixo. Observao: usando um eixo no unitrio,
o ngulo de giro pode ser codificado no mdulo do vetor k, de modo a utilizar apenas
trs parmetros (representao no redundante da orientao).
A matriz de rotao equivalente Rk pode ser obtida a partir de (kx, ky, kz, ) usando o
seguinte procedimento:

Alinhar o eixo k com o eixo z do referencial {A} atravs de duas rotaes: giro de
um ngulo em torno do eixo xA, seguido de um giro de um ngulo - em torno do
eixo yA.
Girar um ngulo em torno do eixo zA (que agora coincide com o eixo k).
Retornar o eixo k ao seu alinhamento original revertendo as duas rotaes iniciais:
um giro de um ngulo em torno do eixo yA seguido de um giro de um ngulo em
torno do eixo xA.
yA
ky
k

xA
kx

kz

3
zA

Figura 2.11. Rotao de um ngulo em torno de um eixo arbitrrio k.


Rk = R(x,-).R(y,).R(z,).R(y,-).R(x,)
Rk =

1 0 0
0 c s
0 -s c

c 0 s
0 1 0
-s 0 c

c -s 0
c s 0
0 0 1

c 0 s
0 1 0
-s 0 c

1 0 0
0 c -s
0 s c

Definindo v = vers() = 1 cos() e substituindo os termos dependentes de e por:


s = ky/[ky2+ kz2]1/2
Rk =

c = kz/[ky2+ kz2]1/2

s = kx

c = [ky2+ kz2]1/2

(kx2.v+c)
(kx.ky.v-kz.s) (kx.kz.v+ky.s)
(kx.ky.v+kz.s)
(ky2.v+c)
(ky.kz.v-kx.s)
(kx.kz.v-ky.s) (ky.kz.v+kx.s)
(kz2.v+c)

A partir de relaes entre elementos da matriz acima, possvel obter a representao


ngulo-eixo equivalente representao Rk:
= cos-1((R11+R22+R33-1)/2)
kx = (R32-R23)/(2.s)

ky = (R13-R31)/(2.s)

kz = (R21-R12)/(2.s)

A soluo acima valida 0 . Para uma dada matriz Rk, existem duas solues
possveis: (k, ) e (-k, -). Verifica-se tambm que, para = 0 ou = , a soluo
degenera (ocorre uma diviso por zero), o que resulta em infinitas solues, (o eixo k
torna-se indefinido). Assim, para pequenos ngulos, a soluo mal condicionada.
Exemplo: dados os referenciais {A} e {B} mostrados na figura abaixo, obtenha a
matriz de rotao ARB bem como a sua representao em ngulos de Euler ZXZ, ZYZ,
ZYX e a representao equivalente ngulo/eixo.
yA, zB

xA, yB
zA, xB
Figura 2.12. Exemplo de orientao relativa entre dois referenciais.
Expressando os eixos de {B} em {A}, obtemos a sua orientao relativa:
A

RB =

0
0
1

1
0
0

0
1
0

Os ngulos de Euler ZXZ so dados por:


= atan2(R 13,-R23) = atan2(0,-1) =
= atan2([R 312+R322]1/2 , R33) = atan2(1,0) = /2
= atan2(R 31,R32) = /2

Os ngulos de Euler ZYZ so dados por:


= atan2(R 23,R13) = atan2(1,0) = /2
= atan2([R 312+R322]1/2 , R33) = atan2(1,0) = /2
= atan2(R 32,-R31) = atan2(0,-1) =
Para o caso dos ngulos de Euler ZYX (roll, pitch, yaw), temos que indefinido, pois
= atan2(R 21,R11) = atan2(0,0). Neste caso, teremos infinitas solues:
= atan2(-R31,[R322+R332]1/2) atan2(-1,0)= -/2
+ = atan2(-R12,R22) = atan2(-1,0) = -/2
Para obter uma soluo necessrio arbitrar um dos ngulos. Impondo o ngulo = 0,
temos que = -/2.
A representao equivalente ngulo/Eixo dada por:
= cos-1((R11+R22+R33-1)/2) = cos-1(-1/2) = 2/3
kx = (R32-R23)/(2.s) = -(1/3)1/2
ky = (R13-R31)/(2.s) = -(1/3)1/2
kz = (R21-R12)/(2.s) = -(1/3)1/2

2.2.

Transformaes Homogneas:

Mapeamentos:
Dados dois referenciais {A} e {B} e um ponto P, conhecendo as coordenadas BP do
mesmo no referencial {B}, as coordenadas AP do mesmo no referencial {A} podem ser
obtidas, desde que se conhea a posio APB e orientao ARB de {B} em relao a {A},
atravs de um mapeamento de BP para AP. A seguir, define-se {U} como um referencial
universal.
Mapeamento de Translao:
Um mapeamento de translao caracteriza-se por mapear um ponto de um
referencial {B} para um referencial {A}, onde {A} e {B} possuem origens diferentes
mas orientaes coincidentes (UPA UPB, URA = URB). Como {A} e {B} possuem a
mesma orientao, as coordenadas de P em {A} podem ser expressas diretamente
atravs de uma soma vetorial:
A

P = BP + APB

P
B

P
{B}
A

PB

{A}

Figura 2.13. Mapeamento de Translao.


Mapeamento de Rotao:
Um mapeamento de rotao caracteriza-se por mapear um ponto de um
referencial {B} para um referencial {A}, onde {A} e {B} possuem origens coincidentes
mas orientaes diferentes (UPA = UPB, URA URB). Como {A} e {B} possuem a
mesma origem, as coordenadas de P em {A} podem ser expressas como a projeo de
B
P nos eixos de {A}:
A

px = BxAT.BP

py = ByAT.BP

pz = BzAT.BP

ou, matricialmente,
A

P = [BxAT.BP

yAT.BP

zAT.BP]T = [ BxA ByA BzA]T.BP AP = BRAT.BP

Mas, como BRA uma matriz ortogonal, BRAT = BRA-1 = ARB , assim, o mapeamento de
rotao definido por:
A

P = ARB. BP
A

py
P

py

px

{B}

px

pz

{A}

pz

Figura 2.14. Mapeamento de Rotao.

Mapeamento Geral:
Quando os sistemas de referncia {A} e {B} diferem tanto em posio como em
orientao (UPA UPB, URA URB), a representao de um ponto P em {A} pode ser
obtida a partir da sua representao em {B} atravs do seguinte procedimento:

Por meio de um mapeamento de rotao, obter a representao IP de P em relao a


um referencial intermedirio {I}, tal que este possua a mesma origem que {B}, mas
esteja alinhado com o referencial {A}, (UPI = UPB e URI = URA).

P = IRB.BP = ARB.BP

Representar IP em {A} atravs de um mapeamento de translao:

P = IP + IPB = IP + APB

Assim: AP = ARB.BP + APB


P

{B}
A

P
A

PB

{I}

{A}

Figura 2.15. Mapeamento de Geral.


Transformao Homognea:
O mapeamento geral pode ser representado matricialmente da seguinte maneira:
A

P
1

onde:
A

RB
0 0 0

=
A

RB
0 0 0

PB
1

PB
1

P
1

TB

TB a Matriz de Transformao Homognea que representa de modo compacto a


posio e orientao de {B} em relao a {A}. A linha inferior da equao matricial foi
acrescentada de modo a resultar numa matriz ATB quadrada 4x4 para a qual exista
matriz inversa. Os vetores de posio 4x1 (ltimo elemento igual a 1) so vetores de
coordenadas homogneas. Doravante, para fins de simplificao, usaremos a
nomenclatura AP tanto para vetores de posio 3x1, como para vetores em coordenadas
homogneas, sempre que o contexto torne obvio as suas dimenses.

Operadores de Movimento:
O movimento de um referencial em relao a outro pode ser descrito usando
transformaes homogneas apropriadas que definam as mudanas de posio e
orientao relativas ao se passar de um referencial para outro.
Operadores de Translao:
Dado um vetor APB, o Operador de Translao T(APB/APB,APB) aplicado sobre um
vetor BP o translada uma distncia APB ao longo da direo do vetor unitrio
A
PB/APB, resultando no vetor transladado AP (em coordenadas homogneas):
P = T(APB/APB,APB).BP

onde, sendo I a matriz identidade 3x3:


T(APB/APB,APB) =

0 0 0

PB
1

Outra maneira de abordar este problema considerar o ponto BP fixo em relao ao


referencial {B}, inicialmente coincidente com o referencial {A}. A seguir, deslocar a
origem de {B} at a posio APB relativa a {A} atravs de um movimento de translao
(mantendo a sua orientao paralela orientao de {A}). Conseqentemente, o ponto
B
P sofrer tambm uma translao em relao ao referencial {A}, visto que BP fixo
em {B}. Conhecendo BP e o movimento de translao de {B} em relao a {A}, (APB),
o operador de translao permite obter a representao AP do ponto transladado em
relao ao referencial {A}. Deste modo, em coordenadas cartesianas, temos:
A

P = BP + APB

{B}
A

{A}
{A} = {B}

Figura 2.16. Operador de Translao.

PB

Assim, os operadores de translao para um deslocamento linear d ao longo dos eixos x,


y e z so dados respectivamente por:

T(x,d) =

T(y,d) =

T(z,d) =

1
0
0
0

0
1
0
0

0
0
1
0

d
0
0
1

1
0
0
0

0
1
0
0

0
0
1
0

0
d
0
1

1
0
0
0

0
1
0
0

0
0
1
0

0
0
d
1

Operadores de Rotao:
Dado um vetor unitrio k e um ngulo , o Operador de Rotao R(k,), quando
aplicado sobre um vetor BP, faz com que este gire o ngulo em torno do eixo k,
resultando em um vetor rotacionado AP, em coordenadas homogneas:
A

P = R(k,).BP

R(k,) =

RB

0 0 0

0
0
0
1

onde ARB a matriz de rotao 3x3 equivalente representao ngulo/eixo (k, ). Outra
maneira de abordar este problema considerar o ponto BP fixo em relao ao referencial
{B}, inicialmente coincidente com o referencial {A}. A seguir, girar {B} at a
orientao ARB relativa a {A} atravs de um movimento de rotao em torno do eixo
k, (mantendo a origem de {B} coincidente com a origem de {A}). Conseqentemente, o
ponto BP sofrer tambm uma rotao em relao ao referencial {A}, visto que BP fixo
em {B}. Conhecendo BP e o movimento de rotao de {B} em relao a {A}, (APB), o
operador de rotao permite obter a representao AP do ponto rotacionado em relao
ao referencial {A}. Deste modo, em coordenadas cartesianas, temos:
A

P = ARB.BP

{A} = {B}

{B}

{A}

Figura 2.17. Operador de Rotao.


Assim, os operadores de rotao para um deslocamento angular em torno dos eixos x,
y e z so dados respectivamente por:

R(x,) =

R(y,) =

R(z,) =

1
0
0 c
0 s
0
0

0
0
-s 0
c 0
0
1

c
0
-s
0

0
1
0
0

s
0
c
0

0
0
0
1

1
0
0
0

0
c
s
0

0
-s
c
0

0
0
0
1

Operadores de Transformao:
Um Operador de Transformao aplicado sobre um vetor BP resulta num vetor
A
P (em coordenadas homogneas), movimentado para uma localizao genrica em
relao sua localizao inicial. Esta nova localizao pode ser melhor descrita
matematicamente como uma combinao de uma operao de rotao de um ngulo
em torno do vetor unitrio k seguida de uma operao de translao por uma distncia
APBao longo de um eixo unitrio APB/APB.
Assim, em coordenadas cartesianas, a operao de transformao geral pode ser descrita
matematicamente como:
A

P = ARB.BP + APB

Onde ARB representa a matriz de rotao equivalente rotao de um ngulo em torno


do vetor k. Ento, o operador de transformao geral dado por:

ATB =

TB = T( APB/APB,APB).R(k,)

RB
0 0 0

PB
1

O operador de transformao ATB, aplicado a um ponto BP (em coordenadas


homogneas), resulta no ponto AP (tambm em coordenadas homogneas):
A

P = ATB.BP
B

P
{B}

PB

{B}

{A} = {B}

{A}

{I}
{A}

Figura 2.19. Operador de Transformao.


Exemplo: Dado o referencial {B} rotacionado 45 em torno do eixo zA e transladado a
uma distncia de duas unidades ao longo do eixo xA do referencial {A}, determinar as
coordenadas do ponto BP = [1 1 0] T em relao ao referencial {A}.
B

45
{A}

{B}
2

Figura 2.20. Exemplo de operador de transformao.


A

PB = [2 0 0]

RB

000

RB =

PB
1

AP = [2 (1/2) 1/2 0]T

cos(45o) -sen(45o) 0
sen(45o) cos(45 o) 0
0
0
1
=

(1/2)1/2 -(1/2)1/2 0 2
(1/2)1/2 (1/2) 1/2 0 0
0
0
1 0
0
0
0 1

1
1
0
1

Aritmtica de Transformaes:
Transformao Composta:
Problema: conhecendo a localizao de {C} em relao a {B} e a localizao de
{B} em relao a {A}, determinar a localizao de {C} em relao a {A}.
Soluo: dado um ponto P representado em {A}, {B} e {C},
B

P = BTC.CP,

P = ATB.BP,

P = ATC.CP

Ento,
A

P = ATB.BP = AP = ATB.(BTC.CP) = (ATB.BTC).CP

ATC =

(ARB.BRC)
0 0 0

TC = ATB.BTC

(APB + ARB.APC)
1

Transformao Inversa:
Problema: conhecendo a localizao de {B} em relao a {A}, determinar a
localizao de {A} em relao a {B}.
Soluo: dado um ponto P representado em {A} e {B},
A

P = ARB.BP + APB

P = ARB-1.(AP - APB) = ARBT.AP - ARBT.APB

Ento, o operador matricial que relaciona AP a BP :


B

TA = ATB-1 =

(ARBT)
0 0 0

(-ARBT.APB)
1

Equaes de Transformao:
As transformaes homogneas permitem descrever a localizao relativa de corpos
rgidos. Muitos problemas de robtica envolvem a determinao da localizao relativa
entre dois referenciais a partir do conhecimento da localizao relativa destes em
relao a um terceiro referencial. Nestes casos, possvel estabelecer uma equao de
transformaes, a qual pode ser resolvida utilizando as regras aritmticas de composio
e/ou inverso de transformaes homogneas. Assim, por exemplo, conhecendo ATB e
A
TC, possvel obter BTC. Assim:
TC = ATB.BTC

TA. ATC = BTA.ATB.BTC (ATB)-1. ATC = ( ATB)-1.ATB.BTC

TC = ( ATB)-1. ATC

Exemplo: seja a clula de trabalho mostrada na figura abaixo e dados os referenciais


{B} (Base), {G} (Garra}, {E} (Estao) e {O} (Objeto}; determinar GTO a partir das
transformaes homogneas conhecidas BTG , BTE , ETO.
{G}
G
B

TG
E

TO

{B}

TO = ?
{O}

TE {E}

Figura 2.21. Exemplo de equao de transformao.


Soluo:

2.3.

TO =

TB. BTO = GTB.(BTE.ETO) = BTG-1.(BTE.ETO)

Cinemtica Direta:

O Problema da Cinemtica Direta:


Do ponto de vista cinemtico, o rob manipulador pode ser considerado como
um conjunto de corpos rgidos, (chamados elos), interligados numa cadeia cinemtica
aberta atravs de juntas, com uma extremidade fixa na base do manipulador e com uma
garra ou ferramenta fixa na outra extremidade, que livre.
Elo: corpo rgido que define a relao geomtrica entre dois eixos de juntas vizinhas na
cadeia cinemtica. Para identificar elos usaremos nmeros inteiros, de acordo com a
seguinte conveno: a base do manipulador o elo zero; os elos seguintes so
numerados em ordem crescente na cadeia cinemtica, da base at a ferramenta.
Junta: conexo entre dois elos vizinhos na cadeia cinemtica. A partir do seu eixo se d
a movimentao relativa entre dois elos vizinhos. Para identificar juntas usaremos
nmeros inteiros, de acordo com a seguinte conveno: a junta mais prxima da base do
manipulador a junta 1; as juntas seguintes so numeradas em ordem crescente na
cadeia cinemtica, da base at a ferramenta.
Varivel de Junta: grandeza que mede o deslocamento relativo entre dois elos vizinhos
{i-1} e {i} interligados pela junta i. Para uma junta genrica i, utilizaremos a
nomenclatura qi para denotar a varivel de junta associada. Se a junta i for rotacional, a
varivel da junta i o ngulo de junta i. Se a junta i for prismtica, a varivel da junta
i o deslocamento de junta di. Um rob de N graus de liberdade possui N variveis de
junta, que so representadas pelo vetor de variveis de junta q de dimenso Nx1.

O problema de Cinemtica Direta de robs manipuladores consiste em


determinar a localizao da garra (e eventualmente de cada elo do manipulador) a
partir do valor atual das variveis de junta (ngulos ou deslocamentos de junta). O
problema da cinemtica direta pode ser resolvido para qualquer rob manipulador serial
utilizando transformaes homogneas que relacionam a localizao de um elo em
relao ao elo anterior na cadeia cinemtica. A soluo do problema da cinemtica
direta nica. Esta soluo pode ser obtida em forma analtica fechada ou em forma
numrica atravs de um procedimento sistemtico.
A seguir, apresenta-se um mtodo sistemtico para soluo do problema da
cinemtica direta de robs manipuladores. Para esta soluo necessrio caracterizar
matematicamente os elos do rob atravs de referenciais e parmetros cinemticos
atribudos de acordo com convenes apropriadas. A notao Denavit-Hartenberg
uma destas convenes que permite solucionar o problema da cinemtica direta de uma
maneira simples e sistemtica.
Notao Denavit Hartenberg:
Conveno para atribuio de Referenciais de Elo:

Os elos so numerados partindo da base do rob, qual associa-se o referencial {0},


e prosseguindo em ordem crescente na cadeia cinemtica em direo ferramenta.
As juntas correspondentes so numeradas da mesma maneira, recebendo o mesmo
nmero que o elo que, dentre os dois que so associados mesma, seja o mais
distante da base na cadeia cinemtica.
O eixo zi do referencial do elo {i} coincidente com o eixo de movimento da junta
i.
A origem de {i} estabelecida na interseo entre o eixo zi e a reta normal a zi e
zi+1.
O eixo xi estabelecido sobre a reta normal a zi e zi+i e apontando de z i para zi+1.
O eixo yi definido pela regra da mo direita.

Casos especiais:

O eixo zi intersecta o eixo zi+1: o eixo xi estabelecido sobre a reta normal ao plano
formado por zi e zi+1, na direo do vetor zizi+1.
Extremidades da cadeia cinemtica:
base do rob fixo um referencial {0}, que define arbitrariamente a
localizao do elo {1} para a qual a varivel da junta 1 igual a zero.
O referencial {0} atribudo de maneira a ser coincidente com o
referencial {1} quando a varivel da junta 1, q 1, for igual a zero.
Ao ltimo elo (no qual est fixa a ferramenta) so fixos dois referenciais: um
na junta associada (referencial {N}} e outro na ponta da ferramenta {N+1}.
O referencial {N} atribudo de maneira a ser coincidente com o
referencial de elo {N-1} quando a varivel da junta N, qN, for igual a
zero.
O referencial {N+1) posicionado na ponta da ferramenta e com a
mesma orientao do referencial {N}.

Descrio Cinemtica de Elos:


Comprimento do elo i: ai, distncia entre zi e zi+1 medida ao longo do eixo xi.
ngulo de toro do elo i: i, ngulo entre zi e zi+1 medido em torno do eixo xi.
zi+1

Elo i

zi

ai
i

xi
Figura 2.22. Parmetros de elo.
Descrio Cinemtica de Juntas:

Deslocamento da junta i: di, distncia entre x i-1 e xi medida ao longo do eixo zi.
ngulo da junta i: i, ngulo entre xi-1 e xi medido em torno do eixo zi.
Varivel da junta i: qi, igual ao ngulo da junta i se a junta i for rotacional ou igual
ao deslocamento da junta di se a junta i for prismtica. Grandeza que varia ao acionar o
atuador da junta i, resultando no movimento relativo entre os elos {i-1} e {i}.
zi+1

Elo i

zi
zi-1

xi

Elo i-1

di
xi-1

Figura 2.23. Parmetros de junta.

Transformaes de Elo:
De acordo com as convenes acima, a localizao do referencial do elo {i} em relao
ao referencial do elo anterior {i-1} pode ser obtida a partir de uma seqncia de
translaes e rotaes ao longo dos eixos xi e zi: rotao i em torno de zi e translao di
ao longo de zi, seguidas de rotao i-1 em torno de xi e translao ai-1 ao longo de xi.
i-1

Ti = T(xi,ai-1).R(xi,i-1).T(zi,di).R(zi,i)

i-1Ti =

i-1

Ri
000

onde, c = cos(),

i-1

Pi
1

s = sen(),

(ci)
(-si)
0
(a i-1)
(ci-1si) (ci-1ci) (-si-1) (-si-1di)
(si-1si) (si-1ci) (ci-1) (ci-1di)
0
0
0
1
c = cos(), s = sen()

Soluo do Problema da Cinemtica Direta:


Definidas as transformaes de cada elo de um rob manipulador em funo de da sua
varivel de junta associada, a soluo do problema de cinemtica direta trivial,
podendo ser obtida pela simples composio de transformaes.
0

TN = 0T1.1T2. ... i-1Ti. ... . N-2TN-1.N-1TN

Exemplo de clculo de Cinemtica Direta: dado o Manipulador Planar Articulado de


trs Graus de Liberdade mostrado na figura abaixo, obtenha a sua cinemtica direta.
L2
2

y2
L1

y1

x2

y0 x1
1

y3

x3

x0

Figura 2.24. Exemplo de atribuio de referenciais para clculo de Cinemtica Direta.


Os eixos zi so todos paralelos, alinhados com os eixos das juntas correspondentes e
perpendiculares ao plano do rob. Os Parmetros Denavit-Hartenberg so:
i
1
2
3

ai-1
0
L1
L2

i-1
0
0
0

di
0
0
0

i
1
2
3

As transformaes de elo so obtidas em funo dos parmetros Denavit-Hartenberg.


Cada linha da tabela acima est associada a uma transformao de elo correspondente.
0

T1 =

T2 =

T3 =

T3 =
0

c1 -s1
s1 c1
0
0
0
0

0
0
1
0

0
0
0
1

c2 -s2
s2 c2
0
0
0
0

0
0
1
0

L1
0
0
1

c3 -s3
s3 c3
0
0
0
0

0
0
1
0

L2
0
0
1

c123 -s123 0 (L 1c1+L2c12)


s123 c123 0 (L1s1+L2s12)
0
0
1
0
0
0
0
1

onde, c1 = cos(1), s1 = sen(1), c12 = cos(1+2), s12 = sen(1+2), c123 = cos(1+2+3)


e s123 = sen(1+2+3).
Exemplo de clculo de Cinemtica Direta: dado o Manipulador PUMA de seis Graus
de Liberdade mostrado na figura abaixo, obtenha a sua cinemtica direta.
Lb
Lc

x2

Ld

Lf

z2

z0 , z1

z3

x3

Le

z5

La

x5
Lg
x4
z4
z6

Figura 2.25. Atribuio de referenciais para um manipulador PUMA.

x6

Os eixos zi so todos paralelos, alinhados com os eixos das juntas correspondentes. Os


Parmetros Denavit-Hartenberg so:
i
1
2
3
4
5
6

i-1
0
-/2
0
-/2
/2
-/2

ai-1
0
0
Lc
Le
0
0

i
1
2
3
4
5
6

di
0
Lb - Ld
0
Lf
0
0

A partir dos parmetros Denavit-Hartenberg, obtemos as transformaes de elo:


0

T1 =

T3 =

T5 =

c1 -s1
s1 c1
0
0
0
0

0
0
1
0

0
0
0
1

c3 -s3
s3 c3
0
0
0
0

0
0
1
0

Lc
0
0
1

c5
0
s5
0

-s5 0
0 -1
5
0
0
0

0
0
0
1

T2 =

T4 =

T6 =

c2 -s2
0
0
-s2 -c2
0
0

0
1
0
0

0
L b-Ld
0
1

c4 -s4
0
0
-s4 -c4
0
0

0
1
0
0

Le
L f
0
1

c6
0
-s6
0

0
1
0
0

0
0
0
1

-s6
0
-c6
0

A partir da composio das transformaes de elo, a transformao de cinemtica direta


pode ser facilmente obtida. A matriz de orientao R e o vetor de posio
correspondentes so dados por:
R11 = c1[c23(c4c5c6 - s4s6) - s23s5c6] + s1[s4c5c6 + c4s6]
R12 = c1[-c23(c4c5s6 + s4c6) + s23s5s6] - s1[s4c5s6 - c4c6]
R13 = -c1[c23c4s5 + s23c5] - s1s4s5
R21 = s1[c23(c4c5c6 - s4s6) - s23s5c6] - c1[s4c5c6 + c4s6]
R22 = s1[-c23(c4c5s6 + s4c6) + s23s5s6] + c1[s4c5s6 - c4c6]
R23 = -s1[c23c4s5 + s23c5] + c1s4s5
R31 = -s23(c4c5c6 - s4s6) - c23s5c6
R32 = s23(c4c5s6 + s4c6) + c23s5s6
R33 = s23c4s5 - c23c5
Px = c1(c2Lc + c23Le s23Lf) s1(Lb - Ld)
Py = s1(c2Lc + c23Le s23Lf) + c1(Lb - Ld)
Pz = -s2Lc - s23Le c23Lf

2.4.

Cinemtica Inversa:

O Problema da Cinemtica Inversa:


O Problema da Cinemtica Inversa fundamental no controle de robs
manipuladores. Normalmente, a tarefa especificada em espao cartesiano, enquanto
que os controladores atuam sobre atuadores de junta, requerendo que as referncias de
controle sejam especificadas em espao de juntas. Deste modo, torna-se necessrio
mapear referncias especificadas em espao cartesiano em referncias equivalentes em
espao de juntas. Assim, o problema da cinemtica inversa pode ser estabelecido da
seguinte forma: especificada a localizao (posio e orientao) que se deseja que a
garra alcance, determinar o valor das variveis de junta (ngulos ou deslocamentos de
junta) necessrios para levar a garra a tal localizao. Ou seja, a partir da especificao
de 0TN*, determinar o vetor de variveis de junta q.
Caractersticas do Problema da Cinemtica Inversa:
A localizao da garra 0TN uma funo no linear transcendente das N variveis de
junta (0TN* = 0TN(q)). 0TN possui 16 elementos (quatro deles triviais) sendo que os nove
elementos da matriz de rotao esto sujeitos a seis restries. Assim, tm-se ao todo
seis equaes linearmente independentes que devem ser resolvidas para as variveis de
junta. Ao contrrio da cinemtica direta, o problema da cinemtica inversa no trivial
e tem um complicador adicional: o mapeamento 0TN q no um mapeamento umpara-um. Assim, dois problemas adicionais devem ser levados em conta: a verificao
da existncia de soluo e a possibilidade de existirem mltiplas ou infinitas solues
para uma dada localizao da garra.
Existncia de solues:
Espao de trabalho: conjunto de todas as localizaes da ferramenta para as
quais existe soluo para a cinemtica inversa. Podem existir especificaes para
0
TN* para as quais no existe solu o fora do espao de trabalho.
Espao de trabalho alcanvel: Volume do espao que pode ser alcanado com,
pelo menos uma orientao.
Espao de trabalho manipulvel: Volume do espao de trabalho que pode ser
alcanado em qualquer orientao.
Mltiplas Solues:
Para N = 6 juntas
6 equaes e 6 incgnitas. Para uma localizao
especificada dentro do espao de trabalho existe um numero finito de solues.
At 16 solues diferentes podem existir.
Para N < 6 juntas
6 equaes e N < 6 incgnitas. No possvel alcanar
objetivos gerais no espao 3D. As localizaes para as quais existe soluo da
cinemtica inversa constituem um subespao do espao 3D.
Para N > 6 juntas
6 equaes e N > 6 incgnitas (manipuladores
redundantes). Para uma dada especificao de localizao podem existir infinitas
solues para o problema da cinemtica inversa. necessrio escolher uma
soluo dentro do conjunto de possveis solues. Deve-se definir algum critrio
de escolha, como por exemplo: menor movimento em relao localizao
atual, movimento das juntas mais leves, contorno de obstculos, etc.

Mtodos de Soluo:
Soluo Numrica:
As equaes no lineares simultneas podem ser resolvidas por mtodos iterativos.
Por utilizar mtodos iterativos, esquemas baseados neste tipo de abordagem podem ter
problemas de convergncia. Por esta razo, no so muito apropriados para
implementaes em tempo real.
Soluo em frmula fechada:
As equaes so resolvidas por mtodos algbricos, freqentemente fazendo uso de
consideraes geomtricas, resultando numa expresso analtica computvel. Este tipo
de abordagem resulta em solues fceis de implementar e que envolvem pouco esforo
computacional, encorajando aplicaes em tempo real. Como a cinemtica inversa deve
ser calculada a taxas elevadas (perodo de amostragem menor do que 30 ms), solues
fechadas so mais adequadas.
Robs manipuladores de seis graus de liberdade e com trs eixos se intersectando
num ponto possuem soluo em frmula fechada (Soluo de Pieper). A grande maioria
dos manipuladores industriais projetada e construda de modo a possuir soluo em
frmula fechada.
Uma tcnica freqentemente utilizada na obteno de uma soluo fechada consiste
em transformar a equao cinemtica de modo a obter uma representao equivalente
mais simples. A equao cinemtica original:
0

T6* = 0T1(q1).1T2(q2). ... .5T6(q6)

equivalente a doze equaes algbricas, com seis variveis desconhecidas (q1, q2, q3,
q4, q5, q6). Transformando esta expresso:
[0T1(q1). ... .i-1Ti(qi)]-1.0T6*.[jTj+1(qj+1). ... .5T6(q6)]-1 = iTi+1(qi+1). ... .j-1Tj(qj)
obtemos outro conjunto equivalente de doze equaes simultneas para cada par (i,j)
com i < j. Escolhendo as equaes mais simples dentro deste conjunto, freqentemente
possvel encontrar mais facilmente a soluo.
A soluo proposta por Pieper para manipuladores de seis graus de liberdade
baseia-se em uma aplicao particular desta abordagem. Grande parte dos robs
manipuladores industriais possuem punho com trs juntas rotacionais cujos eixos se
intersectam em um ponto comum. Neste caso, a origem dos referenciais {4}, {5} e {6}
est localizada neste ponto. A especificao da posio e orientao da garra determina
a posio da origem de {6}. A orientao da garra pode ser especificada de diversas
maneiras (matriz de rotao, ngulos de Euler, etc.). Em particular, se esta for
especificada atravs de um vetor de aproximao, com o ngulo de rolamento
codificado em seu mdulo, a origem de {6} estar localizada sobre o mesmo.
Conhecendo a posio de {6}, determina-se conseqentemente a posio de {4}, visto
que suas origens so coincidentes. Esta ltima representada por trs componentes 0P4x,
0
P4y, 0P4z, funo das trs primeiras variveis de junta: q1, q2 e q3. Assim, utilizando
mtodos algbricos e/ou geomtricos, possvel determinar q1, q2 e q3 a partir da
posio e orientao especificada para a ferramenta. A partir de q1, q2 e q3, possvel

determinar a posio e orientao de {3}, bem como a orientao de {6} relativa a {3}
(por transformao da equao cinemtica). Como esta ltima orientao funo
apenas de q4, q5 e q6, estas trs ltimas variveis desconhecidas podem ser obtidas
facilmente da equao transformada.
Exemplo de clculo de Cinemtica Inversa:
Resolva o problema da cinemtica inversa para o Manipulador Planar Articulado de trs
Graus de Liberdade.
Considere a posio e orientao da garra especificada por trs valores: (x, y, ), onde
(x, y) so respectivamente as coordenadas x e y da origem do referencial da garra {3}
expressas no referencial de base {0} e o ngulo de orientao do referencial {3} em
relao ao referencial {0}, que corresponde a uma rotao de radianos em torno do
eixo z 0 . Esta especificao de localizao pode ser expressa em forma de uma matriz
de transformao homognea 0T3*, a qual igualada expresso da cinemtica direta
0
T3, funo das variveis de junta:
T3 = T3 =
0

c -s 0 x
s c 0 y
0
0 1 0
0
0 0 1

c123 -s123 0 (L 1c1+L2c12)


s123 c123 0 (L 1s1+L2s12)
0
0
1
0
0
0
0
1

Da equao matricial acima podemos obter quatro equaes, funo dos ngulos de
junta, das quais, as duas so dependentes entre si:
c = c123
s = s123
x = L1c1+L2c12
y = L1s1+L2s12
Por meios algbricos, estas equaes podem ser resolvidas para 1, 2 e 3:
2 = atan2(s2, c2)
x 2 + y 2 L1 L 2
s 2 = 1 c 22
2.L 1 .L 2
atan2(s,c) a funo arcotangente definida para quatro quadrantes, onde os parmetros
de entrada s e c representam respectivamente o seno e o coseno do arco a ser calculado.
2

onde, c 2 =

1 = atan2(y, x) - atan2(L2.s2, L1+L2.c2)


= atan2(s 123,c123)
3 = - 1 - 2
Observaes:

a) Existncia de soluo: a expresso obtida deve obedecer restrio 1 c2 1.


b) Soluo singular: se x = y = 0, a soluo para 1 pode assumir qualquer valor.
c) Mltiplas solues: de acordo com o sinal escolhido para s2, duas solues so
possveis, com o brao para cima e com o brao para baixo.

Figura 2.26. Exemplo de mltiplas solues no problema de Cinemtica Inversa.

Exemplo de clculo de Cinemtica Inversa para manipulador PUMA:


Considerando as forma fechada da cinemtica direta do rob manipulador PUMA e
levando em conta que as trs juntas distais possuem eixos que se intersectam em um
nico ponto, a cinemtica inversa pode ser obtida usando a abordagem de Pieper. Por
procedimentos algbricos, as trs primeiras variveis de junta podem ser obtidas a partir
da posio da garra P x, Py e Pz:
1 = atan2(-px,py) atan2([Px2+Py2-(Lb-Ld)2]1/2, [Lb-Ld])
3 = atan2(-Lf,Le) atan2([Lc2(Le2+Lf2)-Ka2]1/2, Ka)
onde: Ka = [Px2 + Py2 + Pz2 Lc2 - Le2 - Lf2 -(Lb-Ld)2]/2
2 = atan2(K b, Kc)
onde:
Kb = -(Les3+Lfc3)(c1Px+s1Py)-(Lec3-Lfs3+Lc)Pz
Kc = (Lec3-Lfs3+Lc)(c1Px+s1Py)-(Les3+Lfc3)Pz
A partir dos valores j calculados de 1, 2 e 3, podemos transformar a equao
cinemtica, de modo a obter equaes em 4, 5 e 6:
[0T3]-1.0T6 = 3T4(4).4T5(5).5T6(6).
Denotando os elementos da componente de orientao 3R6 de 3T6 por rij, com i,j = 1,2,3:
r11 r12 r13
r21 r22 r23
r31 r32 r33

(c4c5c6-s4s6) (-c4c5s6-s4c6) (-c4s5)


(s5c6)
(-s5c6)
(c 5)
(-s4c5c6-c4s6) (s4c5s6-c4c6) (s4s5)

A partir da expresso acima, podemos facilmente obter 4, 5 e 6. Quando r 13 = r33 0,


temos:
4 = atan2(r 33,-r13)
5 = atan2([r132+r332]1/2,r23)
6 = atan2(-r22,r21)
Quando r13 = r 33 = 0, significa que s 5 = 0, ou seja, c5 = r 23 = 1. Assim:
4 = arbitrrio.
5 = (1 - r23) /2
6 = atan2(-r31,-r32) r32.4
Portanto, existem at oito possveis solues para o problema da cinemtica inversa:
dois possveis valores para 1, combinados a dois possveis valores para 3 e a dois
possveis valores para 5.
Mtodos de Soluo para manipuladores com menos de seis juntas :
Quando um rob manipulador possui menos do que seis graus de liberdade, o seu
espao de trabalho um subconjunto (subespao) do espao definido pro todas as
possveis posies e orientaes no espao tridimensional. Este subespao possui
dimenso igual ao nmero de graus de liberdade do rob manipulador.
Exemplo: dado o rob manipulador polar mostrado na figura abaixo, determine o seu
subespao de trabalho.
z0,z1
z2,x1
x0 = x1
para 1 = 0

x2

Figura 2.27. Manipulador com duas juntas gera um subespao de trabalho.


A posio da garra no plano horizontal especifica como:
0

P2 = [x y 0] T

Devido a que o brao tem apenas duas juntas, a orientao da ferramenta em relao
base no pode ser imposta de forma independente, mas dependente da posio:
0

R2 = [ 0x2

y2

z2]

(y/[x2+y2]1/2) 0 (x/[x 2+y2]1/2)


(-x/[x2+y2]1/2) 0 (y/[x 2+y2]1/2)
0
-1
0

A localizao dada por 0R2 e 0P2 define um subespao no qual a orientao da garra no
independente da sua posio, mas funo de x e y. Desta maneira, para um nmero de
juntas N menor do que seis, nem sempre possvel alcanar objetivos gerais de posio
e orientao. Neste caso, quando a localizao especificada para a garra 0TN* est fora
do subespao alcanvel pelo rob, o que se pode fazer definir um novo objetivo 0TN
dentro do subespao, o mais prximo possvel da especificao inicial. Alguma mtrica
deve ser utilizada para definir o que se entende por o mais prximo possvel. A partir
da nova especificao 0TN possvel ento encontrar as variveis de junta
correspondentes atravs do mapeamento de cinemtica inversa.

Você também pode gostar