Professional Documents
Culture Documents
TESIS
presenta
Jos Aarn Padilla Garca
Agosto 2009
i
Resumen
En este trabajo de investigacin se propone un procedimiento para determinar la respuesta
de estado estacionario de un robot manipulador planar, el cual pertence a un tipo de sis-
temas no lineales caracterizado por el producto de estados, mediante el modelado en Bond
Graph con una causalidad derivativa (BGD) en los elementos almacenadores. Esta repre-
sentacin del sistema no tiene sentido fsico, pero dentro del marco terico del Bond Graph
puede proporcionar informacin valiosa del sistema a modelar, como son las propiedades de
controlabilidad y observabilidad. El Bond Graph es una tcnica de modelado que va ganando
adeptos por su versatilidad en el manejo de distintos dominios de energa y llevando el sistema
modelado a otro dominio en variables generalizadas. Se realiza, adems, una comparacin de
resultados con una tcnica de modelado de robots tradicional como es Euler-Lagrange, donde
se puede ver que para las tcnicas tradicionales cuando se incrementa el nmero de eslabones
las ecuaciones resultantes se vuelven relativamente grandes y difciles de simular, en cambio
con la tcnica de Bond Graph su metodologa es menos engorrosa de llevar a cabo, aunque el
procedimiento maneja matrices relativamente grandes, lo cual es compensado por la facilidad
R
en la simulacin del modelo mediante programas de simulacin como el 20-sim .
El procedimiento propuesto est basado principalmente en el procedimiento de Gawtrhop
haciendo uso de los transformadores modulados multipuerto propuestos por Karnopp, adems
de agregar las prdidas por rozamiento debido a las fricciones.
ii
Abstract
In this research work is proposing a procedure to determine the response steady state of
a planar robot manipulator, which belongs to a type of non-linear systems characterized
by the product of states, through the modeling in Bond Graph with a derivative causality
(BGD) assignment in the storage elements. This representation of the system does not have
a physical sense, but within the theoretical framework of Bond Graph can provide valuable
information of the system to model, as are controllability and observability properties. The
Bond Graph is a technique of modeling that is gaining followers by its versatility in the
handling of dierent energy domains and carrying the modelled system to another domain
in generalized variables. In addition, a comparison of results with a technique of modeling
robots traditional as is Euler-Lagrange is performed, where you can see that for the traditional
techniques when increases the number of links the equations resulting become relatively large
and di cult to simulate, in contrast with the technique of Bond Graph its methodology is less
cumbersome to carry out, although the procedure manages matrices relatively large, which
is oset by the facility in the simulation of the model through simulation programs such as
R
the 20-sim .
The proposed procedure is mainly based on the procedure of Gawtrhop making use of mod-
ulated multiport transformers proposed by Karnopp, in addition to add the lost by friction
due to friction.
iii
ndice general
Resumen i
Abstract ii
Lista de guras iv
Lista de tablas v
1 Introduccin 1
1.1 La robtica y su modelado . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 1
1.2 Objetivo General . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2
1.2.1 Objetivos particulares . . . . . . . . . . . . . . . . . . . . . . . . . . . 2
1.3 Justicacin . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2
1.4 Publicaciones y trabajos relacionados . . . . . . . . . . . . . . . . . . . . . . . 3
1.5 Dominio fsico . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5
1.6 Estructura de la tesis . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5
2 Antecedentes 7
2.1 Introduccin . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7
2.2 Comprendiendo el Bond Graph . . . . . . . . . . . . . . . . . . . . . . . . . . 8
2.2.1 Elementos . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9
2.2.2 Bonds y conexiones . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 10
2.2.3 Elementos de un puerto o puerto-1 . . . . . . . . . . . . . . . . . . . . 11
2.2.4 Puertos uno y medio . . . . . . . . . . . . . . . . . . . . . . . . . . . . 11
2.2.5 Elementos de dos puertos o puertos-2 . . . . . . . . . . . . . . . . . . 12
2.2.6 Elementos de tres puertos o puertos-3 . . . . . . . . . . . . . . . . . . 13
2.2.7 Elementos multipuerto o multipuertos . . . . . . . . . . . . . . . . . . 15
2.2.8 Smbolos de potencia . . . . . . . . . . . . . . . . . . . . . . . . . . . . 16
2.3 La Causalidad en un Bond Graph . . . . . . . . . . . . . . . . . . . . . . . . . 18
2.3.1 Procedimiento para la asignacin de causalidad . . . . . . . . . . . . . 18
2.3.2 La causalidad derivativa en un Bond Graph . . . . . . . . . . . . . . . 20
2.4 Transformadores modulados multipuerto . . . . . . . . . . . . . . . . . . . . . 21
iv
3 Robots Manipuladores 52
3.1 Introduccin . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 52
3.2 Cinemtica y dinmica del brazo del robot . . . . . . . . . . . . . . . . . . . . 55
3.3 Cinemtica directa. La representacin de Denavit-Hartenberg . . . . . . . . . 56
3.3.1 Cadenas cinmaticas . . . . . . . . . . . . . . . . . . . . . . . . . . . . 56
3.3.2 Representacin Denavit-Hartenberg . . . . . . . . . . . . . . . . . . . 58
3.3.3 Ejemplo: Manipulador Elbow planar . . . . . . . . . . . . . . . . . . . 64
Bibliografa 158
vi
Lista de guras
Lista de tablas
Introduccin
La robtica es una ciencia que ha evolucionado de manera constante, inicialmente, su uso con
nes industriales para el mejoramiento no slo de la calidad si no de la cantidad de productos
realizados en una jornada, hoy en da, la robtica ya no slo son brazos mecnicos amorfos
anclados a un lugar determinado y que no podan realizar ninguna tarea ms que para la
que fueron creados, ahora son mquinas complejas capaces de realizar un sin n de tareas
que van desde emular seres humanos hasta mascotas virtuales, por lo que se han vuelto ms
complejos tanto de realizar como de predecir su comportamiento.
El modelado dentro de la robtica como en cualquier rama de la ciencia es un factor impor-
tante, ya que teniendo un modelo cercano o muy cercano al sistema fsico al cual se le pueden
crear condiciones extremas, se puede predecir su comportamiento en presencia de dichas
condiciones sin necesidad de llevar a cabo el experimento en la realidad, con el propsito de
tomar desiciones respecto a la evolucin del sistema real en presencia de condiciones reales, es
decir, los modelos son simplicaciones de la realidad. Un modelo excesivamente complejo y
detallado puede contener parmetros que sean imposibles o muy difciles de estimar o medir,
pero un modelo excesivamente simplicado no es capaz de mostrar las caractersticas im-
portantes del sistema, por lo que se debe buscar un punto intermedio de acuerdo con las
Captulo 1. Introduccin
ii) Determinar la estructura unin del modelo en Bond Graph del sistema.
1.3 Justicacin
El modelado de sistemas con Bond Graph est siendo utilizado en muchas reas de la in-
geniera. En robtica, se pretende aprovechar la caracterstica principal del bond Graph, la
2
Captulo 1. Introduccin
cual es englobar en un marco de referencia distintos tipos de energa, ya que en los robots se
tiene partes mecnicas y elctricas.
las tcnicas de modelado clsicas como Euler-Lagrange conforme se incrementan los grados de
libertad en el robot manipulador de igual manera crece la dicultad para obtener su modelo
matemtico, en bond Graph, se puede hacer uso del modelado por bloques,as, al incrementar
los grados de libertad slo se tendrn que ir agregando bloques los cuales representarn los
eslabones del manipulador.
Cuando Paynter invent el Bond Graph intentaba crear una metodologa en la cual se
pudieran modelar todos los sistemas fsicos, aunque el objetivo era muy ambicioso, sta
tcnica puede aportar mucho al modelado de distintos fenomenos fsicos, principalmente los
que manejan interaccin de distintos tipos de energa, que son una mayoria en la realidad,
por esto se decide usar la metodologa del Bond graph para modelar los robot manipuladores.
En esta seccin se enuncian importantes trabajos relacionados con este trabajo de tesis.
Un Bond Graph es una representacin abstracta de un sistema, donde varios componentes
interactan entre ellos por medio de puertos de energa y son colocados en un sistema donde
existe intercambio de energa [Karnopp, 2000].
En [Karnopp, 2000] se establecen los elementos bsicos para modelar sistemas fsicos con
Bond Graph. Por otro lado la interpretacin del estado estacionario es una caracterstica
muy importante de un sistema cuando el periodo dinmico ha terminado [Gonzlez, 2003].
En [Gonzlez, 2003] es propuesto un procedimiento para determinar el estado estacionario
de un sistema lineal e invariante en el tiempo representado en un modelo en Bond Graph en
causalidad derivativa.
En el caso de sistemas lineales la condicin del estado estacionario puede ser formulada en
trminos del sistema de ecuaciones, esto es: x_ = Ap x+Bp u para x_ = 0. El concepto de estado
estacionario para sistemas no lineales fue introducido por Isidori y Byrnes para formular el
problema de regulacin de la salida de un sistema [Xia, 2007]. En [Breedveld, 1984] se propone
3
Captulo 1. Introduccin
un algoritmo para determinar por inspeccin directa del Bond Graph el estado de equilibrio
de un sistema con entrada constante.
En [Filippini, 2000] es implantada una teora general para sistema multicuerpo dentro del
marco de modelado Bond Graph. En mecnica clsica existen varios procedimientos por
los cuales se pueden deducir las ecuaciones diferenciales un sistema de cuerpos rgidos. El
protocolo Bond Graphs permite un modelado unicado de sistemas fsicos multidisciplinarios
y esta bien adaptado para un enfoque modular, modelando basndose en los principios fsicos
[Filippini, 2000].
En [Karnopp, 2000] se establecen las bases de los transformadores multipuerto modulados y
su aplicacin en los sistemas mecnicos. En [Karnopp, 1997] se demuestra que Bond Graphs
pueden ser utilizados para describir sistemas mcanicos y frecuentemente proporcionan un
signicado intuitivo y fsico para mostrar las diferentes relaciones que actan en un sistema.
En [Brown, 1991] se presentan procedimentos para determinar Bond Graphs hamiltonianos
que representan directamente ecuaciones de hamilton. En esto se emplea un campo I multi-
puerto para el cual la velocidad generalizada o el vector de velocidad es una funcin algebraica
del vector de momento generalizado, y un campo C multipuerto para la fuerza generalizada
o el vector de esfuerzo es una funcin algebraica del vector de desplazamiento generalizado,
consistentes con la notacin de Bond Graph convencional. As mismo, en [Brown, 1991] se
describe el Bond Graph Lagrangiano que emplea elementos de Bond Graph convencionales.
En [Allen, 1997] se presenta una tcnica la cual produce ecuaciones de lagrange o de Hamilton
explcitas para dinmicas de mecanismos adecuados para solucin computacional.
En [Zeid, 1992] se modelan mecanismos de espacio y sistemas multicuerpo utilizando el
mtodo de Karnopp-Margolis. adems, se presenta una librera de Bond Graph para seis tipos
de uniones que son comunes en construcciones de mecanismos de espacio. En [Tiernego, 1985]
se describe un mtodo para modelar sistemas mecnicos con Multibond Gaphs. El mtodo
est basado en la descripcin de la relacin de un punto en movimiento del vector de velocidad
en un sistema rotatorio. Esta relacin es incorporada en un Bond Graph. En [Karnopp, 1982]
se muestra que una representacin de transformadores multipuerto de un sistema inercial
produce las mismas fuerzas generalizadas a partir de las fuerzas dinmicas inerciales que
4
Captulo 1. Introduccin
5
Captulo 1. Introduccin
planar usando el Bond Graph en causalidad Integral y comparando con la obtencin del
estado nal con el Bond Graph en causalidad Derivativa.
El captulo 6 contiene las conclusiones y los trabajos propuestos a futuro.
El apndice A entrega una descripcin del movimientos en tres dimensiones para los robots
manipuladores. En el apndice B presenta el articulo desarrollado de los resultados obtenidos
en la presente tesis, titulado Steady State for a Class of Nolinear Systems: A Bond Graph
Approach y que fue aceptado en la 14th IEEE International Conference on Methods and Au-
tomation and Robotics que se llevar a cabo del 19 al 21 de agosto del 2009 en Miedzyzdroje,
Polonia.
6
Captulo 2
Antecedentes
2.1 Introduccin
El Bond Graph es una tcnica que ha venido tomando fuerza y renombre debido a algunas
caractersticas como son la exibilidad y la robustez. Este mtodo fue desarrollado por Henry
Paynter en 1961 para modelar la interaccin entre los subsistemas hidrulico, mecnico y
elctrico en el proceso de generacin hidroelctrica.
Esta metodologa de modelado de sistemas en el dominio fsico, en ingles Bond Graph, se es-
tablece como un enfoque unicado para representar de manera conjunta sistemas hidrulicos,
mecnicos, elctrico, neumticos y trmicos a travs del ujo de potencia entre los compo-
nentes del sistema por medio de puertos de energa.
Los Bond Graphs consistenten en seales, lneas y simbolos propios que permiten repre-
sentar grcamente el modelo fsico, de igual forma, proporciona una visualizacin de las
interacciones de causa y efecto entre sus distintos componentes y suministra implcita y sis-
temticamente el modelo matemtico en forma de variables de estado. Y as, facilitando
el uso de recursos computacionales para la simulacin que se realiza directamente de sta
representacin grca.
Es importante mencionar que esta tcnica utiliza analogas de los sistemas elctricos, lo
que permite la construccin de modelos complejos con elementos bsicos. Esta tcnica de
Captulo 2. Antecedentes
modelado permite conocer propiedades del sistema como son observabilidad, controlabilidad
y la dependencia lineal de los elementos que lo componen, basado en una representacin
grca y generalizada de los conceptos de la variable de ujo y esfuerzo.
Los sistemas bondgraphs son sistemas interdisciplinarios y consisten de elementos con lneas
entre ellos llamadas bonds. Del mismo modo que encontramos en circuitos electrnicos.
Cuando los invent, Paynter quedo impresionado por su parecido (supercial) con los enlaces
qumicos, de ah su nombre (bonds).
Las lneas llevan signos especiales y los elementos son letras cdigo para ingeniera elctrica.
Bsicamente los Bond Graphs relaciona la nocin de voltaje y corriente a todas las deniciones
cientcas. Llamadas esfuerzo y ujo en dentro de la metodologa de Bond Graph.
La ecuacin de potencia siempre es como se muestran en (2.1):
donde la potencia es igual al producto entre el esfuerzo (e (t)) y el ujo (f (t)). La ecuacin
(2.1) es vlida para Bond Graphs verdaderos (los bondgraphs son verdaderos cuando el pro-
ducto de esfuerzo y ujo es potencia).
Dado que existen interacciones de potencia cuando en un sistema se conectan dos o ms
elementos, es til clasicar la variedad de variables de potencia en un esquema universal y
describir todos los tipos de multipuerto en un lenguaje comn. Las variables de potencia
son llamadas esfuerzo e (t) y flujo f (t). Estas son llamadas variables generalizadas debido a
que pueden ser utilizadas en todos los dominios de energa. En la Figura 2.1 se muestra la
representacin de un bond con las variables de potencia asociadas.
Ejemplos de estos pares de variables son voltaje y corriente para un sistema elctrico, fuerza
y velocidad para un sistema mecnico. La relacin de ambas variables est dada en (2.2):
8
Captulo 2. Antecedentes
e(t)
f(t)
En sistemas que almacenan energa es necesario denir variables que representen el estado
del sistema llamadas variables de energa, denominadas momento p (t) esfuerzo acumulado
ea (t) y desplazamiento q (t) ujo acumulado fa (t), y son descritas por (2.3) y (2.4):
Z t
p (t) = ea (t) , e( )d (2.3)
0
Z t
q (t) = fa (t) , f ( )d (2.4)
0
La Tabla 2.1 muestra las variables generalizadas para sistemas fsicos utilizadas en el modelado
mediante Bond Graph, donde se describe la correspondencia entre las variables generalizadas
y las variables fsicas en diferentes dominios de energa. Por ejemplo, el esfuerzo e (t) en
sistemas elctricos es el voltaje v(t), el momento p(t) representa el enlace de ujo (t), el
ujo f (t) representa la corriente i(t) y el desplazamiento q(t) es la carga q(t) en un sistema
elctrico.
2.2.1 Elementos
En el modelado en Bond Graph se utilizan varios elementos propios de dicha metodologa para
representar los componentes de un sistema fsico. Existen elementos disipativos (elementos-
9
Captulo 2. Antecedentes
R) los cuales representan componentes que disipan energa en forma de calor. Los elementos
capacitivos e inductivos (Elementos-C y -I, respectivamente) son necesarios para represen-
tar los componentes de un sistema fsico que son almacenadores de energa. Dentro de la
metodologa existen otros elementos los cuales se detallarn ms adelante.
Escencialmente el nmero de conexiones o puertos en cada elemento es lo que permite clasi-
carlos en elementos de puerto-1, puerto-2, etc. Los puertos son utilizados para conectar
elementos a otros elementos y al entorno.
La convencin del ujo de potencia es que entra a los elementos -C, -I, y elementos-R y sale
de las fuentes hacia los elementos del sistema. Siempre se dibuja la semiecha en la parte de
abajo de los bonds horizontales, ya que este hbito se ha propagado.
Los diferentes bonds que se utilizan para modelar en Bond Graph son presentados en la Tabla
2.2. Los bonds son utilizados para conectar elementos y transmitir potencia, el trazo causal
(lnea vertical) indica la direccin del esfuerzo e (t) (el esfuerza va hacia el trazo causal y
en consecuencia el ujo en sentido contrario), a continuacin se detalla la importancia de la
causalidad en la metodologa de Bond Graph.
10
Captulo 2. Antecedentes
Los elementos de puerto-1 con la causalidad aplicada se muestran en la Tabla 2.3. Para las
fuentes la causalidad es obligatoria, los elementos-1 activos (tambin llamados fuentes) son
los que suministran potencia al sistema (existen las fuentes de esfuerzo Se y las fuentes de
ujo Sf ,). De una Se sale un esfuerzo, y de una Sf sale un ujo.
En Bond Graph se utilizan las fuentes moduladas, es decir, son fuentes de esfuerzo o ujo las
cuales tiene un puerto extra de control por el cual se introduce una ganancia para modicar
el valor de la fuente, este valor puede ser una constante o una variable generalizada (normal-
mente se usan detectores ya sea de ujo o esfuerzo dentro de un Bond Graph para obtener
las seales modulantes). Estos elementos se muestran en la Tabla 2.4.
11
Captulo 2. Antecedentes
Los elementos de dos puertos son conocidos como transformadores (T F ) y giradores (GY ).
Los T F 0 s son elementos que relacionan los esfuerzos de entrada con los esfuerzos de salida y
los ujos de entrada con los ujos de salida por medio de una ganancia, un ejemplo de estos
elementos son los trenes de engranes en sistemas mecnicos en los que la velocidad del primer
engrane esta relacionada con la velocidad del ltimo, de igual forma, el par de salida de la
caja de engranes depender del par en el primer engrane dependiendo de la relacin de las
muescas en el engranaje (ganancia).
Los GY 0 s son elementos que relacionan los esfuerzos de entrada con los ujos de salida y los
ujos de entrada con los esfuerzos de salida utilizando una ganancia, un ejemplo de estos
se puede encontrar en los motores de CD, en los cuales el esfuerzo de entrada (voltaje de
armadura) esta relacionado con la velocidad de salida, y el ujo de entrada (corriente de
12
Captulo 2. Antecedentes
Los elementos tipo unin son necesarios para representar las conexiones serie (uniones-1 o de
ujo comn) y paralelo (uniones-0 o de esfuerzo comn) en los sistemas fsicos, estas uniones
son conservadoras de energa.
Las uniones pueden tener ms de tres puertos, pero la clasicacin de tres puertos es ms
conveniente para explicar su funcionamiento. Estos elementos se muestran en la Tabla 2.6.
13
Captulo 2. Antecedentes
14
Captulo 2. Antecedentes
En una unin de esfuerzo (paralelo o unin-0) un esfuerzo est entrando (indicado por
el trazo causal, e1 (t)) y los dems esfuerzos estn saliendo (e2 (t) y e3 (t)).
En una unin de ujo (serie o unin-1) un ujo est entrando (contrario a el trazo
causal, f1 (t)) y los dems ujos estn saliendo (f2 (t) y f3 (t)).
En ciertos casos no es posible representar los fenmenos que se desean mediante elementos-1,
como en el caso de las inductancias mutuas que se muestra en la Figura 2.2 a).
En la Figura 2.2 a) cada devanado pose una inductacia propia Li pero interacta con los
otros dos devanados por inductancia mutua.
La representacin de estos fenmenos acoplados se realiza mediante un elemento I multipuerto
(tambin conocido como campo-I ) al cual se asocia una relacin matricial que vincula el
vector de ujos magneticos (2.5) con el vector de corrientes (2.6) bajo la forma representada
por (2.7).
15
Captulo 2. Antecedentes
h iT
= 1 2 3 (2.5)
h iT
i = i1 i2 i3 (2.6)
2 3
L M12 M13
6 1 7
6 7
= Li = 6 M21 L2 M23 7i (2.7)
4 5
M31 M32 L3
1 T 1
E( )= L (2.8)
2
La representacin graca se muestra en la Figura 2.2 b)
Las variables de esfuerzo y ujo se agrupan en los vectores (2.9) y (2.10) respectivamente, y
la potencia es expresada por (2.11)
h iT
v = v1 v2 v3 (2.9)
h iT
i = i1 i2 i3 (2.10)
P = vT i (2.11)
Los elementos multipuerto no necesariamente tienen que ser inductivos, y este es un caso par-
ticular. Es decir, tambin existen los elementos multipuerto o campos resistivos y capacitivos
[Karnopp, 2000].
Los elementos multipuerto se describen en la Tabla 2.7.
La orientacin normal de los smbolos de potencia o medias echas deben ser como se muestra
en la Figura 2.3, es decir hacia los puertos uno, hacia afuera de las fuentes y a travs de los
16
Captulo 2. Antecedentes
transformadores y giradores,esto da valores positivos para los parmetros en casi todos los
casos.
Se
Sf C
Note que la semiecha para potencia slo da la direccin del ujo de potencia, que es una
direccin positiva. As, el esfuerzo y el ujo pueden ser ambos positivos o ambos negativos.
17
Captulo 2. Antecedentes
e(t) e(t)
f(t) f(t)
La Figura 2.4 muestra dos elementos A y B los cuales estn conectados mediante un bond
que indica el sentido del esfuerzo y del ujo mediante el trazo causal. El esfuerzo entra a un
elemento en el sentido del trazo causal. Para la asignacin de la causalidad se deben cumplir
las reglas que se muestran en la Tabla 2.8.
18
Captulo 2. Antecedentes
Causalidad Necesaria
MSe MSf
Causalidad Restrictiva
Causalidad Integral
C I
Causalidad Derivativa
C I
Causalidad Arbitraria
R R
19
Captulo 2. Antecedentes
R
E C1 C2
Figura 2.5: Ejemplo de un circuito elctrico donde existe dependencia lineal entre los
capacitores.
Del circuito de la Figura 2.5, podemos obtener dos posibles bond graphs dependiendo si a
C1 se le asigna una causalidad integral entonces C2 tendr causalidad derivativa o viceversa,
es decir, los elementos almacenadadores C1 y C2 son linealmente dependientes (ya que la
carga del capacitor C1 depende de la carga almacenada en C2 y viceversa.) y por lo tanto
no es posible asignar causalidad integral a ambos. El nmero de elementos almacenadores de
energa en un sistema en causalidad integral es el nmero de ecuaciones linealmente indepen-
dientes en el mismo. La Figura 2.6 muestra los dos bond graphs posibles para el circuito de
la gura 2.5.
20
Captulo 2. Antecedentes
R C1 R C1
Se 1 0 C2 Se 1 0 C2
a) b)
Figura 2.6: Bond graphs con causalidad derivativa para el circuito elctrico de la gura 2.5.
Un punto de vista interesante sobre las estructuras de unin (las estructuras de unin son
el conjunto de uniones-0 y -1, transformadores y giradores, ms adelante se detallar este
concepto) involucra las transformaciones de variables que ocurren dentro de las estructuras
de unin. Consideraremos, por ejemplo, la estructura de unin que se muestra en la Figura
2.7 [Karnopp, 2000].
1 3
1 0
m1
TF
2 4
1 TF 0
m2
21
Captulo 2. Antecedentes
A partir de que la estructura unin indica que las transformaciones deben ser conservadoras
de potencia (todos los elementos dentro de una estructura unin no son disipadores ni ala-
macenadores de energa, es decir,sus relaciones constitutivas son conservadores de energa).
Reordenando las ecuaciones, aparece la forma asimtrica caracterstica de conservacin de
potencia: 2 3 2 32 3
e1 (t) 0 0 1 1 f1 (t)
6 7 6 76 7
6 7 6 76 7
6 e2 (t) 7 6 0 0 m1 m2 7 6 f2 (t) 7
6 7=6 76 7 (2.14)
6 7 6 76 7
6 f3 (t) 7 6 1 m1 0 0 7 6 e3 (t) 7
4 5 4 54 5
f4 (t) 1 m2 0 0 e4 (t)
Esta estructura se considera una generalizacin de un transformador puerto-2.
Considerando el Bond Graph de la Figura 2.8.en el que se cambio el ujo de potencia en
los bonds 1 y 2, esto para representar que existe una interaccin con el exterior (elementos
disipadores y/o almacenadores de energa). La Figura 2.8 se puede simplicar usando un slo
TF, esto es importante cuando los Bond Graphs son grandes, el TF incluye las relaciones
constitutivas de transformacin (Figura 2.9).
1 3
1 0
m1
TF
2 4
1 TF 0
m2
Figura 2.8: Estructura unin de la gura 2.7 con modicacin en el signo de las semiechas
de los puertos 1 y 2.
1 3
2 TF 4
Figura 2.9: Simplicacin de la estructura unin de la gura 2.8 de dos TFs a uno.
Las relaciones de transformacin de esfuerzo y ujo son las que se muestran en (2.15) y (2.15),
22
Captulo 2. Antecedentes
respectivamente.
2 3 2 32 3 2 3
e1 (t) 1 1 e3 (t) 1 1
4 5=4 54 5 =) M =4 5 (2.15)
e2 (t) m1 m2 e4 (t) m1 m2
2 32 3 2 3 2 3
1 m1 f (t) f3 (t) 1 m
4 54 1 5=4 5 =) Mt = 4
1
5 (2.16)
1 m2 f2 (t) f4 (t) 1 m2
Se puede probar que las transformaciones involucrando una matriz y su transpuesta implican
que la potencia que uye en un lado de un transformador multipuerto debe ser igual a la
potencia que uye por el otro extremo.
Sean [e1 ], [f1 ] vectores columna de esfuerzos y ujos en un lado de un transformador multi-
puerto y [e2 ], [f2 ] son vectores de esfuerzo y ujo en el otro lado del mismo y que dependen del
tiempo, entonces, sea una [M ] matriz de transformacin de dimensiones apropiadas, entonces,
23
Captulo 2. Antecedentes
Lo cual establece que la suma de las potencias de los puertos en el lado nmero 1 es igual a
la suma de las potencias de los puertos en el lado nmero 2.
Es interesante que en la prueba anterior, no solamente puedan ser en cualquier nmero de
puertos en los dos lados del transformador o que los elementos de la matriz tengan que
ser constantes. Por lo tanto, las consideraciones aplican no solamente a transformadores
de multipuerto con matrices constantes sino tambin para transformadores de multipuerto
modulados en los cuales los elementos de la matriz cambian con el tiempo.
Una aplicacin importante de transformadores multipuerto modulados es en mecnica donde
se tienen no linealidades. Considerando, por ejemplo, la transformacin entre coordenadas
rectangulares y coordenadas polares que se muestra en la Figura 2.10.
Y
y
r
r
x
r
Las relaciones entre r y ,y x y y son funciones no lineales las cuales se pueden expresar en
diferentes formas, por ejemplo, para convertir a partir de r y a x y y.
Se puede escribir como se muestra en (2.22).
x = r cos (2.22)
y = r sin
24
Captulo 2. Antecedentes
Estas relaciones de desplazamiento pueden ser complicadas, pero las relaciones de velocidad
correspondientes tienen una estructura particular, como se muestra en (2.24) y (2.25).
dx @x @r @x @
= + (2.24)
dt @r @t @ @t
y
dy @y @r @y @
= + (2.25)
dt @r @t @ @t
de esta forma, las relaciones de velocidad se denotan como:
2 3 2 32 3 2 3
x_ cos r sin r_ cos r sin
4 5=4 54 5 =) M =4 5 (2.26)
y_ sin r cos _ sin r cos
MTF
[M(r,)]
Fy
y
25
Captulo 2. Antecedentes
F3 l F1 v3 l v1
2 2
l l
2 2
Fuerzas Velocidades
Figura 2.12: Ejemplo de varilla rgida, donde se representan las fuerzas y las velocidades.
3
MTF
2
Figura 2.13: Bond graph con MTF para el ejemplo de varilla rgida.
26
Captulo 2. Antecedentes
Al modelar en Bond Graph pasamos de un dominio fsico que puede ser elctrico, mecnico,
etc. a otro dominio en el cual se usan variables generalizadas, sin importar si el sistema viene
de uno o ms dominios de energa. El siguiente procedimiento explica los pasos a seguir para
obtener un modelo en Bond Graph.
1. Dibujar una unin-0 unin-1 de acuerdo al sistema correspondiente para los puntos
donde las trayectorias paralelas coincidan.
27
Captulo 2. Antecedentes
2. Dibujar una unin-0 unin-1 para cada componente en una trayectoria serie y conectar
el componente apropiado de Bond Graph usando un bond en esa unin. La direccin
asumida del ujo de potencia es a partir de las fuentes hacia los elementos amacenadores
y/o disipadores de energa, la direccin se indica por el sentido de la semiecha.
3. Dibujar bonds entre las uniones adyacentes indicando la direccin del ujo de potencia.
4. Remover la unin-0 unin-1 que representa el punto de referencia, asi como tambin
todos los bonds conetados a dicha unin.
5. Simplicar el modelo obtenido usando las reglas que se muestran en la gura 2.14.
a) b)
Asignar la causalidad a los elementos comenzando con las fuentes (causalidad necesaria),
despus los elementos almacenadores (causalidad integral) y nalmente los elementos
disipadores (causalidad arbitraria).
Para obtener el Bond Graph de sistemas elctricos se usa el procedimiento general con las
siguientes modicaciones:
28
Captulo 2. Antecedentes
R1 R2 L
a b d e f
E C1 C2
r
c g
Como ejemplo del procedimiento para sistemas elctricos considrese el circuito mostrando
en la gura 2.15.
Aplicando el inciso 1 se identican los nodos donde existen diferentes voltajes (marcados
como a, b, c, d, e y f ) y se colocan uniones-0 por cada uno de ellos, en el paso 2 se
colocan uniones-1 para unir los diferentes elementos al Bond Graph, en el paso 3 se
agregan los bonds faltantes para terminar de unir todos los componentes y en el paso
4 se identican los nodos de referencia (c y g) los cuales se eliminarn junto con los
bonds que estn conectados a ellos, esto se muestra en la gura 2.16.
a b d e f
:
X
X
c g
29
Captulo 2. Antecedentes
1 0 TF 1
:
Figura 2.17: Bond Graph para el sistema elctrico de la gura 2.15.
En la obtencin del Bond Graph para los sistemas mecnicos se usa el procedimiento general
con la siguientes obobservaciones:
De forma similar que en el sistema elctrico, Aplicando el paso 1 se identican los puntos
donde existen velocidades distintas (marcados como a, b y c) y se colocan uniones-1 por
cada una de ellas, en el paso 2 se colocan uniones-0 para unir los diferentes elementos
al Bond Graph, en el paso 3 se agregan los bonds faltantes para terminar de unir todos
los componentes y en el paso 4 se identica el nodo de referencia (denotado como a) el
cual se eliminar junto con los bonds que estn conectados a l, esto se muestra en la
gura 2.19.
30
Captulo 2. Antecedentes
M
FM
c
k1 b
m Fm
b
k2
dz
(Velocidad)
a dt
c
1
1 0
1b 0 1
1 0 0
X
X 1 X
a
31
Captulo 2. Antecedentes
0 1 0 1
Para obtener el Bond Graph de sistemas hidrulicos se realizan las siguientes observaciones
al procedimiento general:
En el inciso 2 se insertan los elementos utlilizando uniones-1 entre los pares de uniones-0
correspondientes, incluir tambin las fuentes de ujo y/o de presin.
En el inciso 4 escoger una presin de referencia (por lo general se usa la presin atmos-
frica) y eliminar la unin-0 de referencia del modelo as como los bonds asociados a
ella.
Como ejemplo del procedimiento para sistemas hidrulicos considrese el sistema mostrando
en la gura 2.21.
Aplicando el paso 1 se identican los nodos donde existen diferentes presiones (marcados
como a, b, c, etc.) y se colocan uniones-0 por cada uno de ellos, en el paso 2 se colocamos
uniones-1 para unir los diferentes elementos al Bond Graph, en el paso 3 se agregan los
bonds faltantes para terminar de unir todos los componentes y en el paso 4 se identica
32
Captulo 2. Antecedentes
a b c d e Cf
Rf1 Rf 2 Lf
Q ( t) 1:n
b c d e
0 TF 0 1 0 1 0
1 1
X
0
a
33
Captulo 2. Antecedentes
0 TF 0 1
En un Bond Graph (BG) en forma convencional es posible clasicar como bonds externos a
los elementos o puertos que conectan R, C, I, S e y S f y a los que conectan con los elementos
0, 1, TF y GY se les llaman bonds internos. Los bonds externos pueden ser clasicados
de acuerdo a su forma de manifestacin de energa. La gura 2.24 muestra un diagrama a
bloques que describe la estructura unin de un modelo en Bond Graph.
Fuentes
u
x Din
Almacenadores xd Uniones Disipadores
z Dout
IyC zd 0,1,TF, GY R
Detectores
D
34
Captulo 2. Antecedentes
En la Figura 2.24, los vectores clave son formados por las fuentes (Se y Sf ), elementos
almacenadores (I y C), disipadores (R), detectores (D) y por ltimo se tiene en la estructura
unin donde intervienen los transformadores, giradores y uniones-0 y uniones-1 (1; 0; T F; GY ).
Los vectores clave son los que representan el sistema, estos se muestran en la gura 2.24,
donde u (t) 2 Rp contiene las variables de potencia (esfuerzos y ujos) debidas a las fuentes
en la Estructura de Unin. Los estados x (t) 2 Rn y xd (t) 2 Rm estn compuestos de
variables de energa, momento generalizado p (t) en elementos almacenadores I y desplaza-
miento generalizado q (t) en elementos almacenadores C en causalidad integral y derivativa
respectivamente; z (t) 2 Rn y zd (t) 2 Rm son variables de co-energa en causalidad integral y
derivativa, respectivamente Din (t) 2 Rr y Dout (t) 2 Rr son una mezcla de esfuerzos y ujos
que contienen los intercambios energticos entre el campo de disipacin y la Estructura de
Unin, n y m son el nmero de elementos almacenadores en causalidad integral y derivativa,
respectivamente; p es el nmero de fuentes y r es el nmero de elementos disipadores de
energa.
donde:
Fd representa una funcin que relaciona cada zdi con xdi para i = 1; :::; m:
L denota una funcin que relaciona cada Douti con Dini para i = 1; :::; r:
El comportamiento de un elemento especco est descrito por una ley fsica la cual ese conoce
35
Captulo 2. Antecedentes
como relacin constitutiva. Si las relaciones constitutivas son tipo lineal tenemos:
donde:
L; F y Fd son matrices reales de dimensin r r; n nym m, respectivamente.
Las relaciones de la estructura de unin estn dadas por:
2 3
2 3 2 3 z (t)
x_ (t) S S12 S13 S14 6 7
6 7 6 11 76 7
6 7 6 76 Dout (t) 7
6 Din (t) 7 = 6 S21 S22 S23 0 766
7
7 (2.39)
4 5 4 5 6 u (t) 7
y (t) S31 S32 S33 0 4 5
| {z } x_ d (t)
Matriz de estructura unin S
T
zd (t) = S14 z (t) (2.40)
Los elementos dentro de la matriz de estructura unin S toman valores dentro del conjunto
f0; 1; kt; kgg donde kt y kg representan el mdulo o relacin del transformador y
del girador. La matriz S est particionada de acuerdo a la dimensin de sus vectores clave.
Las submatrices Sij tienen las siguientes propiedades:
Relacionando las ecuaciones (2.36) a la (2.38) con (2.41) y (2.42) obtenemos las matrices que
representan este tipo de sistemas y que permiten conocer el modelo matemtico en variables
36
Captulo 2. Antecedentes
1
Ap = E (S11 + S12 M S21 ) F (2.43)
1
Bp = E (S13 + S12 M S23 ) (2.44)
E = I + S14 Fd 1 S14
T
F (2.47)
1
M = (I LS22 ) L (2.48)
2 3 5
1 9 10 12 6
0 1 0 1
4 11
8 7
1
Figura 2.25: Bond Graph para el sistema mecnico de la gura 2.18 con los bonds numerados.
37
Captulo 2. Antecedentes
Fd = 0 (2.51)
De acuerdo con la ecuacin (2.39) para la matriz de estructura de unin tenemos que:
2 3
2 3 6 e2 7
6 7
f2 6 f4 7
6 7 6 7
6 7 2 6 7
6 e4 7 6
3 f6 7
6 7 6 7
6 7 6 S11 S12 S13 7 6 6
7
6 e6 7 6 7 6 e7 77
6 7=6 S
6 7 4 21 S22 S23 7 5
6
6
7
7
(2.52)
6 f7 7 e
6 8 7
6 7 S31 S32 S33 6 7
6 7 6 f 7
6 f8 7 6 1 7
4 5 6 7
6 7
f4 6 e3 7
4 5
e5
Un anlisis del modelo en Bond Graph de la gura 2.25 permite determinar las ecuaciones
38
Captulo 2. Antecedentes
f2 = f1 f9 y como: f9 = f4 ) f2 = f1 f4
) e4 = e2 + e3 e8 e9
) f7 = f4 f6
f8 = f7 = f4 f6
f4 = f4
39
Captulo 2. Antecedentes
2 3
0 1 0 0
6 7
6 7
6 1 0 0 1 7
S11 =6
6
7
7 (2.55)
6 0 0 0 1 7
4 5
0 1 1 0
2 3
0
6 7
6 7
6 1 7
6
S12 = 6 7 (2.56)
7
6 1 7
4 5
0
2 3
1 0 0
6 7
6 7
6 0 1 0 7
S13 = 6
6
7
7 (2.57)
6 0 0 1 7
4 5
0 0 0
h i
S21 = 0 1 1 0 (2.58)
S22 = 0 (2.59)
S23 = 0 (2.60)
h i
S31 = 0 1 0 0 (2.61)
S32 = 0 (2.62)
S3 = 0 (2.63)
Usando las ecuaciones (2.43) y (2.46) para obtener la representacin en espacio de estado.
Como no hay elementos almacenadores en causalidad derivativa se tiene que:
0 1 1
40
Captulo 2. Antecedentes
41
Captulo 2. Antecedentes
2 3
q2
6 7
h i6 7
6 p4 7
f4 = 0 1
m 0 0 6
6
7
7 (2.71)
6 p6 7
4 5
q7
Donde las variables de estado son:
q2 es el desplazamiento del resorte k1 y f2 es la velocidad en dicho resorte.
p4 es el momento inercial en la masa m y e4 es la fuerza en dicha masa.
p6 es el momento inercial en la masa M y e6 es la fuerza en dicha masa.
q7 es el desplazamiento del resorte k2 y f7 es la velocidad en dicho resorte.
Adems e3 y e5 son los esfuerzos debidos a la fuerza de gravedad en las masas m y M
respectivamente; f1 es una fuente de velocidad externa la cual inicial el movimiento del
sistema;. f4 es la velocidad en la masa m la cual es la salidad seleccionada del sistema.
42
Captulo 2. Antecedentes
el voltaje en el motor de tal manera que el pndulo est estabilizado en la posicin derecha
hacia arriba en cualquier posicin x deseada del carretn.
x1,I1
1 1
x I:m
x1 l1
1 I:m1
x1
x l1 y1 g
1 I:m1
y1
+ m F
e R
- 1 I:J1
1
I R I R
R
e F Carretn
1 GY 1 TF
i x y barra
Figura 2.26: Ejemplo elemental de un carretn con pndulo invertido que se mueve usando
un motor elctrico.
Como se muestra en la gura 2.26, la representacin del bond graph del sistema se obtiene
directamente, pero la limitacin rgida entre el carretn y la barra ciertamente causar prob-
lemas de causalidad derivativa los cuales son complicados si el ngulo 1 no es pequeo.
Continuando con el desarrollo, se muestra que un enfoque de bond graph a sistemas multi-
cuerpo est estrechamente relacionado a un enfoque de sistema multicuerpo obteniendo las
ecuaciones en la forma descriptiva.
El primer paso es considerar elementos de bond graph representando la dinmica del cuerpo
rgido sin considerar restricciones entre los cuerpos. Las coordenadas x para el carretn y x1 ,
y1 y 1 para la barra se denen con respecto a un marco de referencia inercial. Por lo tanto,
los cuatro elementos-I del lado derecho de la gura 2.26 representan correctamente las leyes
bajos las cuales se arma que la suma de todas las fuerzas aplicadas es igual a la relacin de
43
Captulo 2. Antecedentes
cambio del momento lineal y que las componentes de velocidad del centro de masa son los
momentos divididos entre las masas.
Tambin, la suma del momento sobre el centro de masa de la barra es igual a la relacin
de cambio del momento angular. Para este caso del movimiento plano, la velocidad angular
dividida por el momento centroide de la inercia da la velocidad angular de la barra.
A n de limitar los cuatro elementos-I y por lo tanto crear un bond graph para la barra y el
subsistema del carretn que ser conectado al bond graph de la transmisin. Primero den-
imos las aberturas 1 y 2 en la gura 2.27, estas aberturas horizontales y verticales entre
el pivote de la barra y el pivote del carretn se desvanecern. Adems, sern necesarias las
fuerzas 1 y 2 a travs de las aberturas para asegurar que 1 y 2 desaparezcan. El uso de
para representar fuerzas asociadas con restricciones se propone para recordar que en el for-
malismo multicuerpo [Dauphin-Tanguy, 2000], estas fuerzas de abertura son multiplicadores
de Lagrange.
x1
y1
1
2
1 2 2
x 1
Figura 2.27: Barra y carretn de la gura 2.26 donde se muestran las aberturas 1 y 2 y las
fuerzas 1 y 2 asociadas con ellas.
Estas aberturas se relacionan con las coordenadas de posicin de los cuerpos rgidos en la
44
Captulo 2. Antecedentes
Se
F
Fx
1
x
1
Fx1
1 1
x1
Se:m1g
MTF
Fy1
1
2 y1
2
1
1
1
Figura 2.28: Bond graph que relaciona las velocidades de abertura con las velocidades del
cuerpo.
gura 2.27.
1 = x1 x `1 sin 1 (2.72)
2 = y1 `1 cos 1
Por diferenciacin de las expresiones de las aberturas, se pueden relacionar las velocidades
de las aberturas con las velocidades del cuerpo:
2 3
x_
2 3 2 36 7
_1 6 7
1 1 0 `1 cos 1 6 x_ 1 7
4 5=4 56 7 (2.73)
_2 6 7
0 0 1 `1 sin 1 6 y_ 1 7
4 5
_
1
La relacin (2.73) puede ser representada en trminos de bond graph por un transformador
multipuerto modulado de desplazamiento. La gura 2.28 muestra el transformador conectado
a los cuatro elementos-I representando los dos cuerpos.
La transpuesta de la matriz en la ecuacin (2.73) relaciona automticamente las fuerzas de
45
Captulo 2. Antecedentes
En el bond graph tambin es aplicada la fuerza debido a la gravedad m1 g, siguiendo los trazos
causales, pueden escribirse algunas ecuaciones dinmicas:
px
p_x = F Fx = F + x_ = m
Rescribiendo se obtiene:
m
x=F +
m1 x
1 = 1
(2.76)
m1 y1 = m1 g 2
tiendan a desaparecer.
A pesar de que esta informacin es matemticamente correcta, representa un conjunto de
ecuaciones algebraico-diferenciales y tales sistemas no son particularmente fciles de resolver
numricamente. El bond graph de la gura 2.28 sugiere un enfoque alternativo.
Suponiendo que en lugar de requerir que 1 y 2 desaparezcan completamente, modelamos
la interaccin del pivote entre los dos cuerpos como si existieran resortes rgidos, los cuales
generaran las fuerzas cada vez que las aberturas no fueran cero. En un sentido, esto parece
ser ms real, a partir de que los cuerpos rgidos realmente no existen. Sin embargo, si no
se usarn barras rgidamente reales, se podra crear un modelo con frecuencias naturales
46
Captulo 2. Antecedentes
muy altas de vibracin, lo cual necesitara pasos de tiempo cortos en cualquier simulacin
numrica.
Es mejor considerar resortes y amortiguadores insertados a lo largo de las aberturas como
dispositivos articiales para forzar las limitaciones y hacer esto con ecuaciones diferenciales
explicitas en lugar de ecuaciones algebraicodiferenciales.
La idea es experimentar con resortes rgidos para encontrar la rgidez menor la cual producir
valores lo sucientemente pequeos de 1 y 2 en la operacin del sistema real. Esto producir
pasos de tiempo ms grandes en simulacin y tiempos de simulacin cortos.
El bond graph completo del sistema se muestra en la gura 2.29.
C
I R I R
R
e 0
1 GY 1 TF
i
F
R
1
x
1
C 1
1 1
x1
Se
MTF
1
2 y1
C 1
2
1
R 1
grandes cuando las aberturas no son cero y por lo tanto reducir dichas separaciones. Ya que
la introduccin de los resortes implica que es posible el movimiento de vibracin, tambin es
til introducir elementos-R articiales para proveer amortiguamiento. Asimismo, es necesario
algo de experimentacin con los valores de los parmetros de amortiguamiento para alcanzar
47
Captulo 2. Antecedentes
un resultado favorable.
El elemento-C extra insertado, es porque si los dos fragmentos de bond graph son simplemente
conectados, la inercia rotatoria del motor y la inercia del carretn estn acopladas por un
transformador relacionando variables de movimiento rotatorio a lineal.
Esta es otra alternativa de acoplamiento rgido entre elementos de inercia que siempre induce
causalidades derivativas. En este caso, sera simple eliminar este inconveniente deniendo una
equivalencia sencilla rotatoria o elementos de inercia lineal, denir un campo-I usando los
mtodos establecidos. En lugar de esto, esta restriccin rgida ha sido reemplazada con una
aproximacin deniendo un elemento-C equivalente. Este elemento podra ser considerado
para representar la exibilidad de conduccin de la polea o simplemente un dispositivo para
hacer que el modelo completo pueda tener causalidad integral.
Finalmente, podemos notar que sera relativamente fcil escribir las ecuaciones de estado para
todos los elementos I y C en la gura 2.29. Se debe recordar, sin embargo, que en esta tcnica
de multipuerto, el transformador modulado de desplazamiento utiliza los desplazamientos
de los elementos de inercia para expresar las restricciones o ecuaciones de abertura. En
bond graphs, las variables de desplazamiento para elementos de inercia normalmente no son
necesarias como variables de estado, entonces sern necesarias algunas ecuaciones de estado
extras.
Las matrices del transformador de este ejemplo, en realidad necesitan el desplazamiento 1,
p 1
entonces, estrictamente hablando, solamente la ltima ecuacin en (2.75), _ 1 = J1 necesitara
ser incluida. Para este tipo de sistemas sera, probablemente, ms til incluir ecuaciones de
estado para todos los desplazamientos x, x1 , y1 y 1 en cualquier caso, como se indica en
las ecuaciones (2.75). Estas ecuaciones hacen que se incremente el orden del sistema, pero
su inclusin solamente tiene un efecto menor en el tiempo de simulacin para un estudio por
computadora.
Para ilustrar como este mtodo de introducir restricciones entre cuerpos interconectados
puede ser de gran extensin, consideremos una segunda barra conectada al sistema anterior-
mente estudiado, como se muestra en la gura 2.30.
Deniendo 3, 4 y las fuerzas correspondientes 3 y 4 que pertenecen al segundo conjunto
48
Captulo 2. Antecedentes
2 m2g
m2,l2 3
4
4 4
x2,y2
m1,l1 3
1
1 m1g
x1,y1 1
2
1 2 2
m,x F F
4 = y2 `2 cos 2 y1 `1 cos 1
2 3
x_ 1
6 7
6 7
6 y_ 1 7
2 3 2 36 7
_3 6 _ 7
1 0 `1 cos 1 1 0 `2 cos 2 6 1 7
4 5=4 56 7 (2.78)
_4 6 7
0 1 `1 sin 1 0 1 `2 sin 2 6 x_ 2 7
6 7
6 7
6 y_ 2 7
4 5
_
2
49
Captulo 2. Antecedentes
En este caso, ambas barras tienen tres grados de libertad, as como seis velocidades general-
izadas que son involucradas cuando dos cuerpos son forzados. Asimismo, hay la posibilidad
de relacionar 3 y 4 a las fuerzas que estn actuando en los elementos-I y requiriendo que
50
Captulo 2. Antecedentes
Se
F
R
1
x
1
C 1
1 1
x1
Se
R MTF
1
2 y1
C 1
2
R
1
1
3
C 1
3 1
x2
Se
MTF
1
4 y2
C 1
4
1
2
R
51
Captulo 3
Robots Manipuladores
3.1 Introduccin
pueden efectuar diferentes tareas de montaje. Con esta denicin, un robot debe poseer in-
teligencia que se debe normalmente a los algoritmos de computador asociados con su sistema
de control y sensorial.
Un robot industrial es un manipulador de uso general controlado por computador que consiste
en algunos elementos rgidos conectados en serie mediante articulaciones prismticas o de
revolucin. El nal de la cadena est jo a una base soporte, mientras el otro extremo est
libre y equipado con una herramienta para manipular objetos o realizar tareas de montaje.
El movimiento de las articulaciones resulta en, o produce, un movimiento relativo de los
distintos elementos. Mecnicamente, un robot se compone de un brazo y una mueca ms una
herramienta. Se disea para alcanzar una pieza de trabajo localizada dentro de su volumen de
trabajo. El vlumen de trabajo es la esfera de inuencia de un robot cuyo brazo puede colocar
el submontaje de la mueca en cualquier punto dentro de la esfera. El brazo generalmente se
puede mover con tres grados de libertad. La combinacin de estos movimientos orienta a la
pieza de acuerdo a la conguracin del objeto para facilitar su recogida. Estos tres ltimos
movimientos se denominan con frecuencia elevacin (pitch), desviacin (yaw) y giro (roll).
Por tanto, para un robot con seis articulaciones, el brazo es el mecanismo de posicionamiento,
mientras que la mueca es el mecanismo de orientacin. Estos conceptos se ilustran para el
robot Cincinnati Milacron T3 y el robot PUMA de Unimation que se muestran en la gura
3.1.
Muchos robots industriales que estn disponibles comercialmente, se utilizan ampliamente
en tareas de fabricacin y ensamblaje, tales como manejo de material, soldadura por arco y
de punto, montaje de piezas, pinturas al spray, carga y descarga de mquinas controladas
numricamente, exploraciones espaciales y submarinas, investigacin de brazos protsicos y
en el manejo de materiales peligrosos. Estos robots caen en una de las cuatro categoras que
denen movimientos bsicos (gura 3.2):
Coordenadas cartesianas (tres ejes lineales) ejemplo: robot RS-1 de IBM y el robot
Sigma de Olivetti.
Coordenadas cilndricas (dos ejes lineales y un eje rotacional) ejemplo: robot Versatran
53
Captulo 3. Robots Manipuladores
a) b)
Figura 3.1: Robots manipuladores : a) Robot Cincinnati Milacron T3; b) Robot de la serie
PUMA 560.
600 de Prat.
Coordenadas esfricas (un eje lineal y dos ejes rotacionales) ejemplo: Unimate 2000B
de Unimation Inc.
a) b) c) d)
54
Captulo 3. Robots Manipuladores
La cinemtica del brazo del robot trata con el estudio analtico de la geometra del movimiento
de un brazo de robot con respecto a un sistema de coordenadas de referencia jo sin considerar
las fuerzas o momentos que originan el movimiento. As, la cinemtica se interesa por la
descripcin analtica del desplazamiento espacial del robot como una funcin del tiempo, en
particular de las relaciones entre la posicin de las variables de articulacin, la posicin y
orientacin del efector nal del brazo de robot.
Hay dos problemas fundamentales en la cinemtica del robot. El primero se suele conocer
como el problema cinemtico directo, mientras que el segundo es el problema cinemtico
inverso. Como las variables independientes en un robot son las variables de articulacin, y
una tarea se suele dar en trminos del sistema de coordenas de referencia, se utiliza de manera
ms frecuente el problema cinemtica inverso. Denavit y Hartenberg [1955] propusieron un
enfoque sistemtico y generalizado de utilizar lgebra matricial para describir y representar la
geometra espacial de los elementos del brazo de robot con respecto a un sistema de referencia
jo. Este mtodo utiliza una matriz de transformacin homognea 4x4 para describir la
relacin espacial entre dos elementos mecnicos rgidos adyacentes y reduce el problema
cinemtico directo a encontrar una matriz de transformacin homognea 4x4 que relaciona
el desplazamiento espacial del sistema de coordenadas de la mano al sistema de coordenadas
de referencia. Estas matrices de transformacin homogneas son tambin tiles en derivar
ecuaciones dinmicas de movimiento del brazo del robot. En general, el problema cinemtico
inverso se puede resolver mediante algunas tcnicas. Los mtodos utilizados ms comnmente
son el algebraico matricial, iterativo, o geomtrico.
La dinmica del robot, por otra parte, trata con la formulacin matemtica de las ecuaciones
del movimiento del brazo. Las ecuaciones dinmicas del movimiento de un manipulador son
un conjunto de ecuaciones matemticas que describen la conducta dinmica del manipulador.
Tales ecuaciones de movimiento son tiles para simulacin en computadora del movimiento
del brazo, el diseo de ecuaciones de control apropiadas para el robot y la evaluacin del dis-
eo y estructura cinemtica del robot. El modelo dinmico real de un brazo se puede obtener
55
Captulo 3. Robots Manipuladores
de las leyes fsicas conocidas tales como las leyes de Newton y la mecnica lagrangiana. Esto
conduce al desarrollo de las ecuaciones dinmicas de movimiento para las distintas articula-
ciones del manipulador en trminos de los parmetros geomtricos e inerciales especicados
para los distintos elementos. Se puede aplicar sistemticamente enfoques convencionales
como la formulacin de Lagrange-Euler y de Newton-Euler para desarrollar las ecuaciones de
movimiento del robot.
El problema de la cinemtica directa puede ser establecido como sigue: dadas las variables
de las uniones del robot, determinar la posicin y orientacin del efector-nal. Las variables
de las uniones son los ngulos entre los eslabones en el caso de uniones de revolucin o
rotacionales, y la prolongacin en el caso de uniones prismaticas o de deslizamiento.
Para los propsitos de anlisis de cinmatica, se puede pensar en un robot como un conjunto
de enlaces rgidos conectados por medio de uniones.
El objetivo del anlisis de la cinemtica directa es determinar el efecto acumulativo del
conjunto de las variables de unin. Para hacer esto de una manera sistemtica, realmente
se deberan introducir algunas convenciones. Sin embargo, el anlisis de la cinemtica de un
manipulador de n-eslabones es extremadamente complejo y las convenciones introducidas a
continuacin simplican considerablemente las ecuaciones. Ms an, ellas dan un lenguaje
universal con el cual los ingenieros de robtica se pueden comunicar.
La variable de unin i esima est denotada por qi . En caso de una unin de revolucin,
56
Captulo 3. Robots Manipuladores
Sin embargo, la hiptesis de que todas las uniones son de revolucin o prismticas signica
que Ai es una funcin de una sola variable de unin, llamada qi . En otras palabras,
Ai = Ai (qi ) (3.1)
Ahora, la matriz homognea que transforma las coordenadas de un punto a partir del marco
de referencia j al marco de referencia i, es llamada, por convencin, matriz de transformacin
y es usualmente denotada por Tij . Sabemos que:
Tij = I si i = j (3.3)
1
Tij = Tji si j > i (3.4)
Por la manera en la cual se tienen colocados los diferentes marcos de referencia a los eslabones
correspondientes, se desprende que la posicin de cualquier punto en el efector-nal, cuando es
expresado en el marco de referencia n, es una constante independiente de la conguracin del
robot. Denotar la posicin y orientacin del efector-nal con respecto a marco base o inercial
por medio un vector tridimensional dno y una matriz de rotacin de 3 3 Ron , respectivamente,
y se dene la matriz homognea como:
2 3
Ron dno
H=4 5 (2.66)
0 1
57
Captulo 3. Robots Manipuladores
Por lo tanto: 2 3
Rij dji
i
Tij = Ai+1 Aj = 4 5 (3.7)
0 1
La matriz Rij expresa la orientacin del marco de referencia j relativa al marco de referencia
i, est dada por las partes rotacionales de las matrices A como:
dji = dji 1
+ Rij 1 j
dj 1 (3.9)
Es decir:
2 32 32 32 3
C S 0 0 1 0 0 0 1 0 0 ai 1 0 0 0
6 i i
76 76 76 7
6 76 76 76 7
6 Si C 0 0 76 0 1 0 0 76 0 1 0 0 76 0 C i S 0 7
Ai = 6 76 76 76 7 (3.11)
i i
6 76 76 76 7
6 0 0 1 0 76 0 0 1 d 76 0 0 1 0 76 0 S i C 0 7
4 54 54 54 i
5
0 0 0 1 0 0 0 1 0 0 0 1 0 0 0 1
58
Captulo 3. Robots Manipuladores
es el ngulo.
A partir de que la matriz Ai es una funcin de una sola variable, entonces tres de la cuatro
variables son constantes para un eslabn dado, mientrs que de los cuatro parmetros, i es
para la unin de revolucin y di para la unin prismtica.
Una matriz homognea arbitraria puede ser descrita por 6 cantidades, tal como, por ejemplo,
las tres componentes de desplazamiento del vector d y tres ngulos de Euler correspondiente
a la matriz de rotacin R.
En la representacin D H, en contraste, hay solamente cuatro parmetros, Como es esto
posible? La respuesta es que mientras el marco de referencia i es requerido para colocarse
rgidamente al eslabn i; se tiene libertad considerable en escoger el origen y los ejes de las
coordenadas del marco de referencia. As, con una seleccin hbil del origen y de los ejes de
coordenadas, es posible reducir el nmero de parmetros necesitados de 6 a 4 (en algunos
casos menor).
Para comprobar lo anterior, se inicia determinando pequeas transformaciones homogneas
que pueden ser expresadas en la forma de (3.10). Suponer que se tienen dos marcos de
referencia denotados por 0 y 1. Entonces existe una matriz de transformacin nica A que
toma las coordenadas a partir de 1 hacia 0. Ahora, suponer que los marcos de referencia
tienen las siguientes caracteristicas adicionales:
59
Captulo 3. Robots Manipuladores
z1
z0
x1 i1
a o1
d
1
k0 d0
y1
o0
x0 y0
Para mostrar que la matriz A puede ser escrita en esta forma, se puede escribir A como:
2 3
R d
A=4 5 (3.15)
0 1
60
Captulo 3. Robots Manipuladores
La nica informacin que tenemos es que r31 = 0, pero es suciente. Primero, a partir de
que cada rengln y columna de R debe tener longitud unitaria, r31 = 0 implica qu:
2 2 2 2
r11 + r21 = 1; r32 + r33 =1 (3.17)
Una vez que y fueron encontrados, es de rutina mostrar que los elementos restantes de
R deben tener la la forma mostrada en (3.16), utilizando la matriz de rotacin R.
A continuacin, la hiptesis (DH2) indica que el vector d = d10 (el cual es el vector de
coordenadas del origen del marco de referencia 1 en trminos del marco de referencia 0) es
una combinacin lineal de ko y Ri1 . por lo tanto, a partir de que r31 = 0 se puede expresar
d10 como:
Una vez que se ha establecido que cada matriz homognea que satisface las condiciones (DH1)
y (DH2) sta puede ser representada en la forma (3.13), se puede dar una interpretacin fsica
a las cuatro cantidades en (3.13).
El parmetro a es la distancia entre los ejes z0 y z1 y es medida sobre el eje x1 . El ngulo
es el ngulo entre los ejes z0 y z1 medido en un plano normal a x1 . El sentido positivo de
es determinado de z0 a z1 por la regla de la mano derecha, tal como se muestra en la gura
3.4.
El parmetro d es la distancia entre el origen o0 y la interseccin del eje x1 con zo medido
a lo largo del eje zo . Finalmente, es el ngulo entre los ejes x0 y x1 medido en un plano
normal al eje z0 .
Para iniciar, es til identicar todas las uniones de los ejes y etiquetarlas z0 ; ; zn 1. zi es
el eje de revolucin de la unin i + 1, si la unin i + 1 es de revolucin, y es el eje de traslacin
61
Captulo 3. Robots Manipuladores
zi zi-1
i
i zi-1
xi-1
xi
xi
ai
Unin i
oi zi-2
xi yi Eslabn i
Esl
ab n
Unin i+1 xi-1 i- 1
di
Para colocar de manera correcta el marco de referencia i es necesario considerar dos casos:
a) Los ejes zi 1, zi no son coplanares.
b) Ellos son coplanares.
Si los ejes zi 1; zi no son coplanares entonces existe una nica lnea perpendicular a ambos
62
Captulo 3. Robots Manipuladores
tal qu, la lnea que conecta a ambos tiene longitud mnima. La lnea es normal comn a
zi 1 y zi ; entonces la linea es denida como xi , y el punto de interseccin con zi es el origen
oi .
Entonces por construccin, se satisfacen ambas condiciones (DH1) y (DH2) y el vector de
oi 1 a oi es una combinacin lineal de zi 1 y xi .
La especicacin del marco de referencia i esta completa seleccionando el eje yi para formar
el marco de referencia de la mano derecha. Dado que las hiptesis (DH1) y (DH2) son
satisfechas, la matriz homognea Ai est en la forma (3.13).
Ahora considerando el caso b); esto es, los ejes zi 1 y zi son complanares. Esto signica que
son paralelos, o que se intersectan.
Si los ejes zi 1 y zi son paralelos, hay una innidad de lineas normales entre ellos y la condicin
(DH1) no especica completamente a xi . En este caso se escoge el origen oi en la unin i as
que xi es normal a partir de zi 1 la cual pasa a travs de oi . Notar que la seleccin de oi es
arbitrario en este caso. Se podra tambin escoger la normal que pasa a travs de oi 1 como
el eje xi en el cual el caso di sera cero.
A partir de que los ejes zi 1 y zi son paralelos, i ser cero en este caso. Una vez que xi esta
jo, yi se puede determinar. Finalmente, considerar el caso donde zi intersecta el eje zi 1.
63
Captulo 3. Robots Manipuladores
Eslabn ai i di i
1 a1 0 0 1
2 a2 0 0 2
o2
a2
y1 z2
2
x1
a1 o1
y0
z1
1
o0 x0
z0
64
Captulo 3. Robots Manipuladores
T01 = A1 (3.23)
T02 = A1 A2 (3.24)
2 32 3
C1 S1 0 a1 C1 C2 S2 0 a2 C2
6 76 7
6 76 7
6 S1 C1 0 a1 S1 7 6 S2 C2 0 a2 S2 7
T02 = 6
6
76
76
7
7 (3.25)
6 0 0 1 0 76 0 0 1 0 7
4 54 5
0 0 0 1 0 0 0 1
2 3
C C S 1 S2 C1 S2 S1 C2 0 a2 C1 C2 a2 S1 S2 + a1 C1
6 1 2 7
6 7
6 S1 C2 + C1 S2 S1 S2 + C1 C2 0 a2 S1 C2 + a2 C1 S2 + a1 S1 7
T02 = 6
6
7
7 (3.26)
6 0 0 1 0 7
4 5
0 0 0 1
2 3
C S12 0 a1 C1 + a2 C12
6 12 7
6 7
6 S12 C12 0 a1 S1 + a2 S12 7
T02 6
= 6 7 (3.27)
7
6 0 0 1 0 7
4 5
0 0 0 1
Notar que las primeras dos entradas de la ltima columna de T2 son las componentes x y y
65
Captulo 3. Robots Manipuladores
x = a1 C1 + a2 C12 (3.28)
y = a1 S1 + a2 S12 (3.29)
son las coordenadas del efector-nal en el marco de referencia base. La parte de rotacin
de T02 entrega la orientacin del marco de referencia o2 x2 y2 z2 relativa al marco de referencia
base.
66
Captulo 4
Modelado de Robots
Manipuladores en Bond Graph
Existen diferentes caminos para determinar las ecuaciones de movimiento de sistemas mecni-
cos. El propsito de esta seccin es mostrar como el bond graph proporciona un camino sis-
temtico para describir los sistemas mecnicos y su dinmica correspondiente. el documento
fundamental en esta rea es el que redact Karnopp en 1969 y las extensiones de esta teoria
aparecen en un libro de texto escrito por Karnopp y otros autores en 1990.
Un concepto clave introducido por Karnopp es la representacin de transformaciones ge-
omtrica (conservadoras de energa) usando transformadores en Bond Graph. Esto permite
que el Bond Graph sea escrito bajo consideraciones geomtricas; la conservacin de potencia
implica automticamente las fuerzas correspondientes a las velocidades.
La barra rgida de la gura 4.1 que se mueve en el plano, es un componente estndar de los
sistemas mecnicos, los tres puntos importantes en la barra son los dos extremos y el centro
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
vy
vx
y
l1
x
Vy
l2
Vx
V
de masa. Los extremos son importantes porque ellos denen las conexiones en la barra; el
centro de masa es importante debido a que ahi es ms conveniente escribir las ecuaciones de
movimiento. La barra rgida por lo tanto, acta como una restriccin entre estos tres puntos
del espacio.
La gura 4.2 muestra el bond graph de un cuerpo rgido.
El movimiento se considera con respecto a un sistema de coordenadas absoluto: vx y vy son
las componentes de velocidad de un estremo con respecto a dicho sistema de coordenadas;
Vx y Vy son las componentes de velocidad del otro extremo; x_ y y_ son las componentes
de velocidad del centro de masa. Estos tres puntos muestran la misma velocidad angular
_ = v = V . La distancia a partir del primer extremo al centro de masa es l1 y la distancia
a partir del segundo extremo al centro de masa es l2 .
La cinemtica de la barra es expresada por las ecuaciones:
x_ = vx vx (4.1)
y_ = vy + vy (4.2)
Vx = x_ Vx (4.3)
Vy = y_ + Vy (4.4)
68
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
fx vx f v fy vy
1 vx 1 v 1 vy
0 fx 0 fy
MTF: c1 MTF: s1
d
I: mx 1 dx C 1 I: J dy 1 I: my
:
Se: mg
MTF: c2 MTF: s2
Fx 0 0 Fy
1 Vx 1 V 1 Vy
Fx Vx F V Fy Vy
69
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
vx = l1 cos _ (4.5)
vy = l1 sin _ (4.6)
Vx = l2 cos _ (4.7)
Vy = l2 sin _ (4.8)
Hay un elemento-C llamado "C " que tiene rigidez cero y por lo tanto no afecta en el
comportamiento del sistema, pero su correspondiente variable de ujo integrada q es:
Z t
q= _ t0 dt0 = + q0 (4.10)
0
Estas uniones-1 transportan las tres velocidades asociadas con el centro de masa
x;
_ y_ y _ .
Estas uniones-1 calculan los esfuerzos netos que estn actuando en el elemento-I
correspondiente ( fx , fy y ).
70
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
La gura 4.3 muestra un pndulo simple construido por una varilla conectada a la parte su-
perior de una estructura. Un par es aplicado a la parte superior del pndulo. Por simplicidad
l1 = l2 = l, una fuerza de gravedad u1 = fg acta en el centro de la masa.
Debido a que el pndulo es un caso especial de la barra, el bond graph es el mismo que el de
la barra pero con componentes adicionales, en particular:
Fuentes de velocidad cero son conectadas a las uniones vx y vy que indican que la parte
superior esta ja.
Fuentes de fuerza cero son conectadas a las uniones Vx y Vy para indicar que no hay
fuerzas actuado en el extremo inferior.
Una fuente de fuerza es conectada a la unin dy para indicar que la gravedad est
actuando en la direccin negativa del eje y en el centro de masa.
71
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
y
l1
x
Vy
l2
Vx
V
Solamente uno de los tres elementos-I puede tener causalidad integral, el nico que la tiene
es el elemento correspondiente de rotacin como se muestra en la gura 4.4.
Una variacin de este tipo de sistemas es agregando a la parte inferior de la varilla un peso
de masa mb de pequea dimensin, el bond graph de la gura 4.5 es semejante al de la gura
4.4 excepto que las dos fuentes de fuerza de la parte baja de la barra han sido reemplazadas
por elementos-I correspondientes a las velocidades x y y de la masa agregada y una tercera
entrada Fb ha sido aadida en la forma de una fuente adicional para considerar el efecto de
la gravedad debido a la masa agregada.
La gura 4.6 muestra un pndulo doble construido con dos pndulos simples sujetando un
extremo de la segunda barra a la parte baja de la primera usando una unin de revolucin
72
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
1 vx 1 v 1 vy
0 fx 0 fy
MTF: c1 MTF: s1
d
I: mx 1 dx C 1 I: J dy 1 I: my
:
MTF: c2 MTF: s2
Fx 0 0 Fy
1 Vx 1 V 1 Vy
73
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
1 vx 1 v 1 vy
0 fx 0 fy
MTF: c1 MTF: s1
d
I: mx 1 dx C 1 I: J dy 1 I: my
:
C
Se:F g
MTF: c2 MTF: s2
Fx 0 0 Fy
1 Vx 1 V Vy 1 Se:F b
74
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
sin friccin. Esta unin obliga que las velocidades sean iguales en la parte baja de la barra
superior y la parte superior de la segunda barra. Por simplicidad, las barras se consideran
uniformes y de longitud 2l. La inercia J sobre el centro es:
ml2
J= (4.11)
3
2 = 2 1 (4.12)
y1
1
Vy1=vy2
x1
y2
Vy2 V1
Vx1=vx2
x2
Vx2
La gura 4.7 muestra el bond graph correspondiente a un pndulo doble. Una copia del bond
graph de una barra simple ha sido agregada a otro del pndulo simple y conectada por dos
bonds, lo cual asegura que las velocidades sean iguales en la parte baja de la barra superior
y la parte superior de la barra inferior.
75
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
1 vx1 1 v1 1 vy1
0 fx1 0 fy1
MTF:c11 MTF:s11
d1
I:m x1 1 dx1 C 1 I:J 1 dy1 1 I:m y1
:
C1
S e:F 1
MTF: c21 MTF:s21
Fx1 0 0 Fy1
1 1 V1 1
S e:f 2 0 F
1 vx2 1 v2 1 vy2
0 fx2 0 fy2
MTF:c12 MTF:s12
d2
I:m x2 1 dx2 C 1 I:J2 dy2 1 I:m y2
:
C2
S e:F 2
MTF: c22 MTF:s22
Fx2 0 0 Fy2
1 1 V2 1
Esta seccin considera el manipulador de dos eslabones que se muestra en la gura 4.8 com-
puesta de dos eslabones rgidos uniformes de longitud 2l movindose en un plano horizontal.
y1
1
Vy1=vy2
x1
y2
Vy2 V1
Vx1=vx2
x2
Vx2
1 = 1 (4.13)
2 = 2 1 (4.14)
El bond graph que se muestra en la gura 4.9 es similar al del pndulo doble excepto porque:
Los pares son aplicados en cada unin y son medidas las correspondientes velocidades
de unin.
Esta seccin est dirigida a resolver el siguiente problema, dada una representacin es-
quemtica de un sistema mecnico acompaado de descripciones matemticas de las partes
que lo componen, encontrar una forma conveniente para modelar el sistema as como predecir
su comportamiento dinmico.
La importancia del problema no necesita remarcarse, se ha trabajado en forma constante, al
menos desde el tiempo de Newton y ha atrado la atencin de muchos cientcos notables,
77
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
1 vx1 1 v1 1 vy1
0 fx1 0 fy1
MTF:c11 MTF:s11
d1
I:m x1 1 dx1 C 1 I:J 1 dy1 1 I:m y1
:
C1
Fx1 0 0 Fy1
1 1 V1 1
S e:f 2 0 F
1 vx2 1 v2 1 vy2
0 fx2 0 fy2
MTF:c12 MTF:s12
d2
I:m x2 1 dx2 C 1 I:J2 dy2 1 I:m y2
:
C2
Fx2 0 0 Fy2
1 1 V2 1
Se inicia considerando el resultado que nos gustara alcanzar. Para un problema dado en
mecnica involucrando partculas, cuerpos rgidos y elementos elsticos, deseamos obtener un
conjunto de ecuaciones diferenciales de primer orden en trminos de variables que producen
signicado fsico dentro del comportamiento del sistema. Se anticipa que las ecuaciones sern
acopladas y si es posible explcitas (esto es, una derivada en cada ecuacin) teniendo la
siguiente forma:
campo-C fC = C (qC ) (4.15)
q_ C = [TCI (qC )] vI
Estructura unin (4.17)
p_ I = TtCI (qC ) fC
donde fC es el conjunto de fuerzas deniendo la coenerga potencial, qC es el conjunto de
desplazamientos deniendo la energa potencial, vI es el conjunto (inercial) de velocidades
deniendo la coenerga cintica; pI es el conjunto de momentos deniendo la energa cintica,
y q_ C y p_ I son las derivadas de qC y pI , respectivamente.
Abordando un ejemplo para reducir las ecuaciones de (4.15) a (4.17) se tiene:
79
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
Estas son las ecuaciones de un sistema conservativo no lineal expresado en trminos de vari-
ables de estado qC y pI .
La gura 4.10 muestra un modelo de bond graph representando el tipo de sistema antes
mencionado.
qC
qC1 vI1 pI1
1 1
C 1
qCM
MTF 1
vIP
pIP I
(a)
MTF
pIP
CM 1 1 IP
vIP
qCM (b)
Figura 4.10: Modelo de un bond graph simblico para un sistema conservativo bsico no
lineal (a) Campos -C y -I acoplados; (b) Campos -C y -I uniones-1.
Considerando el oscilador no lineal de la gura 4.11a, en el cual la masa es libre para girar
en una cuerda y es limitada por un resorte. Un segundo resorte limita la cuerda a girar en el
plano X-Y.
Las variables geomtricas claves son identicadas en la gura 4.11b como r, , x, y, vx y vy .
Las relaciones constitutivas para resortes e inercias lineales, en forma de las ecuaciones (4.15)
y (4.16), son entregadas por las ecuaciones (4.19) y (4.20) para resortes y las ecuaciones (4.21)
y (4.22) para inercias:
F = k1 (r R) (4.19)
80
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
k2
0 0
X X
k1 g
y
r
vx
x
Y Y vy
(a) (b)
Figura 4.11: Un oscilador mecnico no lineal (a) Diagrama esquemtico; (b) Cantidades
geomtricas claves denidas.
r vx
1 7 3
C:C1 1 1 I:I1
5 px
MSe:k1R 11 MSe:mg
0 MTF
10
6
2 9 4
C:C2 8 1
1 I:I2
(r , ) vy py
= k2 (4.20)
1
vx = px (4.21)
m
1
vy = py (4.22)
m
donde R es la longitud libre de la barra exible (resorte), F es la fuerza de la barra exible,
es el par de la torsin del resorte en la barra respecto a un eje a travs del origen normal
al plano X-Y, y k1 y k2 son constantes del resorte. Tanto el campo-C como el campo-I son
lineales y desacoplados.
El bond graph correspondiente es el que se muestra en la gura 4.12.
81
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
_= cos sin
vx + vy (4.25)
r r
por lo tanto:
2 3 2 3 2 3
sin cos f5 f3
TCI (qC ) = 4 5 ; 4 5 = TCI (qC ) 4 5 (4.26)
cos sin
r r f6 f4
Slo resta calcular p_ I en trminos de las fuerzas en el resorte. Para una denicin apropiada
de la fuerza F y el efecto del par en las direcciones X y Y (esto es px y py ), obtenemos:
cos
p_x = ( sin ) F + (4.27)
r
sin
p_y = ( cos ) F + + mg (4.28)
r
La inspeccin cuidadosa de las ecuaciones (4.27) y (4.28) muestran que ciertamente la trans-
formacin del arreglo TCI (qC ) es integrada como el transpuesto negativo, particularmente:
2 3
cos
sin
TtCI (qC ) = 4 r 5 (4.29)
sin
cos r
82
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
La inuencia de la gravedad simplemente se suma en forma apropiada (es decir, afecta direc-
tamente en py ) y se muestra en la gura 4.12 como una fuente de esfuerzo, MSe.
Primero se muestran las ecuaciones (4.24) y (4.25) combinadas con las (4.27) y (4.28), elim-
inando F, , vx y vy usando las ecuaciones de la (4.19) y (4.22). El sistema de ecuaciones de
estado es:
1 1
r_ = (sin ) px + (cos ) py (4.30)
m m
_= cos 1 sin 1
px + py (4.31)
r m r m
cos
p_x = ( sin ) k1 (r R) + k2 (4.32)
r
sin
p_y = ( cos ) k1 (r R) + k2 + mg (4.33)
r
Una representacin bond graph del sistema completo se muestra en la gura 4.12. Los signos
menos en las ecuaciones (4.27), (4.28) y (4.29) surgen debido a la convencin de signos en las
uniones-1 en el lado derecho de la gura 4.12.
El modelado propuesto est basado principalmente en el desarrollo que realiz Peter Gawthrop,
como se muestra en la gura 4.13, esto porque su forma de modelar los sistemas es explcita,
y de Karnoop se retoma la idea de simplicar los modelos, es decir, eliminar el uso de 4
transformadores modulados por uno slo, el cual, tiene la relacin constitutiva de los cuatro
usados en la primer tcnica mencionada.
Las relaciones constitutivas para c1 y c2 es cos y para s1 y s2 es sin , donde = 1, 2 ,..., n
de acuerdo con el nmero de eslabones en el robot manipulador, con los efectos moduladores
83
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
MTF: c1 MTF: s1
C 1 I: J
:
C
MTF: c2 MTF: s2
de modulacin):
f2 = cos f4 (4.34)
f1 = cos f4 (4.35)
f5 = sin f4 (4.36)
f3 = sin f4 (4.37)
Adems, se le agregan al modelo los efectos de la friccin, tanto en las barras como en las
masa de las uniones (donde se considera el peso del motor de control).
Una caracterstica importante del modelado de un sistema en Bond Graph, es que a partir
de ste, su modelo matemtico puede ser derivado en forma directa y relativamente simple.
84
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
f3 e1
e3 f1
e4
f4 MTF
f5 e2
e5 f2
Figura 4.14: Transformador modulado que sustituye los cuatro MTF del modelo de Gawthrop.
Hay un elemento-C que tiene rigidez cero y por lo tanto no afecta en el comportamiento
del sistema, pero su correspondiente variable de ujo integrada nos proporciona la seal
modulante para el transformador multipuerto (ngulo ).
El transformador modulado MTF contiene las relaciones constitutivas que implican las trans-
formaciones de fuerza correspondientes.
El efecto de la gravedad se agrega con la fuente de esfuerzo (mg) la cual slo afecta en el eje
y:
85
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
1 2
3
R:Friccin de M x 31
1 V x1 1 V 1 V y1 1 R:Friccin de M y
4
8 5
7 6
F x1 0 0 F y1
11
R:Friccin de b x 12
10 C:C R:Friccin de b y
9 13
18 14
32 15 I:m
I:m x 1 d x1 MTF 1 d 1 d y1 1 y
23
:
MTF 19 16
I:J
S e:mg
22 17
21 25 20
f x1 0 0 f y1
24 26
v x1 1 1 v 1 1 v y1
28
0 F 1
29 27
Escaln 30
S f:v x MS e:f 1 S f:v y
86
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
1 1
F = Diag ; ; Fd = Diag fMx ; My ; my ; mx g ; L = Diag fF My ; F bx ; F by ; F Mx g
C J
(4.41)
Las relaciones entrada-salida del transformador modulado (M T F ) en forma de ecuaciones:
87
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
En la estructura se puede observar que S11 y S22 son matrices cuadradas antisimtricas y que
S12 es la matriz transpuesta negativa de S21 . Las propiedades anteriores estn basadas en el
principio de conservacin de energa.
De la estructura unin anterior (ecuacin 4.48) se observa que:
2 3
0 1
S11 = 4 5 (4.49)
1 0
2 3
0 0 0 0
S12 = 4 5 (4.50)
2 sin cos sin 2 cos
2 3
0 0 0 0 0
S13 = 4 5 (4.51)
1 1 0 0 sin
2 3
0 0 0 0
S14 = 4 5 (4.52)
2 cos 2 sin sin cos
2 3
0 2 sin
6 7
6 7
6 0 cos 7
S21 =6
6
7
7 (4.53)
6 0 sin 7
4 5
0 2 cos
S22 = 0 (4.54)
88
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
2 3
0 0 0 0 0
6 7
6 7
6 0 0 0 1 0 7
S23 =6
6
7
7 (4.55)
6 0 0 1 0 0 7
4 5
0 0 0 1 0
S24 = 0 (4.56)
Para obtener la representacin de estados de esta clase de sistemas nolineales a partir del
Bond Graph en causalidad Integral se tiene que:
donde:
1
f (x) = E (S11 + S12 M S21 ) F (4.59)
1
g (x) = E (S13 + S12 M S23 ) (4.60)
E = I + S14 Fd 1 S14
T
F (4.63)
1
M = (I LS22 ) L (4.64)
donde:
= Mx My mx my (4.67)
89
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
donde, los estados son q18 que es la posicin angular del brazo ngulo , y p19 es el momento
angular en el mismo, e30 es la entrada para llevar el brazo a la posicin deseada y por ltimo
e16 es el efecto debido a la fuerza de gravedad (mg), adems los valores de e2 = f27 = f29 = 0:
90
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
La dinmica del robot trata con las formulaciones matemticas de las ecuaciones de movimiento
del brazo. Tales ecuaciones son tiles para la simulacin en computadora del movimiento del
robot, el diseo de ecuaciones de control apropiadas para el robot y la evaluacin del diseo
y estructura del brazo.
El modelo dinmico de un robot se puede obtener a partir de leyes fsicas conocidas tales
como las leyes de la mecnica newtoniana y lagrangiana. Esto conduce al desarrollo de
las ecuaciones de movimiento dinmico para las diversas articulaciones del manipulador en
trminos de los parmetros geomtricos e inerciales de los elementos. Mtodos convencionales
como las formulaciones de Lagrange-Euler y Newton-Euler se pueden aplicar de manera
sistemtica para desarrollar las ecuaciones de movimiento del brazo.
Las ecuaciones de movimiento general de un manipulador se pueden expresar mediante la
aplicacin directa de la formulacin Euler-Lagrange a sistemas no conservativos[Fu, 1989].
(e)
donde: Fi es la fuerza externa que est actuando sobre la partcula i debido a fuentes
externas al sistema, Fji es la fuerza interna sobre la partcula i debido a la partcula j.
Haciendo las sumas sobre todas las partculas i:
X (e)
X
(Fji ) + Fi = mi ri (4.73)
i;j i6=j i
91
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
Fi(e)
Fji(e )
Fij(e)
r1 ri
! !
Claramente Fii = 0, tambin debido a la tercera ley de Newton Fij = Fji por lo tanto:
X (e)
X
Fi = mi ri (4.74)
i i
(e)
Sustituyendo Fi ,
X (a)
Fi + fi ri = 0 (4.78)
i
92
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
Considerando aquellos sistemas para los cuales las fuerzas de restriccin no realizan trabajo,
entonces:
X (a)
Fi ri = 0 =) para sistemas con restricciones holnomicas. (4.79)
i
(e) (a)
Fi = Fi + fi = p_i = mi v_ i = mi ri (4.80)
(a) (e)
X (e)
Fi = Fi fi ) Fi fi ri = 0 (4.81)
i
P (e)
Pero Fi ri = 0 , entonces:
X (a)
Fi p_i ri = 0 =) Principio de DAlembert. (4.82)
i
Considere el trmino:
X @ri X d @ri d @ri
mi ri = mi r_i mi r_i (4.85)
@qj dt @qj dt @qj
i i
d @ri
donde se rest y sum el trmino mi r_i dt @qj , dado que:
Entonces:
!
X @ ri ! !
d ri @ ri
r_i = = q_j + (4.87)
dt @qj @t
j
93
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
!
@ ri
donde @t generalmente es cero. expandiendo la ecuacin (4.87),
! ! ! !
@ ri @ ri @ ri @ ri
r_i = q_1 + q_2 + + q_n + (4.88)
@q1 @q2 @qn @t
De la ecuacin (4.88) se puede deducir que:
@ r_i @ri @ r_i @ri @ r_i @ri
= ; = ; ; = (4.89)
@ q_1 @q1 @ q_2 @q2 @ q_n @qn
es decir,
@ r_i @ri
= (4.90)
@ q_j @qj
Sustituyendo en la ecuacin (4.85),
X @ri X d @ r_i @ r_i
mi ri = mi r_i mi r_i (4.91)
@qj dt @ q_j @qj
i i
X @ri X d @ mi r_i r_i @ mi r_i r_i
mi ri = (4.92)
@qj dt @ q_j 2 @qj 2
i i
X @ri d @T @T
mi ri = (4.93)
@qj dt @ q_j @qj
i
donde la energa cintica es:
1X 1X @ri @ri 2
T = mi r_i2 = mi q_j + (4.94)
2 2 @qj @t
i
Sustituyendo (4.85) en (4.83) se obtiene:
1X d @T @T
T = Qj + qj = 0 (4.95)
2 dt @ q_j @qj
j
Si las restricciones son holonmicas, entonces todos los qj son linealmente independientes.
As:
d @T @T
Qj + = 0 (4.96)
dt @ q_j @qj
d @T @T
= Qj (4.97)
dt @ q_j @qj
(a) (a) @V (r1 ;r2 ; )
Si las Fi son derivables de una funcin de potencial, Fi = @ri , entonces, la fuerza
generalizada Qj toma la forma:
X @V @ri @V @r1 @V @r2
Qj = = + + (4.98)
@ri @qj @r1 @q1 @r2 @q1
i
@V (r1 ; r2 ; )
Qj = (4.99)
@qj
94
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
dV
Como V (qj ), entonces dq_ = 0, entonces la ecuacin (4.97) se puede escribir como:
d @L @L
=0 (4.100)
dt @ q_j @qj
L=T V (4.101)
En el caso que se tengan fuerzas j no derivables de una funcin potencial, Qj puede dividirse
en las que si lo son y en j (como es el caso de fuerza de friccin), la ecuacin (4.100) se
rescribe como:
d @L @L
= j =) Modelo Euler-Lagrange (4.102)
dt @ q_j @qj
Supngase que el sistema a modelar satisface:
i) El marco de referencia (x; y; z) es inercial, as, son validadas las leyes de Newton.
ii) El trabajo virtual neto realizado por las fuerzas de restriccin es despreciable. Entonces
es valido el principio de DAlembert.
Para compar los dos mtodos de modelado, se propone modelar el robot manipulador ms
simple: el de un slo eslabn, como se muestra en la gura 4.17.
Se aplica el modelo matemtico Euler-Lagrage:La variable generalizada es:
q= (4.103)
x y
cos = ) x = l cos y sin = ) y = l sin (4.104)
l l
95
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
m
l
!
Por lo que el vector r es:
!
r = (l cos ) i + (l sin ) j (4.105)
!
Sustituyendo r1 se obtiene:
!
!2
1 @ r _
T = m (4.107)
2 @
Se resuelve la derivada parcial, y recordando que i i = j j = 1 y i j = j i = 0,
1 n o2
T = m [( l sin ) i + (l cos ) j] _ (4.108)
2
1 2
T = m l2 sin2 i2 2l2 sin cos ij + l2 cos2 j 2 _ (4.109)
2
1 2 2
T = ml sin2 + cos2 _ (4.110)
2
1 2 _2
T = ml (4.111)
2
96
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
1 2
L = ml2 _ mlg sin (4.113)
2
@L @L d @L
= ml2 _ ; = mlg cos ; = ml2 (4.114)
@_ @ dt @_
x_ 1 = x2 (4.117)
g
x_ 2 = cos x1 (4.118)
ml2 l
97
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
x 1=posicin
x 2=velocidad
98
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
model
4
Posicin
-1
5
Velocidad Angular
4
-1
-2
-3
-4
-5
0 2 4 6 8 10
time {s}
99
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
Considere el robot manipulador planar de la gura 4.20, adems se consideran masas con-
centradas en los puntos extremos.
y
l2 m2
2
2
m1
l1
1 1
x1 y1
cos 1 = ) x1 = l1 cos 1 y sin 1 = ) y1 = l1 sin 1 (4.120)
l1 l1
!
Por lo que el vector r1 es:
!
r1 = (l1 cos 1) i + (l1 sin 1) j (4.121)
x2 y2
cos 2 = ) x2 = l2 cos 2 + x1 y sin 2 = ) y2 = l2 sin 2 + y1 (4.122)
l2 l2
!
Por lo que el vector r2 es:
!
r2 = (l1 cos 1 + l2 cos 2) i + (l1 sin 1 + l2 sin 2) j (4.123)
100
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
101
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
@L
= l12 _ 1 (m1 + m2 ) + l1 l2 m2 _ 2 cos ( 1 2) (4.133)
@ _1
@L
= m2 l22 _ 2 + l1 l2 m2 _ 1 cos ( 1 2) (4.134)
@ _2
@L
= l1 l2 m2 _ 1 _ 2 sin ( 1 2) l1 g cos 1 (m1 + m2 ) (4.135)
@ 1
@L
= l1 l2 m2 _ 1 _ 2 sin ( 1 2) l2 m2 g cos 2 (4.136)
@ 2
Ahora se resuelven las derivadas ordinarias de las ecuaciones (4.133) y (4.134):
d @L h 2
i
= l12 1 (m1 + m2 ) + l1 l2 m2 2 cos ( 1 2)
_ 1 _ 2 sin ( 1 2) + _ 2 sin ( 1 2) (4.137)
dt @ _1
d @L h i
= m2 l22 2 + l1 l2 m2 1 cos ( 1 2) + _ 1 _ 2 sin ( 1 2)
_ 21 sin ( 1 2) (4.138)
dt @ _2
Entonces, para obtener las ecuaciones del modelo matemtico Euler-Lagrange, de acuerdo a
la ecuacin (4.102) para la primera ecuacin se tiene que:
d @L @L
= 1 (4.139)
dt @ _ 1 @ 1
2 m2 l2 + 1 l1 l2 m2 cos ( 1 2)
_ 2 l1 l2 m2 sin ( 1 2) + l2 m2 g cos 2 = 2 (4.142)
2 1
102
Captulo 4. Modelado de Robots Manipuladores en Bond Graph
Escrito en la forma = M q + C q_ + G,
2 3 2 32 3
1 l12 (m1 + m2 ) l1 l2 m2 cos ( 1 2 )
4 5 = 4 54 1 5
2 l1 l2 m2 cos ( 1 2) m2 l2 2 2
2 32 3
0 _ 2 l1 l2 m2 sin ( 1 2)
_
+4 54 1 5
_ 1 l1 l2 m2 sin ( 1 2) 0 _2
2 3
l1 g (m1 + m2 ) cos 1
+4 5 (4.143)
l2 m2 g cos 2
Para comprobar que el modelo matemtico obtenido sea correcto se realizan las siguientes
pruebas:
Primera prueba M = M T :
2 3T 2 3
l12 (m1 + m2 ) l1 l2 m2 cos ( 1 2) l12 (m1 + m2 ) l1 l2 m2 cos ( 1 2)
4 5 =4 5 (4.144)
l1 l2 m2 cos ( 1 2) m2 l22 l1 l2 m2 cos ( 1 2) m2 l22
T
Segunda prueba M_ 2C = M_ 2C :
2 3
0 l1 l2 m2 sin ( 1 2)
_1 _2
M_ = 4 5 (4.145)
l1 l2 m2 sin ( 1 2)
_1 _2 0
Entonces:
2 3
0 _ 1 + _ 2 l1 l2 m2 sin ( 1 2)
M_ 2C = 4 5 (4.146)
_ 1 + _ 2 l1 l2 m2 sin ( 1 2) 0
T
M_ 2C = M_ 2C (4.148)
103
Captulo 5
5.1 Introduccin
donde: 2 3
1
0
f (x) = 4 Mx My mx my (4F Mx cos2
J
+F bx cos2 +4F My sin2 +F by sin2 )
5 (5.4)
J
C
2 3
0 0 0 0 0
g (x) = 4 5 (5.5)
J J J F by sin J (2F Mx cos + F bx cos ) J sin
= Mx My mx my (5.6)
105
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
1 2
3
R:Friccin de M x 31
1 V x1 1 V 1 V y1 1 R:Friccin de M y
4
8 5
7 6
F x1 0 0 F y1
11
R:Friccin de b x 12
10 C:C R:Friccin de b y
9 13
18 14
32 15 I:m
I:m x 1 d x1 MTF 1 d 1 d y1 1 y
23
:
MTF 19 16
S e:mg
I:J
22 17
21 25 20
f x1 0 0 f y1
24 26
v x1 1 1 v 1 1 v y1
28
0 F 1
29 27
Escaln 30
S f:v x MS e:f 1 S f:v y
106
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
Los estados son q18 que es la posicin angular del brazo ngulo , y p19 es el momento angular
en el mismo, e30 es la entrada para llevar el brazo a la posicin deseada y e16 es el efecto
debido a la fuerza de gravedad mg = 9 78 sm2 , adems los valores de e2 = f27 = f29 = 0:
Para simplicar, consideramos valores unitarios en todos los elementos, se obtiene el siguiente
sistema:
2 3
0
6 7
2 3 2 32 3 2 36
6 e30
7
7
f18 0 1 q18 0 0 0 0 0 6 7
4 5=4 54 5+4 56
6 0
7
7 (5.8)
e19 1 5
p19 1 1 1
sin 3
cos 1
sin 6 7
6 6 6 6 6 6 6 6 7
6 0 7
4 5
9 78
se observa que como p19 = 0 y q18 = , podemos expresar la ecuacin de la siguiente forma :
1 1
0 = e30 1 63 sin (5.10)
6 6
usando la ecuacin (5.11), si se desea que la posicin nal del brazo sea por ejemplo 45 =
107
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
model
Teta
Velocidad angular
27.41,0.78539968803205
0.5
-0.5
0 5 10 15 20 25 30 35
time {s}
108
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
Fuentes
u
xd Din
Almacenadores x Uniones Disipadores
z Dout
IyC zd 0,1,MTF, MGY R
x y
Detectores
D
109
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
Una forma ms directa de obtener el estado estable es usando el BGD (Bond Graph en
causalidad Derivativa), que es simplemente intercambiando la causalidades integrales por
derivativas, en este caso, la causalidad de los elementos J y C, el Bond Graph obtenido es el
de la gura 5.5.
Los vectores clave son:
2 3 2 3 2 3
p1 e1 f1 2 3
6 7 6 7 6 7 2 3 2 3 e2
6 7 6 7 6 7 6 7
6 p3 7 6 e3 7 6 f3 7 f e 6 7
6 7 6 7 6 7 6 4 7 6 4 7 6 e30 7
6 7 6 7 6 7 6 7 6 7 6 7
6 p15 7 6 e15 7 6 f 7 6 f 7 6 e 7
x=6 7 ; x_ = 6 7 ; z = 6 15 7 ; Din = 6 9 7 ; Dout = 6 9 7; u = 6
6 f27
7
7
6 7 6 7 6 7 6 7 6 7 6 7
6 q18 7 6 f18 7 6 e18 7 6 f14 7 6 e14 7 6 7
6 7 6 7 6 7 4 5 4 5 6 f29 7
6 7 6 7 6 7 4 5
6 p19 7 6 e19 7 6 f19 7 f31 e31
4 5 4 5 4 5 e16
p23 e23 f23
(5.13)
las relaciones constitutivas para los elementos son:
1 1 1 1 1 1
Din = Ld Dout ; Ld = Diag fF My ; F bx ; F by ; F Mx g ; Fd = Diag ; ; ; ; ; (5.14)
Mx My my C J mx
110
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
1 2
3
R:Friccin de M x 31
1 V x1 1 V 1 V y1 1 R:Friccin de M y
4
8 5
7 6
F x1 0 0 F y1
11
R:Friccin de b x 12
10 C:C R:Friccin de b y
9 13
18 14
32 15 I:m
I:m x 1 d x1 MTF 1 d 1 d y1 1 y
23
:
MTF 19 16
S e:mg
I:J
22 17
21 25 20
f x1 0 0 f y1
24 26
v x1 1 1 v 1 1 v y1
28
0 F 1
29 27
Escaln 30
S f:v x MS e:f 1 S f:v y
111
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
112
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
2 3
0 0 0 0
6 7
6 7
6 0 0 0 0 7
6 7
6 7
6 0 0 0 0 7
J12 =6
6
7
7 (5.23)
6 2 sin cos sin 2 cos 7
6 7
6 7
6 0 0 0 0 7
4 5
0 0 0 0
2 3
0 0 0 1 0
6 7
6 7
6 0 0 1 0 0 7
6 7
6 7
6 0 0 1 0 0 7
J13 =6
6
7
7 (5.24)
6 1 1 0 0 sin 7
6 7
6 7
6 0 0 0 0 0 7
4 5
0 0 0 1 0
2 3
0 0 0 2 sin 0 0
6 7
6 7
6 0 0 0 cos 0 0 7
J21 =6
6
7
7 (5.25)
6 0 0 0 sin 0 0 7
4 5
0 0 0 2 cos 0 0
J22 = 0 (5.26)
2 3
0 0 1 0 0
6 7
6 7
6 0 0 0 1 0 7
J23 =6
6
7
7 (5.27)
6 0 0 1 0 0 7
4 5
0 0 0 1 0
para obtener la representacin de estados de esta clase de sistemas nolineales a partir del
Bond Graph en causalidad Derivativa tenemos que:
donde:
113
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
114
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
considerando valores unitarios en todos los elementos como en el caso del BGI, y adems los
valores de e2 = f27 = f29 = 0: se obtiene lo siguiente:
2 3 2 3
p1 0
6 7 6 7
6 7 6 7
6 p3 7 6 0 7
6 7 6 7
6 7 6 7
6 p15 7 6 0 7
6 7 =6 7 (5.42)
6 7 6 7
6 q18 7 6 C (e30ss + e16ss sin ) 7
6 7 6 7
6 7 6 7
6 p19 7 6 0 7
4 5 4 5
p23 0
ss
de la ecuacin (5.42) se observa que el nico estado diferente de cero en estado estacionario
es:
q18 = C (e30 + e16 sin ) (5.43)
como q18 es la posicin angular del brazo ngulo , e30 es la entrada para llevar el brazo a
la posicin deseada y e16 es el efecto debido a la fuerza de gravedad mg = 9 78 sm2 :
e30 = + 9 78 sin
115
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
R:Friccin M x 9 4
1 1 1 R:Friccin M y
8 5
6
0 Fx2 7 0 Fy2
11
10
R:Friccin b 2x C:C 2
R:Friccin b 2y
13
18 14
25
I:m 2x 1 dx2 MTF 59
1 d2 dy2 1 15 I:m 2y
24
MTF2 19 16
S e:m 2g
I:J2 17
23 21
22 20
fx2 0 0 fy2
26 27
1 vx2 1 v2 1 vy2
29
MS e:f 2 31
0 F2 30
28
32
1 1 V1 1
35 Escalon2 33
42
0 Fx1 0 Fy1
37 34
36
C:C 1 R:Friccin b 1y
R:Friccin b 1x 43
38 48 44
I:m 1x 39
1 dx1 MTF 58
1 d1 dy1 1 45 I:m 1y
MFT1 49
46
I:J1 S e:m 1g
40 47
52 50 51
fx1 0 0 fy1
54 53
1 vx1 1 v1 1 vy1
55 56 57
e58 = cos 1 e52 + cos 1 e37 sin 1 e51 sin 1 e42 (5.52)
para el M T F 2 :
117
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
donde:
2 3
0 0 0 2 cos 2 0 0 0 0 2 cos 1 0
6 7
6 7
6 0 0 0 2 sin 2 0 0 0 0 2 sin 1 0 7
6 7
6 7
6 0 0 0 sin 2 0 0 0 0 2 sin 1 0 7
6 7
6 7
6 2 cos 2 2 sin 2 sin 2 0 1 cos 2 0 0 0 0 7
6 7
6 7
6 0 0 0 1 0 0 0 0 0 0 7
J11 =6
6
7
7
6 0 0 cos 2 0 0 0 0 0 2 cos 1 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 cos 1 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 sin 1 0 7
6 7
6 7
6 2 cos 1 2 sin 1 2 sin 1 0 0 2 cos 1 cos 1 sin 1 0 1 7
4 5
0 0 0 0 0 0 0 0 1 0
(5.59)
2 3
0 0 0 0 0 0
6 7
6 7
6 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 7
6 7
6 7
6 2 sin 2 2 cos 2 sin 2 cos 2 0 0 7
6 7
6 7
6 0 0 0 0 0 0 7
J12 =6
6
7
7 (5.60)
6 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 7
6 7
6 7
6 2 sin 1 2 cos 1 2 sin 1 2 cos 1 cos 1 sin 1 7
4 5
0 0 0 0 0 0
118
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
2 3
0 0 0 0 1 0 0
6 7
6 7
6 0 0 0 0 0 0 1 7
6 7
6 7
6 0 0 0 0 0 0 1 7
6 7
6 7
6 1 sin 2 1 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 7
J13 =6
6
7
7 (5.61)
6 0 0 0 0 1 0 0 7
6 7
6 7
6 0 0 0 0 1 0 0 7
6 7
6 7
6 0 0 0 0 0 0 1 7
6 7
6 7
6 0 2 sin 1 1 sin 1 0 1 0 7
4 5
0 0 0 0 0 0 0
2 3
0 0 0 2 sin 2 0 0 0 0 2 sin 1 0
6 7
6 7
6 0 0 0 2 cos 2 0 0 0 0 2 cos 1 0 7
6 7
6 7
6 0 0 0 sin 2 0 0 0 0 2 sin 1 0 7
J21 =6
6
7
7 (5.62)
6 0 0 cos 2 0 0 0 0 0 2 cos 1 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 cos 1 0 7
4 5
0 0 0 0 0 0 0 0 sin 1 0
J22 = 0 (5.63)
2 3
0 0 0 0 0 0 1
6 7
6 7
6 0 0 0 0 1 0 0 7
6 7
6 7
6 0 0 0 0 0 0 1 7
J23 =6
6
7
7 (5.64)
6 0 0 0 0 1 0 0 7
6 7
6 7
6 0 0 0 0 1 0 0 7
4 5
0 0 0 0 0 0 1
se obtiene la representacin en espacio de estados de la misma manera que se hace para el
caso de un eslabn. Considerando valores unitarios para todos los elementos (para simplicar
los clculos).
0 1 1
119
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
entonces, de acuerdo con la ecuacin xss = Fd 1 g (x) uss , sustituyendo g (x) se obtienen los
estados en estado estacionario:
2 3 2 3
p1 0
6 7 6 7
6 7 6 7
6 p3 7 6 0 7
6 7 6 7
6 7 6 7
6 p15 7 6 0 7
6 7 6 7
6 7 6 7
6 q18 7 6 e31 9 78 sin 2 7
6 7 6 7
6 7 6 7
6 p19 7 6 0 7
6 7 =6 7 (5.68)
6 7 6 7
6 p24 7 6 0 7
6 7 6 7
6 7 6 7
6 p39 7 6 0 7
6 7 6 7
6 7 6 7
6 p45 7 6 0 7
6 7 6 7
6 7 6 7
6 q48 7 6 e48 e31 29 34 sin 1 7
4 5 4 5
p49 0
ss
de la ecuacin (5.68) se observa que los nicos estados diferentes de cero en estado estable
son:
como q18 = 2 y q56 = 1 y las fuentes de esfuerzo de control para los brazos son e31 y e56 ;
sustituyendo y despejando se obtienen las siguientes expresiones:
120
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
usando las ecuaciones (5.71) y (5.72), si se desea que la posicin nal del brazo sea por
ejemplo 1 = 30 = 6 = 0 52359rad y 2 = 45 = 4 rad = 0 78539rad, se sustituyen los
valores de los ngulos para determinar los esfuerzos necesarios para alcanzar dicha posicin
en estado estacionario:
simulando el robot manipulador en 20-sim con las entradas calculadas se obtiene la grca de
la gura 5.7 donde se puede observar que las velocidades angulares en estado estacionario se
van a cero y el resultado en estado estacionario para los ngulos es prcticamente el mismo
que se deseaba obtener.
model
Teta 1
Teta 2
Velocidad angular 1
Velocidad angular 2
34.73,0.78530018457063
34.73,0.52360335097492
0.5
-0.5
0 5 10 15 20 25 30 35
time {s}
Figura 5.7: Simulacin del robot manipulador de dos eslabones en 20-sim para 1 = 30 y
2 = 45 .
Analizando otro caso, por ejemplo si se desea que la posicin nal del brazo sea ahora 1 =
121
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
simulando el robot manipulador en 20-sim con las entradas calculadas se obtiene la grca de
la gura 5.8 donde se puede observar que las velocidades angulares en estado estacionario se
van a cero y el resultados en estado estacionario para los ngulos es prcticamente el mismo
que se encontr de manera analtica.
model
1.5
Teta 1
Teta 2
Velocidad angular 1
Velocidad angular 2
1
30.00,0.87262510483738
0.5
30.00,0.34909710388679
-0.5
-1
0 5 10 15 20 25 30
time {s}
Figura 5.8: Simulacin del robot manipulador de dos eslabones en 20-sim para 1 = 50 y
2 = 20 .
122
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
Din = Ld Dout ; Ld = Diag fF My ; F Mx ; F b3y ; F b3x ; F b2x ; F b2y ; F b1x ; F b1y ; g (5.83)
1 1 1 1 1 1 1 1 1 1 1 1 1 1
Fd = Diag ; ; ; ; ; ; ; ; ; ; ; ; ; (5.84)
Mx My m3y C3 J3 m3x m2x m2y C2 J2 m1x m1y C1 J1
Las relaciones entrada-salida de los transformadores modulados son las siguientes ecuaciones:
para el M T F 1:
e80 = cos 1 e68 + cos 1 e63 sin 1 e75 sin 1 e69 (5.89)
123
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
R:Friccin M x 9 1 V3 1 Vy3 1 4
R:Friccin M y
8 5
6
Fx3 0 7 0 Fy3
11
10
R:Friccin b 3x C:C 3
12
R:Friccin b 3y
13
21 18
I:m 3x 1 dx3 MTF 20
1 d3 dy3 1 14
I:m 3y
22
MTF3 19 15
17
I:J 3 S e:m 3g
23 16
24
25
fx3 0 0 fy3
26 27
vx3 1 v3 1 1 vy3
29
MS e:f 3 31
0 F3
28 30
32
1 1 1
Escalon3
33 35
36
Fx2 0 34
0 Fy2
37
38
R:Friccin b 2x C:C 2
43
R:Friccin b 2y
44
39 48
I:m 2x 1 dx2 MTF 50
1 d2 dy2 1 45
I:m 2y
40
MTF2 49 46
52
I:J2 S e:m 2g
41 47
42
51
fx2 0 0 fy2
53 54
vx2 1 v2 1 1 vy2
56
MS e:f 2 58
0 F2
55 57
59
1 1 V1 1
Escalon2
60 62
69
Fx1 0 61
0 Fy1
63
64
fx1 0 75
0 fy1
77 83
1 vx1 v1 1 1 vy1
82 84
81
para el M T F 2 :
e50 = cos 2 e42 + cos 2 e37 sin 2 e51 sin 2 e36 (5.94)
para el M T F 3 :
donde:
2 3
0 0 0 2 cos 3 0 0 0 0 2 cos 2 0 0 0 2 cos 1 0
6 7
6 0 0 0 2 sin 3 0 0 0 0 2 sin 2 0 0 0 2 sin 1 0 7
6 7
6 7
6 0 0 0 sin 3 0 0 0 0 2 sin 2 0 0 0 2 sin 1 0 7
6 7
6 7
6 2 cos 3 2 sin 3 sin 3 0 1 cos 3 0 0 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 1 0 0 0 0 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 cos 3 0 0 0 0 2 cos 2 0 0 0 2 cos 1 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 cos 2 0 0 0 2 cos 1 0 7
6
J11 = 6 7
7
6 0 0 0 0 0 0 0 0 sin 2 0 0 0 2 sin 1 0 7
6 7
6 7
6 2 cos 2 2 sin 2 2 sin 2 0 0 2 cos 2 cos 2 sin 2 0 1 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 1 0 0 0 0 0 7
6 7
6 0 0 0 0 0 0 0 0 0 0 0 0 cos 1 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 0 0 0 0 sin 1 0 7
6 7
6 7
6 2 cos 2 sin 1 2 sin 1 0 0 2 cos 1 2 cos 1 2 sin 1 0 0 cos 1 sin 1 0 1 7
4 1 5
0 0 0 0 0 0 0 0 0 0 0 0 1 0
(5 .1 0 1 )
125
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
2 3
0 0 0 0 0 0 0 0
6 7
6 0 0 0 0 0 0 0 0 7
6 7
6 7
6 7
6 0 0 0 0 0 0 0 0 7
6 7
6 7
6 2 sin 3 2 cos 3 sin 3 cos 3 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 7
J12 =6
6
7
7 (5.102)
6 0 0 0 0 0 0 0 0 7
6 7
6 7
6 2 sin 2 2 cos 2 2 sin 2 2 cos 2 cos 2 sin 2 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 7
6 7
6 7
6 2 sin 2 cos 2 sin 2 sin 2 cos 2 sin cos sin 7
4 1 1 1 1 1 1 1 1 5
0 0 0 0 0 0 0 0
2 3
0 0 0 0 0 0 1 0 0
6 7
6 0 0 0 0 0 0 0 0 1 7
6 7
6 7
6 7
6 0 0 0 0 0 0 0 0 1 7
6 7
6 7
6 1 sin 3 1 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 1 0 0 7
6 7
6 7
6 0 0 0 0 0 0 1 0 0 7
J13 =6
6
7
7 (5.103)
6 0 0 0 0 0 0 0 0 1 7
6 7
6 7
6 0 2 sin 2 1 sin 2 1 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 0 7
6 7
6 7
6 0 0 0 0 0 0 1 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 1 7
6 7
6 7
6 0 2 sin 0 2 sin 1 sin 0 1 0 7
4 1 1 1 5
0 0 0 0 0 0 0 0 0
126
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
2 3
0 0 0 2 sin 3 0 0 0 0 2 sin 2 0 0 0 2 sin 1 0
6 7
6 7
6 0 0 0 2 cos 3 0 0 0 0 2 cos 2 0 0 0 2 cos 1 0 7
6 7
6 7
6 0 0 0 sin 3 0 0 0 0 2 sin 2 0 0 0 2 sin 1 0 7
6 7
6 7
6 0 0 0 cos 3 0 0 0 0 2 cos 2 0 0 0 2 cos 1 0 7
J21 =6
6
7
7 (5.104)
6 0 0 0 0 0 0 0 0 cos 2 0 0 0 2 cos 1 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 sin 2 0 0 0 2 sin 1 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 0 0 0 0 cos 1 0 7
4 5
0 0 0 0 0 0 0 0 0 0 0 0 sin 1 0
J22 = 0 (5.105)
2 3
0 0 0 0 0 0 0 0 1
6 7
6 7
6 0 0 0 0 0 0 1 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 1 7
6 7
6 7
6 0 0 0 0 0 0 1 0 0 7
J23 =6
6
7
7 (5.106)
6 0 0 0 0 0 0 1 0 0 7
6 7
6 7
6 0 0 0 0 0 0 0 0 1 7
6 7
6 7
6 0 0 0 0 0 0 1 0 0 7
4 5
0 0 0 0 0 0 0 0 1
se obtiene la representacin en espacio de estados de la misma manera que se hace para el
caso de un eslabn. Considerando valores unitarios para todos los elementos (para simplicar
los clculos).
0 1 1
127
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
Entonces, de acuerdo con ecuacin xss = Fd 1 g (x) uss , sustituyendo g (x) se obtienen los
estados en estado estacionario:
2 3 2 3
p1 0
6 7 6 7
6 p3 7 6 0 7
6 7 6 7
6 7 6 7
6 p14 7 6 0 7
6 7 6 7
6 7 6 7
6 q18 7 6 e31 9 78 sin 7
6 7 6 3 7
6 7 6 7
6 p19 7 6 0 7
6 7 6 7
6 7 6 7
6 p22 7 6 0 7
6 7 6 7
6 7 6 7
6 p40 7 6 0 7
6 7 6 7
6 7=6 7 (5.110)
6 p45 7 6 0 7
6 7 6 7
6 7 6 7
6 q48 7 6 e58 e31 29 34 sin 7
6 7 6 2 7
6 7 6 7
6 p49 7 6 0 7
6 7 6 7
6 7 6 7
6 p66 7 6 0 7
6 7 6 7
6 7 6 7
6 p72 7 6 0 7
6 7 6 7
6 7 6 7
6 q78 7 6 e82 e58 48 9 sin 1
7
4 5 4 5
p79 0
de la ecuacin 5.110 se observa que los nicos estados diferentes de cero en estado estacionario
son:
128
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
como q18 = 3; q48 = 2 y q78 = 1 y las fuentes de esfuerzo de control para los brazos son
e31 ; e58 y e82 ; sustituyendo y despejando se obtienen las siguientes expresiones:
usando las ecuaciones (5.114), (5.115) y (5.116), si se desea que la posicin nal del brazo
sea por ejemplo 1 = 15 = 0 2617rad , 2 = 20 = 0 349rad y 3 = 30 = 0 5236rad, se
sustituyen los valores de los ngulos para determinar los esfuerzos necesarios para alcanzar
dicha posicin en estado estacionario:
simulando el robot manipulador en 20-sim con las entradas calculadas se obtiene la grca de
la gura 5.10 donde se puede observar que las velocidades angulares en estado estacionario se
van a cero y el resultados en estado estacionario para los ngulos es prcticamente el mismo
que se obtuvo de manera analtica.
Analizando otro caso, por ejemplo si se desea que la posicin nal del brazo sea ahora 1 =
35 = 0 6108rad, 2 = 50 = 0 8726rad y 3 = 45 = 0 7853rad, se sustituyen los valores de
los ngulos para determinar los esfuerzos necesarios para alcanzar dicha posicin en estado
estacionario en las ecuaciones (5.114), (5.115) y (5.116), se obtiene:
simulando el robot manipulador en 20-sim con las entradas calculadas se obtiene la grca de
la gura 5.11 donde se puede observar que las velocidades angulares en estado estacionario se
129
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
model
0.8
Teta1
Velocidad Angular 1
Teta2
Velocidad Angular 2
Teta3
Velocidad Angular 3
0.6
24.90,0.52364711640479
0.4
24.90,0.34882727133158
24.90,0.26179355219251
0.2
0 5 10 15 20 25
time {s}
Figura 5.10: Simulacin del robot manipulador de tres eslabones en 20-sim para 1 = 15 ,
2 = 20 y 3 = 30 .
130
Captulo 5. El Estado Estacionario de un Robot Manipulador en Bond Graph
van a cero y el resultados en estado estacionario para los ngulos es prcticamente el mismo
que se obtuvo de manera analtica.
model
1.5
Teta1
Velocidad Angular 1
Teta2
Velocidad Angular 2
Teta3
Velocidad Angular 3
1
34.99,0.87259044119329
34.99,0.78537666704601
34.99,0.61070219528785
0.5
-0.5
-1
0 5 10 15 20 25 30 35
time {s}
Figura 5.11: Simulacin del robot manipulador de tres eslabones en 20-sim para 1 = 35 ,
2 = 50 y 3 = 45 .
131
Captulo 6
6.1 Conclusiones
R
en la simulacin del modelo mediante programas de simulacin como el 20-sim El proced-
imiento propuesto est basado principalmente en el procedimiento de Gawtrhop haciendo uso
de los transformadores modulados multipuerto propuestos por Karnopp, adems de agregar
las perdidas por rozamiento debido a las fricciones.
133
Apndice A
Un bond graph entrega una representacin de un sistema de libre causalidad en el que, a pesar
de que esto implica restricciones en las posibles causalidades de los componentes del sistema;
no especica cual de las posibles causalidades puede ser utilizada. Esta exibilidad puede ser
usada para dar representaciones causales alternativas del mismo sistema; la seleccin entre
estas alternativas depende del uso de la representacin que se realizar. En este contexto
(robtica) hay tres consideraciones fundamentales para esta seleccin:
M ( ) + V ; _ + G( ) = (A.1)
2. Es natural pensar en las variables de estado del sistema en trminos de velocidades del
motor y posiciones; en el caso rgido, este estado determina la posicin y velocidad de
cada eslabn del mecanismo.
3. Desde el punto de vista del control, es agradable ver el sistema como un conjunto
ordenado de sensores y actuadores: las velocidades ngulares y pares del motor.
Considerar un conjunto de motores lineales vistos como fuentes de torque ideales manejando
una inercia. Dada la discusin anterior, cada motor tiene dos estados asociados con l: el
motor i -simo tiene un estado que comprende el ngulo i y la velocidad ngular _ i . Sin
embargo, Desde el punto de vista de modelado sistemtico del sistema, los estados deberan
ser variables de esfuerzo integrado o el ujo integrado. Por lo tanto, un estado alternativo
consiste de un ngulo i (ujo integrado) y un momento ngular hi = ii _ i (esfuerzo integrado).
La gura A.1 proporciona un bond graph de tres motores desacoplados ideales conectados a
las fuentes de par que estn manejando una inercia. Los elementos C sunimistran los ngulos
de cada motor como un estado, como ellos tienen cero rgidez no afectan a la dinmica.
donde:
id1 , id2 e id3 son las inercias del motor: estados h1 , h2 y h3 (componentes de inercia).
135
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
1 1 1
h_ = T (A.2)
_ = Im1 h (A.3)
Considerar el manipulador de la gura A.2 con una unin prismtica simple (con parmetro
136
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
vy vx
3
2=Constante
La fuente Sg maneja a una masa ig con una aceleracin de g. Esta aceleracin es transfor-
mada a las coordenadas x y y por los dos transformadores tgx (con ganancia sin 2) y tgy
(con ganancia cos ). El acoplamiento es por medio de seales o bonds activos, asi que la
aceleracin de la masa no es afectada por el resto del sistema.
137
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
vy 1 I:m y I:m x 1 vx
I:i 3
dt3
0 fy fx 0 1 S e:S 3
C:C 3
1 vgy 1 vgx
TF TF
:
:
tgy tgx
S e:S g 1 I:i g
vg
138
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
z y
Fy
Fz
z
Z y
z y
vy
vz m, Jx, Jy, Jz
vx
x
X x
Fx
x
En el instante mostrado, el cuerpo tiene una velocidad absoluta v y una velocidad angu-
lar absoluta !. Newton estableci que la fuerza neta F actuando en el cuerpo cambia su
momento:
dp
F= (A.4)
dx
donde:
p = mv (A.5)
@p
F= +! p (A.6)
@t rel
@p
donde @t rel , indica la relacin de cambio del momento relativo al marco de referencia en
movimiento. Una ley de momento angular puede ser deducida si el par neto que acta en el
cuerpo y el momento angular h son evaluados con respecto a punto jo, si existe uno para
139
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
h = J! (A.8)
En la cual J es una matriz diagonal de los momentos principales de inercia, Jx , Jy, Jz . Para
h expresado con respecto al marco de referencia en rotacin.
@h
= +! h (A.9)
@t rel
Fx = mv_ x + m! y vz m! z vz
Fy = mv_ y + m! y vx m! x vz (A.10)
Fz = mv_ z + m! x vy m! y vx
y
x = Jx !_ x + ! y Jz ! z ! z Jy ! z
y = Jy !_ y + ! z Jx ! x ! x Jz ! z (A.11)
z = Jz !_ z + ! x Jy ! y ! y Jx ! x
Estas ecuaciones diferenciales son conocidas como Ecuaciones de Euler. Estas ecuaciones no
tienen solucin general y solamente pueden ser resueltas analticamente para algunos casos
especiales.
Si estas ecuaciones fueran resueltas, entonces se conocera vx , vy , vz , ! x , ! y , ! z , con respecto
a un marco de referencia que estara apuntando en una direccin diferente en todo instante,
lo cual hace la interpretacin del movimiento del cuerpo un poco ms difcil. Adems, las
componentes de fuerza y par deben estar alineadas con las coordenadas jas al cuerpo para
poder utilizar de manera correcta estas ecuaciones. Esto nunca ocurrira naturalmente, as,
la utilidad de estas ecuaciones es cuestionable en esta etapa de desarrollo. Un Bond Graph
de las ecuaciones de Euler se muestran en la gura A.5.
140
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
I:m I:Jx
px pJx
Fx v x x
mz
1 x my
Jzz
1 Jyy
y
Fy vy v Fz y z
1 MGY 1 1 MGY 1
py pz p pJz
Jy
A partir de que es improbable que las fuerzas externas y pares estn alineados de forma
conveniente con las direcciones principales que estn cambiando constantemente, y a partir
de que es difcil interpretar el movimiento del cuerpo con respecto a las coordenadas del
cuerpo jo, es necesario transferir a otros marcos de referencia ms convenientes a partir de
las coordenadas del cuerpo jo, esto, a travs de una serie de transformaciones de coordenadas
a las coordenadas inerciales, la gura A.6 muestra un marco de referencia inercial (X, Y, Z )
una orientacin del cuerpo jo (x, y, z), y dos marcos de referencia intermedios (x , y, z y
x , y, z ).
El marco de referencia del cuerpo se obtiene primero girando sobre el eje Z a travs de
un ngulo (desviacin) produciendo el marco de referencia x , y, z . A continuacin,
se gira sobre el eje y a travs de un ngulo (elevacin) produciendo los ejes x , y, z .
Finalmente, se gira sobre el eje x a travs de un ngulo (giro) produciendo el marco de
referencia instantneo del cuerpo jo (el marco de referencia est jo al cuerpo instantneo)
x, y, z.
Ahora, se asume que las velocidades angulares del cuerpo jo ! x , ! y , ! z son conocidas y se
escriben las componentes de velocidad angular en los marcos de referencia intermediarios y
141
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
Z
z
z
y
z
y , y
y
Y
x
X
,x
x
142
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
! x = ! x
! y = ! y cos ! z sin
! z = ! y sin + ! z cos
! x = ! x cos + ! z sin
! y = ! y (A.12)
! z = ! x sin + ! z cos
! X = ! xcos ! ysin
! Y = ! xsin + ! ycos
! Z = ! z
143
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
entonces: 2 3 2 3 2 3 2 3
!X !x vX vx
6 7 6 7 6 7 6 7
6 7 6 7 6 7 6 7
6 !Y 7= 6 !y 7 ; 6 vY 7= 6 vy 7 (A.15)
4 5 4 5 4 5 4 5
!Z !z vZ vz
la relacin entre fuerzas y pares es:
2 3 2 3 2 3 2 3
Fx F x
6 7 6 X 7 6 7 6 X
7
6 7 t6 7 6 7 6 7
6 Fy 7 = ( ) 6 FY 7 ; 6 y 7=( )t 6 Y 7 (A.16)
4 5 4 5 4 5 4 5
Fz FZ z v Z
marco de referencia
Fx vx Fy vy Fz vz x x y y z z
fijo del cuerpo
MTF MTF
Fx vx Fy vy Fz vz x x y y z z
MTF MTF
Fx vx Fy vy Fz vz x x y y z z
MTF MTF
marco de referencia
FX vX FY vY FZ vZ X X Y Y Z Z
inercial
Se debe notar que los ngulos , , son requeridos para representar las transformaciones
de coordenadas. Es relativamente simple relacionar _ , _ , _ a las componentes del cuerpo jo
! x , ! y y ! z . A partir de la gura A.6.
!x = _ _ sin
144
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
Resolviendo para _ y _ :
_ = ! y cos ! z sin
(A.18)
_ = ! y sin + ! z cos
cos cos
entonces:
_ = ! x + ! y sin sin + ! z cos sin (A.19)
cos cos
Estas tres ecuaciones de estado adicionales deben ser integradas junto con las otras, de tal
manera que , y esten siempre disponibles como variables modulantes.
La versin ms simple de las ecuaciones de Euler ocurre cuando el movimiento del cuerpo
rgido se realiza sobre un punto jo, este caso simple puede ser representado por el Bond
Graph de la gura A.8.
Se:sy
1 wy
I:iy
MGY:gz MGY:gx
I:ix I:iz
wx w
1 MGY 1
:
gy
Se:sx Se:sz
donde:
145
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
Sf:sy
1 wy
I:iy
MGY:gz MGY:gx
I:ix I:iz
wx w
1 MGY 1
:
gy
Sf:sx Se:sz
h iT
Las entradas ahora son: u = !x !y z y se tiene una sola ecuacin diferencial lineal-
mente independiente (los elementos I marcados como ix e iy tienen causalidad derivativa).
El caso ms complejo ocurre cuando el movimiento se considera con respecto al centro de
masa. El bond graph resultante es el que se muestra en la gura A.10.
146
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
Sf:Wy Sf:Vy
1 wy 1 vy
I:iy I:my
MGY:gz MGY:gx GY:gz GY:gx
:
gy gy
Figura A.10: Bond Graph del anillo de Euler, movimiento rotacional y traslacional.
147
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
! x = ! 1 sin 2 (A.20)
! y = ! 1 cos 2 (A.21)
dt2
S e:S 2 1 1 w2
C:C 2
1 wz
I:i z
MGY: gy MGY: gx
I:i x I:i y
wx 1 MGY 1 wy
:
gz
MTF: tx ty
I:i
I:i 1
dt1
S e:S 1 1 1 w1
C:C 1
Figura A.12: Bond Graph del robot PUMA de dos grados de libertad.
148
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
donde:
i1 y i2 son las inercias de los eslabones 1 y 2 respectivamente, y w1 y w2 son las velocidades
angulares.
Una aproximacin a un robot PUMA de tres grados de libertad aparece en la gura A.13,
y el Bond Graph correspondiente se muestra en la gura A.14. La parte baja del diagrama
es similar al de la gura A.12 (pero sin la unin prismtica), la parte superior contiene la
estructura doble de anillo de Euler.
149
Apndice A. Movimiento en Tres Dimensiones en Bond Graph
w z3 v y32 v x32
1 TF 1 GY 1
:
t cy3
:
g vz3
I:m y3 I:m x3
I:i z3
MGY: g y3 MGY: g x3
GY:g vx3 I:m z3 GY:g vy3
I:i x3 I:i y3 0 f y3
w x3 1 MGY 1 w y3
1 w z33 : 1 v z32
g z3
I:id 3 0 f x3
TF 0 f z3
:
MS e:S 3 1 0 t z23 t cz3
dt 3
t
0 x23
C:C 3 0 t y23
TF:t vyy TF: t vyx TF:t vxy TF:t vxx
TF 0 f y23 TF 0 f z23
:
:
t ty2 t tz2
v y2 1 GY 1 v x2
:
I:id2 g vz2
I:m y2 I:m x2
w z2
MS e:S 2 1 1 TF 0 f y2
GY:g vx2 GY:g vy2
:
dt 2 t cy2
MSf MSf2
I:i y2 1 v gx
I:i x2
1 v gy I:m z2
w x2 1 MGY 1 TF
w y2
:
:
g z2 t cz2
TF:t x2 TF:t y2 TF:t gy TF:t gx
I:id1 I:i 1
C:C 1
Figura A.14: Bond Graph del robot PUMA de tres grados de libertad.
150
Apndice B
Artculo Publicado
En el presente apndice se presenta el artculo derivado del presente trabajo, aceptado para su
publicacin en la 14 th IEEE International Conference on Methods and Models in Automation
and Robotics que se llevar a cabo del 19 al 21 de agosto del presente ao. en la ciudad de
Miedzyzdroje, polonia.
Bibliografa
[Zeid, 1992] Ashaf Zeid, Chin-Huang Chung (1992), Bond Graph Modeling of
Multibody System: a librery of Three-dimensional Joints, Journal
of the Franklin Institute, Vol. 329, No. 4, pp. 605-636.
[Xia, 2007] Xia X. and Jiangfeng Zhang (2007) Steady States of Nonlinear Sys-
tems, Proceedings of IEEE international Conference on control and
Automation, pp. 1525-1530, Guangzhou, China.
[Thoma, 2006] J. Thoma and G. Mocellin (2006), Simulation with Entropy in En-
gineering Thermodynamics, Springer.
[Dauphin-Tanguy, 2000] Dauphin-Tanguy Genevive (2000), et al., Les Bond Graphs, Her-
mes Science Publications, France.
159
Bibliografa
160