modelado y control de un esquema lÃder-seguidor basado en ... · formaci on de un sistema l...

6
Modelado y control de un esquema ıder-seguidor basado en distancia y ´ angulo ? O. Gonz´ alez-Medina * J. Gonz´ alez-Sierra ** A. Dzul * E.G. Hern´ andez-Mart´ ınez *** P. Paniagua-Contro *** * Tecnol´ogico Nacional de M´ exico/I.T. de La Laguna Blvd. Revoluci´on y Cuauht´ emoc S/N C.P. 27000, Torre´ on, Coahuila, M´ exico (e-mail: [email protected], [email protected]) ** CONACYT-Tecnol´ ogico Nacional de M´ exico/I.T. de La Laguna Blvd. Revoluci´ on y Cuauht´ emoc S/N C.P. 27000, Torre´on, Coahuila, exico (e-mail: [email protected]). *** Departamento de Ingenier´ ıa, Universidad Iberoamericana, 01219 Ciudad de M´ exico, M´ exico (e-mail: [email protected], [email protected]) Resumen: Este trabajo est´ a enfocado en la obtenci´ on de un modelo matem´ atico basado en distancia y ´ angulo para un sistema multi-agente, conformado por dos robots m´ oviles del tipo diferencial, utilizando el esquema l´ ıder-seguidor. Dicho modelo matem´ atico se obtiene a partir del modelo cinem´ atico de los robots m´ oviles. Posteriormente, se presenta una estrategia de control, bajo el enfoque de linealizaci´ on por retroalimentaci´ on din´ amica, la cual permite al agente seguidor mantener una distancia y un ´ angulo deseado con respecto al agente ıder. Las simulaciones num´ ericas muestran el desempe˜ no del controlador y son validadas experimentalmente. Keywords: Sistema multi-robot, Control de formaci´ on, L´ ıder-seguidor, Robot diferencial. 1. INTRODUCCI ´ ON El control cooperativo de sistemas multi-agente ha toma- do gran importancia en los ´ ultimos a˜ nos, espec´ ıficamente el control de formaci´ on, el cual consiste en alinear a un grupo de agentes dentro de un patr´ on geom´ etrico deseado. Para abordar este problema existen diferentes enfoques tanto para el modelado del sistema como para el control del mismo. De acuerdo a Yamaguchi et al (2003), b´ asicamente existen dos esquemas en los que est´ an basados los sistemas multi- robot cooperativos: los basados en comportamiento y los basados en modelos. Los esquemas basados en compor- tamiento imitan la conducta y organizaci´ on colectiva de seres biol´ ogicos (conocidos en la literatura como swarms), tales como los bancos de peces, las parvadas de aves, las colonias de hormigas, etc. Hamann et al (2004), Gazi (2015), Balch et al (1998), Sakurama et al (2018), Wiech et al (2018). Por otra parte, en los esquemas basados en modelos, se obtienen las ecuaciones matem´ aticas que describen la ? Los autores agradecen el soporte financiero de CONACYT 817174 y 266524 y del proyecto del Tecnol´ogico Nacional de M´ exico. cinem´ atica o din´ amica de cada robot m´ ovil, as´ ı como las interacciones entre estos, donde el comportamiento de cada robot m´ ovil est´ a gobernado por su respecti- va ley de control. Algunas t´ ecnicas de interacci´ on entre robots utilizadas en este esquema son: campos poten- ciales artificiales, m´ etodos de Lyapunov, an´ alisis de to- polog´ ıa/geometr´ ıa, modelos de ecuaciones diferenciales, teor´ ıa de grafos, predicci´ on del movimiento de cohesi´ on, frecuencia de colisi´ on, fuerzas de atracci´ on y repulsi´ on de part´ ıculas, etc. Hamann et al (2004). Sin embargo, para la implementaci´ on de la mayor´ ıa de estas t´ ecnicas, se requiere de un sistema que permita conocer las posiciones de cada robot dentro de un marco de referencia inercial. Actualmente el enfoque basado en distancia toma gran importancia debido a que los agentes no requieren un sistema de coordenadas global para posicionarse. Consi- derando una estructura tipo l´ ıder-seguidor, cada agente seguidor es controlado tomando en cuenta la distancia relativa entre agentes. Uno de los primeros trabajos que aborda este enfoque se presenta en Desai et al (1998), donde se dise˜ na una estrategia de control para formar a un grupo de robots utilizando la distancia y el ´ angulo de alineamiento respecto al l´ ıder. De manera similar, en Desai et al (2001), los autores proponen una estrategia de Memorias del Congreso Nacional de Control Automático San Luis Potosí, San Luis Potosí, México, 10-12 de Octubre de 2018 382 Copyright©AMCA. Todos los Derechos Reservados www.amca.mx

Upload: others

Post on 05-Aug-2020

14 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Modelado y control de un esquema lÃder-seguidor basado en ... · formaci on de un sistema l der-seguidor, conformado por aviones, cuya velocidad es constante y est a de nida por

Modelado y control de un esquemalıder-seguidor basado en distancia y

angulo ?

O. Gonzalez-Medina ∗ J. Gonzalez-Sierra ∗∗ A. Dzul ∗

E.G. Hernandez-Martınez ∗∗∗ P. Paniagua-Contro ∗∗∗

∗ Tecnologico Nacional de Mexico/I.T. de La Laguna Blvd. Revoluciony Cuauhtemoc S/N C.P. 27000, Torreon, Coahuila, Mexico (e-mail:

[email protected], [email protected])∗∗ CONACYT-Tecnologico Nacional de Mexico/I.T. de La Laguna

Blvd. Revolucion y Cuauhtemoc S/N C.P. 27000, Torreon, Coahuila,Mexico (e-mail: [email protected]).

∗∗∗Departamento de Ingenierıa, Universidad Iberoamericana, 01219Ciudad de Mexico, Mexico (e-mail: [email protected],

[email protected])

Resumen: Este trabajo esta enfocado en la obtencion de un modelo matematico basado endistancia y angulo para un sistema multi-agente, conformado por dos robots moviles del tipodiferencial, utilizando el esquema lıder-seguidor. Dicho modelo matematico se obtiene a partirdel modelo cinematico de los robots moviles. Posteriormente, se presenta una estrategia decontrol, bajo el enfoque de linealizacion por retroalimentacion dinamica, la cual permiteal agente seguidor mantener una distancia y un angulo deseado con respecto al agentelıder. Las simulaciones numericas muestran el desempeno del controlador y son validadasexperimentalmente.

Keywords: Sistema multi-robot, Control de formacion, Lıder-seguidor, Robot diferencial.

1. INTRODUCCION

El control cooperativo de sistemas multi-agente ha toma-do gran importancia en los ultimos anos, especıficamenteel control de formacion, el cual consiste en alinear a ungrupo de agentes dentro de un patron geometrico deseado.Para abordar este problema existen diferentes enfoquestanto para el modelado del sistema como para el controldel mismo.

De acuerdo a Yamaguchi et al (2003), basicamente existendos esquemas en los que estan basados los sistemas multi-robot cooperativos: los basados en comportamiento y losbasados en modelos. Los esquemas basados en compor-tamiento imitan la conducta y organizacion colectiva deseres biologicos (conocidos en la literatura como swarms),tales como los bancos de peces, las parvadas de aves,las colonias de hormigas, etc. Hamann et al (2004), Gazi(2015), Balch et al (1998), Sakurama et al (2018), Wiechet al (2018).

Por otra parte, en los esquemas basados en modelos,se obtienen las ecuaciones matematicas que describen la

? Los autores agradecen el soporte financiero de CONACYT 817174y 266524 y del proyecto del Tecnologico Nacional de Mexico.

cinematica o dinamica de cada robot movil, ası comolas interacciones entre estos, donde el comportamientode cada robot movil esta gobernado por su respecti-va ley de control. Algunas tecnicas de interaccion entrerobots utilizadas en este esquema son: campos poten-ciales artificiales, metodos de Lyapunov, analisis de to-pologıa/geometrıa, modelos de ecuaciones diferenciales,teorıa de grafos, prediccion del movimiento de cohesion,frecuencia de colision, fuerzas de atraccion y repulsionde partıculas, etc. Hamann et al (2004). Sin embargo,para la implementacion de la mayorıa de estas tecnicas, serequiere de un sistema que permita conocer las posicionesde cada robot dentro de un marco de referencia inercial.

Actualmente el enfoque basado en distancia toma granimportancia debido a que los agentes no requieren unsistema de coordenadas global para posicionarse. Consi-derando una estructura tipo lıder-seguidor, cada agenteseguidor es controlado tomando en cuenta la distanciarelativa entre agentes. Uno de los primeros trabajos queaborda este enfoque se presenta en Desai et al (1998),donde se disena una estrategia de control para formar aun grupo de robots utilizando la distancia y el angulode alineamiento respecto al lıder. De manera similar, enDesai et al (2001), los autores proponen una estrategia de

Memorias del Congreso Nacional de Control Automático

San Luis Potosí, San Luis Potosí, México, 10-12 de Octubre de 2018 382 Copyright©AMCA. Todos los Derechos Reservados www.amca.mx

Martin
Typewritten Text
ISSN: 2594-2492
Page 2: Modelado y control de un esquema lÃder-seguidor basado en ... · formaci on de un sistema l der-seguidor, conformado por aviones, cuya velocidad es constante y est a de nida por

control para lograr la formacion de un grupo de robotsno holonomos y, ademas, evadir obstaculos cambiando laformacion. Por otro lado en Lopez-Gonzalez et al (2016)se presenta un esquema de formacion considerando quelos controles locales de cada agente pueden ser equipadoscon sensores de orientacion y distancia. Siguiendo esteesquema, en Oh et al (2011) se presenta una ley de control,obtenida a partir de la dinamica de la distancia que lograque los errores de formacion converjan exponencialmentea cero. Por su parte Kang et al (2014) presenta una ley decontrol adaptable, basada en distancia, para mantener laformacion de un sistema lıder-seguidor, conformado poraviones, cuya velocidad es constante y esta definida porla velocidad del lıder. En Ahmadi et al (2016) se utilizala dinamica de los robots no holonomos para proponeruna ley de control, obtenida a traves del gradiente de unafuncion que depende de la distancia y el angulo, con elobjetivo de lograr una formacion deseada. Mientras queen Mastellone et al (2007) proponen un control de forma-cion basado en distancia, disenado mediante el metodode analisis de Lyapunov, para garantizar la evasion decolisiones y el seguimiento de la trayectoria por el grupode agentes, siendo necesario en estos ultimos un sistemade coordenadas global. Finalmente, en Khaled (2015) sepropone un control por modos deslizantes para mantenerla formacion durante el vuelo de un conjunto de UAVs(vehıculos aereos no tripulados, del ingles UnmannedAerial Vehicles) del tipo Quad-Rotor, en movimientosplanares X-Y; mientras que en Vallejo et al (2015) se pro-pone una ley de control por backstepping para resolver elproblema de formacion lıder-seguidor de un Quad-Rotorsiguiendo como lıder a un robot movil tipo diferencial.

Tanto en los trabajos de Desai et al (1998), y Desai et al(2001) ası como en el trabajo de Lopez-Gonzalez et al(2016), se controla un punto diferente al punto medio deleje de las ruedas, lo cual implica que no esta definidosi el vehıculo va de frente o en reversa; mientras que enel de trabajo de Oh et al (2011) y Kang et al (2014)se consideran agentes puntuales. Por lo tanto, tienen ladesventaja de carecer de la definicion de la orientacion.Por ultimo en Mastellone et al (2007) y Ahmadi et al(2016), se considera un sistema de coordenadas global,necesitando entonces el conocimiento de las coordenadasde todos los agentes, lo cual conlleva a tener un sistemacentralizado y en un ambiente totalmente controlado.

Con el fin de resolver los inconvenientes antes menciona-dos, este trabajo se enfoca en la obtencion de un modelomatematico, basado en distancia y angulo, de un sistemamulti-agente compuesto por dos robots moviles del tipodiferencial bajo el esquema lıder-seguidor; cada vehıculoes controlado desde el punto medio del eje de las ruedas, yconsiderando como marco de referencia el del robot lıder.Dicho modelo matematico se obtiene a partir del modelocinematico de ambos robots moviles. Posteriormente, sedisena una estrategia de control, utilizando tecnicas delinealizacion por retroalimentacion, para lograr el controlde formacion. Con base en lo anterior, el control de for-macion propuesto usa solamente informacion local de los

sensores en un esquema lıder-seguidor. En ese sentido,se asume que cada robot esta equipado con sensores quemiden la distancia y orientacion de un robot con respectoa otro (e.g. camaras de video, sonares, laser, giroscopio,etc); ademas, se considera que el movimiento del lıder yaesta planeado.

El artıculo esta organizado de la siguiente manera. LaSeccion 2 presenta el planteamiento del problema y laobtencion del modelo basado en distancia y angulo. En laSeccion 3 se presenta el diseno de la ley de control y se ex-hiben en detalle los resultados teoricos. Las simulacionesnumericas y los resultados experimentales se presentan enla Seccion 4. Finalmente, en la Seccion 5 se presentan lasconclusiones y trabajo futuro.

2. PLANTEAMIENTO DEL PROBLEMA

Figura 1. Esquema lıder-seguidor.

Sea N = {RF , RL} el conjunto compuesto por dos robotsmoviles del tipo diferencial, donde RL es el agente lıdery RF el agente seguidor. El modelo cinematico de cadaagente (Figura 1), esta dado por

xj = vj cos θj , (1a)

yj = vj sin θj , (1b)

θj = wj , (1c)

con j = L,F ; donde [xj yj ]> ∈ R2 es la posicion del punto

medio del eje de las ruedas, θj es el angulo de orientacion

con respecto al eje horizontal X, y [vj wj ]> ∈ R2 son

las velocidades longitudinal y angular, respectivamente ycorresponden a las entradas de control. Por otra parte, apartir de la Figura 1, se define a ` y ϕ como la distanciay el angulo que existe entre el agente lıder y el agenteseguidor, respectivamente. Ademas, note que `x y `y sonlas componentes de ` en el marco de referencia del lıder.

Con base en lo anterior, el problema consiste en obtenerun modelo matematico basado en distancia y angulo deun sistema multi-agente, conformado por robots movilesdel tipo diferencial, al cual se le pueda disenar una

San Luis Potosí, San Luis Potosí, México, 10-12 de Octubre de 2018 383 Copyright©AMCA. Todos los Derechos Reservados www.amca.mx

Page 3: Modelado y control de un esquema lÃder-seguidor basado en ... · formaci on de un sistema l der-seguidor, conformado por aviones, cuya velocidad es constante y est a de nida por

ley de control que permita a los agentes mantenerse auna distancia y angulo deseado mientras se realiza elseguimiento de una trayectoria deseada, i.e.

lımt→∞

` = `d, lımt→∞

ϕ = ϕd,

donde `d es una distancia deseada y ϕd es un angulodeseado.

2.1 Modelado

Para obtener el modelo cinematico basado en distancia yangulo en un esquema lıder-seguidor, en primera instan-cia, se requiere proyectar las distancias entre los agentescon respecto al marco de referencia del lıder, las cualesestan dadas por

`x = −(yL − yF ) sin θL − (xL − xF ) cos θL, (2a)

`y = −(yL − yF ) cos θL + (xL − xF ) sin θL, (2b)

mientras que la distancia entre agentes, en funcion de laposicion de cada uno de ellos, esta dada por

` =√

(xL − xF )2 + (yL − yF )2. (3)

Por otra parte, note que la distancia ` puede ser expresadaen funcion de sus componente `x y `y como

` =√`2x + `2y, (4)

ası como `x y `y se pueden expresar en funcion de ` y elangulo ϕ, de la siguiente manera

`x = −` cosϕ, `y = −` sinϕ. (5)

Con el fin de representar el sistema lıder-seguidor enfuncion de ` y ϕ, se obtendran sus derivadas. Derivando(2) y (4) y, sustituyendo el modelo cinematico (1), seobtiene lo siguiente

˙x =−vL + vF cos(θF − θL) + wL`y, (6a)

˙y = vF sin(θF − θL)− `xwL, (6b)

˙ =`x ˙

x + `y ˙y

`. (6c)

Sustituyendo (5), (6a) y (6b) en (6c), se obtiene losiguiente

˙ = vL cosϕ− vF cos(θF − θL − ϕ). (7)

Por otro lado, a partir de (5), el angulo ϕ se define como

ϕ = arctan(`y`x

), cuya derivada esta dada por

ϕ =`x ˙

y − `y ˙x

`2. (8)

Sustituyendo (5), (6a) y (6b) en (8), se tiene que ladinamica de ϕ esta dada por

ϕ=1

`[−vF sin(θF − θL − ϕ)− `wL − vL sinϕ] . (9)

Finalmente, el modelo expresado en forma matricial que-da definido como

η = fη(vL, wL,η) + gη(η)uF , (10)donde

fη =

vL cos(eθ − ϕ)

−vL

`sin(eθ − ϕ) − wL

−wL

, gη =

− cos(eθ − ϕ) 0

−sin(eθ − ϕ)

`0

0 1

,

con eθ = θF − θL, η = [` ϕ eθ]> ∈ R3 es el vector de

estados del sistema y uF = [vF wF ]> ∈ R2 es el vector

de entradas de control para el agente seguidor.

Comentario 1. En este trabajo se asume que el agentelıder puede ser controlado y este, sigue una trayectoriacuyas ecuaciones satisfacen las restricciones dadas poreste tipo de robots. En ese sentido, el modelo dado en (10)incluye implıcitamente las restricciones no-holonomas delos robots diferenciales.

Note que la matriz de desacoplamiento del sistema (10),

con la salida h = [` ϕ]>

, esta dada por

gη =

[− cos(eθ − ϕ) 0

− sin(eθ − ϕ)

`0

],

la cual, evidentemente, es singular, por lo tanto no esposible desacoplar la respuesta entrada-salida del sistemacon una ley de control por realimentacion estatica. Pararesolver este problema, se considera el modelo dinamicoextendido anadiendo un integrador a la salida de la velo-cidad longitudinal vF , obteniendose el siguiente sistema

˙η = fη(vL, wL, η) + gηuF , (11)con

fη =

vL cosϕ− vF cos(eθ − ϕ)

−`wL − vL sinϕ− vF sin(eθ − ϕ)

`0

−wL

, gη =

0 00 01 00 1

,

donde η = [` ϕ vF eθ]> ∈ R4 es el vector de estados

extendido, uF = [uF wF ]> ∈ R2 es el nuevo vector de

entradas de control con uF como la nueva entrada decontrol para el agente seguidor. Nuevamente, consideran-do a h como salida del sistema (11), se obtiene la siguienteexpresion

h = fh(vL, wL, vF , eθ, vL, wL,h) + gh(eθ, vF ,h)uF , (12)

donde

fh =

[a1

−wL + a2

], gh =

[− cos(eθ − ϕ) vF sin(eθ − ϕ)

−sin(eθ − ϕ)

`−vF cos(eθ − ϕ)

`

],

con

a1 = vL cosϕ + vLwL sinϕ +1

`(vL sinϕ + vF sin(eθ − ϕ))2,

a2 =1

`[−vL sinϕ + vLwL cosϕ]

+1

`2

[v2L sin 2ϕ− v2F sin 2(eθ − ϕ) + 2vF vL sin (eθ − 2ϕ)

],

donde vL corresponde a la aceleracion longitudinal dellıder. En este caso consideramos que es posible controlar

San Luis Potosí, San Luis Potosí, México, 10-12 de Octubre de 2018 384 Copyright©AMCA. Todos los Derechos Reservados www.amca.mx

Page 4: Modelado y control de un esquema lÃder-seguidor basado en ... · formaci on de un sistema l der-seguidor, conformado por aviones, cuya velocidad es constante y est a de nida por

el punto medio del eje de las ruedas del agente lıderRodrıguez-Cortes et al (2007).

Debido a que el determinante de la matriz de desacopla-miento es det(gh) = vF

` , entonces, la matriz es no singularpara todo vF 6= 0. Esto implica que la ley de control porretroalimentacion dinamica no se puede aplicar cuando losagentes estan en reposo, i.e. vF = vL = 0. Para resolverla singularidad de vF = 0, se propone como salida alternala velocidad longitudinal y el angulo de orientacion del

agente seguidor, i.e. h = [vF θF ]>

. Al derivar la salida hcon respecto al tiempo, se obtiene el siguiente sistema

˙h =

[uFwF

]. (13)

Comentario 2. El grado relativo del sistema extendido(11) con la salida h, es {2, 2}. Debido a que la dimensionde (11) es de 4 y la suma de los grados relativos tambienes 4, entonces, es posible disenar una ley de control quelinealice completamente el sistema (11).

Comentario 3. El grado relativo del sistema extendido(11) con la salida h es {1, 1}. Por lo tanto, la dimension dela dinamica cero del sistema (11) es de 2, y correspondea la evolucion de los estados ` y ϕ.

3. DISENO DE LA ESTRATEGIA DE CONTROL

En esta seccion se disena la ley de control que logra queel agente seguidor se mantenga a una distancia y angulodeseados con respecto al lıder. A partir de (12), se obtieneune ley de control por retroalimentacion dinamica, la cualesta dada por

ν =

[uFwF

]= g−1h

{−fh +

[¨d − k`pe` − k`p e`

ϕd − kϕpeϕ − kϕd

]},

(14)donde e` = `−`d y eϕ = ϕ−ϕd son los errores de distanciay angulo, respectivamente. `d es la distancia deseada, ϕdes el angulo deseado y k`p , k`d , kϕp , kϕd

> 0 son gananciasde diseno.

Teorema 1. Considere el sistema (12) en lazo cerrado conel control (14), entonces, el agente seguidor se mantendraa una distancia deseada y a un angulo deseado conrespecto al lıder, i.e. lım

t→∞e` = lım

t→∞eϕ = 0.

Prueba 1. La dinamica de las coordenadas del error, enforma matricial, esta dada por

e = h− hd, (15)

donde e = [e` eϕ]>

y hd = [`d ϕd]>

. Sustituyendo (12) y(14) en (15), se obtiene el siguiente sistema

e = −Kde−Kpe, (16)

donde Kd = diag{k`d , kϕd} y Kp = diag{k`p , kϕp

}.Reescribiendo (16) en espacio de estados, se obtiene elsiguiente sistema

d

dt

e`e`eϕeϕ

=

0 1 0 0−k`p −k`d 0 0

0 0 0 10 0 −kϕp

−kϕd

︸ ︷︷ ︸

K

e`e`eϕeϕ

.

Note que la matriz K es una matriz diagonal a bloques. Silas ganancias k`p , k`d , kϕp

, kϕd> 0, se tiene que K es una

matriz Hurwitz, y por lo tanto los errores de distanciay de orientacion convergen asintoticamente a cero, i.e.lımt→∞

e` = lımt→∞

eϕ = 0.

2

Por otra parte, para el sistema (13), la ley de control porretroalimentacion dinamica esta dada por

ν =

[uFwF

]=

[vL − kvpevwL − kθpeθ

], (17)

donde ev = vF − vL y eθ = θF − θL corresponden a loserrores de velocidad y de orientacion, respectivamente;mientras que kvp , kθp > 0 son ganancias de diseno.

Teorema 2. Considere el sistema (13) en lazo cerrado conel control (17), entonces, la velocidad y orientacion delagente seguidor convergeran a la velocidad y orientaciondel agente lıder, i.e. lım

t→∞ev = lım

t→∞eθ = 0.

Prueba 2. La dinamica de las coordenadas del error, enforma matricial, esta dada por

˙e = ˙h− ˙hL, (18)

donde e = [ev eθ]>

, hL = [vL wL]>

y, al sustituir (13) y(17) en (18), se obtiene lo siguiente

˙e = −Kpe, (19)

donde Kp = diag{kvp , kθp} es una matriz diagonal. Si

kvp , kθp > 0, entonces, la matriz Kp es Hurwitz y los erro-res de velocidad y orientacion convergen asintoticamentea cero, i.e. lım

t→∞eξ = lım

t→∞eθ = 0.

2

Con el fin de obtener una estrategia de control quepermita evitar la singularidad en vF = 0, se propone elsiguiente esquema de conmutacion

η =

{ν, si vF ≥ δ,ν si vF < δ,

donde δ es un parametro positivo correspondiente alumbral de conmutacion.

Comentario 4. De acuerdo a Brockett (1983), el sistema(1) no puede ser estabilizado por leyes de control estaticase invariantes en el tiempo. Por otro lado, el sistema dadopor (11) se obtiene al anadir un integrador a la salidade la velocidad longitudinal, resultando en un sistemacinematico extendido. En ese sentido, la principal ley decontrol (14), es una retroalimentacion dinamica de losestados mientras que en la ley alterna (17) no se estacontrolando el punto medio del eje de las ruedas. Cabeaclarar, que la ley de control alterna (17) solo se utilizapara evitar la singularidad de vF = 0.

4. RESULTADOS EXPERIMENTALES

Para las pruebas experimentales, se utilizaron dos robotsdel tipo diferencial (Figura 2), los cuales estan actuados

San Luis Potosí, San Luis Potosí, México, 10-12 de Octubre de 2018 385 Copyright©AMCA. Todos los Derechos Reservados www.amca.mx

Page 5: Modelado y control de un esquema lÃder-seguidor basado en ... · formaci on de un sistema l der-seguidor, conformado por aviones, cuya velocidad es constante y est a de nida por

Tabla 1. Ganancias de control.

Ganancia Valor Ganancia Valor

k`p 100 kϕp 200

k`d 6.5 kϕd 7.5kvp 5 kθp 5

por servo-motores Dynamixel AX - 12W, y controladospor un microcontrolador NXP R© modelo LPC 1768, elcual se comunica con la computadora de control medianteBluetooth. La posicion y orientacion de cada robot sonmedidas con el sistema de captura de movimiento Vicon R©compuesto por seis camaras modelo Bonita R©. Ademas,notese en la Figura 2, que en la parte superior de cadarobot fueron colocados marcadores reflexivos (cuatro es-feras en cada robot) para poder ser identificados por elsistema de captura Vicon R©.

Se realizo un experimento donde el agente lıder RL escontrolado para seguir una trayectoria circular, dada porlas ecuaciones

mx = 0.75 sin( π

15t), my = 0.75 cos

( π15t).

Figura 2. Robot movil tipo diferencial.

La distancia deseada a la que debe permanecer el agenteseguidor es `d = 0.5 [m] con un angulo ϕd = 0 [rad],Las ganancias del controlador para el agente seguidorse muestran en la Tabla 1 mientras que las condicionesiniciales, dadas en [m] para las posiciones y en [rad] paralos angulos, de los agentes estan dadas por

[xL(0) yL(0) θL(0)]>

= [−0.7713 0.0335 6.24]>,

[xF (0) yF (0) θF (0)]>

= [−0.8124 −0.5053 9.2476]>,

[`(0) ϕ(0)]>

= [0.5395 −0.027]>.

La Figura 3 presenta una comparacion de las trayectoriasdescritas en el plano por parte de los agentes, consi-derando los resultados numericos y los experimentales.Las lıneas solidas representan los resultados obtenidosnumericamente mientras que las lıneas discontinuas co-rresponden a los resultados obtenidos de manera experi-mental.

Figura 3. Trayectoria en el plano.

Figura 4. Errores de distancia y angulo.

Figura 5. Entradas de control.

Por otro lado, en la Figura 4 se observa que el errorde distancia y el error de angulo convergen a cero.Esto implica que el agente seguidor alcanza y mantienela distancia y angulo deseados con respecto al lıder.Finalmente, en la Figura 5 se muestran las entradas decontrol para cada agente, siendo la columna izquierdalas correspondientes al agente lıder y la columna derechalas correspondientes al agente seguidor, en ambos casos

San Luis Potosí, San Luis Potosí, México, 10-12 de Octubre de 2018 386 Copyright©AMCA. Todos los Derechos Reservados www.amca.mx

Page 6: Modelado y control de un esquema lÃder-seguidor basado en ... · formaci on de un sistema l der-seguidor, conformado por aviones, cuya velocidad es constante y est a de nida por

las dos graficas superiores presentan el comportamientode la velocidad lineal vj , tanto del agente lıder comodel agente seguidor, respectivamente, mientras que lasgraficas inferiores representa el comportamiento de lavelocidad angular wj .

5. CONCLUSIONES

En este trabajo se obtuvo el modelo matematico basadoen distancia y angulo de un sistema multi-agente con-formado por dos robots moviles del tipo diferencial bajoel esquema lıder-seguidor. Se utilizo el enfoque de linea-lizacion por retroalimentacion dinamica para disenar laley de control que permite al agente seguidor mantenersea una distancia y angulo deseados con respecto al lıder.Ademas, se disena una ley de control que permite evitarla singularidad que aparece cuando la velocidad lineal escero. Una desventaja del controlador propuesto reside enque es necesario conocer la aceleracion angular del agentelıder. Sin embargo, es posible demostrar que el sistemaes entrada-estado estable con respecto a este parametro.Debido a esto, y como trabajo futuro, se utilizaran dife-rentes enfoques para disenar la ley de control, ası comoel diseno de observadores para estimar la orientacion delos agentes, ademas de extender este caso a un grupo den agentes.

AGRADECIMIENTOS

Los autores agradecen el apoyo del Laboratorio de Anali-sis de Movimiento, del Departamento de Estudios deIngenierıa para la Innovacion de la Universidad Iberoame-ricana, Campus Ciudad de Mexico, para la realizacion delos experimentos.

REFERENCIAS

Ahmadi, S. and Werner, H. (2016). Cascaded formationcontrol using angle and distance between agents withorientation control part 1 and part 2. InternationalConference on Control, Belfast, U. K.

Balch, T. and Arkin, C. (1998) Behavior-based formationcontrol for multirobot teams. IEEE Trans. On Roboticsand Automation, Vol. 14, No. 6, pages 926-939.

Brockett, R. W. (1983) Asymptotic stability and feedbackstabilization. Differential Geometry Control Theory.

Desai, J., Ostrowski, J. and Kumar, V. (1998) Controllingformations of multiple mobile robots. Proc. of the 1998IEEE Int. Conf. on Robotics and Automation, Leuven,Belgium, pages 2864-2869.

Desai, J., Ostrowski, J. and Kumar, V. (2001) Modelingand Control of Formations of Nonholonomic MobileRobots. Proc. of the 2001 IEEE Trans. on Roboticsand Automation, Vol. 17, No. 6, pages 905-908.

Gazi, V. (2015) Swarm aggregations using artificialpotential and sliding-mode control. IEEE Trans. OnRobotics, Vol. 21, No. 6, pages 1208-1214.

Hamann, J.C., Heil, R., Spears, W.M. and Spears, D.F.(2004). Distributed, physics-based control of swarms ofvehicles (2004). Autonomous Robots, Vol. 17, No.2-3,pages 137-162.

Kang, S.M., Park, M.C., Lee, B.H. and Ahn, H.S. (2014).Distance-based formation control with a single movingleader (2014). American Control Conference, Portland,Oregon, USA, pages 305-310.

Khaled, A. and Youmin, Z. (2015) Formation Controlof Multiple Quadrotors Based on Leader-Follower Met-hod. Proc. of the 2015 IEEE Int. Conf. on UnmannedAircraft Systems, Denver, Colorado, USA, pages 1037-1042.

Lopez-Gonzalez, A., Ferreira, E. D., Hernandez-Martinez,E.G., Flores-Godoy, J.J., Fernandez-Anaya, G. andPaniagua-Contro, P. (2016). Multi-robot formationcontrol using distance and orientation. Advanced Ro-botics, Vol. 30, No.14, pages 1-13.

Mastellone, S., Stipanovic, D., Graunke, C., Intlekofer, K.and Spong, M. (2007). Formation Control and CollisionAvoidance for Multi-agent Non-holonomic Systems:Theory and Experiments. The International Journalof Robotics Research, Vol. 27, No. 1, pages 107-126.

Oh, K. K. and Ahn, H. S. (2011). Formation control ofmobile agents based on inter-agent distance dynamics(2011). Automatica, Vol. 47, No. 10, pages 2307-2312.

Rodrıguez-Cortes, H. and Aranda-Bricaire, E. (2007).Observer based trajectory tracking for a wheeled mo-bile robot (2007). Proc. of the 2007 American ControlConference, Nueva York, USA, pages 991-996.

Sakurama, K., Kosaka, Y. and Nishida, S. (2018). Forma-tion control of swarms robots with multiple proximitydistance sensors. (2018). Int. Journal of Control Auto-mation and Systems, Vol. 16, No. 1, pages 16-26.

Vallejo-Alarcon, M.A., Castro-Linares, R. and Velasco-Villa, M. (2015). Unicycle-Type Robot & Quadro-tor Leader-Follower Formation Backstepping Control.IFAC, Vol. 48, No. 19, pages 51-56.

Wiech, J., Eremeyev, V.A. and Giorgio, I. (2018). Vir-tual spring damper method for nonholonomic roboticswarm self-organization and leader following. (2018).Continuum Mech. Thermodyn, Vol. 30, No. 5, pages1091-1102.

Yamaguchi, H. (2003). A distributed motion coordinationstrategy for multiple nonholonomic mobile robots incooperative hunting operation. (2003). Robotics andautonomous systems, Vol. 43, No. 14, pages 257-282.

Ze-su, C., Jie, Z. and Jian, C. (2012). Formation Controland Obstacle Avoidance for Multiple Robots Subject toWheel-Slip. International Journal of Advanced RoboticSystem, Vol. 9, No. 5, pages 1-15.

San Luis Potosí, San Luis Potosí, México, 10-12 de Octubre de 2018 387 Copyright©AMCA. Todos los Derechos Reservados www.amca.mx