Está en la página 1de 8

CONTROL PREDICTIVO DE LA DINÁMICA DE UN

VEHÍCULO AUTÓNOMO
Guilherme V. Raffo∗ , Julio E. Normey-Rico§ , Francisco R. Rubio∗

Dept. Ingenierı́a de Sistemas y Automática, Universidad de Sevilla - España
{raffo, rubio}@cartuja.us.es
§
Dept. de Automação e Sistemas, Universidade Federal de Santa Catarina - Brasil
julio@das.ufsc.br

Resumen LEVEL 4

DIG P
DYNAMIC
ROUTE PLANNING

ITA ROC
IC
ON

L S ES
Este trabajo presenta el diseño de un controlador LEVEL 3

TR

IGN SIN
VEHICLE GUIDANCE
predictivo basado en modelo para las dinámicas

HA

AN G
C
lateral y longitudinal de un vehı́culo autónomo.

ME

DD
LEVEL 2

AT
El controlador propuesto se implementa mediante DYNAMIC CONTROL

A
una estructura en cascada con el control de la LEVEL 1
cinemática del vehı́culo para obtener las presta- SUBUNITS CONTROL

ciones deseadas a altas velocidades para el prob-


lema de seguimiento de trayectoria. Se utiliza un Figura 1: Niveles de control de un rma.
controlador predictivo descentralizado basado en el
modelo dinámico linealizado del vehı́culo. Los re-
sultados de simulación utilizando el controlador de Una de las cuestiones más importantes en el
la dinámica del vehı́culo en una estructura en cas- campo de vehı́culos autónomos con ruedas es el
cada confirman que la estrategia propuesta es un problema de seguimiento de trayectoria, que con-
solución prometedora. siste en el diseño de técnicas de control que tienen
Palabras clave: Vehı́culo autónomo, control el objetivo de asegurar que el vehı́culo seguirá un
predictivo, seguimiento de trayectoria, control de camino pre-definido [4]. Este problema es muy de-
deslizamiento lateral. pendiente del modelado del vehı́culo, puesto que
este es un requerimiento para el diseño de la ley de
control. Por causa de las caracterı́sticas multiva-
riable y no lineal de este problema, las estrategias
1 INTRODUCCIÓN de diseño de control para vehı́culos con ruedas es
una tarea muy compleja.
Un campo que ha motivado muchas investiga-
Los métodos de seguimiento de trayectoria están
ciones en los últimos años es la navegación de
basados en la estimación del error entre la posición
robots (o vehı́culos) móviles autónomos (rmas)
actual del vehı́culo y el camino de referencia a
[1, 5, 8, 12]. Dado el amplio espectro de apli-
seguir. El problema de seguimiento de trayec-
caciones en este campo, varias metodologı́as dis-
toria en un vehı́culo autónomo puede ser abor-
tintas han sido desarrolladas para tratar de los
dado usando tres metodologı́as: (i) considerando
problemas de modelado, diseño y control de tales
solo el modelo cinemático; (ii) considerando solo
sistemas. Los rmas pueden ser usados con difer-
el modelo dinámico; o (iii) considerando ambos los
entes propuestas, incluido el aumento del confort,
modelos cinemático y dinámico. Varios trabajos
optimización del consumo de gas y emisión de
presentados en la literatura resuelven este prob-
polución, y lo más importante, incremento de se-
lema considerando solamente modelos cinemático
guridad [8, 12].
de los robots [14, 9]. En estos trabajos los autores
La estructura de control para navegación de argumentan que el modelo cinemático es valido
vehı́culos autónomos se organiza de forma cas- cuando el robot trabaja a bajas velocidades, ba-
cada, como se presenta en la Figura 1. En el jas aceleraciones, y las condiciones de carga están
nivel más alto (nivel 4) se hace la planificación ligeramente por debajo de las que los robots ope-
de la navegación y la generación de la trayecto- ran [2]. El modelo cinemático no puede prede-
ria. Los algoritmos de control para seguimiento cir con precisión la localización y posición del
de trayectoria basados en los modelos cinemáticos vehı́culo cuando estas condiciones no son cum-
están generalmente localizados en el nivel 3, mien- plidas. Ası́, cuando los vehı́culos son diseñados
tras el control de la dinámica esta en el nivel 2. Fi- para desempeñar trabajos pesados y para re-
nalmente, los sistemas de control sensor/actuador alizar trayectos a altas velocidades, el modelado
están en el nivel 1 [12]. dinámico de estos vehı́culos es muy importante
para su control. 2 DESCRIPCIÓN Y MODELO
Por otro lado, otras estrategias solo consideran el DINÁMICO DEL VEHÍCULO
control del robot a partir del modelo dinámico [2].
En [11, 13] el seguimiento de trayectoria se ejecuta
usando solo las dinámicas del vehı́culo, mientras
su posicionamiento se obtiene a través de la inte-
gración de los estados del modelo dinámico.
Esta claro que una representación completa debe
considerar el modelo cinemático describiendo la
posición y orientación del robot, y el modelo
dinámico describiendo el efecto de las fuerzas gen-
eralizadas aplicadas. Solo unas pocas soluciones
son presentadas en la literatura enfocando este
problema [7].
Sin embargo, los vehı́culos están dotados de partes
mecánicas y electrónicas, las cuales están sujetas
a limitaciones fı́sicas del sistema. Ası́, cuando
las restricciones pueden ser consideradas, los al- Figura 2: Vehı́culo Autónomo Mini-Baja.
goritmos cpbm se presentan como una interesante
elección. Además, el cpbm permite utilizar refer-
encias previamente conocidas y poder utilizarlas
en el cálculo de la ley de control [9].
El vehı́culo autónomo utilizado en este estudio es
El cpbm calcula las acciones de control para un
un Mini-Baja (Figura 2), un vehı́culo de aprox-
determinado horizonte de tiempo futuro, mini-
imadamente 200kg con tracción en las ruedas
mizando una determinada función de coste con
traseras y un motor de combustión de cuatro tiem-
respecto a determinadas variables de decisión y
pos. Estas ruedas son fijas y paralelas al eje longi-
considerando un conjunto de restricciones impues-
tudinal del vehı́culo. La conducción del vehı́culo es
tas. Utiliza un modelo explı́cito del proceso para
realizada a través del eje de las ruedas delanteras
realizar el cálculo de la predicción del compor-
que posee un ángulo máximo de giro de ∼ 0, 79rad.
tamiento futuro [3].
Los parámetros del vehı́culo Mini-Baja son presen-
Dado que las trayectorias son normalmente cono- tados en la Tabla 1.
cidas y que puede ser usada una instrumentación
Para desarrollar el controlador de la dinámica del
adecuada en el vehı́culo que informe sobre su
vehı́culo, en primer lugar se obtiene un modelo
desplazamiento y localización, o bien con infor-
matemático. Por otro lado, debido al hecho de
mación del entorno donde se encuentra, el con-
utilizar un cpbm lineal para la implementación, el
trolador predictivo se presenta como muy apropi-
modelo matemático ha tenido que ser manipulado
ado para esta tarea. Además de conducir el
a fin de obtener un modelo lineal.
vehı́culo suavemente y mejorar su autonomı́a el
cpbm puede ser fácilmente extendido a sistemas El análisis de las dinámicas del vehı́culo se realiza
multivariables. cuando la masa, la carga y la potencia necesaria
para moverlo son consideradas. En diversas apli-
En este trabajo se presenta un controlador pre-
caciones es necesario controlar las dinámicas del
dictivo aplicado a la dinámica de un vehı́culo
vehı́culo para garantizar que el vehı́culo seguirá el
autónomo (nivel 2 de la Figura 1). Este contro-
camino especificado con buen desempeño en ve-
lador se utiliza en una estructura en cascada con
locidades más altas [2]. Se ha obtenido el mo-
el controlador de la cinemática presentado en [10].
delo dinámico de un robot móvil del tipo Acker-
El trabajo esta organizado de la siguiente manera: man, el cual es similar a un coche convencional, a
primeramente son presentados la descripción del través de las Leyes de Newton y considerando que
vehı́culo y su modelo dinámico. En 3 se describe el vehı́culo se mueve en una superficie plana. El
la estrategia utilizada. El apartado 4 aborda la es- modelo comprende los movimientos longitudinal y
tructura cascada describiendo el control predictivo lateral que son usados en el control de velocidad
para la dinámica, ası́ como resultados de simu- longitudinal y lateral, respectivamente. Debido a
lación. El artı́culo termina con las conclusiones que las variaciones de velocidad son más lentas
del trabajo. que los movimientos de dirección, una estructura
de control cascada para las dinámicas puede ser
utilizada.
2.1 MODELO DINÁMICO DE UN • Equilibrio de fuerzas actuantes en el eje yL :
VEHÍCULO ACKERMAN
−FCF · cosβ + FyT + FyA + FxD · sinδD
(2)
El modelo dinámico se obtiene analizando las
+FyD · cosδD = m · v̇ · sinβ .
fuerzas que ocasionan desplazamiento lateral y
longitudinal en el plano xL − yL del sistema de
• Equilibrio de pares alrededor del eje :
coordenadas fijo en el vehı́culo y movimientos de
rotación en torno del eje zL . (FyD · cosδD + FxD · sinδD ) · dD − FyT · dT
Sin embargo para el control de seguimiento de
trayectoria, algunas simplificaciones deben ser +FyA · dA = Jz · θ̈ .
(3)
consideradas: se asume que el cm (centro de
masa) está al nivel del suelo, las influencias
aerodinámicas están concentradas en un punto ca donde β es el ángulo de deslizamiento lateral del
(centro aerodinámico), los movimientos de sus- chasis, θ̇ es la velocidad de rotación del vehı́culo
pensión son despreciables, el peso es igualmente en el cm, v es la velocidad lineal del vehı́culo en el
distribuido a lo largo del chasis y las ruedas de un cm, rc es el radio de curvatura, Jz es el momento
mismo eje son representadas por una rueda posi- de inercia total alrededor del eje vertical, dD y dT
cionada en el centro de este. Por lo tanto, los son las distancias del eje delantero y trasero al cen-
movimientos de rotación alrededor de los ejes xL tro de gravedad, respectivamente, cD y cT son los
y yL pueden ser despreciados. Estas simplifica- coeficientes de adherencia de los neumáticos de-
ciones llevan al modelo de bicicleta bien conocido lanteros y traseros, respectivamente, m es la masa
de un vehı́culo tipo Ackerman [5]. total del carro, FCF es la fuerza centrı́fuga, FxD y
FyD son las fuerzas de tracción en la rueda de-
lantera, FxT y FyT son las fuerzas de tracción
en la rueda trasera y FxA y FyA son las fuerzas
aerodinámicas.
Basándose en las ecuaciones (1)-(3) y en el de-
sarrollo de las fuerzas presentado previamente, un
nuevo conjunto de ecuaciones describiendo el com-
portamiento dinámico del vehı́culo con respecto
a las variables deseadas (β, θ̇ y v) puede ser
obtenido:
 
cT dT − cD dD cosδD ca Ac vrc
β̇ = θ̇ · − 1 +
mv 2 cosβ 2mcosβ
 
cT + cD cosδD v̇tgβ
−β − (4)
mvcosβ v

FxD sinδD cD δD cosδD


+ +
mvcosβ mvcosβ

β ca Ac v 2 rc dA
θ̈ = (cT dT − cD dD cosδD ) +
Jz 2Jz

FxD dD sinδD cD dD δD cosδD


+ + (5)
Jz Jz
Figura 3: Diagrama de Fuerzas del Automóvil.
θ̇
cT d2T + cD d2D cosδD


Jz v
El análisis del diagrama de fuerzas presentado en
la Figura 3 conduce a las ecuaciones (1)-(3), las
  FxT ca Ac v 2 rc
v̇ = vtg(β) θ̇ + β̇ + −
cuales relacionan las componentes de fuerza en xL mcosβ 2mcosβ
y yL y los pares alrededor del eje zL .   (6)
FxD cosδD cD sinδD dD θ̇
+ − −β + δD −
mcosβ mcosβ v
• Equilibrio de fuerzas actuantes en el eje xL :
2.1.1 Modelo Dinámico Linealizado
FCF · sinβ + FxT − FxA + FxD · cosδD
(1) El modelo dinámico es linealizado para su apli-
−FyD · sinδD = m · v̇ · cosβ ; cación con el cpbm lineal. El modelo lineal se
obtiene en dos fases. Primero, resolviendo la ex- El modelo dinámico de la velocidad linealizado
presión de las dinámicas del ángulo del vector ve- se calcula considerando que, en cada periodo de
locidad, β, con respecto al eje x, y las dinámicas muestreo, la velocidad angular y el ángulo de
de la velocidad angular, θ̇, considerando la ve- deslizamiento del chasis son idénticos a los valo-
locidad lineal constante. Ası́, en una segunda res de referencia. Este modelo fue obtenido ex-
fase, un modelo linealizado de la velocidad del perimentalmente a través del análisis de la res-
puesta al escalón del sistema, presentado en [6].
vehı́culo es identificado. Este procedimiento es Como el vehı́culo de test tiene tracción solo en el
necesario porque la dinámica de velocidad es sig- eje trasero, la fuerza FxD es despreciada y solo
nificativamente más lenta que los otros elementos la fuerza FxT es considerada, la cual es propor-
del modelo dinámico. En otras palabras, el pe- cional al par del motor de combustión. Por ello,
riodo de muestreo para el bucle de control de v la variable de entrada del modelo puede ser la
es más grande que para el bucle de β y θ̇, y du- aceleración angular de la rueda trasera ω̇RT . En
rante Tv /Tβ, θ̇ periodos de muestreo la velocidad este trabajo se ha considerado que el vehı́culo
v puede ser considerada constante. esta en movimiento y el motor de combustión esta
funcionando en régimen permanente, ası́ las no-
Para las expresiones dinámicas (4) y (5) las varia- linealidades de este tipo de motor son también ig-
ciones de los ángulos β y δD pueden ser consi- noradas. Por lo tanto, la ecuación diferencial que
deradas pequeñas en cada periodo de muestreo. relaciona la velocidad y la aceleración angular de
Por lo tanto, expandiendo cosβ, sinβ, cosδD y la rueda trasera es definida como un sistema lineal
sinδD usando Series de Taylor y truncándolas des- de segúndo orden [6]:
pués del primer termino, cosβ ≃ 1, sinβ ≃ β,
cosδD ≃ 1 y sinδD ≃ δD puede ser consider- (TM gas +TV ) 1
v̈ = − TM gas ·TV
· v̇ − TM gas ·TV
·v
ado. Para el vehı́culo usado en este trabajo las (11)
fuerzas aerodinámicas son muy pequeñas y pueden VV acel
ser despreciadas. Entonces, las expresiones linea- + TM gas ·TV
· ω̇RT ,
lizadas para β y θ̇ conducen a [6]: donde TMgas y TV son las constantes de tiempo
del motor y del vehı́culo, respectivamente, y VV acel
  c + c 
cT · dT − cD · dD T D
β̇ = θ̇ · −1 −β·
m · v2 m·v representa la ganancia del sistema.

FxD · δD cD · δD
+ + 3 ESTRATEGIA DE CONTROL
m·v m·v
(7)
β cD · dD · δD La estrategia de control utilizada en este trabajo
θ̈ = · (cT · dT − cD · dD ) +
Jz Jz esta basada en la idea de la Figura 1.
(8)
θ̇  FxD · dD · δD Aquı́ solo se analiza el nivel de control 2. El con-
− · cT · d2T + cD · d2D +
Jz · v Jz trol de la cinemática (nivel 3) para seguimiento de
trayectoria fue presentado en [10]. Los sistemas
El modelo dinámico resultante, por lo tanto, es de control local (nivel 1) utilizados para actuar
válido para aceleraciones laterales hasta 4m/s2 directamente en el acelerador, frenos y volante se
[5]. Además, con el objetivo de obtener un consideran definidos. El sistema de supervisión
movimiento sin deslizamiento lateral, β debe tener
en el nivel 4 calcula la trayectoria deseada para
el mismo signo que el ángulo de dirección δD . Ası́
que, analizando la ganancia estática de la función unir la posición inicial y final predefinida en el sis-
de transferencia β(s)/δD (s) y usando las ecua- tema de coordenadas globales. También, en este
ciones (7) y (8), se obtiene la siguiente relación: nivel se ejecuta un algoritmo adaptativo que de-
fine el parámetro lookahead de la estrategia Pure-
cT cD dT (dT + dD ) − cD dD mv 2 Pursuit. Con esta información, la trayectoria de
Keβ = >0,
cT cD (dT + dD )2 + mv 2 (cT dT − cD dD ) aproximación se calcula con la finalidad de generar
(9)
r señales de referencia para los controladores predic-
cT dT (dT + dD )
vmax < . (10) tivos del tercer nivel y de la velocidad.
dD m
Notar que la máxima velocidad del vehı́culo El control cinemático puede generar un compor-
(vmax ) es dependiente del coeficiente de adheren- tamiento aceptable cuando las velocidades y acel-
cia del neumático trasero, y es el único parámetro eraciones del vehı́culo están por debajo de deter-
variable. A partir de esta relación se define minados limites, donde el efecto de la masa y la
la velocidad donde el uso del controlador de la carga podrı́an ser despreciados. Este no es el caso
dinámica del vehı́culo se torna necesario para el del vehı́culo analizado cuando es necesario que tra-
problema de seguimiento de trayectoria. En el baje a velocidades > vmax . Ası́, un controlador
apartado 4 se presentan simulaciones que cor- predictivo se utiliza para controlar las dinámicas
roboran que controlando el vehı́culo solo con la del vehı́culo. Este controlador es implementado
cinemática con v > vmax se pierden prestaciones. en una estructura cascada con el controlador de la
cinemática, por lo que sus señales de control fu- angular de la rueda de tracción es dada por:
turas son usadas como señales de referencia en el VV acel
bucle de control de la dinámica. G(s)vel = . (13)
TM gas TV s2 + (TM gas + TV )s + 1
Tres son las variables controladas en este nivel:
Utilizando las funciones de transferencias (12)
la velocidad longitudinal, la velocidad angular y y (13) discretizadas se obtienen los polinomios
ángulo de deslizamiento del chasis. Como las A z −1 e B z −1 del sistema y, con estos, se llega

dinámicas de velocidad son más lentas que las al modelo carima,
otras dos dinámicas, se propone un controlador 
descentralizado. Se utilizan, un GPC monovari- C z −1
A z −1 · y(k) = B z −1 · u(k − 1) +
 
· e(k) ,
able para en el control de velocidad y un GPC ∆
(14)
multivariable para el control de la velocidad an-
El algoritmo gpc se ejecuta en los dos bucles de
gular y del ángulo de deslizamiento del chasis, por control del modelo dinámico del vehı́culo. Este
lo que el ángulo de dirección de la rueda delantera controlador consiste en el cálculo de la ley de con-
es una variable manipulada. El desarrollo de cada trol que minimice la función de coste definida por:
uno de estos controladores se analiza en el próximo
apartado. J = (ŷ − yr )′ Q (ŷ − yr ) + ∆u′ R∆u (15)

donde el vector de predicción ŷ se obtiene uti-


4 CONTROL PREDICTIVO lizando el modelo carima. La predicción puede
ser calculada como una función de las acciones de
APLICADO AL MODELO control futuro ∆u y la respuesta libre f:
DINÁMICO
ŷ = G∆u + f , (16)
Para mejorar el comportamiento en bucle cerrado donde la matriz G es una matriz de respuesta a
se utiliza una configuración en cascada con los con- escalón constante.
troladores dinámico y cinemático. La estructura
cascada se representa en 4. En el caso sin restricciones la solución de la
función de coste es dada de forma analı́tica:
La ecuación (6) se utiliza para representar el mo-
delo dinámico de velocidad del vehı́culo mientras ∆u(k) = k · (yr − f) (17)
las ecuaciones (4) y (5) son utilizadas, respecti-
vamente, para el modelo dinámico del ángulo de donde k es la primera fila de la matriz
deslizamiento del chasis y para la dinámica de la −1
G′ · Q · G + R · G′ · Q y yr es el vector de
velocidad angular.
referencias futuras. En el caso con restricciones,
Para el diseño del controlador de la dinámica de un algoritmo de optimización resuelve el problema
velocidad las otras dos se ignoran. Esta aproxi- en cada periodo de muestreo.
mación simplifica el controlador y está basada en
la observación que las variaciones de velocidad son Las leyes de control lineal utilizadas para contro-
más lentas que las dinámicas de las otras dos varia- lar el modelo dinámico del vehı́culo sin considerar
bles. Para el controlador de las variables β y θ̇ se restricciones son definidas como sigue:
asume que la velocidad es constante durante un 
βref (k + 1)

periodo de muestreo. La función de transferen-  .. 
cia para los dos controladores dinámicos fueran 
 . 

derivadas de las ecuaciones (7), (8) y (11). Los  βref (k + N2β ) 
∆δD (k) = K · (yref − f ) , yref =
 
siguiente modelos fueron obtenidos:  θ̇ref (k + 1) 


 .. 

1

es + de + bf
  . 
G(s)β,θ̇ = θ̇ref (k + N2θ̇ )
s2 + (a + d)s + (ad − bc) f s + af + ce
(12) (18)
donde: y
vref (k + 1)
 
cT + cD cT · dT − cD · dD
a= , b= −1, ..
m·v m · v2 ∆ωRT (k) = K·(vref −f ) , vref =

.


cT · dT − cD · dD cT · d2T + cD · d2D vref (k + N2v )
c= , d= , (19)
Jz Jz · v

cD + FxD dD · (cD + FxD )


e= , f= . También se ha incluido un filtro paso bajo en la
m·v Jz
referencia de velocidad como: vref F (k + 1) = α ·
y la función de transferencia que relaciona la ve- vref F (k) + (1 − α) · vref (k), donde α = 0, 95 fue
locidad tangencial del vehı́culo con la aceleración sintonizado.
   

     



(
  +  
*&       
 
 
 

 (
- '
 (

)*  
(
 %  + 
 *& 
 6  <      3
12 "/0$   

 

δ D(n),δ D(n + 1),


( 
 

  >
7

 1 "#/0$    (n + j) /
- *

 9:;   

δDref (k)
@ref
 ?ref (n + j)  ."/0$ % &
' 
  


 


  

 8
 ,


    (n)
'
 
 "#$ !
'
 δD    (n)    y(k)
 


(
    "#$
ωRT v(k)
4  

 

 (
- '
 (

) 
(
   *  
%  
21 "#/0$  4 5
 

ωRT(k), ωRT(k + 1),


/
= + j)  ."#/0$ % &
ref (k ' 
,


   
'
 

'


Figura 4: Estructura de Control Cascada para la Cinemática y Dinámica.

Varias simulaciones fueron utilizadas para ilus- 60

trar las ventajas de la estructura en cascada con- 50


siderando el controlador predictivo de la dinámica
del vehı́culo propuesto. Solo un conjunto de 40

parámetros fueron ajustados para todos los ca- 30


sos usando la siguiente estrategia. Los horizontes
y [m]

fueran elegidos para capturar las dinámicas domi- 20

nantes de cada bucle y para obtener una acción de 10


control suave. Para el controlador cinemático fue
necesario incrementar los pesos de ponderación a 0 Referencia
Controlador CD vD=9m/s
fin de aumentar la robustez. El control de veloci- −10
Controlador C vD=9m/s
Controlador CD vD=18m/s
dad fue ajustado para lograr una respuesta más Controlador C vD=18m/s
rápida y sin oscilación en bucle cerrado. −20
−20 −10 0 10 20 30 40 50
x [m]
Ası́, los siguiente parámetros fueron elegidos:
N2β,θ̇ = [10 10]′ , NuδD din = [10], Qβ,θ̇ = Iβ,θ̇ , Figura 5: Seguimiento de trayectoria en el plano
RδD din = [0, 5], N2v = [20], Nuω̇RT = [20], xy.
Qv = [1], Rω̇RT = [0, 05].
Resultados de simulación comparando el control
CD (Cinemático-Dinámico) con el C (Cinemático)
se muestran a continuación. Para los ensayos se
usa una trayectoria de referencia rectangular con en cascada con el controlador de la cinemática o
los bordes redondeados con una velocidad de vD = solo el controlador cinemático con velocidad de
9m/s y vD = 18m/s en las rectas y reducidas vD = 9m/s son muy similares. Este resultado
un 20% en la curvas, y una posición inicial x0 = era esperado a partir de la expresión (10), pues
[−1 − 5 0]′ . para los parámetros del vehı́culo analizado vmax =
Los resultados de simulación muestran las mejoras 9.44m/s. Sin embargo, si v > vmax el esquema en
obtenidas usando el control CD a pesar de con- cascada ofrece mejor comportamiento a pesar de
siderar un modelo simple para calcular las predic- presentar deslizamiento lateral del vehı́culo, mien-
ciones en el control de la dinámica. Como se puede tras utilizando solo el control de la cinemática
ver en las Figuras 5-9, el seguimiento de trayec- el vehı́culo se obtiene un comportamiento fuerte-
toria usando el controlador del modelo dinámico mente oscilatorio, como se puede percibir en las
gráficas de δD y θ̇.
0.15 40 Controlador CD v =9m/s

ωRT [rad/s]
D
0.1 Controlador C v =9m/s
δD [rad] D
20
0.05

0 0
Controlador CD vD=9m/s
−0.05 Controlador C v =9m/s
D −20
Referencia
−0.1 0 5 10 15 20 25
0 5 10 15 20 25
tiempo [s] tiempo [s]

Controlador CD vD=18m/s

ωRT [rad/s]
0.2
Controlador C v =18m/s
[rad]

0.1 50 D

0
−0.1
D

0
δ

Controlador CD vD=18m/s
−0.2
Controlador C vD=18m/s
−0.3
Referencia −50
−0.4
0 2 4 6 8 10 12 0 2 4 6 8 10 12
tiempo [s] tiempo [s]

Figura 6: Acción de Control δf . Figura 9: Acción de control ωRT .

1
Controlador CD vD=9m/s
Controlador C vD=9m/s
autónomo.
0.5 Referencia
θ [rad/s]

La arquitectura de los controladores considera


un control descentralizado para la dinámica del
°

0
vehı́culo. Se demostró que para altas prestaciones
−0.5
0 5 10 15 20 25 de seguimiento es necesario usar el esquema com-
tiempo [s]
pleto con los dos controladores trabajando en una
3
configuración cascada.
2
1
Se han presentado resultados de simulación con
θ [rad/s]

0
−1 el modelo del vehı́culo autónomo Mini-Baja para
°

Controlador CD v =18m/s
−2 D
Controlador C v =18m/s
D
mostrar las buenas cualidades de la metodologı́a
−3
−4
Referencia propuesta.
0 2 4 6 8 10 12
tiempo [s]
Agradecimientos
Figura 7: Velocidad angular θ̇. Los autores desean agradecer a M.Eng. Guilherme
Gomes, a Dr. Christian Kelber, a Dr. Leandro
10.5 Becker, al MCyT la financiación de este trabajo
Controlador CD v =9m/s
10 D
Controlador C v =9m/s
D
con cargo al proyecto de investigación DPI2004-
v [m/s]

9.5
9
Referencia
06419 y a las agencias de Investigación Brasileña
8.5 CAPES, CNPq y FAPESC.
8
7.5
7
0 5 10 15 20 25 Referencias
tiempo [s]

21
Controlador CD v =18m/s
[1] O. Amidi. Integrated Mobile Robot Con-
20 D
Controlador C vD=18m/s trol. Technical Report CMU-RI-TR-90-17,
v [m/s]

19
Referencia
18 Robotics Institute, Carnegie Mellon Univer-
17 sity, Pittsburgh, PA, May 1990.
16
15
[2] F. D. Boyden and S. A. Velinsky. Dynamic
14
0 2 4 6
tiempo [s]
8 10 12 Modeling of Wheeled Mobile Robots for High
Load Applications. In Proc. of the 1994
Figura 8: Velocidad longitudinal v. IEEE International Conference on Robotics
and Automation, volume 4, pages 3071–3078,
San Diego, USA, 1994.
5 CONCLUSIONES
[3] E. F. Camacho and C. Bordons. Model Pre-
dictive Control. Springer-Verlag, New York,
Este trabajo presenta el análisis, diseño, sintonı́a e 1998.
implementación de un controlador predictivo para
la dinámica de un vehı́culo en una estructura en [4] C. Canudas De Wit, H. Khennouf, C. Sam-
cascada con el controlador de la cinemática para el son, and O. J. Sørdalen. World Scientific
problema de seguimiento de camino de un vehı́culo Series in Robotics and Intelligent Systems,
Tabla 1: Datos del vehı́culo autónomo analizado.
Constantes del Vehı́culo Cantidad
Masa m ≃ 200kg
Distancia de las ruedas delanteras hasta el centro de masa dD = 0, 75m
Distancia de las ruedas traseras hasta el centro de masa dT = 0, 80m
Constante de adherencia del neumático delantero cD = 10780N
Constante de adherencia del neumático trasero cT = 10780N
Radio de las ruedas delanteras y traseras Rr = 0, 18m
Distancia entre las ruedas delanteras dR = 0, 975m
Momento de inercia con respecto al eje zL del vehı́culo Jz = 56, 07083N m
Constante de tiempo del motor TMgas = 2, 5s
Constante de tiempo del vehı́culo TV = 2, 5s
Ganancia entre la fuerza necesaria para desplazar el VV acel = 4, 1
vehı́culo y la fricción que este es sometido

chapter Nonlinear Control Design for Mobile com CPBM. In XVI Congresso Brasileiro de
Robots, pages 121–157. World Scientific Pub- Automática, Salvador, Brasil, 2006.
lisher, 1993.
[11] N. Sarkar, X. Yun, and V. Kumar. Dynamic
[5] R. Isermann. Diagnosis Methods for Elec- Path Following: A New Control Algorithm
tronic Controlled Vehicles. Vehicle System for Mobile Robots. In Proc. of the 32nd
Dynamics: International Journal of Vehi- IEEE International Conference on Decision
cle Mechanics and Mobility, 36(2-3):77–117, and Control, pages 2670–2675, San Antonio,
2001. USA, 1993.

[6] C. R. Kelber, D. Webber, G. K. Gomes, M. A. [12] J. Wit, C. D. Crane III, and D. Armstrong.
Lohmann, M. S. Rodrigues, and D. Ledur. Autonomous Ground Vehicle Path Tracking.
Active Steering Unit with integrated ACC for Journal of Robotic Systems, 21(8):439–449,
X-by-Wire Vehicles using a Joystick as H.M.I. 2004.
In Proc. of the IEEE / IV2004 - Intelligent
[13] J. Yang and J. Kim. Sliding Mode Con-
Vehicles Symposium, pages 173–177, Parma,
trol for Trajectory Tracking of Nonholonomic
Italy, 2004.
Wheeled Mobile Robots. IEEE Transactions
[7] B. Kim, D. S. Necsulescu, and J. Sasiadek. on Robotic and Automation, 15(3):578–587,
Model Predictive Control of an Autonomous 1999.
Vehicle. In Proc. of the IEEE International [14] X. Yang, K. He, M. Guo, and B. Zhang. An
Conference on Advanced Intelligent Mecha- Intelligent Predictive Control Approach to
tronics, pages 1279–1284, 2001. Path Tracking Problem of Autonomous Mo-
[8] J. Manigel and W. Leonhard. Vehicle Con- bile Robot. IEEE International Conference
trol by Computer Vision. In IEEE Trans- on Systems, Man, and Cybernetics, 4:3301–
3306, 1998.
actions on industrial electronics, volume 39,
pages 181–188, 1992.

[9] J. E. Normey-Rico, J. Gómez-Ortega, and


E. F. Camacho. A Smith-Predictor-Based
Generalised Predictive Controller for Mobile
Robot Path-Tracking. In Control Engineering
Practice, volume 7, pages 729–740, London,
England, 1999.

[10] G. V. Raffo, G. K. Gomes, J. E. Normey-


Rico, L. B. Becker, and C. R. Kelber. Segui-
mento de Trajetória de um Veı́culo Mini-Baja

También podría gustarte