Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
INTRODUCCIN
Estudia las propiedades geomtricas y temporales del movimiento. Adems del problema geomtrico
involucrado en el posicionamiento esttico, se consideran las variaciones en el tiempo de las
posiciones y orientaciones; es decir, las velocidades.
Modelos geomtrico y diferencial : Tratan de establecer relaciones entre el espacio de las variables
articulares ( espacio de coordenadas generalizadas )( espacio articular ) y el espacio de las
variables cartesianas ( espacio de coordenadas operacionales )( espacio de trabajo u operacional )
Si se pretende que el robot realice una trayectoria deseada, sta estar definida en cada instante de
tiempo t por la posicin y orientacin de su elemento terminal y no por el giro o el desplazamiento
de sus articulaciones. Como el control del robot se realiza sobre stas, es necesario efectuar las
correspondientes transformaciones de coordenadas.
La base del modelado cinemtico son las transformaciones en el espacio.
Para un punto P tendremos 2 representaciones :
A.
1
Permite calcular la localizacin del elemento terminal en el sistema de coordenadas que se tome
como referencia ( en el espacio de coordenadas operacionales ) conociendo los desplazamientos o
giros relativos a cada una de las articulaciones ( en el espacio de coordenadas generalizadas ).
El sistema de referencia, solidario al robot, se define teniendo en cuenta la tarea que se pretende
desarrollar con el robot :
En un robot manipulador : Suele elegirse asociado al efector final del robot
determinar la localizacin del elemento terminal con relacin a la base del robot.
Se trata de
f toma como argumento un vector en el espacio articular, con tantas componentes como GDL ( =
n ) tenga la cadena cinemtica que se considere, y devuelve un vector de m componentes.
para representar
A.
2
Determinar la configuracin que debe adoptar el robot para alcanzar una posicin y orientacin
conocidas de su extremo final.
Encontrar los valores que deben adoptar las coordenadas articulares (
) del
robot para que su extremo se posicione y oriente segn una determinada localizacin espacial.
Obtener los valores de las variables articulares, que es lo que realmente se enva al sistema de
control del manipulador, a partir de la posicin y orientacin deseadas para el punto terminal.
4
El problema cinemtico directo se puede resolver de manera sistemtica a partir de la utilizacin de
las MTH, e independientemente de la configuracin del robot.
Que el punto pedido est fuera del alcance del robot debido a su lejana o debido a problemas
geomtricos ( unos enlaces del robot chocan con otros ).
Pueden
N de articulaciones.
Singularidades.
Complejidad cinemtica ( parmetros D-H no nulos ).
El problema de
es que normalmente no es unvoca soluciones para alcanzar una
misma localizacin [ ( posicin + orientacin ) del elemento terminal ].
Redundancia
5
No siempre
Las ecuaciones que relacionan variables articulares con variables cartesianas no son solubles,
en el sentido de que no siempre se pueden encontrar soluciones separables ( soluciones
cerradas ) que den el valor de cada variable articular como funcin exclusivamente de las
variables cartesianas.
Condiciones suficientes para que exista solucin cerrada :
Para un manipulador de 6 GDL, si las 3 ltimas articulaciones son rotacionales y sus ejes se
cortan en un punto comn. Siempre solucin cerrada.
( Ejemplos : Robots PUMA y Stanford )
Pueden
configuraciones singulares.
( n = GDL de la tarea )
soluciones.
Finitas
soluciones.
Configuraciones singulares : Aquellas en las que se pierde al menos 1 GDL.
solucin.
En general, un manipulador con n GDL< 6 no puede situar y orientar el elemento terminal en una
posicin cualquiera del espacio 3D.
Espacio de trabajo de un manipulador plano con 2 articulaciones
de rotacin ( 2 GDL de rotacin ).
Si (
, el espacio
y
Si (
Subespacio alcanzable de un manipulador de n GDL = Subespacio del espacio de trabajo que puede
expresarse como funcin de las n variables articulares.
Dando valores a las variables articulares en todo su rango se determinara, mediante el modelo
cinemtico directo, el subespacio alcanzable del manipulador.
Si se pretende determinar las variables articulares que corresponden a cada punto del subespacio
alcanzable, o a una regin de ste, se necesita resolver el modelo cinemtico inverso.
MODELO DIFERENCIAL
Trata de encontrar las relaciones entre las velocidades del extremo del robot y las velocidades del
movimiento de las articulaciones ( los desplazamientos diferenciales de las articulaciones ).
Se expresa mediante la matriz Jacobiana ( J )
El modelo cinemtico del robot, adems de establecer la relacin entre variables articulares y
variables de posicin y orientacin del extremo final del robot, tambin debe permitir conocer la
relacin entre sus respectivas derivadas. El sistema de control del robot puede establecer qu
velocidades debe imprimir a cada articulacin ( a travs de sus respectivos actuadores ) para
conseguir que el extremo desarrolle una trayectoria temporal concreta ( por ejemplo, una lnea recta
a velocidad cte ).
Es til disponer de la relacin entre las velocidades de las coordenadas articulares y las de la
posicin y orientacin del extremo del robot.
La relacin entre ambos vectores de velocidad se obtiene a travs de J
DIFICULTADES :
Se utilizan relaciones geomtricas que puedan establecerse entre las articulaciones del manipulador
para calcular las coordenadas operacionales correspondientes a una configuracin dada.
Normalmente se emplea para obtener la posicin, pero no la orientacin del extremo del brazo.
VENTAJA
INCONVENIENTES
, se multiplican
del robot.
del manipulador.
y obtener la
solidario a l, de acuerdo a un
Cartesiana :
Cilndrica :
Euler
Esfrica :
El conjunto de normas que establece cmo deben fijarse los sistemas de coordenadas se conoce
como convenio de DenavitHartenberg, y a los parmetros geomtricos que relacionan los
sistemas de referencia parmetros de DenavitHartenberg ( parmetros DH ).
Cartesiana :
B.
1
10
Mtodo matricial sistemtico para describir y representar la geometra espacial de los elementos de
una cadena cinemtica, y en particular de un robot, con respecto a un sistema de referencia fijo.
Utiliza una MTH para describir la relacin espacial entre 2 elementos rgidos adyacentes,
reducindose el problema cinemtico directo a encontrar una MTH 4x4 que relacione la
localizacin espacial del extremo del robot con respecto al sistema de coordenadas de su base.
Empleo de sistemas de coordenadas auxiliares en cada articulacin.
Automatizado e independiente de las caractersticas geomtricas particulares del robot. Aplicable
a cualquier manipulador simple de cadena abierta. til en robots con varios GDL.
Rotacin de ngulo
y
para alinear
con
a lo largo de
una distancia
[ vector
] para dejar a
a lo largo de
una distancia
[ vector
] para hacer
colineales.
del elemento ( i1 ) :
alrededor de
y
3
Rotacin de ngulo
alrededor de
con
( y, por tanto,
con
11
MTH que representa la posicin y orientacin relativa entre los sistemas asociados a 2
eslabones consecutivos del robot.
solidario al
con respecto al
solidario al
) con respecto al
solidario al
eslabn (
) con respecto al
eslabn (
Ejemplo
eslabn (
eslabn (
solidario al
Transformacin desde el
hasta el
solidario a la base (
solidario al
> Las matrices se han postmutiplicado, ya que las transformaciones se efectan siempre respecto a
los nuevos ejes que van resultando de la transformacin anterior. En forma explcita :
12
Para
variable la distancia
caractersticas
B.
2
y como
13
14
TIPO 1
TIPO 3
no son | |
a
0
d
0
TIPO 2
d
0
/2
TIPO 4
-( /2 )
a
0
d
0
/2
15
TIPO 5
TIPO 7
a
0
TIPO 6
-( /2 )
d
0
Parmetros de DH del
TIPO 8
a
0
a
0
-( /2 )
/2
representan ngulos, y
distancias.
Una de las magnitudes es la variable de la articulacin y las restantes son parmetros fijos.
Definen las matrices A que permiten el paso de un
( asociado a una
( asociado a una
) al siguiente
16
expresadas en el
. Igualmente, da la posicin del origen
de
(viendo la 4 columna ), y su orientacin ( viendo la submatriz de rotacin ).
a coordenadas
respecto al
ngulo de
medido en un plano
ngulo entre
ngulo entre la normal a los ejes ( i1 / i ) y la normal a los ejes ( i / i+1 ), medido en un
plano
al eje i
, girando alrededor de
hasta la interseccin de
con
, con
medida a lo largo de
( que es la
desde el origen
comn entre
Distancia entre
largo de la
comn
[ origen de
, hasta situarlo sobre
de
a lo
Distancia entre los puntos de interseccin de la normal a los ejes ( i / i+1 ) con el eje i, y la
normal a los ejes ( i1 / i ) con el eje i, medida a lo largo del eje i
y el de
hacia
medida sobre la
)
17
rotacional Distancia a lo largo de
origen
con
hasta el
de
Distancia ms corta ( distancia mnima ) entre
prismtica
desde la interseccin de
, medida en la
, utilizando la
direccin positiva de
ngulo entre
medido en un plano
, girando alrededor de
, con
y el de
Para determinar (
Para determinar (
rotacional
Cuando
gira en torno a
),
permanecen ctes,
y
, que son
invariables.
pueden calcularse a partir de cualquier configuracin de la estructura
articulada, en particular a partir de una configuracin inicial estndar.
B.3
prismtica
ALGORITMO DE DENAVIT-HARTENBERG
PARA LA OBTENCIN DEL MODELO CINEMTICO DIRECTO
18
1.1
1.2
) hasta
) ( n = N GDL)
conecta la base (
) al
;y
)( ltima
) y articulaciones ( joints )(
; y cada
3.2
es el eje de la
( i = 1,,n ) : Cada
es
sobre el eje de la
es el de la
, de modo que
en cualquier punto de
, dado que
coincide con
cumplindose que :
ningn
al cual
19
3.3
con la
comn a
define
( solidario al
se sita en la
son | |
a) Si 2 ejes z consecutivos
que
rectas
se intersecan
al plano, pero
=0
se escoge
Determinan un plano. La
a dicho plano en cualquiera
, a lo largo de cualquier
direccin de
cumplindose que :
en la
comn a
)a
Situar el origen
lo ms
( a la direccin de la
3.6
Corresponde a la del
3.5
,y
c) Si 2 ejes z consecutivos
b) Si 2 ejes z consecutivos
de los 2 sentidos y
comn es la
) en la
se sita en la interseccin de la
de
del
sea
coincida con la
a
20
rotacional
prismtica
alineada con
cuando
cuando
Establecer
preferentemente en el centro de la pinza ( gripper ) o en la punta de la herramienta
que tenga el robot. Es comn emplear la notacin [ n, s (o), a ], para referirse a los vectores unitarios
respectivamente, del sistema de coordenadas de la herramienta o extremo efector.
en el
Parmetros
DH de las
articulaciones
Obtener
para que
queden | |
Signo de
positivo si al llevar
sobre
sentido que resulte de aplicar la regla de la mano derecha es igual que el del
Obtener
desplazar
Parmetros
DH de los
eslabones
Obtener
para que
quedasen alineados.
Obtener
Signo de
coincidir con
[ origen de
positivo si al llevar
( que ahora
sentido que resulte de aplicar la regla de la mano derecha es igual que el del
21
En la 1 articulacin (
rotacional
prismtica
), los valores de
Todo parmetro cte en un robot lo es por construccin del mismo, y permanece cte en toda
circunstancia, salvo que se altere mecnicamente al robot.
La accin de los actuadores, que provocarn el movimiento, slo cambia el parmetro variable de
cada
para
rotacional y
prismtica.
para
entre s; esto
Las relaciones entre eslabones consecutivos vienen dadas por las matrices A.
Las relaciones entre eslabones no consecutivos vienen dadas por las matrices T, que se obtienen
como producto de un conjunto de matrices A.
Obtenida T, que expresa la orientacin ( submatriz 3x3 de rotacin ) y posicin ( submatriz 3x3
de traslacin ) del extremo del robot en funcin de sus n coordenadas articulares, queda resuelto
el problema cinemtico directo.
Una vez identificados todos los parmetros y obtenidas las MTH, hay que encontrar la
transformacin entre el sistema de coordenadas del mundo ( WCS )
Como cada elemento de
o
es funcin de (
)(
y el ltimo
y
22
funcin de (
) con ( i = 1n )
Las reglas anteriores garantizan la existencia de una T nica. Sin embargo, el mtodo de DH
permite que las definiciones de los marcos de coordenadas no sean nicas.
Por esta razn, las MTH intermedias pueden ser diversas, pero la T resultante ser siempre igual
para una geometra dada del robot.
NORMAS PARA DETERMINAR LOS EJES DE CADA
SISTEMA ORTONORMAL ASOCIADO A UN
con
de
un
por medio de la
y la
Si el eje de
y el de
son | | Se elegir una
comn atendiendo a posibles condiciones de
simetra o a simplificaciones en cada caso particular.
Si el eje de
y el de
se cortan El origen
se sita en el punto de interseccin.
se sita en la
comn a los ejes
con el eje de
se elige | | al eje de
El origen
de
interseccin de la
) ( se lleva
Si
Si
sobre
con
con ms
23
2
Construir la tabla de parmetros DH, y a partir de cada una de sus filas, usando la frmula
comn.
) de cada
) y va en la direccin de la
es el eje de la
Resulta :
Posicin
Cuaternio
de rotacin
se transforma en el
mediante :
24
Un objeto localizado en
el vector de posicin
y su cuaternio de rotacin
y el cuaternio de rotacin
INCONVENIENTES
en
siguientes :
permiten convertir
1.3
, tendr en
25
1) Ms adecuada para el control en tiempo real : En muchas aplicaciones, el problema cinemtico
inverso ha de resolverse en tiempo real ( por ejemplo, en el seguimiento de una determinada
trayectoria ). Una solucin de tipo iterativo no garantiza tener la solucin en el momento adecuado.
2) Con frecuencia, la solucin del problema cinemtico inverso no es nica ( Al contrario del problema
cinemtico directo ); existiendo diferentes n-uplas
que posicionan y orientan el
extremo del robot del mismo modo. La solucin cerrada permite evaluar fcilmente las
mltiples soluciones que aseguren que la solucin adoptada sea la ms adecuada.
3) Posibilidad de simplificaciones : La mayor parte de los robots poseen cinemticas simples que
facilitan la resolucin de su problema cinemtico inverso.
Ejemplos :
Considerando slo los 3 primeros GDL de muchos robots, stos tienen una estructura planar, esto
es, los 3 primeros elementos quedan contenidos en un plano. Se facilita la resolucin.
En muchos robots ocurre que los ltimos 3 GDL, dedicados fundamentalmente a orientar el
extremo del robot, corresponden a giros sobre ejes que se cortan en un punto. Se facilita el
clculo de la nupla correspondiente a la posicin y orientacin deseadas.
Para estos y otros casos, es posible establecer ciertas pautas generales que permitan plantear y
resolver el problema cinemtico inverso de manera sistemtica.
MTODOS GEOMTRICOS
5) Adecuados para robots de pocos GDL o en el caso de que se consideren slo los primeros GDL,
dedicados a posicionar el extremo.
26
Procedimiento : Para determinar el parmetro
variable
B.
2
MTODOS ALGEBRAICOS
INCONVENIENTES :
Generalmente, las ecuaciones son no lineales y bastante complejas, siendo difcil encontrar de
modo simple una solucin cerrada.
MTODOS
B.2.
1
, es posible pensar
se puedan despejar las n
2) Aplicables en robots con muchos parmetros DH nulos. Mtodo vlido para cualquier manipulador.
3) Se tiene 12 ecuaciones y 6 ( o menos ) incgnitas.
Se puede obtener el modelo cinemtico inverso a partir del modelo cinemtico directo. Conociendo las
relaciones que expresan el valor de la posicin y orientacin del extremo del robot en funcin de sus
coordenadas articulares, es posible obtener por manipulacin de aqullas las relaciones inversas.
27
Esto no es trivial, siendo a veces tan complejo que obliga a desechar este mtodo. Adems, como el
problema cinemtico directo, resuelto a travs de , contiene en el caso de un robot de 6 GDL 12
ecuaciones, y se buscan slo 6 relaciones ( 1 por cada GDL ), existirn necesariamente ciertas
dependencias entre las 12 expresiones de partida ( resultado de la condicin de ortonormalidad de ,
y ) con lo cual la eleccin de qu ecuaciones de escoger debe hacerse con cuidado.
se obtiene :
para la 1 articulacin.
no puede despejarse fcilmente, pasar otra de las matrices A al lado izquierdo por
premultiplicacion :
La solucin se obtiene de forma secuencial, aislando cada variable por premultiplicacin por un
n de transformaciones en cada ecuacin.
B.2.
2
Los procedimientos anteriores permiten obtener los valores de las 3 primeras variables articulares del
robot, aquellas que posicionan su extremo en unas coordenadas
determinadas.
No basta con posicionar el extremo del robot en un punto determinado del espacio, tambin es preciso
conseguir que la herramienta se oriente de una manera determinada. Para ello, el robot cuenta con 3
GDL adicionales, situados al final de la cadena cinemtica y cuyos ejes se cortan en un punto. Si bien
la variacin de estos 3 ltimos GDL origina un cambio en la posicin final del extremo real del robot,
su verdadero objetivo es poder orientar la herramienta libremente en el espacio.
Este mtodo saca partido a este hecho, separando ambos problemas : Posicin y orientacin.
1) Dada una posicin y orientacin final deseadas, establece las coordenadas del punto de corte de
los 3 ltimos ejes ( mueca del robot ) calculando los valores de las 3 primeras variables
articulares
se obtienen los
28
valores del resto de variables articulares.
Consiste en la resolucin independiente de los GDL que posicionan y de los que orientan la mueca :
Si se consideran robots con capacidad para posicionar y orientar su extremo en el espacio, esto es,
robots con 6 GDL, este mtodo permite resolver los 3 primeros GDL, dedicados al posicionamiento,
de manera independiente a la resolucin de los ltimos 3 GDL, dedicados a la orientacin.
La mayora de los robots industriales de 5 6 GDL utilizan los 3 primeros GDL ( las 3 primeras
articulaciones ) para posicionar el elemento terminal, mientras que las ltimas articulaciones,
dispuestas en una mueca de ejes concurrentes (
En estas condiciones suele ser posible separar el problema cinemtico inverso en 2 subproblemas :
1
Esto es posible porque la localizacin del punto de corte de los ejes de las articulaciones de la mueca
puede obtenerse a priori a partir de la especificacin de la posicin y orientacin final deseada.
( Un ejemplo es el robot manipulador PUMA 560 )
PASOS :
que va
La resolucin de
1.
4
hasta el punto
, encontrando
RESOLUCIN DEL PROBLEMA DIFERENCIAL DIRECTO
MTODO NO
SISTEMTICO
MTODO
SISTEMTICO
NOTA : A diferencia de las rotaciones, que no pueden expresarse en forma de vector, las
velocidades angulares ( rotaciones diferenciales ) s admiten dicho formato porque : Las rotaciones
diferenciales son conmutativas y aditivas.
29
A
de J depender de los
) Y GEOMTRICA (
30
Las velocidades angulares se obtienen a partir de la matriz antisimtrica , que se obtiene a partir de
la submatriz de rotacin R de [ n o a p ] :
CLCULO SISTEMTICO DE LA JACOBIANA GEOMTRICA
Articulacin prismtica
Articulacin rotacional
1.
31
5
A
GDL :
Invertir simblicamente J : Conocida la relacin directa, dada por J, se puede obtener la relacin
inversa invirtiendo simblicamente J
INCONVENIENTE : Suponiendo que J se cuadrada, la inversin de una matriz 6x6, cuyos
elementos son funciones trigonomtricas, es de gran complejidad.
Calcular J en el punto deseado e invertirla numricamente : Planteando la evaluacin numrica
de J para una configuracin ( ) concreta del robot, e invirtiendo numricamente esta matriz, se
puede encontrar la relacin inversa vlida para esa configuracin.
INCONVENIENTES :
ha de ser recalculada
es
32
B
JACOBIANA PSEUDOINVERSA
n=m
J de rango completo
Solucin nica :
El sistema es sobredeterminado e
n<m
rango( J ) < m
n>m
J de rango completo
33
C
CONFIGURACIONES SINGULARES
Cuando | J | = 0, un incremento infinitesimal de las coordenadas cartesianas supondra un
incremento de las coordenadas articulares, lo que en la prctica se traduce en que en las
inmediaciones de las configuraciones singulares, el pretender que el extremo del robot se mueva a
velocidad cte, obligara a movimientos de las articulaciones con velocidades inabordables por sus
actuadores. Por ello, en las inmediaciones de las configuraciones singulares se pierde algn GDL,
siendo imposible que su extremo se mueva en una determinada direccin cartesiana.
Hay que prestar atencin a la localizacin de las configuraciones singulares del robot para que sean
tenidas en cuenta en su control, evitando solicitar a los actuadores movimientos a velocidades
inabordables o cambios bruscos de las mismas. El sistema de control debe detectar y tratar las
configuraciones singulares evitando pasar por ellas.
Para evitar la aparicin de configuraciones singulares debe considerarse su existencia desde la
propia fase de diseo mecnico, imponiendo restricciones al movimiento del robot o utilizando
robots redundantes ( lo que conlleva otro tipo de problema ).
CLASIFICACIN DE LAS CONFIGURACIONES SINGULARES DE UN ROBOT
: Cuando el
extremo del robot est en algn punto del lmite de trabajo interior o exterior. En esta situacin
el robot no podr desplazarse en las direcciones que lo alejan de este espacio de trabajo.
: Ocurren dentro
de la zona de trabajo y generalmente son debidas al alineamiento de 2 o ms ejes de las
articulaciones del robot.
Procedimiento para resolver la presencia de una singularidad interior al espacio de trabajo, en la que
se pierde la utilidad de alguna articulacin ( prdida de algn GDL ) :
Con la nueva J reducida ( rango n1 ) obtener las velocidades de todas las articulaciones, a
excepcin de la eliminada, necesarias para conseguir las velocidades cartesianas deseadas.
La velocidad de la articulacin eliminada se mantendr a 0.
1.
6
Permite conocer las rdenes de mando a los accionadores de cada articulacin para que el extremo del
robot alcance una determinada localizacin espacial.
Permite saber dnde est el extremo libre a partir de la lectura de los captadores de posicin de cada
articulacin.
Permite relacionar las velocidades del extremo y de los actuadores.
34
Los modelos son de obtencin relativamente compleja, y deben ser utilizados en tiempo real durante
el funcionamiento de robot.
2.
1
INTRODUCCIN
El modelo dinmico de un robot tiene por objetivo conocer la relacin matemtica entre el
movimiento del robot y las fuerzas y pares implicados en el mismo.
Relaciona matemticamente :
La localizacin del robot definida por sus variables articulares o por las coordenadas de
localizacin de su extremo, y sus derivadas : Velocidad y aceleracin.
Las fuerzas y pares aplicados en las articulaciones ( o en el extremo del robot ).
Los parmetros dimensionales del robot : Longitud, masas e inercias de sus elementos
( incluyendo la de sensores, actuadores y sistemas de transmisin ).
CARACTERSTICAS :
Complejidad matemtica que aumenta con el n GDL No siempre es posible su obtencin
en forma cerrada En ocasiones, se resuelve por procedimientos numricos iterativos.
El modelo dinmico completo del robot debe incluir no slo la dinmica de sus elementos
( barras o eslabones ) sino tambin la de sus sistemas de transmisin, actuadores y equipos
electrnicos de mando. Estos elementos incorporan al modelo dinmico nuevas inercias,
rozamientos, saturaciones de los circuitos electrnicos, etc, aumentando su complejidad.
Casos especiales : En la mayora de las aplicaciones robticas, las cargas e inercias manejadas
no son suficientes como para originar deformaciones en los eslabones, pero en determinadas
ocasiones no ocurre as, siendo preciso considerar al robot como un conjunto de eslabones no
rgidos ( robot flexible ). Aplicaciones en robtica espacial o en robots de grandes dimensiones.
UTILIDAD :
Simulacin del movimiento del robot.
Diseo y evaluacin de la estructura mecnica y del control dinmico del robot. De la calidad
del control dinmico del robot depende la precisin y velocidad de sus movimientos.
Formar parte del propio algoritmo de control ( en lnea ).
Dimensionamiento de los actuadores.
35
Si un cuerpo de masa
2 ley de Newton
la
2) Alternativa para la obtencin del modelo dinmico : Usar la formulacin Lagrangiana, basada en
consideraciones energticas y vlida para movimiento de slidos con n coordenadas generalizadas.
a la articulacin
Variables articulares
Coordenadas generalizadas
Traslacin : Fuerza
Rotacin : Momento
Traslacin : Distancia
Rotacin : ngulo
36
Velocidades articulares
Funcin Lagrangiana
Energa cintica
Energa potencial
un sistema de referencia
Derivada de
respecto de la coordenada
rotacional
traslacional
: Coordenadas
del elemento diferencial de
masa dm respecto al
sistema de coordenadas del
elemento i.
37
Las integrales estn extendidas al elemento i considerado, de modo que cada integral se evala
para cada punto del elemento i de masa dm y coordenadas
: Matriz simtrica, semidefinida positiva, escalar y cte para cada robot.
i, j = 1,..,n
Cada elemento
Se cumple :
Cada elemento
articulacin i
10
debido al movimiento
Establece el modelo dinmico inverso de un robot, dando los pares y fuerzas que deben
proporcionar los actuadores para que las variables articulares sigan una determinada trayectoria
38
q(t).
coordenada
un sistema de referencia
y sus inversas
Velocidad angular =
Aceleracin angular =
Velocidad lineal =
Aceleracin lineal =
de
respecto a
respecto de
respecto de su CM expresado en
39
4
40
10
41
referencia
del elemento i con el
del elemento ( i1 ). Se realizan operaciones de
producto y suma innecesarias ( recordar la informacin redundante contenida en las matrices A
debido a la ortonormalidad de la submatriz de rotacin )
Ineficiente desde el punto de vista computacional, pero conduce a unas ecuaciones finales bien
estructuradas donde aparecen de manera clara los diversos pares y fuerzas que intervienen en el
movimiento ( inercia, Coriolis, gravedad ).
( La aceleracin
Cinemtica hacia adelante : Desarrollando estas ecuaciones se llega a una formulacin recursiva en
la que se obtienen posicin, velocidad, y aceleracin del
correspondientes del
se llega al
Dinmica hacia atrs : Con los datos anteriores se obtienen las fuerzas y pares actuantes sobre el
referidos a la base, a partir de los correspondientes al
( i = n,,1 ).
Para robots con ms de 3 GDL la deduccin analtica se hace excesivamente compleja. Se han
desarrollado algoritmos que permiten obtener el valor del par a partir de q(t) en pasos incrementales.
ALGORITMO
Complejidad
computacional
Newton-Euler
( Mecnica Newtoniana )
Lagrange-Euler
( Mecnica Lagrangiana )
Basado en la representacin de DH
Alta [
] : El n operaciones a realizar
crece con la potencia 4 del n de GDL
Representacin
cinemtica
Matrices de rotacin y
vectores de posicin
Ecuaciones de
movimiento
obtenidas
Ecuaciones diferenciales
en forma cerrada
Aparecen explcitos
los trminos D, H y C
Solucin
obtenida
42
E
es no lineal, no siendo trivial obtener a partir de ella el modelo dinmico directo que
proporciona la trayectoria seguida como consecuencia de la aplicacin de unos pares
determinados.
Las variables de estado naturales del sistema sern las posiciones y velocidades de cada una de las
articulaciones, siendo por lo tanto
el vector de estado.
Permite obtener la
aceleracin de las coordenadas articulares a partir del vector generalizado de pares.
= f ( q ) y N = f ( q,
Esta representacin responde a una ecuacin de estado lineal, habindose trasladado la no linealidad
a la entrada .
43
F
Por otra parte, partiendo del hecho de que la P consumida por el robot debe ser la misma tanto si se
evala en el espacio cartesiano como en el espacio articular, se tiene :
MODELO ESTTICO
44
2.
2
MODELO ESTTICO
Reacciones en articulaciones :
45