Professional Documents
Culture Documents
I. INTRODUCTION
La Robtica mvil es un rea de investigacin activa
donde investigadores de todo el mundo encuentran nuevas
tecnologas para mejorar la inteligencia de los robots
mviles y las reas de aplicacin. Entre las distintas
estructuras de robots, el tipo uniciclo es el ms utilizado en
varias tareas debido a su buena movilidad y configuracin
simple. Esta estructura del robot se ha utilizado en varias
aplicaciones como vigilancia, limpieza de pisos y el
transporte de carga industrial que utiliza los vehculos
autnomos guiados [1] [2].
Los Robots Mviles tipo uniciclo, estn constituidos
bsicamente por una estructura mecnica que consta de dos
ruedas fijas convencionales sobre el mismo eje, controladas
de manera independiente y una rueda local que le confiere
estabilidad, permitindole navegar a travs de un
determinado ambiente de trabajo de forma autnoma. Dicha
autonoma se refiere a la capacidad de percibir, planificar y
actuar sin la intervencin del operador humano para alcanzar
determinados objetivos, tomando en cuenta que para ejecutar
tareas que requieren altas velocidades o transporte de cargas,
es fundamental considerar la dinmica del robot, adems de
su cinemtica. Los robots mviles se utilizan en reas que
son demasiado peligrosas para los seres humanos o las
misiones que con llevan demasiado tiempo. Esta inteligencia
es suministrada por el sistema de control del vehculo.
es el punto que se
ejercidas sobre C por la rueda libre, Fex ' y Fey ' son
x u cos a sen
y usen a cos
(1)
x usen a cos 0
y
0
30 2 40
1
u
0
0
0
u
1
1
1
0
60 0
5
0 u 0
2
2
y
uref 0
0 ref
1
0
2
0
0
0
(2)
de incertidumbres y 10 20 30 40 50 60 es el
vector q contiene los parmetros dinmicos del robot.
A. Identificacin paramtrica
La identificacin es un campo de la modelacin
matemtica de sistemas a partir de datos experimentales. El
modelo dinmico del robot mvil puede ser representado
como una regresin lineal
TFT 0 YFT
(3)
ref
ref
(9)
0.15 2 sen(0.2 t )
1 2 cos 2 (0.2 t )
(10)
[m/s]
0.4
2
u
0
u
0
0
s
s
s
T
F
s
0
0
u
s
s
s
us
0.2
(4)
0
0
[rad/s]
(5)
10
Tiempo [s]
15
20
25
u
s ref
YF
s ref
-2
0
10
15
20
25
Tiempo [s]
(6)
(7)
A. Control de Posicin
A1 0.15; A1 0.15
(8)
[m/s]
ur
u
-1
0
10
20
30
40
Tiempo [s]
50
60
70
80
(11)
V p, V1 V2
-1
0
sen
1
[rad/s]
10
20
30
40
Tiempo [s]
50
60
70
80
1
1
h 2 2
2
2
con h >0
(12)
V h
sen
V h u cos u
(13)
(14)
V2 ku
sen cos
f N y tangencial fT ) de la fuerza
(15)
por lo que:
tanh
(16)
sen cos
k ku
[m]
2
0
0
cero.
10
12
14
16
18
20
10
12
Tiempo [s]
14
16
18
20
1
0.5
[rad]
Evasin de Obstculos
0
-0.5
xd
Rotacin de la
referencia
xr
-1
0
Coord. Cartesianas
a
Coord. Polares
Control de movimiento
Control de
Movimiento
Modelo
Cartesiano
xm
10
FT
12
14
16
18
20
10
12
Tiempo [s]
14
16
18
20
0.1
Entorno
0.05
xm
Control de
Impedancia
Sistema
Sensorial
Resultado Experimental
El objetivo de control es alcanzar el punto de coordenadas
X d y yd evitando los obstculos presentes a lo largo del
trayecto. Se considera la posicin inicial del robot en
0
0
k
K x diag
a xi
[m/s]
0.75
0.5
10
12
14
16
18
20
perfecto de velocidad
1
[rad/s]
0.5
x K x x 0
-1
0
10
12
Tiempo [s]
14
16
18
V xT K x x xT K x x 0
B. Seguimiento de Trayectoria
El objetivo del control de seguimiento de trayectoria es
conseguir mediante una ley de control, que el robot mvil
alcance y siga con error cero estados deseados variantes con
el tiempo.
El control de trayectoria propuesto se basa dos
subsistemas en cascada: 1) control cinemtico es el
encargado de cumplir el objetivo de la tarea; 2) control
compensacin dinmica es el en cargado de compensar la
dinmica del robot. La Fig. 10, muestra el esquema de
control propuesto.
vc
xd
xd
uc
yd
yd
Controlador
Cinemtico
vref
s
uc
uref
Controlador
Dinmico
[q ]
(19)
20
xd
tiene,
0
-0.5
xd
a0
0.25
0
0
Robot Mvil
1s
Dinmica
Cinemtica
ref
[q]
1s
1
s
k2
r k2 tanh
Compensacin Dinmica
ku
tanh u
l 0
lu
T (v ) u
0 l
tanh
(20)
T (v ) es definida como
(21)
xcr xd K x x
(17)
x xd xc
(18)
donde
Siendo
Hv HT (v ) Cv Fv
Resultado Experimental
La prueba se realiz en el Pioneer P3-AT, que sigue una
trayectoria senoidal y evade un obstculo. El resultado
experimental muestra la trayectoria descrita por el robot
(Fig. 11) son errores de control se muestran en la Fig.12,
donde se puede observar que los errores tienden
asintticamente a cero. En la Fig. 13 muestra los resultados
obtenidos del movimiento estroboscpico y la trayectoria
descrita por el robot mvil. La velocidad deseada c(t) a lo
largo del camino y la velocidad del robot se muestra en la
Fig. 13.
1.5
1
0.5
0
Obstculo
-0.5
z [m]
Trayectoria a
seguir
0.5
-1.5
0
0.5
1.5
2.5
x [m]
3.5
4.5
0.8
C. Seguimiento de Caminos
-1
Condiciones
iniciales
0
-0.5
y [m]
Trayectoria del
Robot Mvil
xe
ye
0.7
0.6
[m]
0.5
cos
u
vc c 1
c sen
a
0.4
0.3
0.2
0.1
0
-0.1
0
10
15
Tiempo [s]
20
25
kx
sen cos d lx tanh l
x
1
cos
ky
sen d l y tanh
a
l
(22)
0.4
u [m/s]
0.3
Caso 2:
Ley de control dada por:
0.2
uref
V
ky
k ~ ly
~ l
c v
sen x sen tanh x x cos tanh
l
ref a a
lx a
y
~
y
0.1
(23)
u
0
ud
10
Resultado Experimental
Los controladores propuestos fueron implementados en el
robot mvil PIONEER P3-AT, el cual admite como seales
de referencia las velocidades lineal y angular.
La Fig. 13 muestra las acciones de control del robot
mvil. La velocidad deseada v(t) a lo largo del camino y la
velocidad del robot se muestra en la Fig. 14.
0 rad x 1 m y 1 m
Condicin inicial: c
0.4
Velocidad deseada en el camino: v t
m / s
1 kv
Camino a seguir
y [m]
0,5
Camino del
Robot Mvil
0
z [m]
15
Tiempo [s]
0.5
0
-0,5
1
1.5
2.5
3.5
x [m]
4.5
5.5
[6]
[7]
[8]
[9]
[10]
[11]
[12]
[13]
[14]
[15]
[16]
[5]
[17]
http://www.roboticajoven.mendoza.edu.ar/
Barrientos A, Pein L, et al, Fundamentos de Robtica, Segunda
Edicin. McGraw-Hill, Espaa 2007.
Arranz lvaro, Balias Jorge et al., Aplicaciones de robots mviles,
Universidad de Alcal, Archivo PDF, Noviembre 2006
Gonzlez Vctor, Lpez Antonio, Control y Robtica - Curso en lnea
Robots Mviles,
http://platea.pntic.mec.es/vgonzale/cyr_0708/archivos/_15/Tema_5.5.
htm
Lozano Toms, Foreword: Movile Robot and Robotics.
Autonomous Robot Vehicles.Editores I.J,Cox y G.T. Wilfong.
Springer-Verlag, 1990
Secchi Humberto, Una Introduccin a los Robots Mviles,
Universidad Nacional de San Juan, Archivo PDF, 2008
Silva R., Barrientos V., et al., Una Panormica De Los Robots
Mviles, Universidad Rafael Belloso Chasn, Archivo PDF, 2007
Khalil H., Nonlinear Systems, Second Edition, Prentice-Hall, 1996.
Carrelli Ricardo Anlisis y control de sistemas no lineales,
Universidad Nacional de San Juan, 2004.
Slotine J., and Lie W., Applied Nonlinear Control,. Prentice-Hall,
1991.
Ollero Anbal Robtica; Manipuladores y Robots Mviles Primera
Edicin, Editorial Alfaomega-Marcombo, Espaa 2001.
Zhang Y., Kim J., et al., Dynamic Model Based Robust Tracking
Control of a Differentially Steered Wheeled Mobile Robot
Proceedings of the American Control Conference, Philadelphia,
Pennsylvania, pp. 850-85, 1998.
Reyes F. y Kelly R., On Parameter Identification of Robot
Manipulator, IEEE International Conference on Robotics and
Automatition, Albuquerque, New Mexico, pp.1910-1915, 1997.
BIOGRAFA
La Ing. Gabriela Andaluz Ortiz naci el
8 de julio de 1985 en la ciudad de
Ambato, Ecuador. Realiz sus estudios
superiores en la Escuela Politcnica
Nacional (EPN) donde obtuvo el ttulo
de Ingeniera en Electrnica y Control.