Sei sulla pagina 1di 6

CONTROLE BASEADO EM LOGICA FUZZY PARA

VEICULOS AEREOS AUTONOMOS NAO TRIPULADOS DO TIPO OCTOROTOR

Bruno C. O. Miranda, Armando A. Neto, Mario F. M. Campos, Ricardo O. Duarte



Laboratorio de Visao Computacional e Robotica
Departamento de Ciencia da Computacao
Universidade Federal de Minas Gerais, Belo Horizonte MG Brasil

Departamento de Engenharias de Telecomunicacoes e Mecatronica
Universidade Federal de Sao Joao del-Rei, Ouro Branco MG Brasil

Departamento de Engenharia Eletronica
Universidade Federal de Minas Gerais, Belo Horizonte MG Brasil

Emails: brunocaeo@gmail.com, aaneto@ufsj.edu.br, mario@dcc.ufmg.br,


ricardoduarte@ufmg.br

Abstract This paper proposes control laws for attitude moments (pitch and roll) of an Octorotor-like Un-
manned Aerial Vehicles (UAVs). Firstly, research and real world applications are discussed. Secondly, hardware
and software features of our prototype are described. Next, the design of the controllers based on fuzzy logic
is presented as an alternative to classical control laws concerning precise mathematical modeling. Finally, real
experiments are performed and analyzed to demonstrate the stability of the controllers.

Keywords Attitude Control, Fuzzy Logic, Octorotor, UAV.

Resumo Este artigo apresenta leis de controle para orientacao (angulos de arfagem e rolamento) de um
Veculo Aereo Autonomo Nao Tripulado (VAANT) do tipo Octorotor. Inicialmente os VAANTs sao abordados
em termos de sua pesquisa e aplicacao no mundo real. Em seguida, sao descritas as caractersticas principais de
hardware e software do veculo. Na sequencia, e apresentado o projeto de controladores baseados em logica fuzzy
como alternativa as tecnicas classicas de ajuste de controladores que envolvem modelagem matematica. Por fim,
sao apresentados e analisados testes que demonstram a estabilidade do sistema.

Palavras-chave Controle de Atitude, Logica Fuzzy, Octorotor, VAANT.

1 Introducao

Veculos Aereos Autonomos Nao Tripulados (VA-


ANTs) sao atualmente importantes ferramentas
com as mais variadas aplicacoes. Sua utilizacao
em missoes de carater militar, por exemplo, ja e
realidade desde a Guerra do Vietna, na decada de
60, quando o Exercito Americano empregou tais
veculos em tarefas de reconhecimento e vigilancia
(Morgado et al., 2009). A tecnologia envolvida nos
veculos nao tripulados evoluiu muito desde entao. Figura 1: Prototipo do veculo octorotor (com
Hoje em dia, aplicacoes de cunho civil envol- as devidas dimensoes) construdo no VeR-
vendo VAANTs tem se expandido cada vez mais Lab/UFMG.
em diversas areas, indo desde o processamento de
imagens aereas (Jizhou et al., 2004) ate a inspe-
cao de linhas de transmissao de energia eletrica tores acoplados a helices geralmente dispostas de
(R. K. Rangel, 2009). Em meio a tantas aplica- forma simetrica em relacao ao centro geometrico
coes, e natural que haja um conjunto crescente da aeronave. Eles se destacam no meio tecnolo-
de requisitos funcionais para esses veculos, bem gico principalmente por causa de sua capacidade
como uma variabilidade de plataformas utilizadas. de voo pairado e de sua manobrabilidade em pe-
Alguns das plataformas de VAANTs mais conhe- quenos ambientes.
cidas na literatura sao as aeronaves de asa-fixa, os O objeto de estudo do presente trabalho e o
dirigveis (ou baloes), os sistemas de asas articu- Octorotor, um VAANT do tipo VTOL dotado de
ladas e os veculos de Pouso e Decolagem Vertical oito rotores (motores acoplados a helices). A Fi-
(Vertical Take-off and Landing, ou VTOL), como gura 1 mostra o prototipo do veculo em ques-
os helicopteros. Nesse ultimo grupo, um subcon- tao (com suas devidas dimensoes), construdo no
junto deve ser destacado para os fins propostos Laboratorio de Visao Computacional e Robotica
neste trabalho: os chamados multirotores. Multi- (VeRLab) da Universidade Federal de Minas Ge-
rotores (ou n-rotores) sao veculos com varios mo- rais (UFMG) e utilizado nos experimentos reais
apresentados na Secao 4. Em especial, este ar-
tigo consiste na apresentacao de um sistema de
controle para os angulos de arfagem (pitch mo-
ment) e rolamento (roll moment) de um proto-
tipo construdo e testado em laboratorio. Devido
a sua grande complexidade, encontrar um modelo
matematico preciso para um Octorotor, com va-
rios parametros para serem ajustados simultane-
amente, se mostra uma tarefa desafiadora. Sem
tal modelo, tecnicas convencionais de projeto de
controle com seus ajustes de ganhos e algoritmos
lineares classicos podem comprometer a estabili-
dade do veculo. Assim, como alternativa a tais
abordagens, e apresentado um projeto de controle
baseado em Logica Fuzzy. Como forma de validar Figura 2: Arquitetura de hardware utilizada no
o controlador projetado, sao apresentados testes prototipo do octorotor.
de estabilidade realizados com um sistema real.
Nosso trabalho e baseado em (Enomoto,
2010), onde o autor propoem uma lei de controle controle que seja capaz de manter o veculo estavel
de inclinacao para um VAANT do tipo quadriro- e enviar comandos de atuacao aos motores. Esse
tor (mais simples do que o utilizado aqui) usando subsistema e composto por um computador em-
Logica Fuzzy. No texto, adotou-se como base o barcado, o Overo Fire/Gumstix. Trata-se de um
modelo matematico de um quadrirotor. Tal qual computador em modulo de pequenas dimensoes
acontece aqui, o veculo em questao possui seis com processador de arquitetura ARM Cortex-8.
graus de liberdade tres de orientacao em SE(3) O Overo Fire e montado sobre uma placa de ex-
e tres de translacao em R3 . O metodo do cen- pansao, a Tobi Expansion Board, que oferece in-
troide de defuzzyficacao foi utilizado no projeto terfaces como USB, mini-USB, GPIO e I 2 C.
do controlador, um dos mais usados na literatura. O subsistema de comunicacao e responsavel
O restante do artigo e organizado da seguinte por garantir a troca de dados entre o veculo e
forma: na Secao 2 sao apresentadas as principais a estacao de base, o controle remoto por radio-
caractersticas de software e de hardware do sis- frequencia, ou a rede de sensores sem fio. Dois
tema a ser controlado; na Secao 3 e apresentada a modulos sao utilizados para esse fim: o modulo
estrategia principal de controle de atitude do ve- receptor de radio-frequencia, o Futaba FB R12DF,
culo; na Secao 4 sao exibidos alguns dos resultados e o modulo wireless, o X-Bee Pro, da empresa Digi.
alcancados com testes reais; e por fim, na Secao O subsistema de sensoriamento e constitudo
5, sao apresentadas as conclusoes e os trabalhos por tres elementos - uma Unidade de Medicao
futuros para a pesquisa. Inercial (Inertial Measurement Unit, ou IMU), um
altmetro e um receptor de Sistema de Posicio-
2 Descricao da plataforma namento Global (Global Positioning System, ou
GPS). Apenas a IMU diz respeito ao escopo deste
Antes de apresentar o projeto de controle propri- trabalho. Nesse caso e utilizado o modulo de me-
amente dito, e relevante descrever os aspectos es- dicao inercial 9DOF da Sparkfun, dotada de tres
truturais do Octorotor, tanto no que se refere ao sensores - um acelerometro, responsavel por medir
hardware quanto ao software embarcado. Outros as componentes de aceleracao linear nos tres eixos
detalhes podem ser encontrados em (Miranda and coordenados, um giroscopio, capaz de medir a ve-
Duarte, 2013). locidade angular em torno dos tres eixos, e uma
bussola, que mede a intensidade do campo mag-
netico. A partir das medicoes do acelerometro e
2.1 Hardware
possvel determinar os angulos de arfagem e rola-
A arquitetura de hardware do Octorotor e mos- mento. Isso e feito por meio da decomposicao do
trada na Figura 2. Esse modelo pode ser divi- vetor de aceleracao resultante nos eixos com ori-
dido em quatro subsistemas - processamento cen- gem no centro de massa do veculo. Alem disso,
tral, sensoriamento, atuacao e comunicacao. Es- as medicoes do giroscopio fornecem informacoes
ses quatro subsistemas compoem o hardware do sobre a variacao desses angulos.
veculo. O subsistema de atuacao e responsavel pelo
O Processamento Central e a unidade que acionamento dos motores do veculo. Os motores
reune informacoes sobre os demais componentes e utilizados sao do modelo Tower Pro 2409-18T, do
executa a logica de controle, descrita na proxima tipo sem escova (brushless). Esse motor possui
secao. Esse modulo deve ler os dados dos elemen- grande eficiencia, uma vez que a ausencia de esco-
tos sensores periodicamente, calcular uma acao de vas elimina a perda de energia por parte do atrito
com as mesmas. Tais motores sao acionados por z

circuitos conhecidos como ESC (Electronic Speed
Controller ). Esses circuitos recebem um sinal mo-
dulado em largura de pulso (PWM - Pulse Width x
Modulation) e distribuem a corrente nas bobinas
do motor de forma a obter uma velocidade angular
proporcional a largura de pulso do sinal PWM.

y
2.2 Software

O software embarcado e responsavel pela integra- z


{W}
cao entre os subsistemas da arquitetura de hard-
ware. Para tal, ele deve implementar os proto- x y
colos de comunicacao que permitam a leitura dos
sensores e o envio de sinais de acionamento aos Figura 3: Eixos e momentos do veculo em relacao
motores, alem do calculo da acao de controle. O ao referencial inercial {W}.
computador embarcado roda o sistema operaci-
onal Linux. Para essa aplicacao, foi utilizada a w
distribuicao Angstrom, versao 2010.7. Trata-se de yd + e y
uma distribuicao de Linux para sistemas embarca- Controlador u
yd = 0 + Planta
dos, executando o kernel com versao 2.6.33. Para Nebuloso
e y
a execucao do software em tempo real foi utilizado
o modulo Xenomai, versao 2.6.0.
Sobre o sistema operacional e o framework de
tempo real e executada a aplicacao de controle,
Figura 4: Malha de controle utilizada para os an-
escrita em linguagem C. Para leitura dos dados
gulos de arfagem e rolamento.
dos sensores da IMU e utilizado o protocolo I 2 C.
Nesse protocolo sao utilizadas apenas duas linhas
de sinal que conectam toda a rede - SDA (Serial A estrutura de controle usada neste trabalho,
Data) e SCL (Serial Clock ). O SDA e o sinal de vista na Figura 4, representa uma adaptacao da-
dados propriamente dito, ao passo que o SCL e o quela encontrada em (Raza and Gueaieb, 2010).
sinal de clock, usado para sincronizar os dispositi- Essa malha sera utilizada aqui tanto para o con-
vos da rede. trole de quanto de . Nela, yd e y representam
A aplicacao de controle consiste em procedi- os angulos desejado e medido, respectivamente, e
mentos periodicos, que executam a cada 10 ms, ou e o erro e u, a acao de controle (em percentual
seja, com frequencia de 100 Hz. De forma a me- de atuacao). Tanto o angulo quanto sua derivada
lhorar a qualidade dos sinais de medicao da IMU, sao obtidos por meio da IMU, e o sinal de erro e
os mesmos sao submetidos a um filtro digital de sua derivada sao enviados ao Controlador Nebu-
Butterworth de segunda ordem, com frequencia de loso (fuzzy) que calcula a acao de controle. Ja w
corte de 5 Hz, o que equivale a um decimo da corresponde a um sinal de perturbacao aplicado
frequencia de Nyquist para a amostragem de 100 diretamente sobre a planta, e que deve ser rejei-
Hz. tado pelo controlador.
Os erros para os angulos de arfagem e de ro-
3 Sistema de controle lamento sao classificados, cada um, em cinco con-
juntos nebulosos - Negativo Grande (NG), Nega-
Por se tratar de um sistema complexo, a mode- tivo Pequeno (NP), Zero (Z), Positivo Pequeno
lagem matematica do octorotor requer o levanta- (PP) e Positivo Grande (PG), conforme mostrado
mento de uma serie de parametros difceis de se- nas Figuras 5 e 6. O ajuste dos valores limite das
rem obtidos. Sao exemplos desses parametros a funcoes de pertinencia e emprico.
matriz de inercia do veculo, os ganhos das curvas As derivadas dos erros de arfagem e rolamento
estaticas e dinamicas de cada motor e as forcas e tambem sao classificadas em cinco conjuntos ne-
momentos gerados por eles, entre outros. Como bulosos de mesma denominacao, tal como e mos-
alternativa, foram projetados controladores base- trado nas figuras 7 e 8. Dessa forma, a partir do
ados em logica fuzzy para os angulos de arfagem e valor de erro e de sua derivada, os mesmos rece-
rolamento. A Figura 3 mostra o referencial preso bem cinco pesos referentes a cada um dos conjun-
ao corpo do robo, cujos tres eixos determinam os tos nebulosos de entrada.
momentos de arfagem, rolamento e guinada, com Uma vez classificados o erro e sua derivada, os
seus angulos correspondentes , e , respectiva- mesmos sao processados para se obter uma acao
mente, descritos em relacao ao referencial inercial de controle na forma de percentual de atuacao. A
{W}. acao de controle, por sua vez, tambem e definida
Figura 5: Funcoes de Pertinencia para o erro de Figura 7: Funcoes de Pertinencia para a derivada
arfagem. do erro de arfagem.

Figura 8: Funcoes de Pertinencia para a derivada


Figura 6: Funcoes de Pertinencia para o erro de
do erro de rolamento.
rolamento.

ses conjuntos. A pertinencia referente ao conjunto


nos mesmos cinco nveis. O calculo e feito com A B pode ser definida por
base na logica exposta na Tabela 1.
Para cada nvel da sada (NG, NP, Z, PP ou A B = max(A , B ) (1)
PG) e associado um percentual de atuacao (qNG ,
qNP , qZ , qPP e qNG , respectivamente). Cada valor e a pertinencia referente ao conjunto A B pode
de sada e ponderado por um peso obtido a partir ser definida por
da tabela. O peso para um dado tipo da sada
A B = min(A , B ). (2)
e resultado das possveis combinacoes entre erro
e derivada do erro que resultem naquele tipo de Utilizando as operacoes de maximo e mnimo
sada. Em outras palavras, o peso para um dado para uniao e intersecao entre conjuntos, define-se
tipo de sada e obtido por meio de intersecoes e os pesos uNG , uNP , uZ , uPP e uPG referentes a cada
unioes dos conjuntos de erro e de sua derivada cu- tipo de sada. A acao de controle percentual u
jas posicoes da tabela sao preenchidas por aquele e definida como a media ponderada dos tipos de
tipo de sada. sada
Sejam A e B dois conjuntos nebulosos quais- uNG qNG +uNP qNP +uZ qZ +uPP qPP +uPG qPG
quer, e A e B os valores de pertinencia a es- u= .
uNG +uNP +uZ +uPP +uPG
(3)
A acao de controle u representa um percentual
Tabela 1: Matriz de atuacao da logica fuzzy: erro dentro de uma faixa saturada de atuacao de cada
x derivada do erro. motor. Essa faixa e limitada inferiormente por um
valor de giro mnimo do motor.
Nota-se que a base de regras lingusticas aqui
utilizada e comum em sistemas de inferencia do
tipo Mamdani. No entanto, o processo de defuzifi-
cacao por meio dessa estrutura exigiria um grande
esforco computacional. Assim sendo, foi utilizado
um sistema de inferencia do tipo Takagi-Sugeno
de ordem zero, associando um valor constante a
cada tipo de sada.
A Figura 9 mostra o Octorotor visto de cima
com as identificacoes dos motores e os eixos x e y.

Figura 10: Plataforma de Stuart, utilizada para


testes de estabilidade e ajuste de parametros de
controle.

Figura 9: Numeracao dos conjuntos de motores


do octorotor.

Para o controle de arfagem, os motores 1A,


1B, 2A e 2B recebem atuacao u, ao passo que
os demais motores recebem atuacao u. Para o
controle de rolamento, os motores 2A, 2B, 3A e
3B recebem atuacao u, ao passo que os demais
motores recebem atuacao u. A operacao de cada
malha de controle e independente em relacao a
outra, e suas acoes devem ser somadas na atuacao
final dos motores.
Figura 11: Angulo de arfagem em funcao do
4 Testes e resultados tempo.

Para a realizacao do teste de estabilidade, o oc-


torotor foi afixado a uma plataforma girante (ou 5 Conclusoes e trabalhos futuros
plataforma de Stuart), conforme mostrado na Fi-
gura 10. Nessa plataforma, o veculo e livre para Os procedimentos aqui descritos, bem como os
girar em torno de seus tres eixos principais, re- resultados obtidos a partir de tais testes, contri-
presentados na Figura 3, mas nao lhe e permitido buem para a ideia de que metodologias baseadas
executar nenhum movimento de translacao. A fi- em Logica Fuzzy (conjuntos nebulosos) represen-
xacao foi feita em torno do centro geometrico do tam ferramentas passveis de serem utilizadas em
veculo, e o mesmo foi mantido com angulos de aplicacoes que envolvam leis de controle a Veculos
arfagem e rolamento proximos de zero. Aereos Autonomos Nao Tripulados, especialmente
Com o algoritmo de controle em execucao, o para veculos do tipo n-rotor. Octorotores, em
veculo foi liberado de sua condicao inicial com particular, sao plataformas que, alem de serem re-
o objetivo de manter a posicao de equilbrio em presentadas por modelos matematicos complexos
torno dos angulos nulos. As medicoes da IMU (Victor and Stoica, n.d.), requerem levantamento
(acelerometro e giroscopio) foram usadas para in- de parametros com alta precisao, algo que nem
ferir os angulos de arfagem e rolamento, bem como sempre e possvel.
suas derivadas. Esses valores foram registrados, Por outro lado, quando se utiliza controlado-
de modo que as Figuras 11, 12, 13 e 14 mostram res fuzzy, pode-se realizar um ajuste emprico no
os graficos das variaveis medidas em funcao do que se refere as funcoes de pertinencia utilizadas
tempo. para a entrada, e aos valores para os conjuntos de
Durante o teste foram geradas pequenas per- sada. Em geral, esse ajuste pode e deve ser feito
turbacoes em torno do eixo x e do eixo y. Os com base na experiencia que se tem do comporta-
graficos mostram a rejeicao as perturbacoes gera- mento da planta, restando apenas um refinamento
das. Para maiores detalhes, um breve vdeo mos- posterior a ser feito. Em suma, este trabalho mos-
trando o prototipo e o teste executado pode ser tra que controladores baseados em logica fuzzy po-
encontrado no endereco eletronico http://www. dem ser aplicados com exito a VAANTs, desde que
youtube.com/watch?v=jug-IrpOPDo. devidamente projetados e implementados.
Figura 12: Variacao angular em x em funcao do Figura 14: Variacao angular em y em funcao do
tempo. tempo.

amento, ao professor Leonardo A. B. Torres pelo


inestimavel auxlio, contribuicoes tecnicas e dis-
cussoes a respeito do trabalho, e ao Wolmar Pi-
menta pelo auxlio na construcao do prototipo.

Referencias

Enomoto, J. F. (2010). Controle de inclinacao


utilizando logica fuzzy, Masters thesis, Uni-
versidade Federal do Parana.
Jizhou, W., Zongjian, L. and Chengming, L.
(2004). Reconstruction of buildings from a
Figura 13: Angulo de rolamento em funcao do single uav image, Proc. International Soci-
tempo. ety for Photogrammetry and Remote Sensing
Congress, pp. 100103.
Como trabalho futuro pretende-se agora ele- Miranda, B. C. O. and Duarte, R. O. (2013). Pla-
var o nvel da logica de controle, de modo a estabi- taforma de hardware e software para veculo
lizar outras variaveis da planta. E possvel utilizar aereo nao tripulado do tipo octorotor, Con-
os sinais da bussola integrada ao sistema para con- gresso de Iniciacao Cientfica do INATEL
trolar a orientacao latero-direcional do octorotor INCITEL, Vol. 1, Santa Rita do Sapuca,
em relacao ao eixo magnetico da Terra. Uma vez pp. 1296.
estabilizada toda a atitude do robo, pode-se es-
tabelecer leis de controle para ajuste da altitude Morgado, J., Engel, T. C. and de Sousa, J. T. B.
e posicionamento do veculo em relacao ao plano (2009). O programa de investigacao e tec-
terrestre, usando para isso sensores barometricos nologia em veculos aereos autonomos nao-
e receptores de GPS. A expectativa e que seja pos- tripulados da academia da forca aerea, Ca-
svel usar controladores baseados em logica fuzzy dernos do IDN, no 4. Instituto de Defesa Na-
tambem nessa etapa. cional, Julho pp. 4450.
R. K. Rangel, K. H. K. e. M. P. B. (2009). Sis-
Agradecimentos tema de inspecao de linhas de transmissao de
energia eletrica usando veculos aereos nao-
Os autores agradecem a equipe do Laboratorio tripulados, Brazillian Symposium on Aeros-
de Visao Computacional e Robotica (VeRLab) do pace Eng. & Applications .
Departamento de Ciencia da Computacao (DCC)
da Universidade Federal de Minas Gerais (UFMG) Raza, S. and Gueaieb, W. (2010). Intelligent flight
pela disponibilizacao dos recursos fsicos e finan- control of an autonomous quadrotor, Motion
ceiros necessarios ao projeto. Agradecem tam- Control, Intech, ISBN: 978-953-7619-55-8,
bem ao Conselho Nacional de Desenvolvimento pp. 245264.
Cientfico e Tecnologico (CNPq), a Coordenacao Victor, G. and Stoica, A. M. (n.d.). Integral lqr
de Aperfeicoamento de Pessoal de Nvel Superior control of a star-shaped octorotor, INCAS
(CAPES) e a Fundacao de Amparo a Pesquisa do Bulletin 4.
Estado de Minas Gerais (FAPEMIG) pelo financi-

Potrebbero piacerti anche