Escolar Documentos
Profissional Documentos
Cultura Documentos
Orientador:
Co-orientador:
CDU 004.823(043.3)
Resumo
Esta tese apresenta o desenvolvimento de uma nova estrutura de controlador adaptativo robusto aplicado a sistemas robticos mveis com rodas (rob mvel de superfcie)
e restries no-holonmicas de movimento. Este controlador atua tanto na dinmica
como na cinemtica do rob, e pode ser dividido em duas partes distintas. A primeira
parte controla a dinmica, atravs da utilizao de controladores adaptativos por modelo
de referncia e estrutura varivel. A segunda parte controla a cinemtica do rob atravs
de um controlador de posio, cujo objetivo fazer com que o rob seja capaz de atingir
um ponto qualquer no plano cartesiano, sendo que este controlador cinemtico baseado
apenas em informaes da configurao do rob.
O trabalho aplica um mtodo de desacoplamento para transformar o modelo linear do
rob mvel, que um sistema com mltiplas entradas e mltiplas sadas, em dois sistemas
desacoplados com apenas uma entrada e uma sada cada um, para reduzir a complexidade
do projeto do controlador. Em seguida, aplica-se um controlador adaptativo por modelo
de referncia e estrutura varivel a cada um dos sistemas resultantes. Um controlador
ser responsvel pelo posicionamento e o outro pela orientao do rob, sendo que estes
controladores utilizam como referncias sinais provenientes do controlador cinemtico de
posio.
Para comprovar o funcionamento da estrutura proposta, obteve-se resultados simulados e experimentais para o rob mvel com acionamento diferencial de um kit de futebol
de robs. O simulador possui as principais caractersticas do sistema fsico real, dentre as quais podem-se destacar os rudos de entradas e as no-linearidades como zona
morta e saturao. Os resultados experimentais foram obtidos atravs de um programa
desenvolvido em C++ e aplicado a um kit de futebol de robs da empresa Microrobot no
Laboratrio de Acionamento, Controle e Instrumentao da Universidade Federal do Rio
Grande do Norte (LACI/UFRN). Os resultados simulados e experimentais so apresentados e discutidos ao final da tese.
Palavras-chave: Sistemas com Estrutura Varivel, Controle Adaptativo, Desacoplamento, Rob Mvel No-Holonmico.
Abstract
This thesis presents a new structure of robust adaptive controller applied to mobile
robots (surface mobile robot) with nonholonomic constraints. It acts in the dynamics and
kinematics of the robot, and it is split in two distinct parts. The first part controls the robot
dynamics, using variable structure model reference adaptive controllers. The second part
controls the robot kinematics, using a position controller, whose objective is to make the
robot to reach any point in the cartesian plan. The kinematic controller is based only on
information about the robot configuration.
A decoupling method is adopted to transform the linear model of the mobile robot,
a multiple-input multiple-output system, into two decoupled single-input single-output
systems, thus reducing the complexity of designing the controller for the mobile robot.
After that, a variable structure model reference adaptive controller is applied to each one
of the resulting systems. One of such controllers will be responsible for the robot position
and the other for the leading angle, using reference signals generated by the position
controller.
To validate the proposed structure, some simulated and experimental results using
differential drive mobile robots of a robot soccer kit are presented. The simulator uses
the main characteristics of real physical system as noise and non-linearities such as deadzone and saturation. The experimental results were obtained through an C++ program
applied to the robot soccer kit of Microrobot team at the LACI/UFRN. The simulated and
experimental results are presented and discussed at the end of the text.
Keywords: Variable Structure Systems, Adaptive Control, Decoupling, Nonholonomic Mobile Robot.
Lista de Figuras
1.1
1.2
1.3
1.4
2
2
4
1.5
1.6
2.1
2.2
2.3
10
15
15
3.1
3.2
3.3
3.4
3.5
3.6
.
.
.
.
.
.
20
21
22
23
26
29
4.1
4.2
Cinemtica do rob . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Diagrama esquemtico de um motor c.c. controlado pela armadura . . . .
32
33
5.1
5.2
5.3
5.4
5.5
5.6
5.7
5.8
5.9
5.10
5.11
5.12
5.13
39
40
40
40
41
42
43
43
44
44
45
46
46
6.1
6.2
.
.
.
.
.
.
.
.
.
.
.
.
5
6
6
6.3
6.4
6.5
6.6
6.7
6.8
6.9
6.10
6.11
6.12
6.13
6.14
6.15
6.16
6.17
6.18
6.19
6.20
6.21
6.22
6.23
6.24
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
54
55
55
56
56
57
57
58
58
59
60
60
61
61
62
63
63
64
65
66
66
67
81
84
H.1
H.2
H.3
H.4
H.5
H.6
H.7
H.8
H.9
H.10
H.11
H.12
H.13
H.14
H.15
H.16
H.17
H.18
100
100
101
101
102
102
103
103
104
104
105
105
106
106
107
107
108
108
H.19
H.20
H.21
H.22
H.23
H.24
H.25
H.26
H.27
H.28
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
109
109
110
110
111
111
112
112
113
113
I.1
I.2
J.1
J.2
J.3
Lista de Tabelas
3.1
3.2
J.1
ix
25
28
Nomenclatura
J
Jd,e
Kbd,be
constantes de fora-contra-eletromotriz
Kd,e
Rd,e
deslocamento linear
ST
Sre f
ang
d,e
lin
d,e
d,e
nom
ngulo do rob
re f
eS
erro de posio
xi
erro de orientao
ed,e
fr
id,e
massa do rob
nin
nout
rd,e
sinal de controle
vr
xd
xp
yd
yp
vetor regressor
ERP
LACI
MIMO
MRAC
PCI
SISO
UFRN
VS-MRAC
VSC
Sumrio
Sumrio
Lista de Figuras
Lista de Tabelas
ix
xi
1 Introduo
1.1 Sistema inverso . . . . . . . . . . . . . . . . . . . .
1.2 Controladores adaptativos robustos . . . . . . . . . .
1.3 Definio do problema . . . . . . . . . . . . . . . .
1.3.1 Aspectos da no-holonomia . . . . . . . . .
1.3.2 Consideraes sobre as incertezas do sistema
1.3.3 Controle do rob mvel . . . . . . . . . . .
1.4 Organizao da tese . . . . . . . . . . . . . . . . . .
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
1
1
2
4
5
5
6
7
2 Sistema inverso
2.1 Apresentao do sistema . . . . . . . . . . . .
2.1.1 Algoritmo de inverso . . . . . . . . .
2.1.2 Reprodutibilidade funcional assinttica
2.2 Inverso de um sistema linear . . . . . . . . . .
2.3 Modificao do sistema inverso direita . . . .
2.4 Comentrios finais . . . . . . . . . . . . . . .
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
9
9
10
12
13
14
17
.
.
.
.
.
.
.
.
19
19
22
25
29
.
.
.
.
.
31
31
33
34
34
36
3 Controladores adaptativos
3.1 Sistemas a estrutura varivel . . . . . . . . .
3.2 Controle adaptativo por modelo de referncia
3.3 Controlador VS-MRAC . . . . . . . . . . . .
3.4 Comentrios finais . . . . . . . . . . . . . .
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
4.6
4.7
5 Estrutura do controlador
5.1 Desacoplamento do sistema . . . . . . . . . . . . . . .
5.2 Controlador VS-MRAC . . . . . . . . . . . . . . . . .
5.3 Controlador de posio . . . . . . . . . . . . . . . . .
5.3.1 Anlise de estabilidade do controlador proposto
5.3.2 Anlise de estabilidade para o caso geral . . .
5.4 Comentrios finais . . . . . . . . . . . . . . . . . . .
6 Resultados
6.1 Descrio do sistema . . . . . . . . . . . . . . . . .
6.2 Projeto do controlador . . . . . . . . . . . . . . . .
6.3 Simulao . . . . . . . . . . . . . . . . . . . . . . .
6.3.1 Rob mvel em malha aberta . . . . . . . .
6.3.2 Desacoplamento do rob mvel . . . . . . .
6.3.3 Controlador proposto aplicado ao rob mvel
6.3.4 Estabilidade do controlador proposto . . . .
6.4 Resultados experimentais . . . . . . . . . . . . . . .
6.4.1 Rob mvel em malha aberta . . . . . . . .
6.4.2 Desacoplamento do rob mvel . . . . . . .
6.4.3 Controlador proposto aplicado ao rob mvel
6.5 Comentrios finais . . . . . . . . . . . . . . . . . .
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
37
37
.
.
.
.
.
.
39
40
43
45
46
48
49
.
.
.
.
.
.
.
.
.
.
.
.
51
51
52
54
55
56
58
61
62
62
63
65
67
69
Referncias bibliogrficas
72
81
83
87
D Determinao de
89
91
F Anlise de estabilidade
F.1 Anlise de estabilidade do erro de orientao . . . . . . . . . . . . . . .
F.2 Anlise de estabilidade do erro de posio . . . . . . . . . . . . . . . . .
93
93
94
97
H Resultados
H.1 Simulao do desacoplamento sem incertezas .
H.2 Simulao do desacoplamento para o caso ideal
H.3 Simulao (xd = 1, yd = 0) . . . . . . . . . . .
H.4 Simulao (xd = 1, yd = 0) sem zona morta . .
H.5 Simulao (xd = 1, yd = 1) . . . . . . . . . . .
H.6 Simulao (xd = 0, yd = 1) . . . . . . . . . . .
H.7 Simulao (xd = 1, yd = 1) . . . . . . . . . .
H.8 Simulao (xd = 1, yd = 0) . . . . . . . . . .
H.9 Simulao (xd = 1, yd = 1) . . . . . . . . .
H.10 Simulao (xd = 0, yd = 1) . . . . . . . . . .
H.11 Simulao (xd = 1, yd = 1) . . . . . . . . . .
H.12 Simulao 01 com desacoplamento por (s2 )1 .
H.13 Simulao 02 com desacoplamento por (s2 )1 .
H.14 Simulao 03 com desacoplamento por (s2 )1 .
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
Sistema de viso
115
117
K Software desenvolvido
121
Captulo 1
Introduo
O avano da tecnologia embarcada tem permitido uma maior confiabilidade e autonomia no controle de sistemas multivariveis (sistemas com muitas entradas e/ou sadas,
MIMO -Multiple Input Multiple Output). Consequentemente, estes sistemas mais confiveis so cada vez mais aceitos e absorvidos pelo mercado industrial, militar, residencial,
dentre outros. Por outro lado, o amadurecimento da teoria de sistemas adaptativos tem
permitido a aplicao deste tipo de controladores aos mais diversos sistemas.
O foco deste trabalho est em apresentar uma nova estrutura de controle adaptativo
aplicado a um sistema com mltiplas entradas / mltiplas sadas (MIMO). Esta estrutura
utiliza desacoplamento atravs de uma tcnica por sistema inverso, que transforma um
sistema MIMO em um conjunto de sistemas com uma entrada e uma sada (sistemas
SISO - Single Input Single Output), associados a controladores adaptativos para garantir
o perfeito desacoplamento, o que pode ser interpretado como um desacoplador adaptativo.
O controlador proposto aplicado a um rob mvel com acionamento diferencial,
para a verificao de suas propriedades. A escolha por robs mveis se deu por sua presena nas mais variadas tarefas, tais como explorao de terrenos, execuo de atividades
em ambientes hostis, tarefas de auxlio em ambientes hospitalares e residenciais, etc.
Robs mveis aplicados a estas atividades resultam em sistemas com mltiplas entradas
e mltiplas sadas, com incertezas paramtricas e distrbios. Por isso, faz-se necessrio a
utilizao de uma tcnica de controle capaz de se adaptar para compensar estas incertezas
e distrbios. A tcnica de controle utilizada na tese ser o VS-MRAC, o qual, por utilizar
estrutura varivel, leva a um transitrio mais rpido que os controladores adaptativos que
utilizam leis integrais de adaptao.
CAPTULO 1. INTRODUO
x0
u(t)
Sistema
Fsico
x0
y(t)
Sistema
Inverso
u(t)
Sistema
Inverso
x0
u(t)
Sistema
Fsico
y(t) = f (t)
1.2
Uma viso geral sobre controle adaptativo pode ser obtida em um conjunto de livros
disponveis na literatura [Ioannou & Sun 1995, Astrm & Wittenmark 1994, Sastry &
Bodson 1989, Narendra & Annaswamy 1989]. A teoria de controle adaptativo pode ser
dividida em duas reas bsicas: uma supe que as variveis de estado so mensurveis
[Landau 1979], e a outra supe que somente medies da entrada e sada da planta so
disponveis [Narendra & Valavani 1978, Goodwin & Sin 1984, Goodwin & Mayne 1987].
Devido dificuldade de medio das variveis de estado do rob, a tcnica utilizada
neste trabalho ser a segunda, com uma abordagem por modelo de referncia. Nesta
abordagem, a funo do modelo de referncia especificar o comportamento desejado
para a planta. O erro entre as sadas da planta e do modelo de referncia utilizado por
um algoritmo de adaptao para ajustar os parmetros do controlador, de tal forma que
este erro tenda a zero, permitindo, assim, o rastreamento assinttico do modelo.
O controlador adaptativo por modelo de referncia MRAC, foi sugerido por Whitaker e outros [1958, 1961] para solucionar o problema de controle no piloto automtico
das aeronaves. Em 1966, Parks e outros aplicaram a teoria de Lyapunov s leis adaptativas baseadas nas regras do MIT(Massachusetts Institute of Technology) e utilizadas
nos controladores MRAC dos anos 50. Assim, apresentaram provas de estabilidades mais
rigorosas para os controladores adaptativos.
Alguns destes controladores foram acompanhados por diversas aplicaes bem sucedidas [Harris & Billings 1981, Narendra & Monopoli 1980, Unbehauen 1980]. No
trabalho de Egardt [1979] demonstrou-se que os controladores MRAC poderiam ser instveis na presena de pequenos distrbios, fato esse somente corrigido com a proposta
dos controladores adaptativos robustos [Egardt 1979, Ioannou & Sun 1988, Ioannou &
Datta 1991].
Nos dias de hoje, ainda se busca um controlador adaptativo robusto com um bom
comportamento tanto no transitrio como no regime permanente. Bons resultados esto
sendo obtidos integrando-se duas ou mais tcnicas distintas, explorando o que cada uma
tem de melhor.
Um exemplo bem sucedido de associao de tcnicas distintas o VS-MRAC (Controlador Adaptativo por Modelo de Referncia e Estrutura Varivel), o qual associa o controle
a estrutura varivel (VSC - Controlador por Estrutura Varivel) com o controlador MRAC.
Proposto na dcada de 50 na extinta Unio Sovitica por Emelyanov [1967], o VSC possui
bom comportamento transitrio, quando comparado ao controlador MRAC convencional,
que usa leis integrais de adaptao para fazer com que a sada da planta siga um modelo de referncia desejado [Ioannou & Sun 1995, Astrm & Wittenmark 1994, Sastry &
Bodson 1989, Narendra & Annaswamy 1989] (em geral o MRAC possui um transitrio
lento e oscilatrio).
O controlador VS-MRAC foi proposto por Hsu e Costa [1989], e utiliza a estrutura do
controle por modelo de referncia MRAC, substituindo as leis integrais de adaptao por
leis chaveadas, resultando, assim, em um sinal de controle chaveado, como nos sistemas
a estrutura varivel (em alguns artigos [Arajo et al. 1994, Hsu et al. 1997, Cunha et al.
2003] so apresentadas aplicaes). Apesar do bom desempenho transitrio, em geral
tem-se a presena do fenmeno de chattering1 .
O chattering pode deteriorar o desempenho do sistema pela introduo de um erro
oscilatrio na sada da planta. Alm disso, este chaveamento rpido das variveis de
controle no admissvel em muitas aplicaes, podendo levar a significativas perdas trmicas em sistemas eltricos de potncia e a desgastes excessivos em sistemas mecnicos.
Para superar o problema do chattering pode-se modifcar a funo rel por uma aproximao contnua que linear em uma vizinhana da superfcie de deslizamento [Slotine &
Sastry 1983].
1 Chattering o fenmeno originado pelas imperfeies nos mecanismos reais de chaveamento e/ou pela
dinmica no modelada da planta, que faz o chaveamento das variveis de controle em uma taxa rpida,
porm finita, e pode deteriorar o desempenho do sistema pela introduo de um erro oscilatrio na sada da
planta.
1.3
CAPTULO 1. INTRODUO
Definio do problema
Esta seo dedicada a apresentar o problema que se deseja solucionar, bem como
uma viso geral da soluo proposta na tese. Para iniciar, deve-se apresentar a plataforma2
onde sero desenvolvidos os estudos sobre o controlador proposto (ver Figura 1.3).
O item 1 da Figura 1.3 o rob o qual se deseja controlar. O item 2 a cmera, que
funciona como sensor de posio e orientao do rob. Por fim, o item 3 um computador
no qual a estratgia de controle ser embarcada.
O rob um cubo com aresta de 7cm e duas rodas laterais com acionamentos independentes atravs de dois motores de corrente contnua (motor c.c.) semelhantes. O
mesmo possui uma placa de processamento embarcada e um sistema de comunicao.
A comunicao serve para a troca de informaes entre o rob e o computador, o qual
responsvel por realizar os clculos dos sinais de tenso de armadura que devem ser
aplicados aos motores c.c. do rob.
Para realizar o clculo da tenso a ser aplicada a cada motor, o computador executa
o algoritmo de controle proposto nesta tese, o qual gera as tenses com base no erro da
posio do rob, que por sua vez obtida a partir da anlise das imagens capturadas por
uma cmera (sistema de viso [Aires et al. 2001]) localizada acima do campo, no qual o
rob se deslocar.
Sobre o rob ainda necessrio comentar dois aspectos importantes. O primeiro est
relacionado com uma restrio no movimento do rob (restrio no holonmica) que
apresentada na subseo 1.3.1. O segundo aspecto est relacionado com as incertezas
paramtricas e no linearidades do rob, que so comentadas na subseo 1.3.2
2 A plataforma de desenvolvimento deste trabalho est de acordo com as regras da MiroSot/Fira (Micro
Robot World Cup Soccer Tournament / Federation of International Robot-Soccer Association).
(a)
(b)
Figura 1.4: Estacionamento de um rob mvel: (a) sem restries; (b) com restries
no-holonmicas
Na Figura 1.4, a trajetria mais simples para estacionar o rob seria composta por
dois segmentos de reta perpendiculares (ver Figura 1.4(a)). Porm, esta trajetria de
impossvel realizao pelo sistema de locomoo. Desta forma torna-se necessrio gerar
uma trajetria levando-se em considerao as restries inerentes a este sistema, como
mostra a Figura 1.4(b). Na seo 4.1, ser descrita matematicamente a restrio noholonmica do rob mvel utilizado neste trabalho.
CAPTULO 1. INTRODUO
1.3.3
O rob poder ser representado por um sistema com duas entradas e trs sadas (ver
Figura 1.5), ou seja um sistema MIMO.
xp
ee
ed
Rob
yp
p
Figura 1.5: Diagrama de blocos do rob mvel com duas rodas tracionadas
O controle de posio de um rob mvel com acionamento diferencial deve, a partir dos sinais de controle ee,d (tenses de armadura nos motores c.c.), deslocar o rob
de um ponto qualquer (x p ,y p ) sobre uma superfcie para um outro ponto qualquer desejado (xd ,yd ). importante lembrar que o controle de posio no garante um caminho
especfico a ser realizado entre estes dois pontos (ver Figura 1.6).
yd
yp
xp
xd
dinmicos [Tounsi et al. 1995a, Tounsi et al. 1995b, Pereira 2000, Oliveira & Lages
2001, Tanner & Kyriakopoulos 2002] que se propem a controlar um rob mvel, alguns
sendo lineares e outros no-lineares [Samson 1993, Aicardi et al. 1995]. O uso de tcnicas adaptativas tambm j foi apresentado [Bugeja et al. 2009, Chen et al. 2009, Wu
et al. 2009, Bugeja & Fabri 2008, Bugeja & Fabri 2006, Oubbati et al. 2005, Albagul & Wahyudi 2004, Liu et al. 2004, Feng et al. 1994, Shim & Kim 1994, Stotsky
& Hu 1998, Lefeber & Nijmeijer 1999, Lee et al. 1999, Lages & Hemerly 2000, Kim
et al. 2000, Aguiar et al. 2000, Fukao et al. 2000, Ge & Zhou 2000, Dixon et al. 2001],
porm esta tese abordar o controle do rob mvel em duas etapas. A primeira ser o
controle de sistemas MIMO, atravs de uma tcnica de desacoplamento associada a um
conjunto de controladores adaptativos. Esta tcnica poder ser utilizada por todos os sistemas MIMO de uma classe especfica (ver Captulo 2). A segunda etapa ser projetar um
controlador cinemtico para controlar a posio do rob mvel.
Atualmente h vrios trabalhos que propem controladores que se adaptam, utilizando
redes neurais e/ou lgica fuzzy, para rejeitar as incertezas paramtricas existentes nos modelos dos robs mveis [Bugeja et al. 2009, Chen et al. 2009, Wu et al. 2009, Bugeja &
Fabri 2008, Bugeja & Fabri 2006]. Este trabalho propre um controlador com o mesmo
intuito, porm, ao invs das redes neurais e lgica fuzzy, ele utiliza um controlador adaptativo robusto.
CAPTULO 1. INTRODUO
Captulo 2
Sistema inverso
Este captulo destina-se a apresentar o algoritmo de inverso de sistemas no lineares
multivariveis proposto por Hirschorn [1979, 1981], e propor uma modificao na obteno deste sistema inverso para o caso de sistemas lineares. O algoritmo ser utilizado
pelo controlador proposto nesta tese para desacoplar o modelo do rob, que um sistema
MIMO, representando-o como dois sistemas SISO desacoplados.
Observao: As variveis definidas neste captulo so restritas ao mesmo.
x = A(x) + B(x)u; x M
y = C(x)
(2.1)
10
pela sada do sistema original. O sistema inverso utilizado desta forma denominado de
sistema inverso direita (ver Figura 2.1).
x0
f(t)
Sistema
Inverso
x0
u(t)
Sistema
Fsico
y(t)=f(t)
2.1.1
Algoritmo de inverso
x = A(x) + B(x)u; x M1
z1 = C1 (x) + D1 (x)u
onde
(2.2)
(2.3)
dy
dt
C1 (x) = R0 (x)C1 (x)
D1 (x) = R0 (x)D1 (x)
z1 = R0
e R0 uma matriz elementar nout nout a qual reordena as linhas dependentes de D1 (x) de
tal maneira que as primeiras r1 linhas sejam linearmente independentes para algum x M
e M1 um subconjunto de M. Denomina-se r1 de ndice de inversibilidade do sistema 1.
Constri-se, ento, indutivamente uma seqncia de sistemas no lineares, tal que o
k-simo sistema seja:
Sistema k:
x = A(x) + B(x)u; x Mk
zk = Ck (x) + Dk (x)u
11
onde Mk um subconjunto de M, Ck (x) e Dk (x) so matrizes nout 1 e nout nin , respectivamente, cujos elementos so funes analticas reais em Mk , e
Dk1 (x)
Dk (x) =
0
com Dk1 (x) sendo uma matriz rk nin de posto rk para todo x Mk .
Na construo acima, produzida uma seqncia de inteiros no negativos r1 , r2 , . . .,
onde rk denominado ndice de inversibilidade do k-simo sistema. Por construo,
0 r1 r2 r3 . . . nout .
Definio 2.2 A ordem de rastreamento do sistema 2.1 o mnimo inteiro positivo k,
tal que rk = nout ou = se rk < nout para todo k > 0.
Bi A j Rk (.) 0
em
(2.4)
zk
Hk (x)
zk =
=
Yk = Kk (x)Yk
zk
Jk (x)
onde
y(1)
Yk = ...
y(k)
y(i) =
dyi
dt i
Ck (x)
Hk (x)
Dk1 (x)
zk (x) =
Yk =
+
u(t)
Jk (x)
0
Ck (x)
Observa-se que, para < , o -simo sistema dado por
Sistema :
x = A(x) + B(x)u; x M
z = C (x) + D (x)u
12
onde a matriz D (x)nout nin de posto nout , tem a pseudo-inversa dada por
D (x) = DT (D DT )1
com D D = I em M e
z = K (x)Y = H (x)Y
2.1.2
Definio 2.3 Diz-se que uma funo f (t) definida em [0, ) pode ser reproduzida funcionalmente pela sada y(t) do sistema 2.1, para uma dada condio inicial x(0), se existe
algum controle u(.), tal que y(t) = f (t) para todo t [0, ).
Hirschorn [1981] deduziu uma condio suficiente para a reprodutibilidade funcional.
Teorema 2.2 Seja o sistema no linear 2.1 com ordem de rastreamento < e, para
2, supe-se que a condio 2.4 seja satisfeita.
Seja f (t) uma funo analtica real e o estado inicial x(0) = x0 M . Ento, f (.) =
y(., u, x0 ) para algum controle admissvel u, se e somente se,
onde
f (0) = C(x0 ) e
Jk (x0 )Fk (0) = Ck (x0 ), para k = 1, . . . , 1
f (1) (t)
..
Fk (t) =
.
(k)
f (t)
Corolrio 2.1 Seja o sistema no linear 2.1 com ordem de rastreamento < e, para
2, supe-se que a condio 2.4 seja satisfeita. Ento o sistema
onde x(0) = x0 e
x) + B(
x)
x = A(
u;
y = C(
x) + D(
x)
u
x M
x) = A(
A(
x) B(
x)D (
x)C (
x)
x) = B(
B(
x)D H (
x)
x) = D (
C(
x)
x)C (
x) = D (
D(
x)
x)H (
(2.5)
13
atua como um sistema inverso direita para o sistema 2.1. Em particular, se f (.) pode
ser reproduzida por y(., u, x0 ) para algum u e x0 M , ento, f (.) = y(., u f , x0 ) onde
u f = y(., F , x0 ).
x = Ax + Bu
,
(2.6)
y = Cx
onde x n , y m e u m (caso especfico do nmero de entradas igual ao nmero
de sadas), derivando-se cada sada obtm-se
x = Ax + Bu
,
z = C x + D u
onde (D : m m ) uma relao inversvel entre as entradas e sadas do sistema fsico
e
T
z = H y(1) . . . y()
(2.7)
com H sendo uma matriz m m.
Desta forma, seguindo o algoritmo de Hirshorn, possvel obter-se um sistema inverso
para o sistema linear da equao (2.6) dado por
x + B
u
x = A
= C
x + D
u
Y
onde
= A BD1C
A
B = BD1
H
= [U1 . . . Un ]T
u
C = D1
C
1
= D H
D
= C(sI
A)
1 B + D,
G(s)
G(s) = C(sI A)1 B
(2.8)
(2.9)
14
1
sk(i)
i = 1, . . . , m
(2.10)
A 022
B
x =
x+
u
I22 022
022
,
y = Cx
A 022
B
x =
x+
u
I22 022
022
,
z2 = C2 x + D2 u
C = D1
2 C2
1
= D H2
D
2
0010
H2(24) =
0001
1
0
2
G(s) =
W (s) = G(s)
s
1
0
s2
2.3
(2.11)
(equao
Este trabalho prope uma forma alternativa para obteno da matriz G(s)
2.8), a qual funcionar como um sistema inverso ao sistema fsico. Reescrevendo o sistema (2.11) atravs de sua matriz de transferncia, obtm-se
y1 = G11 u1 + G12 u2
,
y2 = G21 u1 + G22 u2
15
G11
y1
G12
G21
u2
G22
y2
U2
11
G
u1
G11
12
G
G12
21
G
G21
22
G
+
+
u2
G22
y1
y2
11U1 + G
12U2
u1 = G
21U1 + G
22U2
u2 = G
Aplicando-se as sadas (u1 ,u2 ) como entradas para um outro sistema linear qualquer, com
duas entradas e duas sadas (y1 ,y2 ), a relao entre as entradas (U1 ,U2 ) do primeiro sistema
e as sadas (y1 ,y2 ) do segundo sistema ser
11 + G12 G
21 )U1 + (G11 G
12 + G12 G
22 )U2
y1 = (G11 G
(2.12)
22 )U2
y2 = (G21 G11 + G22 G21 )U1 + (G21 G12 + G22 G
Para desacoplar as sadas (y1 , y2 ) com relao s entradas (U1 ,U2 ) e garantir que a
se comporte como o sistema inverso de Hirschorn, a soluo
matriz de transferncia G(s)
16
11 + G12 G
21 = 1/s2
G11 G
11 + G22 G
21 = 0
G21 G
12 + G12 G
22 = 0
G11 G
12 + G22 G
22 = 1/s2
G21 G
(2.13)
(2.14)
Pode-se observar que a soluo para as equaes dadas em (2.13) e (2.14) implica em
[Silverman 1969]
1
0
2
= G1
G
s
1 ,
0
s2
ou seja, as sadas (y1,2 ) rastreiam as entradas (U1,2 ) com dinmica 1/s2 (duplo integrador).
A modificao do sistema inverso direita proposta por este trabalho ser importante
na implementao do controlador (ver seo 5.3), pois permitir utilizar em substituio
aos integradores 1/s2 , qualquer planta com a mesma ordem deste integrador, por exemplo
1
0
s2 + a s + b
= G1
G
,
1
0
s 2 + a s + b
simplificando o projeto do controlador e reduzindo a amplitude do sinal de controle como
pode ser comprovado comparando-se as Figuras H.23 at H.28 com as Figuras H.5 at
H.16 do Apndice H.
Generalizando o desacoplamento
x = Ax + Bu
,
y = Cx
(2.15)
= G1 (s) W (s)
G(s)
1
W (s) = diag
,
gi (s)
i = 1, . . . , m
(2.16)
(2.17)
17
18
Captulo 3
Controladores adaptativos
0 1 0 ... 0
0
0 0 1 ... 0
0
..
.. ; b = ..
x = Ax + bu; A = ... ...
(3.1)
.
.
.
0 0 0 ... 1
0
a1 a2 a3 . . . an
1
20
n1
(cixi) + xn = 0};
i=1
ci > 0 (i = 1, . . . , n 1)
(3.2)
; u+ (x) = u (x)
x2
x2
x(0)
x1
x1
s(x)=x1 +cx2 =0
(a) Condio de deslizamento
s(x)=0
(b) Deslizamento ideal
(cixi) + xn = 0;
i=1
xi = xi+1 ;
i = 1, . . . , n 2;
xS
n1
xn1 = xn = (ci xi ).
i=1
Observe que, durante o deslizamento, a dinmica do sistema depende apenas das constantes ci > 0 e, assim, estas devem ser escolhidas para que o sistema de ordem reduzida
apresente um desempenho desejado.
Para o sistema 3.1, com superfcie de deslizamento 3.2 e utilizando como sinal de
21
1,
sgn(x) =
1,
1 > |a1 |;
se x > 0
se x < 0
i = 2, . . . , n
No deslizamento, s 0, onde
s =
t>0
n1
i=1
i=2
e, desta forma, o controle equivalente ueq [Utkin 1978], associado com a superfcie deslizante s = 0, o controle contnuo que garantiria o deslizamento na ausncia de imperfeies (perturbaes, por exemplo) e pode ser obtido fazendo s = 0, ou seja,
O controle equivalente pode ser interpretado fisicamente como o valor mdio (uav )
do sinal de controle u obtido atravs de um filtro passa baixa com freqncia de corte
suficientemente alta ( 0) (Figura 3.2), na ausncia de dinmica no modelada da planta
e de incertezas no chaveamento real [Utkin 1978].
u
1
s + 1
uav
22
x1
s(x)=0
Figura 3.3: Deslizamento real
Um das dificuldades da prova de estabilidade de sistemas a estrutura varivel o fato
das equaes diferenciais apresentarem o lado direito descontnuo (devido lei de controle utilizada). Para estas equaes no se pode determinar uma constante de Lipschitz
para garantir a existncia e unicidade de uma soluo para o sistema. Esta dificuldade foi
superada por uma abordagem feita por Filippov [1964]. Basicamente, as solues no sentido de Filippov (ver Apndice B) so absolutamente contnuas como funes do tempo
e, tambm, contnuas em relao s condies iniciais. Isto torna possvel a extenso do
mtodo direto de Lyapunov para a anlise de estabilidade de sistemas a estrutura varivel.
3.2
O controlador adaptativo por modelo de referncia (MRAC), o qual tem sido aplicado
a plantas com incertezas paramtricas e/ou plantas com uma dinmica complexa, teve
nos trabalhos de Narendra, Lin e Valavani [1980] um grande desenvolvimento, sendo
consolidado por Sastry [1984].
O algoritmo do MRAC utiliza um modelo de referncia para determinar o comportamento desejado para a planta (ver Figura 3.4). O erro entre as sadas da planta e do
modelo utilizado para ajustar os parmetros do controlador. Desta forma, o MRAC utiliza somente informaes da entrada e sada da planta, fato que o torna uma boa opo
para implementao (utiliza um nmero reduzido de sensores).
Considere uma planta linear, monovarivel, invariante no tempo, com incertezas paramtricas e funo transferncia estritamente prpria (grau[n p (s)]<grau[d p (s)])
W (s) = k p
n p (s)
,
d p (s)
(3.3)
Modelo
ym
erro
Controlador
Planta
Adaptao
r
23
nm (s)
dm (s)
(3.4)
(3.5)
tender a zero assintoticamente, para uma condio inicial arbitrria e com sinal de referncia r(t) uniformemente limitado.
importante destacar algumas hipteses assumidas no estudo dos controladores adaptativos por modelo de referncia [Ioannou & Sun 1995, Sastry & Bodson 1989]:
1. A planta deve ser controlvel e observvel, de fase mnima (d p (s) Hurwitz), sendo
d p (s) e n p (s) polinmios mnicos1 com graus [d p (s)] = nd e [n p (s)] = nn conhecidos e incertezas paramtricas uniformemente limitadas;
2. O modelo de referncia dever ser estvel (dm (s) Hurwitz), sendo dm (s) e nm (s)
polinmios mnicos com o mesmo grau relativo (n = nd nn ) da planta (em geral
grau [d p (s)]= grau [dm (s)]) e sinal(k p ) = sinal(km ), positivos por simplicidade;
3. A entrada e a sada da planta devem ser mensurveis e so utilizadas para gerar o
sinal de controle.
Como o nmero de parmetros da planta igual a 2nd , e os sinais disponveis so r e
y, faltam 2nd 2 sinais para a implementao do sinal de controle. Estes so obtidos pela
1 Polinmio
24
v 1 = v1 + gu
v 2 = v2 + gy
(3.6)
(3.7)
onde
u = T (t)(t)
(3.8)
(3.9)
liar
1
M(u T )
2n
(3.10)
Para o caso de grau relativo n 2, torna-se necessria a introduo de um sinal auxiya = ML2n+1 (L1 u T L1 )
(3.11)
ea = (y ym ) ya = e0 ya
(3.12)
(3.13)
25
(3.14)
2n+1
= T
= (y ym ) ya = e0 ya
= ea (L1 T T L1 )
Tabela 3.1: Algoritmo do controlador MRAC convencional
26
kp
s2 + 1 s + 2
M(s) =
km
s2 + m,1 s + m,2
(3.15)
onde M(s) o modelo de referncia e W(s) uma planta com caracterstica semelhante
planta utilizada na tese. O diagrama de blocos do controlador VS-MRAC para uma planta
como W(s) pode ser visualizado na Figura 3.5.
r
Modelo
ym
f0
-
Tnom
+
+
-
Planta
e0
e0 +
u0
y
ya
nom ML
+
-
1
L
f1
u1
Rel
e1
Rel
ueq
(.)eq
1
L
Figura 3.5: Diagrama de blocos de um controlador VS-MRAC compacto (n =2)
Seja L(s) um polinmio com grau N=n -1, de forma que M(s)L(s) seja ERP e estritamente prpria, ou seja,
L(s) = s + , > 0
Em seguida, definem-se novos sinais filtrados
0 = L1 u
0 = L1
onde, por conveno, 1 = e 1 = u.
(3.16)
27
u = u1 + Tnom
o novo sinal de controle, onde nom 2nd um vetor de parmetros nominais obtidos do
modelo nominal da planta (idealmente, nom = para a condio de Matching). O erro
da equao 3.10 ser redefinido como
e0 = k M(u T Tnom )
(3.17)
onde o termo nom T foi acrescido para facilitar a implementao das leis chaveadas e
k = 1/2n .
Seja knom > 0 o valor nominal de k . Assim, pode-se redefinir o erro e0 como
e0 = knom ML(
k
knom
L1 u
k
knom
T L1
=
>0
k
nom
k knom
= +1
> || =
k
nom
0J > |J nom,J |
1J > |J nom,J |
k
knom
Tnom L1 )
(3.18)
(3.19)
(J = 1, . . . , 2n)
(J = 1, . . . , 2n)
(3.20)
0 Tnom 0 = L1 (u Tnom )
= L1 (u1 + Tnom Tnom )
= L1 (u1 )
u0 = 0 (0 Tnom 0 ) T0 0
Seja
u0 = f0 sgn(e0 )
(3.21)
28
f0 = |0 Tnom 0 | + 0 j |0 j |
(3.22)
j=1
a funo de modulao que deve ser escolhida de forma a garantir que e0 0 em tempo
finito. Seja
u1 = f1 sgn(e1 )
onde e1 = (u0 )eq L1 u1 e
f1 =
2n
1 j | j |
(3.23)
j=1
u
ya
e0
e1
f0
f1
ui
= u1 + Tnom
= knom ML[u0 L1 u1 ]
= e0 ya
= |0 Tnom 0 | + 0 |0 |
T
= 1 |1 |
=
fi sgn(ei ),
i = 0, 1
No desenvolvimento da estratgia de controle, introduziu-se uma cadeia de erros auxiliares (e0 , e1 ), duas cadeias de parmetros auxiliares (0 , 1 ) e () para o rastreamento
do modelo.
As leis de adaptao a estrutura varivel so escolhidas de forma que os erros auxiliares ei (i = 0, 1) atinjam modos deslizantes em um tempo finito. O controlador equivalente
(u0 )eq obtido assintoticamente de (u0 ) por meio de um filtro passa baixa (1/F) com
freqncia de corte suficientemente elevada.
A malha de realimentao constituda por um filtro em avano a estrutura varivel,
cuja funo consiste em obter (u)eq = (u1 + unom )eq u = T (condio de Matching). Este filtro necessrio devido introduo do sinal adicional ya , que regido
pelo operador ML.
29
Nesta seo so apresentados os resultados obtidos por Costa e Hsu [1992] sobre a
robustez do controlador VS-MRAC s perturbaes e dinmica no modelada.
Considere um distrbio d uniformemente limitado na entrada da planta (ver Figura
3.6) e uma dinmica no modelada estvel
=
s + 1
,
s + 1
(3.24)
u
+
W (s)
30
Captulo 4
Modelagem do rob mvel
O modelo matemtico de um rob mvel pode ser dividido em duas partes distintas:
Cinemtica e Dinmica. A primeira caracterizada pela representao do movimento e
das suas restries, no incluindo as foras dinmicas que atuam sobre o rob. A segunda
representa a resposta do rob excitao externa no decorrer do tempo, levando em considerao as foras dinmicas atuando sobre sua estrutura, sua massa e seu momento de
inrcia, o modelo dinmico dos atuadores (motores c.c.) do sistema e as foras de atrito
envolvidas. O modelo que ser utilizado neste trabalho o dinmico, no qual, quando
comparado ao modelo cinemtico, mais simples modelar as perturbaes existentes
permitindo impor maiores velocidades ao rob mvel.
Alguns artigos [Yang & Kim 1999, Pereira et al. 2000, Lages & Hemerly 2000, Oliveira & Lages 2001, Tanner & Kyriakopoulos 2002, Lizarralde 1998] encontrados na
literatura utilizam uma modelagem dinmica do rob mvel para o desenvolvimento de
suas tcnicas de controle. Outros trabalhos apresentam abordagens baseadas apenas no
modelo cinemtico.
Este captulo dedicado a descrever como foi obtido o modelo do rob utilizado1 .
Na seo 4.1 apresentado o modelo cinemtico do rob. A dinmica dos motores c.c.
utilizados pelo rob descrita na seo 4.2. A seo 4.3 traz o modelo dinmico do rob
e, por fim, a seo 4.4 apresenta o modelo, em variveis de estado, utilizado na tese, o
qual associa a dinmica dos motores c.c. dinmica e cinemtica do rob.
32
r , r
vr , fr
yp
xp
=
=
=
=
xp = vr cos( p )
yp = vr sen( p )
p = r
(4.1)
d
vr
1/rd d/2rd
= Tv
onde
Tv =
(4.2)
e
r
1/re d/2re
onde d a distncia entre as rodas e rd,e so os raios das rodas direita e esquerda. A relao
dada pela equao 4.2 servir para interligar a cinemtica do rob com a dinmica dos
motores.
33
id,e
ed,e
Jd,e
ebd,be
d,e
d,e
Rotor
Carga
=
=
=
=
=
=
Por questo de simplicidade toda deduo realizada para um motor ser vlida para
os dois motores.
No motor c.c. controlado pela armadura, a corrente de campo mantida constante, o
que resulta em um fluxo constante. Assim, o torque torna-se diretamente proporcional
corrente de armadura, subtrado das perdas pelo atrito viscoso e momento de inrcia do
rotor, de modo que
d,e + d ,e d,e )
d,e = Kd,e id,e (Jd,e
(4.3)
onde Kd,e so as constantes de torque dos motores.
Quando a armadura est girando, induzida na mesma uma tenso proporcional ao
produto do fluxo e da velocidade angular. Para um fluxo constante, a tenso induzida
ebd.be = Kbd,be d,e onde Kbd,be a constante de fora-contra-eletromotriz.
Com a inteno de relacionar a tenso de armadura com o torque, deve-se obter a
equao para o circuito de armadura em funo da corrente
id,e = (Rd,e )1 ed,e (Rd,e )1 Kbd,be d,e
2A
(4.4)
34
(4.5)
onde os torques dos motores sero utilizados para relacionar as dinmicas dos motores
com a dinmica do rob.
4.3
A equao de movimento do rob pode ser obtida a partir das leis de Newton [Halliday
et al. 2000]. Desta forma, a fora do rob dada por
fr = mvr + lin vr
(4.6)
onde m a massa do rob e lin o coeficiente de atrito entre o rob e o solo durante
movimentos de translao. O torque do rob ser
r + ang r
r = J
(4.7)
4.4
(4.9)
Kd
Kd Kbd
0
+ b
0
d
d
Jd 0
Rd
ed
Rd
d
=
(4.10)
K
K
K
e
e
e be
e
ee
0 Je
0
0
+ e e
Re
Re
35
d
ed
d
=K
C
J d
e
e
ee
e
(4.11)
vr
vr
ed
d
T
Jr
+
= Tv K
C
J d
r
e
e
r
ee
(4.13)
Neste instante deve-se utilizar a relao 4.2 para montar um sistema de equaes diferenciais ordinrias de primeira ordem, o que resulta em
vr
vr
ed
vr
v
T
Jr
+
= Tv K
C Tv
J Tv r
(4.14)
r
r
r
ee
r
r
ee
(4.15)
e, de forma simplificada,
vr
vr
e
1
1
= Mv Bv
+ Mv Kv d .
r
r
ee
Seja
Mv1 Bv
e
Mv1 Kv
(4.16)
k1 k2
k3 k4
k5 k6
k7 k8
(4.17)
(4.18)
k1
k2
k3
k4
A = sen( p ) 0
cos( p ) 0
0
1
0
0
0
0
0
0
0
0
0
0
0
k5 k6
vd
k7 k8
r
0
0 0 , x = xp ,
0
,
B
=
0 0
yp
0
0
0 0
p
36
S = vr
(4.20)
p = r
Um problema inerente a esta representao o fato de que S no mensurvel devido
ao sistema de viso utilizado para obter o posicionamento do rob (a posio obtida
apenas em instantes de tempo determinado). O modelo obtido em variveis de estado
ser
vr
k1 k2 0 0
vr
k5 k6
r = k3 k4 0 0 r + k7 k8 ed
(4.21)
S 1 0 0 0 S 0 0 ee
0 1 0 0 p
0 0
p
ou de forma simplificada
x = Ax + Be
S
y = Cx =
p
(4.22)
4.5
G1,1 G1,2 1
(4.23)
G(s) =
G2,1 G2,2 D
Como a tcnica de inverso direita desacopla utilizando cancelamento de plos e
zeros, recomendado que o polinmio
D = s(s2 (k1 + k4 )s + k2 k3 + k1 k4 )
possua razes no semi-plano esquerdo.
Aplicando a frmula de Bhaskara na equao 4.24, tem-se
(4.24)
(4.25)
(4.26)
(4.27)
onde k1 k4 > 0, t > 0. Assim, para garantir que as razes do polinmio D estejam no
semi-plano esquerdo basta que k1 k4 > k2 k3 , o que esperado pois k2 e k3 representam a
37
influncia da assimetria do rob, a qual, na grande maioria dos casos, ser pequena com
relao aos parmetros k1 e k4 .
k1 k2
6, 098 0, 04682
=
k3 k4
4, 491 57, 52383
(4.28)
k5 k6
0, 012799 0, 010618
=
k7 k8
1, 624859 1, 683278
3 Os parmetros foram obtidos para o rob mvel da Microrobot, o mesmo que ser utilizado na obteno
de resultados experimentais.
38
Captulo 5
Estrutura do controlador
Controle
de
Posio
VS-MRAC
Sistema
Inverso
Rob
40
5.1
Desacoplamento do sistema
O rob descrito no Captulo 4 possui como entradas as tenses aplicadas aos motores
das rodas e como sadas a posio e orientao do rob, as quais so obtidas por um
sistema de viso (ver Figura 5.2).
xp
ee
ed
Rob
yp
p
Figura 5.2: Diagrama de blocos do rob mvel com duas rodas tracionadas
Uma modificao na cinemtica do rob foi realizada a fim de se reduzir a complexidade do modelo (ver Figura 5.3).
ee
ed
Rob
Sistema
Inverso
ee
ed
Rob
Figura 5.4: Introduo do sistema inverso do rob mvel com abordagem linear
A equao (4.22) representa o rob em variveis de estado, o qual possui matriz de
transferncia G(s) dada por
G1,1 G1,2 1
1
G(s) = C(sI A) B =
(5.1)
G2,1 G2,2 D
Para desacoplar qualquer sistema linear, de acordo com a seo (2.3), necessrio
obter os graus dos polinmios G1,1 (s) e G2,2 (s), os quais sero utilizados no calculo de
41
G(s),
atravs da equao (2.16), resultando em
0
1 W1
G(s) = G(s)
,
0 W2
(5.2)
kw1
,
2
s + a1 + b1
W2 =
kw2
,
s2 + a2 + b2
(5.3)
Aps a aplicao do sistema inverso, no caso ideal (parmetros totalmente conhecidos), o sistema estar perfeitamente desacoplado. Isso significa dizer que o rob pode
ser considerado como duas plantas totalmente distintas (ver Figura 5.5), e, desta forma,
possvel tratar o controle do rob utilizando dois controladores (SISO), um para cada
planta resultante.
US
W1
W2
S
p
42
As incertezas paramtricas no rob produziro uma matriz G(s) com o formato (ver
Apndice E)
1
G1,1 + Gd1,1 G1,2 + Gd1,2
G(s) =
(5.4)
G2,1 + Gd2,1 G2,2 + Gd2,2 D + Dd
1
(G1,1 + Gd1,1 )d1,1 (G1,2 + Gd1,2 )d1,2
G(s) =
,
(5.6)
(G2,1 + Gd2,1 )d2,1 (G2,2 + Gd2,2 )d2,2 (D + Dd )d
onde
di, j
,
d
i = 1, 2; j = 1, 2
(5.7)
(W1 + W1 )1 S
(W2 + W2 )2
43
(W1 + W1 )1 S
(W2 + W2 )2
+ +
VS-MRAC1
VS-MRAC2
US + +
(W1 + W1 )1 S
(W2 + W2 )2
+ +
Quando os controladores VS-MRAC rejeitam por completo as incertezas paramtricas, as dinmicas no modeladas e os distrbios de entrada, o sistema resultante se torna
S
M1 0
Sre f
=
,
(5.9)
p
0 M2
re f
44
Sre f
M1
ym,1
-
Tnom,1 1
+
-
+
-
W1
re f
f 01
Rel
+
-
f02
-
+
-
W2
Rel
p
nom,2 M2 L2
1
L1
f11
ym,2
Tnom,2 2
Rel
nom,1 M1 L1
M2
1
L2
f12
1
F1
Rel
1
L1
+
-
+
-
1
F2
1
L2
A estrutura proposta associa um conjunto de controladores VS-MRAC, os quais possuem transitrio rpido (significa dizer que o controlador rapidamente rejeita as perturbaes fazendo com que a sada da planta siga o modelo de referncia), a um sistema
inverso para desacoplar o sistema linear MIMO (ver Figura 5.8). Esta tcnica funcionar
para qualquer sistema linear MIMO, garantindo que as sadas do sistema sero obtidas a
partir das entradas impostas, com suas dinmicas determinadas pelos modelos de referncia M1,2 escolhidos (ver Figura 5.10).
Sre f
re f
M1
M2
S
p
Aps a garantia, dada pelos controladores VS-MRAC, de que o sistema MIMO est
desacoplado em duas plantas (M1,2 ), ser apresentado o controlador de posio para o
rob mvel.
45
(xd ,yd )
re f
yp
(xd ,yd )
e
Sp
xp
(a) Variveis utilizadas
Nomenclatura:
xd
yd
re f
e
S
Sp
S = M1 Sre f
(5.10)
p = M2 re f ,
(5.11)
Desta forma, M1,2 so escolhidos de tal forma que S = Sre f aps o transitrio de M1
e p = re f aps o transitrio de M2 . Para o caso do subsistema de orientao (equao
5.11), no haver nenhum problema em projetar um controlador para garantir erro de
orientao nulo (e = 0), pois p medido. J no caso do sistema de posio (equao
5.10), devido no ser possvel medir S, haver problema para se projetar um controlador
46
(5.12)
Para superar esta dificuldade, ser assumida a hiptese que e = 0 [Dias et al. 2007,
Dias et al. 2006] (ver Figura 5.11(b)), o que implica, somente para este caso, em um erro
de posio
es = = S,
(5.13)
o qual pode ser medido a cada instante. Como a medida de S s obtida na condio
assumida, quando tal condio no for verdadeira ser considerado que a medida de S
est acrescida de um distrbio de entrada ds (ver Figura 5.12).
ds
+
Sre f
re f
S = es
M1
M2
L/
re f
VS-MRAC1
Us
VS-MRAC2
Sistema
Inverso
xp
ee
ed
Rob
yp
L/E
es
p
5.3.1
47
(5.14)
t > 0,
(5.15)
para comprovar que o erro de orientao assintoticamente estvel deve-se garantir que
d
V (e (t)) = (e2 (t)) < 0,
dt
t > 0,
(5.16)
v
(sen(e
))
r
r < 0.
V (e ) = 2e
v
sen(e
)
r
V (e ) = 2e
r < 0.
(5.17)
(5.18)
(5.19)
Neste momento definido que o rob poder realizar movimento para frente e para
trs, sendo considerado que o ponto desejado est frente do rob mvel quando o erro de
orientao (e ) estiver entre /2 e /2 e para os demais valores de e o ponto desejado
est atrs do rob mvel. Devido a esta definio, a distncia entre o centro do rob e o
ponto desejado modificada para
48
(5.21)
Ao se garantir uma dinmica mais rpida para M2 em comparao a M1 , garantese que a relao da equao 5.21 verdadeira, pois nos instantes iniciais vr (t) ser pequeno quando comparado a r (t) e, desta forma, o controlador VS-MRAC2 garantir que
e (t) 0. Quando vr (t) aumentar, o erro de orientao (e (t)) ser pequeno, o que ainda
garantir o cumprimento da equao 5.21.
5.3.2
O controlador proposto ser assintoticamente estvel para qualquer ponto desejado se,
e somente se, os erros de posio (eS ) e de orientao (e ) tenderem para zero quando o
tempo tender para infinito. A ideia fundamental do controlador proposto fazer com que
o rob rapidamente aponte para o ponto desejado e, em seguida, busque o ponto desejado.
Na seo anterior foi apresentada a condio na qual o rob convergir assintoticamente
para o ponto desejado, e esta condio assume que os controladores VS-MRAC1,2 conseguem impor uma dinmica M1,2 para os movimentos de translao e rotao, respectivamente.
Nesta seo ser apresentada uma anlise para a estabilidade do rob no caso geral, ou
seja, sem a garantia dos controladores VS-MRAC1,2 imporem as dinmicas M1,2 . Sejam
os erros de posio (eS ) e orientao (e ) dados por
1 yd y p
re f = tg
.
xd x p
A equao do erro de posio
(5.22)
definida positiva, exceto na condio no holonmica, pois eS (t) > 0 (considere a equao 5.20), t > 0. Por este motivo a funo do erro de posio se torna uma funo
candidata de Lyapunov
V (eS (t)) = (t) cos(e (t)) > 0,
t > 0
(5.23)
49
t > 0,
(5.24)
(5.25)
vr (t)
(t) sen(e (t))
(5.26)
(5.27)
a qual uma condio necessria para que os erros de posio e de orientao sejam
assintoticamente estveis.
Observe que esta condio (equao 5.27) varia ao longo do tempo. Assim, todo
controlador proposto para o rob mvel dever agir de forma a torn-la verdadeira. A
partir da equao 5.27, foi proposto um controlador cinemtico assintoticamente estvel
(ver Apndice G). Este controlador a base de uma nova linha de trabalhos derivados
desta tese, os quais utilizam controladores embarcados para controlar as velocidades das
rodas do rob mvel [Dias et al. 2009].
50
Captulo 6
Resultados
Este captulo apresenta os resultados simulados e experimentais obtidos para o controlador proposto. O captulo apresenta, na seo 6.1, a descrio do kit de futebol de
robs no qual sero obtidos os resultados experimentais. Na seo 6.2 so definidos e
calculados os parmetros para o controlador proposto. Os resultados simulados, quando
o controlador proposto aplicado ao rob mvel, so discutidos na seo 6.3, enquanto
na seo 6.4 so apresentados os resultados experimentais. Por fim, alguns comentrios
finais so apresentados na seo 6.5.
Cmera
Placa PCI
Programa
C++
RS
232
Rdio
Computador
52
CAPTULO 6. RESULTADOS
rob mvel com processador embarcado e um computador que deve processar todas as
informaes provenientes dos demais subsistemas.
De acordo com a Figura 6.1, o controlador proposto foi implementado por um programa em C++ que, em conjunto com uma biblioteca fornecida pelo fabricante, processa
a imagem enviada pela cmera e fornece o ponto central e o ngulo p do rob mvel. De
posse deste ponto e ngulo atuais, o controlador deve enviar, atravs do rdio transmissor,
os valores de tenso que sero aplicados aos motores das rodas direita e esquerda do rob
mvel.
6.2
Projeto do controlador
0
1 W1
G(s) = G(s)
,
0 W2
onde G(s) a matriz de transferncia do sistema 4.21 e W1,2 so escolhidos como
W1 = W2 =
1
s2 + 2s + 1
(6.1)
duas plantas criticamente amortecidas (sem sobre sinal) com tempo de acomodao (com
tolerncia de 2%) de aproximadamente 4s.
dada por
A descrio em variveis de estado de G(s)
onde x 4 ,
2 1 0
1
0
0
=
A
0
0 2
0
0
1
8, 872 2, 065
C =
8, 687 1, 997
= A
x + BU
x
x + DU
e = C
(6.2)
0
32
0
0
, B =
0
1
0
0
0
0
e
U
e
, e=
, U= S
8
ed
U
0
2, 157 0, 0354
66,
08
0,
2832
=
, D
.
2, 038 0, 04012
63, 91 0, 3209
O sistema da equao 6.2 servir como sistema inverso (ver Figura 6.2) para o rob
mvel, e ser utilizado tanto nos resultados simulados como nos resultados experimentais.
1 Parmetros nominais so os parmetros conhecidos de um sistema, e, devido a possveis incertezas,
estes parmetros no so necessariamente os parmetros exatos do sistema.
53
Sistema
Inverso
ee
ed
Figura 6.2: Sistema inverso direita para o rob mvel utilizando parmetros nominais
0, 25
s2 + 1s + 0, 25
16
s2 + 8s + 16
1,nom = 1, 0 0, 1 0, 0225 0, 25
e
2,nom = 6 27 54 16 .
1,0 = 0, 4 0, 4 0, 4 0, 4
1,1 = 0, 5 0, 5 0, 5 0, 5
2,0 = 0, 8 0, 8 0, 8 0, 8
2,1 = 1, 0 1, 0 1, 0 1, 0
54
CAPTULO 6. RESULTADOS
6.3
Simulao
A simulao contar com as principais no linearidades (zona morta e saturao) existentes no kit, onde a zona morta corresponde faixa de valores de -1V at 1V (ver Figura
6.3(b)), na qual os motores das rodas no produzem movimento no rob, e saturao de
7V (ver Figura 6.3(b)), ou seja, o maior valor da tenso (positiva ou negativa) que pode
ser aplicada aos motores.
u1,2
7
1.2
(xd ,yd )
1.0
0.8
1
0.6
-1
0.4
ed,e
2cm
0.2
0.0
0.0
0.25
0.50
0.75
1.00
1.25
1.50
-7
A Figura 6.3(a) apresenta como ser definido o sistema de coordenadas para o campo
do kit de futebol de robs, o qual tem 1,5m de comprimento ao longo do eixo x e 1,3m
ao longo do eixo y. O canto inferior esquerdo do campo ser definido como a origem
do sistema de coordenadas, ou seja, ponto (0,0). A simulao do sistema de viso deve
considerar as dificuldades existentes em obter a posio e o ngulo do rob no caso real.
Para o ngulo haver uma incerteza de 4 e para a posio do centro do rob um erro
dado por uma circunferncia de raio 1cm (ver Figura 6.3(c), para mais detalhes de como
foram obtidos os valores de erro ver Apndice I).
As no linearidades e dificuldades em obter a posio e o ngulo do rob mvel so
introduzidas na simulao do rob de acordo com a Figura 6.4, ou seja, as no linearidades
(ver Figura 6.3(b)) so introduzidas em cada uma das entradas do rob e so adicionados
rudos dx , dy posio e dP ao ngulo do rob mvel.
O sistema da Figura 6.4 semelhante ao da equao 4.19 (modelo do rob mvel em
variveis de estado), e descrito por
x = Ax + Bu,
(6.3)
6.3. SIMULAO
55
Rob
dx
ed
u1
xp
x = Ax + Bu
u2
dy
xrp
yrp
rp
L/E
es
+
+
ee
yp
dP
onde
kr1
kr3
kr1
kr2
kr3
kr4
A = sen(rp ) 0
cos(rp ) 0
0
1
kr2
5, 7250
=
kr4
4, 9468
0
kr5 kr6
vd
kr7 kr8
r
0
0
, x = xrp ,
0
0
,
B
=
0
yrp
0
0
0
0
0
rp
0, 0253
kr5 kr6
0, 0089 0, 0077
e
=
.
60, 0460
kr7 kr8
1, 5694 1, 6945
0
0
0
0
0
0
0
0
0
0
Os valores das constantes kr1,r2,...,r8 so ligeiramente diferentes dos obtidos na equao 4.28 para simular as incertezas paramtricas existentes no sistema fsico real. Os
rudos dx , dy so valores uniformemente distribudos entre -1cm e 1cm, o rudo dP um
valor uniformemente distribudo entre 4 e 4 , sendo que os rudos so adicionados
posio e ngulo do rob mvel a cada passo de integrao da simulao (33ms).
ee
ed
Rob
yp
p
Figura 6.5: Diagrama de blocos do rob mvel com duas rodas tracionadas
Foi aplicado 1,1V em cada um dos motores do rob (ed = ee = 1, 1V)2 durante 10s, e
2 Observe, atravs da anlise das Figuras 6.3(a) e 6.4, que exceto nas regies de saturao e zona morta
u1 = ed e u2 = ee .
56
CAPTULO 6. RESULTADOS
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
1.0
0.5
1.5
6.3.2
Sistema
Inverso
xp
ee
ed
Rob
yp
L/E
es
p
6.3. SIMULAO
57
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
0.5
1.0
1.5
conhecimento exato dos parmetros do rob mvel, o que raramente possvel. Assim,
para a maioria dos casos sempre haver perda do desacoplamento entre os movimentos
de translao e de rotao. (A simulao do desacoplamento sem incertezas paramtricas pode ser visualizada na Figura H.1 do Apndice H. J na simulao da Figura H.3 o
desacoplamento para o caso ideal, ou seja, sem incertezas paramtricas e zona morta,
apresentado. A diferena entre elas que na Figura H.1 existe um erro de posio devido
a zona morta do atuador).
7.0
u2
1.0
0.0
0.5
7.0
7.0
u1
0.0
0.0
0.5
7.0
10
0.5
0.0
0.5
1.0
58
CAPTULO 6. RESULTADOS
de tenso enviados aos motores das rodas direita e esquerda, aps um perodo de tempo
(entre 2s e 4s), entraram na regio de zona morta.
Para superar a perda do desacoplamento devido s incertezas paramtricas, as quais
podem variar ao longo do tempo, que ser introduzido um par de controladores adaptativos por modelo de referncia e estrutura varivel (VS-MRAC).
6.3.3
A simulao para comprovar o correto funcionamento do controlador proposto consiste em impor um ponto desejado (xd ,yd ) para o rob mvel atingir em um tempo finito.
Sre f
xd
L/
yd
re f
VS-MRAC1
Us
VS-MRAC2
xp
ee
Sistema
Inverso
ed
Rob
yp
L/E
es
p
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
0.5
1.0
1.5
6.3. SIMULAO
59
devido zona morta no sinal de tenso, ele realiza um pequeno movimento de rotao
(para conferir esta mesma simulao sem zona morta veja a Figura H.7, do Apndice H),
o qual corrigido pelo controlador de orientao. Em aproximadamente 8s o rob atinge
o ponto desejado.
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
0.5
1.0
1.5
60
CAPTULO 6. RESULTADOS
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
1.0
0.5
0.0
0.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
1.0
0.5
0.0
0.5
orientao superior /2. Esta simulao d nfase ao fato do controlador ser capaz de
atingir um ponto desejado com qualquer erro de orientao. Mais uma vez possvel observar que o controlador de orientao tem transitrio rpido, quando comparado com o
controlador de posio, o que faz com que o rob gire rapidamente e aponte para o ponto
desejado e, em seguida, se desloque de forma quase direta em direo a este ponto. Tambm possvel verificar que o movimento de translao foi prejudicado pela zona morta
do sinal de controle. O rob mvel atinge o ponto desejado em aproximadamente 8s.
Outras simulaes para pontos desejados diferentes dos apresentados nesta seo podem
ser visualizadas nas Figuras H.15,H.16,H.17,H.18,H.19,H.20,H.21 e H.22 do Apndice
H.
6.3. SIMULAO
61
(a) t=0,033s
(b) t=0,25s
(c) t=0,5s
(d) t=0,75s
(a) t=1s
(b) t=2s
(c) t=3s
(d) t=4s
62
CAPTULO 6. RESULTADOS
(a) t=5s
(b) t=6s
(c) t=7s
(d) t=8s
6.4
Resultados experimentais
Esta seo apresenta os resultados experimentais obtidos para cada um dos casos simulados na seo 6.3, o que permitir realizar uma comparao entre resultados simulados e experimentais. Os resultados experimentais foram obtidos com um kit de futebol de
rob da Microrobot no Laboratrio de Acionamento, Controle e Instrumentao (LACI)
da Universidade Federal do Rio Grande do Norte (UFRN). Todos os resultados experimentais utilizam o mesmo sistema de coordenadas, o qual apresentado na Figura 6.3(a).
6.4.1
63
ee
1.5
0.0
1.0
7.0
7.0
ed
0.5
0.0
0
7.0
10
0.5
1.0
1.5
mvel. Observe que um pequeno erro em algum dos parmetros de velocidade (linear ou
angular) ser integrado, fazendo com que exista uma diferena entre a posio do rob
mvel simulado e o rob mvel real em apenas alguns instantes. A integral deste erro
ser uma das dificuldades a ser superada pelo controlador proposto.
ee
1.5
0.0
1.0
7.0
7.0
ed
0.5
0.0
0
7.0
10
0.5
1.0
1.5
64
CAPTULO 6. RESULTADOS
ee
1.5
0.0
1.0
7.0
7.0
ed
0.5
0.0
0
7.0
10
0.5
1.0
1.5
1,0 = 1, 0 1, 0 1, 0 1, 0
1,1 = 1, 5 1, 5 1, 5 1, 5
para o controlador VS-MRAC1 e
2,0 = 3, 0 3, 0 3, 0 3, 0
2,1 = 3, 5 3, 5 3, 5 3, 5
para o controlador VS-MRAC2 . Este aumento na amplitude dos rels dos controladores
VS-MRAC1,2 permitir fazer com que as plantas reais W1,2 (t) convirjam para os modelos
M1,2 . Porm, tambm ocorrer um aumento na amplitude do sinal de controle, o que pode
resultar em arrancadas e paradas bruscas do rob mvel.
4 A posio do rob mvel simulado completamente diferente da posio do rob mvel real aps 1,5s
para todos os casos apresentados.
65
ee
1.5
0.0
1.0
7.0
7.0
ed
0.5
0.0
0
7.0
10
0.5
1.0
1.5
66
CAPTULO 6. RESULTADOS
7.0
ee
1.5
0.0
1.0
7.0
7.0
ed
0.5
0.0
0
7.0
12
0.5
1.0
1.5
ee
1.5
0.0
1.0
7.0
7.0
ed
0.5
0.0
0
7.0
10
0.5
1.0
1.5
67
ee
1.5
0.0
1.0
7.0
7.0
ed
0.5
0.0
0
7.0
10
0.5
1.0
1.5
68
CAPTULO 6. RESULTADOS
Captulo 7
Concluses e trabalhos futuros
Nesta tese foi proposta uma nova tcnica de controle adaptativo robusto aplicada a
um rob mvel de superfcie levando em conta sua dinmica. Como foi apresentado no
captulo 4, o modelo do rob mvel que relaciona as tenses dos motores com a posio e
ngulo do rob um sistema MIMO no linear, e o projeto de controladores no-lineares
para este modelo complexo. Desta forma, para simplificar o projeto do controlador
proposto, utilizou-se um modelo MIMO linear em substituio ao modelo MIMO no
linear, o que somente possvel se for utilizado o deslocamento linear, ao invs da posio
do rob, como a sada do modelo. Apesar de agora se dispor de um modelo MIMO linear,
o projeto de um controlador para este modelo ainda complexo, por no ser possvel
medir o deslocamento linear realizado pelo rob mvel utilizando uma cmera de vdeo e
por ser complexo o projeto de controladores para um sistema MIMO linear acoplado.
Para contornar estes problemas, o controlador proposto na tese fez uso de um sistema
inverso (Captulo 2) para desacoplar o sistema MIMO em um conjunto de controladores SISO. O projeto de controladores para plantas SISO mais simples que o projeto
para plantas MIMO. Porm, o desacoplamento somente ser possvel se os parmetros da
planta forem conhecidos, o que raramente verdade. Para superar a dificuldade introduzida pelas incertezas paramtricas da planta foi introduzido um conjunto de controladores
adaptativos VS-MRAC, os quais garantem um perfeito desacoplamento com transitrio
rpido. A unio da tcnica de desacoplamento aos controladores VS-MRAC pode ser
chamada de desacoplador adaptativo.
Por fim, no captulo 5 foi apresentado um controlador de posio para o rob mvel que considera a hiptese de substituir o deslocamento linear pela medida do erro de
posio, as quais possuem o mesmo valor quando o rob est apontando para o ponto desejado e, assim, superando a dificuldade de medir o deslocamento linear. Quando o rob
mvel no estiver apontando para o ponto desejado haver um distrbio no movimento
de translao, o qual pode ser reduzido fazendo-se com que a dinmica do modelo de
referncia do movimento de rotao seja mais rpida que a dinmica do movimento de
translao. A equao que relaciona a dinmica do movimento de rotao com a dinmica
do movimento de translao foi formalmente apresentada, resultando em uma condio
necessria para qualquer controlador candidato a controlar a posio de um rob mvel.
A avaliao do controlador proposto se deu atravs da anlise dos resultados simulados e experimentais apresentados no captulo 6. Apesar do grau de acoplamento do
sistema, rudos, incertezas paramtricas e no-linearidades presentes, nas simulaes e
70
71
A substituio dos controladores adaptativos VS-MRAC por VS-APPC (Controlador
Adaptativo por Posicionamento de Plos e Estrutura Varivel), os quais aguardam prova
de estabilidade para o caso geral, permitir a aplicao da tcnica proposta a uma classe
mais abrangente de sistemas MIMO, pois os VS-APPC podem ser aplicados a plantas
estveis, instveis, de fase mnima ou de fase no mnima.
Tambm ser importante explorar a possibilidade de transportar a estrutura do controlador proposto para outros sistemas com caractersticas similares (sistema MIMO com o
mesmo nmero de entradas e sadas) ao rob mvel, tais como braos robticos e controle
de processos na indstria.
Por fim, para controlar a posio do rob mvel, com uma cmera de vdeo de 30
quadros por segundo, a melhor alternativa ser explorar mais a utilizao de controladores
PID auxiliares para reduzir a variao paramtrica. O estudo desta tcnica j foi iniciado
com seus primeiros resultados j publicados em congresso de mbito nacional [Dias et al.
2009] e prova de estabilidade do controlador cinemtico proposta no Apndice G.
72
Referncias Bibliogrficas
Aguiar, A. P., A. N. Atassi e A. M. Pascoal (2000), Regulation of a nonholonomic dynamic wheeled mobile robot with parametric modeling uncertainty using Lyapunov functions, Proceedings of the 39th IEEE Conference on Decision & Control,
pp. 29953000, Sydney, Australia.
Aicardi, M., G. Casalino, A. Bicchi e A. Balestrino (1995), Closed loop steering of
unicycle-like vehicles via Lyapunov techniques, IEEE R&A Magazine pp. 2735.
Aires, K. R. T., P. J. Alsina e A. A. D. Medeiros (2001), A global vision system for mobile
mini-robots, Anais do V Simpsio Brasileiro de Automao Inteligente, pp. 2995
3000, Brasil.
Albagul, A. e Wahyudi (2004), Dynamic modeling and adaptive traction control for mobile robots, em Industrial Electronics Society, 2004. IECON 2004. 30th Annual
Conference of IEEE, Vol. 1, pp. 614620.
Arajo, A. D. (1983), Reprodutibilidade funcional assinttica e controle de sistemas no
lineares multivariveis inversveis, Dissertao de mestrado, Universidade Federal
de Santa Catarina.
Arajo, A. D. (1993), Contribuio Teoria de Controle Adaptativo por Modelo de Referncia e Estrutura Varivel: Uma Abordagem Entrada/Sada, Tese de doutorado,
Universidade Federal do Rio de Janeiro.
Arajo, A. D. e L. Hsu (1990), Further developments in variable structure adaptive control based only on input/output measurements, Vol. 4, 11th IFAC World Congress,
pp. 293298.
Arajo, A. D., R. R. Costa e L. Hsu (1994), Analysis and design of i/o based variable
structure adaptive control, IEEE Transactions on Automatic Control 39(1), 421.
Astrm, K. J. e B. Wittenmark (1994), Adaptive Control, Addison-Wesley Longman Publishing Co., Inc.
Bailey, E. e A. Arapostathis (1987), Simple sliding mode control scheme applied to robot
manipulators, International Journal of Control 45(4), 11971209.
Bugeja, M.K. e S.G. Fabri (2006), Multilayer perceptron adaptive dynamic control for
trajectory tracking of mobile robots, em IEEE Industrial Electronics, IECON 2006
- 32nd Annual Conference on, pp. 37983803.
73
74
REFERNCIAS BIBLIOGRFICAS
Bugeja, M.K. e S.G. Fabri (2008), Neuro-adaptive dynamic control for mobile robots: Experimental validation, em Communications, Control and Signal Processing, 2008.
ISCCSP 2008. 3rd International Symposium on, pp. 12461251.
Bugeja, M.K., S.G. Fabri e L. Camilleri (2009), Dual adaptive dynamic control of mobile
robots using neural networks, Systems, Man, and Cybernetics, Part B: Cybernetics,
IEEE Transactions on 39(1), 129141.
Chen, Chih-Yang, Tzuu-Hseng S. Li e Ying-Chieh Yeh (2009), Ep-based kinematic control and adaptive fuzzy sliding-mode dynamic control for wheeled mobile robots,
Information Sciences 179(1-2), 180 195.
Costa, R. R. e L. Hsu (1992), Robustness of vs-mrac with respect to unmodeled dynamics and external disturbances, International Journal of Adaptive Control and
Signal Processing 6, 1933.
Cunha, J. P. V. S., L. Hsu, R. R. Costa e F. Lizarralde (2003), Output-feedback modelreference sliding mode control of uncertain multivariable systems, IEEE Transactions on Automatic Control AC-48(12), 22452250.
dAndrea Novel, B., G. Bastin e G. Campion (1995), Control of nonholonomic wheeled
mobile robots by state feedback linearization, Int. Journal of Robotics Research
14(6), 543559.
de Wit, C. Canudas, H. Olsson, K.J. Astrm e P. Lischinsky (1995), A new model for control of system with fricction, IEEE Transactions on Automatic Control 40(3), 419
425.
Dias, Samaherni M., Aldayr D. Arajo e Pablo J. Alsina (2006), Controlador adaptativo
robusto de um rob mvel com acionamento diferencial, em XVI Congresso Brasileiro de Automtica, Vol. 1, Anais do XVI Congresso Brasileiro de Automtica.
Salvador - Bahia : Sociedade Brasileira de Automtica, 2006, Salvador - Bahia,
pp. 20692074.
Dias, Samaherni M., Aldayr Dantas de Arajo e Pablo Javier Alsina (2007), A dual mode
adaptive robust controller for differential drive two actuated wheeled mobile robot,
em ICINCO-RA (2), pp. 3944.
Dias, Samaherni M., Allan M. Medeiros, Aldayr D. Arajo e Pablo J. Alsina (2009),
Controlador adaptativo robusto para um rob mvel com acionamento diferencial,
em IX Simpsio Brasileiro de Automao Inteligente (IX SBAI), Vol. 1, Anais do
IX Simpsio Brasileiro de Automao Inteligente (IX SBAI), 2009, Distrito Federal
- Braslia.
Dixon, W.E., D.M. Dawson, E. Zergeroglu e A. Behal (2001), Adaptive tracking control
of a wheeled mobile robot via an uncalibrated camera system, Systems, Man, and
Cybernetics, Part B: Cybernetics, IEEE Transactions on 31(3), 341352.
REFERNCIAS BIBLIOGRFICAS
75
Egardt, B. (1979), Stability of adaptive controllers, Lecture Notes in Control and Information Sciences, Springer-Verlag, Berlin.
Emelyanov, S. V. (1967), Variable Structure Control Systems, Nauka.
Emelyanov, S. V. e V. A. Taran (1963a), Use of the inertial elements in the design of
a class of variable structure control systems - i, Automation and Remote Control
24(1), 2942.
Emelyanov, S. V. e V. A. Taran (1963b), Use of the inertial elements in the design of
a class of variable structure control systems - ii, Automation and Remote Control
24(2), 183190.
Feng, L., Y. Koren e J. Borenstein (1994), A model reference adaptive motion controller
for a differential-drive mobile robot, Vol. 4, Proceedings of the IEEE International
Conference on Robotics and Automation, pp. 30913096.
Filippov, A. F. (1964), Differential equations with discontinuous right-hand side, American Math. Soc. Translations 42, 199231.
Fukao, T., H. Nakagawa e N. Adachi (2000), Adaptive tracking control of a nonholonomic mobile robot, IEEE Trans. on Robotics and Automation 16(5), 609614.
Gaudiano, P., E. Zalama e J. Coronado (1996), An unsupervised neural network for lowlevel control of a wheeled mobile robot: Noise resistance, stability, and hardware
implementation, IEEE Transactions on Systems, Man, Cybernetics 26(3), 485496.
Ge, S. S. e G. Y. Zhou (2000), Adaptive robust stabilization of dynamic nonholonomic
chained systems, Proceedings of the 39th IEEE Conference on Decision & Control.
Sydney, Australia, pp. 14451450.
Goodwin, G. C. e K. S. Sin (1984), Adaptive Filtering: Prediction and Control, Prentice
Hall.
Goodwin, G.C. e D.Q. Mayne (1987), A parameter estimation perspective of continuous
time model reference adaptive control, Vol. 23, Automatica, pp. 5770.
Guerra, P. N. (2003), Modelagem linear e identificao do modelo dinmico de um rob
mvel com acionamento diferencial, Dissertao de mestrado, Universidade Federal
do Rio Grande do Norte.
Halliday, D., R. Resnick e J. Walker (2000), Fundamentals of Physics, Wiley.
Harris, C. J. e S. A. Billings (1981), Self-Tuning and Adaptive Control: Theory and Applications, Peter Peregrinus, London.
Hirschorn, R. M. (1979), Invertibility of multivariable nonlinear control systems, IEEE
Transactions on Automatic Control AC-24, 855865.
76
REFERNCIAS BIBLIOGRFICAS
REFERNCIAS BIBLIOGRFICAS
77
78
REFERNCIAS BIBLIOGRFICAS
Oliveira, V. M. e W. F. Lages (2001), Controle em malha fechada de robs mveis utilizando redes neurais e transformao descontnua, Anais do V Simpsio Brasileiro
de Automao Inteligente, Brasil, Novembro.
Ortega, R. e T. Yu (1987), Theoretical results on robustness of direct adaptive controllers:
A survey, Vol. 10, Proceedings of the 10th IFAC world congress, pp. 115.
Osburn, P. V., H. P. Whitaker e A. Kezer (1961), New developments in the design of model reference adaptive control systems, Institute of the Aerospace Sciences pp. 39
61.
Oubbati, Mohamed, M. Schanz e P. Levi (2005), Kinematic and dynamic adaptive control
of a nonholonomic mobile robot using a rnn, em Computational Intelligence in
Robotics and Automation, 2005. CIRA 2005. Proceedings. 2005 IEEE International
Symposium on, pp. 2733.
Pereira, G. A. S. (2000), Identificao e controle de microrrobs mveis, Dissertao de
mestrado, Universidade Federal de Minas Gerais, PPGEE, Belo Horizonte.
Pereira, G. A. S., M. F. M. Campos e L. A. Aguirre (2000), Modelo dinmico para predio da posio e orientao de micro-robs mveis, Anais do XIII Congresso
Brasileiro de Automtica, Brasil, Setembro.
Rohrs, C. E., R. Younce e S. Harvey (1989), Unacceptable transients in adaptive controllers, SIAM conference on control in the 90s: Archievements, Opportunities and
Challenges, San Francisco.
Samson, C. (1993), Time-varying feedback stabilization of car-like wheeled mobile robots, Int. Journal of Robotics Research 12(1), 5564.
Sastry, S. S. (1984), Model - reference adaptive control - stability, parameter convergence
and robustness, IMA J. Mathematical Control and Information 1, 2766.
Sastry, S. S. e M. Bodson (1989), Adaptive Control: Stability Convergence and Robustness, Prentice-Hall.
Shim, H. S. e J. H. Kim (1994), Robust adaptive control of nonholonomic wheeled mobile
robot, Proceedings of the IEEE International Conference on Industrial Technology,
pp. 245249.
Silverman, L. M. (1969), Inversion of multvariable linear systems, IEEE Transactions
on Automatic Control 14, 270276.
Slotine, J. J. E. e S. S. Sastry (1983), Tracking control of non-linear systems using sliding
surfaces with application to robot manipulations, International Journal of Control
32(2), 465492.
REFERNCIAS BIBLIOGRFICAS
79
80
REFERNCIAS BIBLIOGRFICAS
Apndice A
Deduo do erro na forma
entrada/sada - MRAC
Considere as equaes da planta, do modelo e dos sinais filtrados v1 e v2 (3.3-3.8),
e as hipteses (1-3) da pgina 23. Para estas consideraes, a estrutura do controlador
apresentada na Figura A.1.
2n (t)
+
+
u
+
+
+
Tv1 (t)
(sI )1 g
Tv2 (t)
(sI )1 g
Planta
n (t)
X = Ac X + k bc (u T ) + bc r; X 3n2
(A.1)
y = hTc X
onde X T = [xT vT1 vT2 ], k = (2n )1 = k p /km > 0 e
A 0 0
b
0 0 + g n hT T
Ac =
v1 v2 ;
0
ghT 0
bc = 2n g ;
0
hc = 0 ;
0
82
0 I 0
hT 0 0
c =
0 0 I
0 0 0
0
0
br =
0
1
(A.2)
Xm = Ac Xm + bc r, Xm 3n2
(A.3)
ym = hTc Xm
Definindo o vetor de erro por e = X Xm , tem-se a seguinte equao de erro
e = Ac e + k bc (u T )
e0 = hTc e
e na forma entrada/sada
e0 = k M(u T )
(A.4)
Apndice B
Soluo no sentido de Filippov
(B.1)
onde f : n n definida para quase todo (x,t) e mensurvel (no sentido de Lebesgue) em um domnio M n+1 . Alm disso, para qualquer subconjunto compacto
D M, A(t) localmente integrvel tal que f (x,t) A(t) para quase todo (x,t) em D.
Definio B.1 [Filippov 1964]: Uma funo vetorial x(.) denominada uma soluo de
(B.1) em [t0 ,t1 ] se x(.) absolutamente contnua em [t0 ,t1 ] e se para quase todo t [t0 ,t1 ]
com
onde
K[ f (x,t)] =
T
N=0
dx
K[ f (x,t)]
dt
(B.2)
\ \
(B.3)
>0 N=0
Lebesgue), B(x, ) uma bola de raio centrada em x e conv denota o fecho convexo.
Em cada ponto da superfcie de descontinuidade, o campo vetorial que determina a
soluo de (B.1) pertence ao conjunto convexo fechado mnimo que contm todos os
valores de f(x), quando x varia em quase toda a vizinhana (com 0) do ponto sob
considerao (a vizinhana completa exceto um conjunto de medida nula). A relao
(B.2) denominada uma incluso diferencial.
A possibilidade de rejeitar um conjunto de medida nula que permite a definio do
campo vetorial em uma superfcie de chaveamento. Na verdade embora o campo vetorial
nos pontos da superfcie de descontinuidade seja incerto, para uma dada trajetria estes
pontos constituem um conjunto de medida nula em uma vizinhana da superfcie e, ento,
podem ser desprezados.
Se ocorrer deslizamento em uma dada superfcie S, o campo vetorial f* em cada ponto
desta superfcie pode ser determinado a partir dos campos vetoriais f + e f direcionados
conforme a Figura (B.1). Desta maneira obtido um fecho convexo mnimo que a
84
f
f+
x2
f*
x1
s(x)=0
base do mtodo de Filippov. Uma vez que, por definio, o deslizamento ideal ocorre
na superfcie de deslizamento, o campo vetorial permanece em um plano tangencial
superfcie. Assim, a equao para o deslizamento ideal, definida de acordo com Filippov,
para o sistema (B.1) dada por
x = f (x,t)
(B.4)
f = f + + (1 ) f ; 0 1
(B.5)
onde um parmetro que depende das direes e magnitudes dos campos vetoriais f + ,
f e do gradiente da funo s(x).
A definio acima permite garantir a existncia e unicidade da soluo em equaes
diferenciais com lado direito descontnuo e muito til em problemas de engenharia.
Suponha que f(x,t) seja funo de um rel no ideal, por exemplo, com um pequeno
atraso de chaveamento. A soluo de Filippov corresponde ao limite da soluo de (B.1)
com o atraso do rel tendendo a zero [Utkin 1978].
Para sistemas da forma x = f (x,t) + B(x,t)u, onde a equao diferencial linear em
relao varivel de controle u, a soluo obtida pelo mtodo do controle equivalente
coincide com a soluo no sentido de Filippov, ou seja, ao se substituir u por ueq na
equao de x,
a soluo obtida para x no modo deslizante a soluo no sentido de
Filippov [Utkin 1978].
Um primeiro passo para usar a teoria de Lyapunov em sistemas descontnuos foi dado
por Filippov [1964]. Considere um sistema representado por x = f (x), x , e, para um
dada funo V (x) = x2 , obtm-se V (x) = 2x f (x). Quando ocorre deslizamento, f(x) no
definida, mas segundo Filippov, V (x) = 2x f (x). Tem-se, ento, o seguinte Lema que
permite estender a teoria de Lyapunov para sistemas descontnuos do tipo (B.1).
Lema B.1 [Bailey e Arapostathis 1987]: Considere (B.1) definida em um domnio M.
Seja V (x,t) uma funo continuamente diferencivel e w(x,t) um funo contnua tal que
(B.6)
85
para quase todo (x,t) em M. Ento, se x(t) uma soluo de (B.1) no sentido de Filippov,
tem-se para quase todo t
dV
(B.7)
86
Apndice C
Detalhes da lei de controle a estrutura
varivel
0
0
0
0
.. ; b = ..
.
.
0
... 1
. . . an
1
(C.1)
ci > 0 (i = 1, . . . , n 1)
(C.2)
0 1 0
0 0 1
.. ..
x = Ax + bu; A = ...
. .
0 0 0
a1 a2 a3
...
...
n1
(cixi) + xn = 0};
i=1
n1
(cixi) + xn = 0,
(C.3)
i=1
xi = xi+1 ;
e
i = 1, . . . , n 2
n
xn = (ai xi ) + u.
(C.4)
(C.5)
i=1
u = (i xi )
i=1
(C.6)
i=2
i=1
i=1
s(x)
= (ci1 xi ) + (ai xi ) + (i xi ),
ou de forma simplificada
n
s(x)
= (a1 + 1 )x1 + (ci1 + ai + i )xi .
i=2
1,
sgn(x) =
1,
1 > |a1 |;
se x > 0
se x < 0
i = 2, . . . , n
t>0
Apndice D
Determinao de
Seja uma planta G(s) de grau relativo 2 e um modelo M(s) com o mesmo grau relativo,
descritos da seguinte forma:
G(s) =
kp
s2 + 1 s + 2
M(s) =
n
(v2 )T
km
s2 + m,1 s + m,2
(D.1)
2n ]T basta fazer:
1 m,1
g
(1 m,1 ) + (2 m,2 ) 1 gv1
=
kp
(2 m,2 ) 2 gv1 k p n
=
kp g
km
=
kp
v1 =
n
v2
2n
(D.2)
onde e g so oriundos dos filtros dos sinais de entrada (equao 3.6 aplicada a uma
planta com o formato de G(s) - equao D.1). Para o clculo do vetor nom , aplica-se as
equaes D.2 para os parmetros nominais da planta.
90
APNDICE D. DETERMINAO DE
Apndice E
Anlise de um sistema MIMO
O conhecimento exato dos parmetros de um sistema real muito defcil de ser obtido e algumas vezes impossvel. Mediante esta dificuldade, ser realizada uma anlise
das modificaes ocorridas na matriz de transferncia do sistema quando h incertezas
paramtricas e dinmicas no modeladas.
Dado um sistema linear qualquer
x = Ax + Bu
(E.1)
y = Cx
onde, escolhendo x 2 , u 2 e y 2 por simplicidade, os parmetros do sistema
so
k1 k2
k5 k6
1 0
A=
, B=
, C=
(E.2)
k3 k4
k7 k8
0 1
A matriz de transferncia para o sistema da equao (E.1) G(s) = C(sI A)1 B, a
qual pode ser descrita por
G1,1 G1,2 1
G(s) =
(E.3)
G2,1 G2,2 D
Acrescentando-se incertezas aos parmetros da equao (E.1), tem-se
k1 + k1 k2 + k2
k5 + k5 k6 + k6
1 0
A=
, B=
, C=
k3 + k3 k4 + k4
k7 + k7 k8 + k8
0 1
(E.4)
1
G1,1 + Gi1,1 G1,2 + Gi1,2
G(s) =
(E.5)
G2,1 + Gi2,1 G2,2 + Gi2,2 D + Di
Outra anlise importante acrescentar dinmica no modelada ao sistema da equao
(E.1), onde, se x 3 , u 2 e y 2 , os parmetros do sistema so
k1 + k1 k2 + k2 ke
k5 + k5 k6 + k6
1 0
A = k3 + k3 k4 + k4 kd , B = k7 + k7 k8 + k8 , CT = 0 1 (E.6)
ka
kb
kc
kf
kg
0 0
92
1
(G1,1 + Gd1,1 )d1,1 (G1,2 + Gd1,2 )d1,2
G(s) =
(E.7)
(G2,1 + Gd2,1 )d2,1 (G2,2 + Gd2,2 )d2,2 (D + Dd )d
Apndice F
Anlise de estabilidade
Neste apndice sero apresentados os detalhes da anlise de estabilidade do controlador proposto nesta tese.
F.1
yd y p
xd x p
(F.1)
(F.2)
t > 0,
(F.3)
para comprovar que o erro de orientao seja assintoticamente estvel, deve-se garantir
que
V (e ) = 2e ( re f p ) < 0, t > 0,
(F.4)
Assim,
yd y p
d
1
tg
r
dt
xd x p
d yd y p
dt x x
p
d
V (e ) = 2e
r
2
(yd y p )
1+
2
(xd x p )
V (e ) = 2e
94
(x p )(yd y p ) (y p )(xd x p )
(xd x p )2
V (e ) = 2e
r
2
(yd y p )
1+
2
(xd x p )
(x p )(yd y p ) (y p )(xd x p )
(xd x p )2
V (e ) = 2e
r
2
2
(xd x p ) + (yd y p )
(xd x p )2
(x p )(yd y p ) (y p )(xd x p )
V (e ) = 2e
r
(xd x p )2 + (yd y p )2
(x p ) sen(re f ) (y p ) cos(re f )
V (e ) = 2e
r
()2
V (e ) = 2e
o que resulta em
F.2
vr (sen(e ))
V (e ) = 2e
r < 0
(F.5)
(F.6)
definida positiva, exceto na condio no holonmia, pois e (t) > 0, t > 0 quando se
considera que possui o mesmo sinal de cos(e ). Por este motivo a funo do erro de
posio se torna uma funo candidata a Lyapunov
V (eS (t)) > 0,
t > 0
(F.7)
Assim, para comprovar que o sistema ser assintoticamente estvel, deve-se garantir
que
t > 0,
(F.8)
95
(F.9)
d
(xd x p )2 + (yd y p )2
dt
d
((xd x p )2 + (yd y p )2 )
1
dt
=
2
(xd x p )2 + (yd y p )2
=
=
=
=
=
=
vr sen(e0 )
V (eS ) = (vr cos(e )) cos(e ) sen(e )
r
vr
sen(e )
(F.10)
96
Apndice G
Controlador cinemtico (prova de
estabilidade)
Sejam
(G.1)
V = 2e (t)
r (t) < 0
(t)
(G.3)
Assim, para a equao (G.3) ser uma funo definida negativa necessrio que
|r (t)| >
(G.4)
(t)
sgn(r (t)) = sgn(e )
(G.5)
t > 0
(G.6)
como a funo candidata de Lyapunov para o erro de posio do rob mvel. A derivada
primeira de V (eS (t)) resulta em
V = vr (t) + r (t)(t) sin(e (t)) < 0
(G.7)
vr (t)
|r (t)| <
(G.8)
(t) sin(e (t))
Finalmente, uma condio necessria, baseada nas equaes (G.4, G.5 e G.8), pode
ser obtida atravs de
vr (t) sin(e (t))
vr (t)
< r (t) <
,
(t)
(t) sin(e (t))
(G.9)
a qual uma condio necessria para qualquer rob mvel com acionamento diferencial.
Neste instante, um controlador cinemtico, respeitando a equao (G.9), ser proposto. Define-se a referncia para a velocidade linear como
vre f = (t)
(G.10)
onde > 0 serve para ajustar o ganho da velocidade linear para o rob mvel e define-se
re f = ( + ) sin(e (t))
(G.11)
como a referncia para a velocidade angular, onde > 0 serve para ajustar o ganho da
velocidade angular.
Por fim, importante notar que > 0 garante que o controlador do ngulo ser assintoticamente estvel, isto , e 0. Quando e = 0, qualquer valor para o controlador de
posio garante 0. Desta forma, pode-se concluir que o controlador proposto ser
assintoticamente estvel para qualquer ponto desejado entre /2 and /2.
Apndice H
Resultados
100
APNDICE H. RESULTADOS
1.5
1.0
0.5
1.0
0.5
1.5
Figura H.1: Desacoplamento sem incertezas paramtricas com zona morta (translao)
7.0
u2
0.0
7.0
7.0
u1
0.0
7.0
10
101
1.5
1.0
0.5
1.0
0.5
1.5
7.0
u2
0.0
7.0
7.0
u1
0.0
7.0
10
102
APNDICE H. RESULTADOS
1.5
1.0
0.5
1.0
0.5
1.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
103
1.5
1.0
0.5
1.0
0.5
1.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
104
APNDICE H. RESULTADOS
1.5
1.0
0.5
1.0
0.5
1.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
105
1.5
1.0
0.5
1.0
0.0
0.5
0.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
106
APNDICE H. RESULTADOS
1.5
1.0
0.5
1.0
0.0
0.5
0.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
107
1.5
1.0
0.5
1.0
0.0
0.5
0.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
108
APNDICE H. RESULTADOS
0.5
0.0
0.5
1.0
1.0
0.0
0.5
0.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
109
0.5
0.0
0.5
1.0
1.0
0.0
0.5
0.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
110
APNDICE H. RESULTADOS
0.5
0.0
0.5
1.0
1.0
0.5
1.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
111
1.5
1.0
0.5
1.0
0.5
1.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
112
APNDICE H. RESULTADOS
1.5
1.0
0.5
1.0
0.0
0.5
0.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
113
1.5
1.0
0.5
1.0
0.0
0.5
0.5
7.0
u2
1.5
0.0
1.0
7.0
7.0
u1
0.5
0.0
0
7.0
10
2.5
114
APNDICE H. RESULTADOS
Apndice I
Sistema de viso
Neste apndice ser apresentada uma anlise sobre as dificuldades existentes no sistema de viso que comprometem o desempenho do controlador proposto.
116
Apndice J
Identificao dos parmetros do rob
mvel
Este apndice apresenta alguns resultados dos ensaios utilizados para identificar os parmetros do rob mvel. As Figuras J.1, J.2 e J.3 mostrou trs ensaios com as velocidades
linear e angular do rob mvel e do modelo identificado pelo ensaio.
1.5
vr
0.0
1.5
15
0.0
15
16
Figura J.1: Identificao dos modelos para posio e para orientao (caso 1)
Todos os ensaios contam com a velocidade linear medida (linha tracejada) e a velocidade resultante do modelo identificado. Ao todo foram realizados quinze ensaios e para
cada um dos ensaios identificou-se um modelo diferente, a mdia dos modelos identificados dada pela equao 4.28. A tabela J.1 apresenta os desvios padro (em percentual)
para cada um dos parmetros do modelo.
118
1.5
vr
0.0
1.5
15
0.0
15
16
Figura J.2: Identificao dos modelos para posio e para orientao (caso 2)
1.5
vr
0.0
1.5
15
0.0
15
Figura J.3: Identificao dos modelos para posio e para orientao (caso 3)
16
119
Parmetro
k1
k2
k3
k4
k5
k6
k7
k8
Valor nominal
-6,098
0,04682
-4,491
-57,52383
0,012799
0,010618
-1,624859
1,683278
120
Apndice K
Software desenvolvido