Sincronización y Control de Sistemas Lineales y no Lineales

15vo CONGRESO NACIONAL DE INGENIERÍA
ELECTROMECÁNICA Y DE SISTEMAS (CNIES 2015)
ARTÍCULO No. SIS03
ARTÍCULO ACEPTADO POR REFEREO
Sincronización y Control de Sistemas Lineales y
no Lineales
J. Martinez Martinez, S.A. Rodríguez Paredes, J. de León Morales, J. G. Alonso Alfaro, A. Roldan
Caballero

I. INTRODUCCIÓN
Resumen— Este artículo presenta un análisis del problema de
Sincronización maestro- esclavo de Sistemas Lineales y Sistemas
no Lineales con características homogéneas. Se selecciona como
Sistema Lineal un sistema multicompuesto masa-resorte y como
Sistema no Lineal un sistema cooperativo de robots
manipuladores. A nivel simulación se prueban estrategias de
control para seguimiento de trayectoria y de sincronización que
permitan a un sistema esclavo sincronizarse con las trayectorias
de un sistema maestro. Para el problema de sincronización de
Sistemas Lineales se plantea una estrategia de control de
seguimiento de trayectoria por medio de retroalimentación
estática del vector de estados. Por otro lado para el caso de
Sistemas no Lineales la estrategia de control para seguimiento de
trayectoria es analizada con un enfoque energético
específicamente por el método de pasividad. En ambos casos se
realiza una estimación de estados por medio de observadores.
E
n muchos sistemas de la naturaleza y sistemas creados por
el hombre la sincronización es un fenómeno natural, un
ejemplo conocido es la sincronización observada entre la
rotación y el movimiento orbital de la luna, de tal manera que
siempre le da la misma cara a la tierra. El problema es que la
sincronización no siempre se da de esa manera natural en todos
los sistemas, de ahí que resulta de interés estudiar la posibilidad
de forzar a los sistemas a sincronizarse, acoplando otro sistema
o agregando las conexiones necesarias para lograr esta
sincronización. A este proceso de lograr una sincronización
forzada le llamaremos sincronización controlada [1].
La sincronización controlada se ha vuelto un tópico importante
en los últimos años debido a su aplicación en teleoperación,
procesos de manufactura, sistemas trabajando en esquemas
coordinados, tareas de ensamble, sistemas multi-robot, etc. El
comportamiento
colaborativo
ofrece
flexibilidad
y
maniobrabilidad que difícilmente puede obtenerse con un
sistema individual. Un campo importante dentro del tema de la
sincronización, es la sincronización de sistemas robóticos [1],
[2], [3], [4].
Existen otros trabajos realizados sobre sincronización de
sistemas dinámicos caóticos o complejos, por ejemplo los
abordados en [5], [6], [7], [8], donde se estudia la
sincronización de sistemas caóticos como sistemas de Lorenz,
Jerk y osciladores de Van der Pool.
En este trabajo se presenta un enfoque de sincronización
maestro- esclavo, para sistemas conformados por subsistemas
con características homogéneas en el cual se presentan
estrategias de control, probadas analíticamente y validadas a
nivel simulación para la sincronización de sistemas dinámicos
lineales y sistemas dinámicos no lineales. Algunos ejemplos de
sistemas lineales son sistemas masa-resorte. Por otro lado el
sistema dinámico no lineal abordado en este artículo está
conformado por 2 manipuladores robóticos de 2 grados de
libertad el cual uno funge como maestro y otro como esclavo.
Palabras Clave— Sincronización, Sistemas Lineales, Sistemas
no Lineales, pasividad, observadores.
Abstract—This paper presents an analysis of the problem of
master-slave synchronization of linear and nonlinear systems with
similar characteristics. A mass-spring multicomponent system is
selected as a Linear System and a cooperative system of robot
manipulators as a Nonlinear System. A level simulation tracking
control strategies and synchronization are tested to enable a slave
system synchronized with the trajectories of a master system. For
the problem of synchronization of linear systems a tracking
control strategy is implemented through static state vector
feedback. In addition to the case of nonlinear systems a tracking
control strategy is analyzing with an energy focus specifically by
the method of passivity. In both cases, state estimation is
performed by observers.
Keywords— Synchronization,
systems, passivity, observers.
linear
systems,
nonlinear
Jesús Martínez estudiante del Instituto Politécnico Nacional/SEPI ESIME,
Unidad Azcapotzalco, Distrito Federal, México. E-mail: [email protected]
Salvador A. Rodríguez adscrito al Instituto Politécnico Nacional/SEPI
ESIME, Unidad Azcapotzalco, Distrito Federal, México. E-mail:
[email protected]
Jesús de León Morales adscrito a la Universidad Autónoma de Nuevo
León/FIME, Ciudad Universitaria, San Nicolás de Los Garza, Nuevo León,
México. E-mail: [email protected]
México D.F., 19 al 23 de octubre 2015
Jorge Alonso estudiante del Instituto Politécnico Nacional/SEPI ESIME,
Unidad
Azcapotzalco,
Distrito
Federal,
México.
E-mail:
[email protected]
Alfredo Roldán estudiante del Instituto Politécnico Nacional/SEPI ESIME,
Unidad
Azcapotzalco,
Distrito
Federal,
México.
E-mail:
[email protected]
1
15vo CONGRESO NACIONAL DE INGENIERÍA
ELECTROMECÁNICA Y DE SISTEMAS (CNIES 2015)
ARTÍCULO No. SIS03
ARTÍCULO ACEPTADO POR REFEREO
El problema de la sincronización parece ser una sencilla
extensión de los controladores de seguimiento clásicos, sin
embargo, implica retos que no se consideran en el diseño de
estos. En la sincronización de sistemas dinámicos existen varios
problemas fundamentales, no tener acceso al vector completo
de estados, la influencia de perturbaciones externas sobre los
sistemas, no contar con modelos exactos de los sistemas, tener
un gran número de sistemas a sincronizar, como están
conectados entre ellos, y encontrar la ley de control que se
encargue de llevar a todos estos sistemas a la sincronización [9],
[10], [11]. El problema de no tener acceso completo al vector
de estados se debe a que, en la actualidad los sistemas no
cuentan normalmente con sensores de velocidad o de
aceleración, ya que estos, por su alto costo aumentan de manera
considerable el costo de instrumentación de estos. Para hacer
frente a esta clase de problemas se ha propuesto utilizar una
herramienta virtual computacional que se encarga de estimar el
valor de la velocidad a partir de la medición de la posición la
cual normalmente se encuentra disponible [12], [13], [14], [15].
sincronización sólo se producirá en casos particulares. Una
interpretación es ver a (7), (8) como un observador de (5), (6)
𝑞𝑚
dada la señal de salida 𝑝𝑚 = (𝐼 ∅) (𝑞̇ ). Así que en aquellas
𝑚
aplicaciones donde (5), (6) es capaz de diseñar libremente a (7),
(8), se proporciona una posible solución para el problema de
sincronización. Sin embargo, los sistemas (5), (6) y (7), (8) son
sistemas que se dan de antemano, de modo que la
sincronización no ocurrirá en forma general. Por lo que, se
puede considerar una versión controlada del problema, en que
permitimos que la dinámica del esclavo depende de una
variable de control 𝑣.
El problema de sincronización controlada formulado
anteriormente se puede ver como un problema extendido de
seguimiento de trayectoria. La sincronización se da cuando (5),
(6) genera las señales que debe seguir (7), (8). Para esto se
necesita de un compensador tal que el error de sincronización
𝒆𝒔 (𝑡) ≔ 𝑞𝑒 − 𝑞𝑚 satisfaga
lim 𝒆𝒔 (𝑡) = 0 ;
(10)
𝑡→∞
A continuación se reescribe el sistema (5), (6) y (7), (8) en la
forma general de un Sistema Lineal propuesta en las ecuaciones
(3), (4), el maestro
𝒒̇ 𝑚 = 𝐴𝒒𝒎 + 𝐵𝑢;
(11)
𝑝𝑚 = 𝐶𝒒𝒎 ;
(12)
y el esclavo
𝒒̇ 𝑒 = 𝐴𝒒𝒆 + 𝐵𝑣;
(13)
𝑝𝑒 = 𝐶𝒒𝒆 ;
(14)
con 𝑞𝑚 , 𝑞𝑒 ∈ ℝ𝑛 y 𝑢, 𝑣 ∈ ℝ𝑚 . Bajo el supuesto de que (C, A)
es observable y (A, B) es controlable, el problema de
sincronización controlada tiene solución [18].
Puesto que (C, A) es observable, existe una matriz K de tal
manera que todos los valores propios de (A + KC) están en la
parte izquierda abierta del plano complejo. Además, el hecho
de que (A, B) es controlable implica que existe una matriz F de
tal manera que todos los valores propios de (A + BF) están en
el parte izquierda abierta del plano complejo. Con lo cual se
puede comprobar que por medio de retroalimentación estática
de se resuelve el problema de sincronización controlada.
Enseguida se analiza a detalle esta propuesta.
Considere el sistema maestro (11), (12) definido para todo 𝑥0 ∈
ℝ𝑛 , 𝑢 ∈ ℝ𝑚 y el controlador
̅̇𝒎 = 𝐴𝒒
̅𝒎 + 𝐵𝜙;
𝒒
(15)
̅𝒎 ;
𝑝̅𝑚 = 𝐶𝒒
(16)
Para garantizar la estabilidad, se reescriben los sistemas (11),
(12) y (15), (16) en el espacio del error
̅𝒎 ;
𝒆: = 𝒒𝒎 − 𝒒
(17)
entonces
̅𝒎 ) + 𝐵(𝑢 − 𝜙);
𝒆̇ = 𝐴(𝒒𝒎 − 𝒒
(18)
por lo tanto se selecciona el control
𝑢 = 𝐹𝒆 + 𝜙; 𝐹 ∈ ℝ𝑚×𝑛 ;
(19)
así el sistema (18) en lazo cerrado se escribe como
𝒆̇ = (𝐴 + 𝐵𝐹)𝒆;
(20)
el cual es estable si los valores propios de (A + BF) se
encuentran en la parte izquierda abierta del plano complejo para
toda F.
II. DESARROLLO Y/O CAMPO TEÓRICO
A. Sincronización de Sistemas Lineales.
En Teoría de Control [16], es posible ver a los sistemas
dinámicos como objetos descritos por sistemas de ecuaciones
de primer orden de la forma
𝐱̇ = 𝐟(x(t), u(t), t);
(1)
𝐲 = 𝐡(x(t), u(t), t);
(2)
En el caso general lineal [16], [17], si todas las matrices son
constantes, el sistema de ecuaciones puede ser escrito
𝐱̇ = 𝐀x(t) + 𝐁u(t);
(3)
𝐲 = 𝐂x(t) + 𝐃u(t);
(4)
y el modelo es llamado Lineal e Invariante en el tiempo (LTI).
Ahora se proponen los siguientes sistemas con características
homogéneas que conforman el sistema multicompuesto
maestro/esclavo
𝑞𝑚
∅
𝐼
∅
𝑞̇
( 𝑚) = (
) (𝑞̇ ) + (
) 𝑢;
(5)
𝐴2,1 𝐴2,2
𝐵2,1
𝑞̈ 𝑚
𝑚
𝑞𝑚
𝑝𝑚 = (𝐼 ∅) (𝑞̇ ) ;
(6)
𝑚
𝑞𝑒
𝐼
∅
)( ) + (
) 𝑣;
(7)
𝐴2,2 𝑞̇ 𝑒
𝐵2,1
𝑞𝑒
𝑝𝑒 = (𝐼 ∅) (𝑞̇ ) ;
(8)
𝑒
𝑛
donde 𝑞𝑚 , 𝑞̇ 𝑚 , 𝑞𝑒 , 𝑞̇ 𝑒 están en ℝ . Se asume que el origen es
uno de los puntos de equilibrio del sistema conformado por las
ecuaciones (5) y (6). El sistema (5), (6) es el maestro, y el
sistema (7), (8) es el esclavo. La sincronización entre el maestro
y el esclavo se produce no importando cómo se inicializan, se
tiene que asintóticamente sus estados coincidirán, i.e.
𝑞𝑒
𝑞𝑚
0
lim ‖(𝑞̇ ) − (𝑞̇ )‖ = ( ) ;
(9)
𝑡→∞
0
𝑒
𝑚
Normalmente, el sistema esclavo (7), (8) depende de (5), (6) a
𝑞𝑚
través de la señal de accionamiento 𝑝𝑚 = (𝐼 ∅) (𝑞̇ ), lo que
𝑚
explica la terminología maestro-esclavo. Es claro que la
∅
𝑞̇
( 𝑒) = (
𝐴
𝑞̈ 𝑒
2,1
México D.F., 19 al 23 de octubre 2015
2
15vo CONGRESO NACIONAL DE INGENIERÍA
ELECTROMECÁNICA Y DE SISTEMAS (CNIES 2015)
ARTÍCULO No. SIS03
ARTÍCULO ACEPTADO POR REFEREO
En forma semejante, se presenta un observador [19], asociado
a (11), (12) i.e.
̂̇𝑚 = 𝐴𝒒
̂𝒎 + 𝐵𝑢 + 𝐾(𝑝̂𝑚 − 𝑝𝑚 );
𝒒
(21)
̂𝒎 + 𝐷𝑢;
𝑝̂𝑚 = 𝐶𝒒
(22)
enseguida se reescriben los sistemas (11), (12) y (21), (22) en
el espacio del error
̂𝒎 − 𝒒𝒎 ;
𝝃=𝒒
(23)
así el sistema retroalimentado es
𝝃̇ = (𝐴 + 𝐾𝐶)𝝃;
(24)
Representando el sistema maestro con su controlador y
observador en el dominio del error se tiene
̇
𝐴 + 𝐾𝐶
∅
𝝃
( 𝝃) = (
)( )
(25)
⏟ 𝐵𝐹
𝐴 + 𝐵𝐹 𝒆
𝒆̇
provean del máximo de beneficios y que resuelvan
inconvenientes experimentados por otros esquemas de control.
Figura 2.- Robots coordinados por medio de sincronización maestro-esclavo.
Λ
el sistema es estable si se verifica que los valores propios de Λ
se encuentran en la parte izquierda abierta del plano complejo.
̂𝒎 del sistema
De interés es inducir las trayectorias estimadas 𝒒
maestro al sistema esclavo (13), (14) de tal manera que se
cumpla la ecuación (10). Por lo cual se propone la siguiente ley
de control de sincronización
̂̇𝑚 = 𝐴𝒒
̂𝒎 + 𝐵Φ𝑠 ;
𝒒
(26)
̂𝒎 ;
𝑝̂𝑚 = 𝐶𝒒
(27)
reescribiendo los sistemas (13), (14) y (26), (27) en el espacio
del error se tiene
̂𝒎 ;
𝒆𝒔 : = 𝒒𝒆 − 𝒒
(28)
por lo tanto el controlador propuesto para el sistema esclavo
(13), (14) es
𝑣 = 𝐺𝒆𝒔 + Φ𝑠 ; 𝐺 ∈ ℝ𝑚×𝑛 ;
(29)
Así en lazo cerrado la sincronización maestro-esclavo de un
Sistema Dinámico Lineal se reescribe como
𝒆̇ 𝑠 = (𝐴 + 𝐵𝐺)𝒆𝒔 ;
(30)
el cual es estable si los valores propios de (A + BG) se
encuentran en la parte izquierda abierta del plano complejo para
toda 𝐺 ∈ ℝ𝑚×𝑛 .
Una representación gráfica de este tipo de sincronización se
encuentra en el diagrama de bloques de la Figura 1.
Un Sistema Dinámico no Lineal conformado por
manipuladores robóticos con características homogéneas en
sincronización maestro-esclavo, como el que se encuentra en la
Figura 2, es analizado enseguida desde un enfoque energético.
Definición del Sistema Lagrangiano Multi-robot.
En [20], [21], se plantea la utilización de la formulación de
Lagrange por su simplicidad en el tratamiento de sistemas
complejos involucrados en dinámicas múltiples. Las
ecuaciones de movimiento para un robot con múltiples
articulaciones (𝐪𝑖 ∈ ℝ𝑛 ) se pueden derivar por medio de las
ecuaciones de Euler-Lagrange
1
𝑑 𝜕𝐿𝑖 (𝐪𝑖 ,𝐪̇ 𝑖 )
𝜕𝐿 (𝐪 ,𝐪̇ )
𝐿𝑖 = 𝐪̇ 𝑖 𝑇 𝐌𝒊 (𝐪𝑖 )𝐪̇ 𝑖 − 𝑉𝑖 ;
[
] − 𝑖 𝑖 𝑖 = 𝛕𝑖 ; (31)
2
𝜕𝐪̇ 𝑖
𝜕𝐪𝑖
𝝏𝐪̇ 𝑖
𝛕𝑖 son las fuerzas generalizadas o torques actuando en el
i−ésimo robot (para este caso particular, i = m,e) y
𝐂𝒊 (𝐪𝑖 , 𝐪̇ 𝑖 )𝐪̇ 𝑖 ∈ ℝ𝑛 representan las fuerzas de Coriolis y
centrifugas.
Para este caso definamos al sistema maestro como
𝐌𝒎 (𝐪𝑚 )𝐪̈ 𝑚 + 𝐂𝒎 (𝐪𝑚 , 𝐪̇ 𝑚 )𝐪̇ 𝑚 + 𝐠 𝑚 (𝐪𝑚 ) = 𝛕𝑚 ; (33)
y el esclavo
𝐌𝒆 (𝐪𝑒 )𝐪̈ 𝑒 + 𝐂𝒆 (𝐪𝑒 , 𝐪̇ 𝑒 )𝐪̇ 𝑒 + 𝐠 𝑒 (𝐪𝑒 ) = 𝛕𝑒 ;
(34)
En Sincronización de Sistemas Robóticos existen dos tareas
importantes de control. La primera es plantear una estrategia de
control que permita que el sistema Maestro pueda seguir una
trayectoria deseada. Y la segunda plantear una estrategia de
control de sincronización maestro-esclavo.
De acuerdo con la propuesta de [22], se propone el siguiente
controlador PD+ para seguimiento de trayectoria,
𝛕𝑚 = 𝐌𝒎 (𝐪𝑚 )𝐪̈ 𝑑 + 𝐂𝒎 (𝐪𝑚 , 𝐪̇ 𝑚 )𝐪̇ 𝑑 + 𝐠 𝑚 (𝐪𝑚 ) − 𝑲𝑝 𝐞𝒅 −
𝑲𝑣 𝐞̇ 𝒅 ; 𝑲𝑝 = 𝑲𝑝 𝑇 > 0; 𝑲𝑣 = 𝑲𝑣 𝑇 > 0;
(35)
El control PD+, es un algoritmo de control que incluye control
proporcional del error de posición, control proporcional del
error de velocidad más la dinámica completa de robot. En la
Figura 1.- Diagrama de bloques en Matlab-Simulink de un Sistema Lineal en
sincronización maestro-esclavo.
B. Sincronización de Sistemas Dinámicos Lineales.
En la conformación de sistemas cooperativos de robots
manipuladores, la investigación ha dado como resultado la
síntesis de múltiples leyes de control. Sin embargo, al hablar de
aplicaciones reales, surgen diferentes problemas relacionados
con restricciones físicas o bien de costo. Por lo tanto, resulta de
gran importancia el análisis de técnicas de sincronización que
México D.F., 19 al 23 de octubre 2015
𝑑𝑡
donde (1 ≤ i ≤ p) denota el índice del robot o sistema dinámico
que comprenden una red, y p es el número total de los elementos
individuales. Para este caso particular la ecuación (31) puede
ser representada como
𝐌𝒊 (𝐪𝑖 )𝐪̈ 𝑖 + 𝐂𝒊 (𝐪𝑖 , 𝐪̇ 𝑖 )𝐪̇ 𝑖 + 𝐠 𝑖 (𝐪𝑖 ) = 𝛕𝑖 ;
(32)
𝝏𝑉𝑖
𝑛
donde 𝐠 𝑖 (𝐪𝑖 ) =
∈ ℝ y denota las fuerzas de gravedad,
3
15vo CONGRESO NACIONAL DE INGENIERÍA
ELECTROMECÁNICA Y DE SISTEMAS (CNIES 2015)
ARTÍCULO No. SIS03
ARTÍCULO ACEPTADO POR REFEREO
donde 𝑙𝑑 > 0 y escalar.
Del mismo modo se puede construir un observador para obtener
̂𝑒 , 𝐪
̂̇𝑒 , 𝐪
̂̈𝑒 ∈ ℝ𝑛 que representan la estimación de los estados
𝐪
del robot esclavo 𝐪̇ 𝑒 , 𝐪̇ 𝑒 y 𝐪̈ 𝑒 respectivamente.
estructura de este esquema de control también se involucra la
trayectoria de seguimiento, velocidad y aceleración deseada.
La implementación del esquema de control (35), requiere del
conocimiento exacto del modelo dinámico del robot, lo cual
significa que los valores numéricos de sus parámetros
dinámicos se conocen [23].
Por otro lado para que el sistema alcance una sincronización
maestro-esclavo se requiere que 𝐪𝑒 alcance la referencia 𝐪𝑚 ,
por lo que los errores de sincronización 𝐞𝒔 , 𝐞̇ 𝒔 , 𝐞̈ 𝒔 ∈ ℝ𝑛 están
definidos por
𝐞𝒔 = 𝐪𝑒 − 𝐪𝑚 ; 𝐞̇ 𝒔 = 𝐪̇ 𝑒 − 𝐪̇ 𝑚 ; 𝐞̈ 𝒔 = 𝐪̈ 𝑒 − 𝐪̈ 𝑚 ; (36)
Partiendo de (36) se puede la reescribir la ecuación del esclavo
(34) como
𝐌𝑒 (𝐪𝑒 )𝐞̈ 𝑠 + 𝐂𝒆 (𝐪𝑒 , 𝐪̇ 𝑒 )𝐞̇ 𝑠 + 𝐠 𝑒 (𝐪𝑒 ) = 𝛕𝑒 ;
(37)
donde el objetivo es (𝐞𝒔 𝐞̇ 𝒔 ) = (0 0), por lo que se propone la
siguiente ley de control
𝛕𝑒 = 𝐌𝑒 (𝐪𝑒 )𝐪̈ 𝑚 + 𝐂𝒆 (𝐪𝑒 , 𝐪̇ 𝑒 )𝐪̇ 𝑚 + 𝐠 𝑒 (𝐪𝑒 )
−𝑲𝑝 𝐞𝑠 −𝑲𝑣 𝐞̇ 𝒔 ; 𝑲𝑝 = 𝑲𝑝 𝑇 > 0; 𝑲𝑣 = 𝑲𝑣 𝑇 > 0; (38)
ahora se propone la siguiente función candidata de Lyapunov
1
1
𝜐 = 𝐞̇ 𝑇𝑠 𝐌𝑒 (𝐪𝑒 )𝐞̇ 𝑠 + 𝐞𝑇𝑠 𝑲𝑝 𝐞𝑠 ; 𝑲𝑝 = 𝑲𝑝 𝑇 > 0;
(39)
2
2
Para garantizar la estabilidad de (38), se realiza
1
𝜐̇ = 𝐞̇ 𝑇𝑠 𝐌𝑒 (𝐪𝑒 )𝐞̈ 𝑠 + 𝐞̇ 𝑇𝑠 𝐌̇𝑒 (𝐪𝑒 )𝐞̇ 𝑠 + 𝐞𝑇𝑠 𝑲𝑝 𝐞𝑠 ;
(40)
2
aplicando la propiedad de antisimetría en (40) se tiene,
𝜐̇ = −𝐞̇ 𝑇𝑠 𝐂𝒆 (𝐪𝑒 , 𝐪̇ 𝑒 )𝐞̇ 𝑠 − 𝐞̇ 𝑇𝑠 𝑲𝑝 𝐞𝑠 − 𝐞̇ 𝑇𝑠 𝑲𝑣 𝐞̇ 𝑠
1
+ 𝐞̇ 𝑇𝑠 𝐌̇𝑒 (𝐪𝑒 )𝐞̇ 𝑠 + 𝐞̇ 𝑇𝑠 𝑲𝑝 𝐞̇ 𝑠 ;
(41)
2
𝑇
𝜐̇ = −𝐞̇ 𝑠 𝑲𝑣 𝐞̇ 𝑠 ≤ 0;
(42)
por lo tanto (38) es estable y se logra la sincronización entre
(33) y (34) .
̂̇𝑚 , 𝐪
̂̈𝑚 , con lo cual la ley
Si no se conoce 𝐪̇ 𝑚 , 𝐪̈ 𝑚 se estiman 𝐪
de control de sincronización (38), se reescribe de la forma
siguiente
̂̈𝑚 + 𝐂𝒆 (𝐪𝑒 , 𝐪
̂̇𝑒 ) 𝐪
̂̇𝑚 + 𝐠 𝑒 (𝐪𝑒 ) − 𝑲𝑝 𝐞𝑠 −
𝛕𝑒 = 𝐌𝑒 (𝐪𝑒 )𝐪
𝑇
𝑲𝑣 𝐞̂̇𝒔 ; 𝑲𝑝 = 𝑲𝑝 > 0; 𝑲𝑣 = 𝑲𝑣 𝑇 > 0;
(43)
𝑛
̇
̇
̈
̂𝑚 , 𝐪
̂𝑒 , 𝐪
̂𝑚 ∈ ℝ representan la estimación de 𝐪̇ 𝑚 , 𝐪̇ 𝑒 y
donde 𝐪
𝐪̈ 𝑚 respectivamente, además 𝐞̂̇𝑠 es
̂̇𝑚 ;
𝐞̂̇𝑠 = 𝐪̇ 𝑒 − 𝐪
(44)
En [24], se propone un observador no lineal desde un enfoque
de pasividad para robots manipuladores, este es utilizado para
̂𝑚 , 𝐪
̂̇𝑚 , 𝐪
̂̈𝑚 . Este observador tiene la estructura
poder estimar 𝐪
siguiente en variables de estado
̂̇𝑚 = 𝐳 + 𝐿𝑑 𝐪
̂𝑚 ;
𝐪
𝐳̇ = 𝐌𝒎 (𝐪𝑚 )[𝛕𝑚 − 𝐂𝒎 (𝐪𝑚 , 𝐪̇ 0 )𝐪̇ 0 + 𝐠 𝑚 (𝐪𝑚 ) +
̃𝑚 ]𝐿𝑝2 𝐪
̃𝑚 ;
𝐿𝑝1 𝐪
(45)
̂𝑇𝑚 𝐳 𝑇 ] son los estados del observador, 𝐪
̂̇𝑚 representa
donde [𝐪
̃𝑚 ≡ 𝐪𝑚 − 𝐪
̂𝑚 es el error de estimación
la estimación de 𝐪̇ 𝑚 , 𝐪
de posición del robot maestro, 𝐿𝑑 = 𝐿𝑇𝑑 > 0, 𝐿𝑝1 = 𝐿𝑇𝑝1 ≥ 0,
𝐿𝑝2 = 𝐿𝑇𝑝2 > 0, y
̂̇𝑚 − Λ2 𝐪
̃𝑚 ;
𝐪̇ 0 = 𝐪
(46)
con Λ2 = Λ𝑇2 ≥ 0.
Se asume que 𝐿𝑑 , 𝐿𝑝1 , 𝐿𝑝2 y Λ2 son matrices constantes y
diagonales. Sin embargo, 𝐿𝑑 y 𝐿𝑝2 , pueden ser escritos como
𝐿𝑑 = 𝑙𝑑 𝐼 + Λ2 ;
(47)
𝐿𝑝2 = 𝑙𝑑 Λ2 ;
(48)
México D.F., 19 al 23 de octubre 2015
III. CONCLUSIONES
Por medio de Matlab-Simulink se realizó la simulación de los
sistemas maestro esclavo.
En la gráfica mostrada en la Figura 3, se observa como la
sincronización maestro-esclavo de un Sistema Dinámico Lineal
masa resorte. Seleccionando los valores apropiados de las
ganancias K y F, el sistema esclavo logra alcanzar la trayectoria
del maestro en aproximadamente 6 segundos por consiguiente
la ecuación (10) se cumple como se observa en la Figura 4.
Figura 3.- Sincronización de un Sistema Dinámico Lineal.
Figura 4.- Error de sincronización de un Sistema Dinámico Lineal.
De igual manera se propuso un Sistema Multi-robot maestroesclavo como sistema no lineal. A nivel simulación, Robots
articulados de 2 grados de libertad y con características
homogéneas, consiguen sincronizarse haciendo una adecuada
selección de las ganancias 𝑲𝑝 y 𝑲𝑣 de la ley de sincronización
mostrada en la ecuación (43), así como también de las
ganancias 𝐿𝑑 , 𝐿𝑝1 y 𝐿𝑝2 del observador no lineal propuesto para
̂𝑚 , 𝐪
̂̇𝑚 , 𝐪
̂̈𝑚 del robot maestro y 𝐪
̂𝑒 , 𝐪
̂̇𝑒 , 𝐪
̂̈𝑒 del robot
encontrar 𝐪
esclavo.
En este caso es importarte observar que la sincronización se
logra en las 2 articulaciones como se observa en las Figuras 5 y
6.
4
15vo CONGRESO NACIONAL DE INGENIERÍA
ELECTROMECÁNICA Y DE SISTEMAS (CNIES 2015)
ARTÍCULO No. SIS03
ARTÍCULO ACEPTADO POR REFEREO
Figura 5.- Sincronización de las primeras articulaciones del Sistema Multirobot.
Figura 8.- Gráfica que muestra la comparación la medición de la trayectoria
estimada del esclavo en color verde y una estimada del maestro en color azul.
Con esto se concluye que la sincronización artificial o
controlada de sistemas dinámicos se logra siempre y cuando se
generan las condiciones necesarias de conexión entre sistemas
maestro-esclavo y de estimación completa del vector de estado.
Como trabajo futuro se sugiere comprobar estas estrategias de
control de sincronización a nivel experimental.
IV. AGRADECIMIENTOS
Los autores agradecen al Instituto Politécnico Nacional y a la
Sección de estudios de Estudios de Posgrado e Investigación de
la Escuela Superior de Ingeniería Mecánica y Eléctrica Unidad
Azcapotzalco, por el apoyo brindado a través del Proyecto SIP
20150901.
Figura 6.- Sincronización de las segundas articulaciones del Sistema Multirobot.
V. REFERENCIAS
[1] Pogromsky, A., Belykh, V., y Nijmeijer H., A Study of
Controlled Synchronization of Huijgens’ Pendula, K.Y.
Pettersen et al. (Eds.): Group Coord. and Cooperat. Cntrl.,
LNCIS 336, Springer-Verlag Berlin Heidelberg, pp. 205–
216, 2006.
[2] Chung, S. J., Nonlinear Control and Synchronization of
Multiple Lagrangian Systems with Applications to Tethered
Formation Flight Spacecraft, Phd Tesis, Massachusetts
Institute of Technology (MIT), 2007.
[3] Chung, S. J. y Slotine, J. J., Cooperative Robot Control and
Concurrent Synchronization of Lagrangian Systems, IEEE
Paper, November 2008.
[4] Nijmeijer H. y Rodriguez A., Synchronizacion of
Mechanical Systems, Series Editor: Leon O. Chua. World
Scientific Publishing Co. Pte., 2003.
[5] Nijmeijer, H., A dynamical control view on
synchronization, Physica D 154, pp. 219–228, 2001.
[6] Manrubia, M., Emergence of Dynamical Order Synchronization Phenomena in Complex Systems, Editorial
World Scientific, 2004 .
[7] Moseklide, Maistrenko y Postnov, Chaotic Synchronization
- Appliacation to Living Systems, Editorial World Scientific,
2002.
[8] Ji, D., et al., Synchronization of neutral complex dynamical
networks with coupling time-varying delays, Nonlinear
Cabe mencionar que las trayectorias que alcanza el sistema
̂𝑚 =
esclavo son las estimadas del robot esclavo es decir, 𝐪
𝑞𝑚1
(𝑞 ).
𝑚2
Otro resultado que es importante mencionar es que el
observador lineal propuesto no solo permite estimar los estados
̂̇𝑚 y 𝐪
̂̈𝑚 , también nos ayuda a reducir considerablemente el
𝐪
ruido de medición como puede compararse en las Figuras 7 y
8.
Figura 7.- Gráfica que muestra la comparación de la medición de la
trayectoria real del maestro en color verde y una estimada en color azul.
México D.F., 19 al 23 de octubre 2015
5
15vo CONGRESO NACIONAL DE INGENIERÍA
ELECTROMECÁNICA Y DE SISTEMAS (CNIES 2015)
ARTÍCULO No. SIS03
ARTÍCULO ACEPTADO POR REFEREO
Dyn., Springer Science Business Media B.V., Vol.65, pp.
349–358, 2011.
[9] Pham, Q. C., y Slotine, J. J., Stable concurrent
synchronization in dynamic system networks, Neural
Networks, Vol. 20, pp. 62-77, 2007.
[10] Estrada, H. J., Sincronización de sistemas mecánicos con
retardos en la transmisión de datos, PhD Tesis, Centro de
Investigación Científica y de Educación Superior de
Ensenada (CICESE), 2008.
[11] Rosas, D., Alvarez, J. y Alvarez, E., Robust
synchronization of arrays of uncertain nonlinear secondorder dynamical systems, Springer Science+Business
Media B.V. September 2011.
[12] Canudas, C. y Fixot, N., Robot Control Via Robust
Estimated State Feedback, IEEE Transactions on Automatic
Control, Vol. 36, No. 12, December 1991.
[13] Berghuis, H. y Nijmeijer, H., Robust Control of Robots via
Linear Estimated State Feedback, IEEE Transactions on
Automatic Control, Vol. 39, No. 10, October 1994.
[14] Rodriguez, A., Nijmeijer, H., Mutual Synchronization of
Robots via Estimated State Feedback: A Cooperative
Approach, IEEE Transactions on Control Systems
Technology, Vol. 12, No. 4, July 2004.
[15] Nijmeijer, H. y Mareels, I., An Observer Looks at
Synchronization, IEEE Transactions on Circuits and
Systems-I: Fundamental Theory and Applications, Vol. 44,
No. 10, October 1997.
[16] Hendricks, E., Jannerup, O., et al., Linear Systems
Control, Deterministic and Stochastic Methods, SpringerVerlag, Berlin, Heidelberg, 2008.
[17] Chen, T., Linear Systems Theory and Design, Oxford
University Press, Inc., 3rd Ed., New York Oxford, 1999.
[18] Huijberts, H., Nijmeijer, H. y Willems, R., Regulation and
controlled synchronization for complex dynamical systems,
Int. J. Robust Nonlinear Contr. 10, pp. 363–377, 2000.
[19] Luenberger, D., Observers for Multivariable Systems,
IEEE Transactions on Automatic Control, Vol. AC-II,
No.2, pp. 190-197, April 1966.
[20] Chao, M., et al., Synchronization of networked EulerLagrange systems by sampled-data communication with
time-varying transmission delays under directed topology,
Neurocomputing, 2014.
[21] Abdelkader, A., et al., Synchronization of Lagrangian
Systems With Irregular Communication Delays, IEEE
Transactions on Automatic Control, Vol. 59, No.1, January
2014.
[22] Paden, B. y Panja R., Globally asymptotically stable ’PD+’
controller for robot manipulators, Int. J. Control, Vol. 47,
no. 6 1697-1712, 1988.
[23] Reyes, F., Robótica, Control de Robots Manipuladores.
Editorial Alfaomega, México, 2011.
[24] Berghuis, H. y Nijmeijer, H., A Passivity Approach to
Controller-Observer Design for Robots, IEEE Transactions
on Robotics and Automation, Vol. 9, No. 6, December 1993.
México D.F., 19 al 23 de octubre 2015
VI. BIOGRAFÍA
Jesús Martínez Martínez recibió el título de Ingeniero en
Robótica Industrial por parte de la Escuela Superior de
Ingeniería Mecánica y Eléctrica (ESIME) Unidad Azcapotzalco
del Instituto Politécnico Nacional (IPN), en 2009, el grado de
Maestría en Ingeniería de Manufactura en el área de Robótica y
Control, en la Sección e Estudios de Posgrado e Investigación
de la ESIME Unidad Azcapotzalco, en 2013. Actualmente se
encuentra realizando el Doctorado en la misma institución. Sus
áreas de interés incluyen sincronización, control lineal y no
lineal de sistemas, observadores y sistemas robóticos.
Salvador Antonio Rodríguez Paredes recibió el título de
Ingeniero en Comunicaciones y Electrónica por parte de la
Escuela Superior de Ingeniería Mecánica y Eléctrica (ESIME)
Unidad Zacatenco del Instituto Politécnico Nacional (IPN), en
1996, el grado de Maestría en Ciencias Ingeniería Eléctrica en
la especialidad en Control Automático por el Centro de
Investigación y Estudios Avanzados (CINVESTAV-IPN), en
1998 y el Doctorado en Automática y Prodúctica por parte del
Laboratorio de Automatización del Instituto Politécnico de
Grenoble (INPG), Francia, en 2003. Sus áreas de interés
incluyen investigación sobre la estabilidad y la pasividad de
sistemas con parámetros concentrados y distribuidos, teoría y
aplicaciones, análisis bajo los enfoques de Lyapunov,
Lagrangianos, Hamiltonianos y retardos.
Jesús de León Morales recibió el título Licenciatura en Física
en la Facultad de Ciencias Físico-Matemáticas de la
Universidad Autónoma de Nuevo León desde 1981, Maestría
en Control Automático del Centro de Investigaciones y de
Estudios Avanzados, en 1987 y el Doctorado en Control
Automático de Procesos en la Universidad Claude Bernard
Lyon I, en Francia, en 1992. Actualmente es profesor
investigador de la Facultad de Ingeniería Mecánica y Eléctrica
de la Universidad Autónoma de Nuevo León (FIME, UANL).
Fue Premio de Investigación UANL 2009 en área de Ciencias
Exactas, miembro del Sistema Nacional de Investigadores nivel
2, miembro del Comité de evaluadores del CONACYT a nivel
Nacional, líder del Cuerpo Académico CASEP y miembro
Regular de la Academia Mexicana de Ciencia. Sus áreas de
interés incluyen Control de sistemas electromagnéticos,
sistemas colaborativos, maquinas inteligentes y drones.
Jorge Guillermo Alonso Alfaro nació en 1982. Cursó
Ingeniería Electromecánica en el Instituto Tecnológico de
Toluca de 2001 a 2006. Cursó la Maestría en Ingeniería de
Manufactura en la Sección de Estudios de Posgrado e
Investigación de la Escuela Superior de Ingeniería Mecánica y
Eléctrica del IPN, de 2012 a 2014, actualmente cursa el
Doctorado en Ingeniería de Sistemas Robóticos y Mecatrónicos
desde el 2015 en la misma institución, donde su trabajo de
investigación está enfocado al control e instrumentación de
UAV´s, los Sistemas Robóticos y Mecatrónicos, así como el
control de los mismos.
6
15vo CONGRESO NACIONAL DE INGENIERÍA
ELECTROMECÁNICA Y DE SISTEMAS (CNIES 2015)
ARTÍCULO No. SIS03
ARTÍCULO ACEPTADO POR REFEREO
Alfredo Roldán Caballero. Nació en Tlaxcala, México en
1990. Obtuvo el grado de Ingeniería en Mecatrónica por la
Benemérita Universidad Autónoma de Puebla (BUAP) en
2013, actualmente se encuentra cursando la Maestría en
Ingeniería de Manufactura en la Escuela Superior de Ingeniería
Mecánica y eléctrica (ESIME) del Instituto Politécnico
Nacional (IPN) en la línea de robótica y control, sobre la
instrumentación y seguimiento de trayectorias de vehículos
aéreos no tripulados, bajo la dirección del Dr. Salvador Antonio
Rodríguez Paredes. Dentro de sus intereses de investigación se
encuentra el diseño y control en robótica móvil, así como la
dinámica y control de Sistemas Mecatrónicos.
México D.F., 19 al 23 de octubre 2015
7