CALCULO DEL MODELO DINAMICO DE UN BRAZO ROBTICO DE DOS

ARTICULACIONES CONTROLADO POR RED TENDONAL

MSc. Ing. Eduardo Alberto Cirera
Dpto. Ingeniera Mecnica-U.N.N.E-Av. Las Heras 727-Resistencia-Chaco-Tel.54-3722-420076-
ecirera@ing.unne.edu.ar
Ing. Vernica Liz Cerio

RESUMEN
La propuesta de este trabajo es obtener el modelo dinmico de un brazo robtico de
dos articulaciones controlado por una red tendonal, aplicando el mtodo de Lagrange.
Dicho mtodo plantea el problema en base a trminos de energa.
Las ecuaciones obtenidas servirn de base para realizar el control dinmico del robot,
cuyo anlisis escapa a los objetivos de este articulo y que ser tratado en una prxima
entrega, en la que se analizar el control dinmico, con el uso de tcnicas de control
discontinuo y superficies deslizantes.
Este trabajo forma parte del Tesis final de la Carrera Tcnicatura en Sistemas.

PALABRAS CLAVES: modelo matemtico red tendonal brazo robtico

INTRODUCCIN
Un robot es un manipulador flexible, reprogramable y multifuncional, en contraposicin
a las mquinas automticas, las que estn diseadas para realizar, nicamente una
tarea especfica.
En los robots al igual que sucede con los seres humanos, para ejecutar cualquier tarea
se debe analizar cules sern los movimientos necesarios y cul ser la fuerza que se
le aplicar.
El modelo dinmico precisamente analiza esta situacin y expresa las fuerzas o pares
requeridos por los actuadores, para lograr el movimiento deseado, en trminos de
posiciones, velocidades y aceleraciones a lo largo de la trayectoria y los parmetros del
manipulador. Esto permitir evaluar vibraciones, sobrepesos y sobrevoltajes, que
llevaran a movimientos errticos o descoordinados.
Los pares de torsin que se requieren para impulsar el brazo del robot no pueden
determinarse solo considerando las fuerzas estticas y dinmicas, sino que tambin
deber tenerse en cuenta que cada articulacin reacciona a los pares de torsin de las
otras articulaciones en el manipulador y los efectos de estas reacciones debern
incluirse en el anlisis.
Resulta difcil proporcionar una solucin adecuada para las aceleraciones de los
enlaces puesto que las mismas dependen de la inercia y esta a su vez de la
configuracin del brazo, la que est sujeta a cambios debido al movimiento de las
articulaciones.
Otro factor adicional que influye en relacin con la inercia, es la masa de la carga til y
su posicin con respecto a las articulaciones la que tambin se modifica con el
movimiento de estas.
Otro punto a tener en cuenta es la velocidad de movimiento del brazo, si esta es
relativamente elevada, los efectos centrfugos que se generen ser significativos.
El modelo plantea una serie de ecuaciones, cuya resolucin nos permite obtener la
informacin necesaria, la que ser enviada hasta el robot mediante tarjetas electrnicas
insertadas en l. Estos circuitos envian la seal de voltaje a la fuente de potencia del
robot, encargada de convertirla en la potencia adecuada que necesita cada motor para
realizar la funcin asignada.
Conocer esta informacin antes de ensamblar el robot permite que las tarjetas, motores
y fuentes de potencia tengan un mejor funcionamiento y se desgasten menos.
Muchas veces se cae en el error de disear la parte mecnica y pasar por alto la
obtencin del modelo dinmico; cuando esto ocurre el robot puede recibir valores
inadecuados de fuerza para mover sus articulaciones, lo que disminuye el desempeo
del movimiento y se presentan comportamientos indeseados.
En cuanto al sistema de transmisin del movimiento del brazo robtico, se considera
que se realizar mediante una red tendonal que ofrece ventajas en trminos de carga y
flexibilidad.
Consta de un sistema de poleas y cables que se utilizan para transmitir potencia desde
los actuadores, situados en la base del robot, lo que reduce substancialmente el peso
del brazo, y permite colocar mayor carga en el efector final. El cable puede estar
constituido por fibras de acero o materiales sintticos tales como el nylon.

HIPTESIS SIMPLIFICATIVAS:
Para el desarrollo del modelo ser necesario tener en cuenta las siguientes
La masa equivalente se encuentra concentrada en un punto, luego podr corregirse
aadiendo unas constantes de inercia (I)
El movimiento es plano (el eje W es perpendicular al plano).

2


DESARROLLO MATEMTICO DEL MODELO:
El mtodo de Lagrange requiere del calculo las energas Cintica (T) y Potencial (U).
Conociendo las coordenadas de las masas m
1
y m
2
en funcin de los ngulos
1
y
2

derivando respecto del tiempo, obtendremos las velocidades de cada una de ellas.

U T L LAGRANGIANO

2
2
1
v m T
i
ENERGIA CINETICA

( ) ( )
]
]
]
]
]

+ + + + + +

2
2
2
1 2 2 1
2
2
2
2 2
2
1 2 2 1
2
2
2
1
2
2
1 1 1
cos 2 2 cos 2
2 2

L L L L L L L L
m L m
T

( ) ( ) [ ]
2 1 2 1 1 2 1 1 1
+ + + sen L sen L g m sen gL m U ENERGIA POTENCIAL

En base a esta ecuacin se podrn calcular las fuerzas de rotacin en las articulaciones
1 y 2 a partir de la siguiente expresin:

n n
n
L L
dt
d

Obtenindose las siguientes ecuaciones del modelo

1 1
1

L L
dt
d


2 2
2

L L
dt
d


Donde:
( ) ( )

+ + + + +

2
1 2 2 1
2
2 2 1 2 2 1
2
2
2
1 2
2
1 1 1
1
cos 2 cos 2

L L L m L L L L m L m
L


( )

+ +

1 2 2 1
2
2 2
2
2 2 2
2
cos 2

L L L m L m
L


( ) [ ]
2 1 2 1 1 2 1 1 1
1
cos cos cos

+ +

L L g m gL m
L


( )
2 1 2 2 2 1 1 2 2 2
2
cos

,
`

.
|
+

gL m sen gL m
L


( ) ( ) ( )

,
`

.
|
+ + + + +

2
2 2 2 1 2 2 2 2 1
2
2 2 2 1 2 2 1 2 1 2 2 1
2
2
2
1 2
2
1 1 1
1
cos 2 cos 2

sen L L m L L L m sen L L m L L L L m L m
L
dt
d


( )

+
,
`

.
|
+

2 1 2 2 1 2
2
2
2
2 2 1 2 2 1
2
2 2
2
cos

sen L L m L m L L L m
L
dt
d


Operando y ordenando se obtiene el modelo del brazo
]
]
]

]
]
]

+
]
]
]
]

]
]
]
]
]
]

,
`

.
|
+
+
]
]
]
]

]
]
]

2
1
2
1
2
1
22 1 21
2 1 12 2 11
2
1
22 21
12 11

N
N
C C
C C
M M
M M

Donde:

1
y
2
son los torques aplicados directamente en las articulaciones

( )
2 2 1 2
2
2 2
2
1 2 1 11
cos 2 L L m L m L m m M + + +

2 2 1 2
2
2 2 21 12
cos L L m L m M M +

2
2 2 22
L m M

2 2 1 2
sen L L m C C C
11

C C
12

C C
21

0
22
C
( ) ( )
2 1 2 2 1 1 2 1 1
cos cos + + + gL m gL m m N
( )
2 1 2 2 2
cos + gL m N

Esquema de poleas y tendones
En este tipo de configuracin, es necesario calcular los torques que se aplicarn, en
funcin del recorrido, la elasticidad y la extensin de los tendones. Para ello, deber
conocerse de antemano la distribucin de los mismos, los radios de las poleas, y otros
parmetros.
Para hacer este anlisis, nos basaremos en la configuracin que se indica en la
siguiente figura:

2
K1
K2
K3
K4
e1 h1
e2 h2
e3 h3
e4 h4




Con esta configuracin la dinmica del modelo tendr la siguiente expresin:

( ) [ ] [ ] ( ) ( ) ( ) [ ] [ ] e K P h h K P N C M +
]
]
]

,
`

.
|
+
]
]
]

]
]
]

,
`

.
|
+

0 , ,
Donde:
M, C y N cuantifican los pares que surgen de las fuerzas de inercia, centrfuga y
Coriolis.
Con la nomenclatura indicada en la figura planteamos:

Funciones del recorrido de los tendones o extensin debido a los mecanismos

2 12 1 11 1 1
R R L h +

1 21 2 2
R L h

1 31 3 3
R L h +

2 42 1 41 4 4
R R L h +

Siendo:
L
i
: long nominal de cada tendn cuando
i
= 0
R
ij
: radios de las poleas del I-simo tendn en la j-sima polea

Teniendo en cuenta que:
14 4 1
L L L

23 3 2
L L L

141 41 11
R R R

231 31 21
R R R

Funciones de la elasticidad de los tendones:
Si consideramos que toda la elasticidad se la puede tratar como un solo elemento
elstico, del tipo resorte, cuya constante de elasticidad ser k
i
> 0. Se podr construir la
matriz de rigidez K.

]
]
]
]
]
]

4
3
2
1
0 0 0
0 0 0
0 0 0
0 0 0
k
k
k
k
K

Funciones de la extensin de los tendones debido a los actuadores:
1. Se obtiene la matriz de acoplamiento P
2. Se calcula una nueva matriz de acoplamiento Q en funcin de la rigidez.

]
]
]

]
]
]

142 142
141 231 231 141
0 0 R R
R R R R
h
P
T

]
]
]

142 4 142 1
141 4 231 3 231 2 141 1
0 0 R k R k
R k R k R k R k
K P Q

Seguidamente se hallaran las diferencias de extensin debido a los mecanismos para lo
cual se deber plantear la siguiente expresin:

( ) ( ) 0 h h



donde h()son las longitudes de los tendones para
una rotacin ; y h(0) son las longitudes nominales
de los tendones cuando =0.


Calculando la matriz de rigidez total S se obtiene la siguiente expresin:


( ) ( ) ( ) ( )
( ) ( ) ( )
( ) ( )
]
]
]

]
]
]

+ +
+ + + +

2
1
4 1
2
141 4 1 142 141
4 1 142 141 3 2
2
231 4 1
2
141
0

k k R k k R R
k k R R k k R k k R
h h K P S
( ) ( )
]
]
]

]
]
]
]
]
]

2
1
142 141
231
231
142 141
0
0
0

R R
R
R
R R
h h
Finalmente la ecuacin de la dinmica del brazo robtico de dos articulaciones, con
tendones elsticos queda de la siguiente manera:

( ) [ ] [ ] [ ] [ ] [ ] [ ] e Q S N C M +
]
]
]

,
`

.
|
+
]
]
]

]
]
]

,
`

.
|
+

, ,

Donde las e
i
sern las extensiones producidas por los actuadores, y se las puede
asimilar como seales de control u
i
Operando se obtienen las siguientes ecuaciones:
( ) [ ] [ ] [ ] +
]
]
]

,
`

.
|
+ + + + + + +

2 1 2 2 1 2 2 1 2 2 2 2 1 2
2
2 2 1 2 2 1 2
2
2 2
2
1 2 1
cos cos 2 sen L L m L L m L m L L m L m L m m


( ) ( ) [ ] ( ) ( ) [ ] ( ) [ ] + + + + + + + + +
2 4 1 142 141 1 3 2
2
231 4 1
2
141 2 1 2 2 1 1 2 1
cos cos k k R R k k R k k R gL m gL m m

[ ] [ ] [ ] [ ]
1 142 4 2 231 3 2 231 2 1 141 1
e R k e R k e R k e R k +

[ ] [ ] [ ] ( ) [ ] ( ) [ ] + + + + + + +

1 4 1 142 141 2 1 2 2
2
1 2 2 1 2 2
2
2 2 1 2 2 1 2
2
2 2
cos cos k k R R gL m sen L L m L m L L m L m

+ ( ) [ ] [ ] [ ]
1 142 4 1 142 1 2 4 1
2
142
e R k e R k k k R +

y suponiendo que e
1
= -e
4
y e
2
= -e
3
, debido a que cada uno de los pares de tendones
se encuentra comandado por un motor

( ) [ ] [ ] [ ] +
]
]
]

,
`

.
|
+ + + + + + +

2 1 2 2 1 2 2 1 2 2 2 2 1 2
2
2 2 1 2 2 1 2
2
2 2
2
1 2 1
cos cos 2 sen L L m L L m L m L L m L m L m m


( ) ( ) [ ] ( ) ( ) [ ] ( ) [ ] + + + + + + + + +
2 4 1 142 141 1 3 2
2
231 4 1
2
141 2 1 2 2 1 1 2 1
cos cos k k R R k k R k k R gL m gL m m

[ ] [ ]
2 231 3 2 1 141 4 1
e R k k e R k k + +

[ ] [ ] [ ] ( ) [ ] ( ) [ ] + + + + + + +

1 4 1 142 141 2 1 2 2
2
1 2 2 1 2 2
2
2 2 1 2 2 1 2
2
2 2
cos cos k k R R gL m sen L L m L m L L m L m

+ ( ) [ ] [ ]
1 142 4 1 2 4 1
2
142
e R k k k k R + +

Asignando variables de estado:
1 1
x

1 2
x






2 3
x

2 4
x
i i
e u
de esta manera se obtiene
2 1
x x

1 2
x
4 3
x x

2 4
x

y el modelo queda conformado en variables de estado

( )
( )

]
]
]

]
]
]

]
]
]

+
]
]
]

+
]
]
]

]
]
]
]

,
`

.
|
+
+
]
]
]
]

]
]
]

2
1
24 21
13 12 14 11
2
1
22 21
12 11
3 1 2
3 1 1
4
2
2 21
4 2 12 4 11
4
2
22 21
12 11
0 ,
,
0
u
u
Q Q
Q Q Q Q
x
x
S S
S S
x x N
x x N
x
x
x C
x x C x C
x
x
M M
M M


Operando con estas ecuaciones, se llega a las siguientes expresiones:
(I)
[ ] [ ] ( ) ( )
3 12 1 11 3 1 1 4 4 2 12 2 4 11 2 13 12 1 14 11 4 12 2 11
, x S x S x x N x x x C x x C u Q Q u Q Q x M x M + + +


[ ] ( )
3 22 1 21 3 1 2
2
2 21 1 24 21 4 22 2 12
, x S x S x x N x C u Q Q x M x M +

(2)

En estas expresiones (1) y (2) se definen:

2
12 22 11
M M M MM

[ ] [ ] ( ) ( )
3 12 1 11 3 1 1 4 4 2 12 2 4 11 2 13 12 1 14 11
, x S x S x x N x x x C x x C u Q Q u Q Q AA + +

[ ] ( )
3 22 1 21 3 1 2
2
2 21 1 24 21
, x S x S x x N x C u Q Q BB +

Se despejan las derivadas de x
2
y x
4
, luego se resta miembro a miembro, llegndose a
las siguientes expresiones:

[ ] [ ] BB
MM
M
AA
MM
M
x
12 22
2

[ ] [ ] BB
MM
M
AA
MM
M
x
11 12
4
+

Finalmente el modelo en variables de estado, adopta la siguiente forma:

+
]
]
]
]
]
]
]
]

]
]
]
]
]
]
]

+
+

]
]
]
]
]
]
]
]

4
3
2
1
4 2 12 12 22 11 12 12 2 21 11 4 11 12 21 11 11 12
4 2 12 22 12 22 22 12 4 11 22 2 21 12 11 22 21 12
4
3
2
1
) (
1 0 0 0
) (
0 0 1 0
x
x
x
x
MM
x x C M
MM
S M S M
MM
x C M x C M
MM
S M S M
MM
x x C M
MM
S M S M
MM
x C M x C M
MM
S M S M
x
x
x
x


+
[ ] [ ] [ ]
[ ] [ ] [ ]
]
]
]

]
]
]
]
]
]
]

+
+
+
]
]
]

]
]
]
]
]
]
]

2
1
12 13 12 24 21 11 11 14 12
14 11 22 21 24 12 14 11 22
2
1
11 12
12 22
0 0
0 0
0 0
0 0
u
u
MM
Q Q M
MM
Q Q M Q Q M
MM
Q Q M
MM
Q Q M Q Q M
N
N
MM
M
MM
M
MM
M
MM
M



Si consideramos que los tendones estn constituidos por pares de igual elasticidad,
tendremos que:
Tendn 1= Tendn 4 k
1
= k
4
k
1


Tendn 2= Tendn 3 k
2
= k
3

k
3


Definimos entonces:

3 1 2
cos x L L LE +

( )
3 2 1 2
2
1 2 1
cos x L L m L m m MLE + +

3
2
2 1
x sen m m ME +

entonces tendremos que:

ME L L m MM
2
2
2
1 2


( ) [ ]
ME L L
R L K R L R E L R K
A
2
2
1
2
231 2 2 141 2 142 141 1
2
+ +


( )
ME L
x L x E L
senx m B
1
4 2 2
3 2
+


( )
ME L L
R L R E L
R K C
2
2
1
141 2 142
142 1
2
+


( )
ME L
x x
senx L m D
1
4 2
3 2 2
+


( ) [ ]
ME L L m
MLE R R K R K R R R K LE L m
E
2
2
2
1 2
142 141 1
231
2
2 142 141 141 1 2 2
2
+ + +


( ) [ ]
ME L L
MLE x x x LE L m
senx F
2 1
2 4 2 2 2
3
+ +


( )
ME L L m
MLE R R R LE L m
R K G
2
2
2
1 2
142 142 141 2 2
142 1
2
+ +


( )
ME L
x x
LE senx m H
1
4 2
3 2
+


ME L
I
1
2
1


ME L L
LE
J
2
1
2


ME L L m
LE L m MLE
K
2
2
2
1 2
2 2
+


ME L L
LE R L R
K L
2
2
1
142 2 141
1
2
+


ME L
R K
M
2
1
231 2
2

( )
ME L L m
MLE R LE L m R R
K N
2
2
2
1 2
142 2 2 142 141
1
2
+ +


ME L L
LE R K
P
2
2
1
231 2
2

De esta manera, el modelo queda:

]
]
]

]
]
]
]
]
]

+
]
]
]

]
]
]
]
]
]

+
]
]
]
]
]
]

]
]
]
]
]
]

]
]
]
]
]
]
]
]

2
1
2
1
4
3
2
1
4
3
2
1
0 0
0 0
0 0
0 0
1 0 0 0
0 0 1 0
u
u
P N
M L
N
N
K J
J I
x
x
x
x
H G F E
D C B A
x
x
x
x



2
1 x x

2 1 2 1 4 3 2 1
2 Mu Lu JN IN Dx Cx Bx Ax x + + + + + + +

4
3 x x

2 1 2 1 4 3 2 1
4 Pu Nu KN JN Hx Gx Fx Ex x + + + + + + +

CONCLUSIONES:
En este trabajo se presentaron los pasos y se obtuvo el modelo dinmico de un brazo
robtico de dos articulaciones, comandado por una red tendonal. Este modelo es de
utilidad a la hora de calcular los controles que se aplicarn al brazo, as al conocer la
trayectoria deseada, las velocidades y aceleraciones sobre dicha trayectoria, es posible
calcular las coordenadas de mquina y sus derivadas por medio de transformaciones
inversas y determinar de esa forma los pares actuantes requeridos. Sin embargo esto
puede consumir una cantidad de tiempo considerable, para calcular el movimiento entre
dos puntos adyacentes en una trayectoria planeada. El tiempo de computo puede
reducirse mediante la simplificacin de las ecuaciones, por ejemplo ignorando los
trminos de segundo orden de Coriolis y la reaccin centrfuga, pero estos modelos
aproximados resultan en un rendimiento subptimo y requieren que se restrinjan las
velocidades de los brazos.

REFERENCIAS BIBLIOGRAFICAS:
Mikell P.Groover, Mitchell Weiss, Roger N. Nagel y Nicholas G. Odrey, Robtica
Industrial. Tecnologa, Programacin y Aplicaciones, Mc Graw Hill, 1989.