Académique Documents
Professionnel Documents
Culture Documents
quadrotores
D i ego Cmar a Sal es , Adr i ano Fr ut uos o, Andr Lamei r a dos Sant os
Laboratrio de Automao Industrial e Robtica, Departamento de Eletrnica, Telecomunicaes e Computao
Universidade Federal do Amazonas
Manaus, Amazonas
Emails:diego@ifam.edu.br ,Adriano.frutuoso@gmail.com, adnrehls@hotmail.com
Resumo Hoje em dia os helicpteros do tipo quadrotor
esto se tornando populares no desenvolvimento de pesquisas em
veculos areos no tripulados, VANT, pela sua capacidade de
pouso vertical e de planar em locais de difcil acesso. O controle
da maioria destes veculos baseado em modelos dinmicos
fsicos ou experimentais, podendo apresentar um alto custo
devido ao tempo de desenvolvimento do projeto. Neste artigo
apresentada o desenvolvimento de um controlador fuzzy, que
dispensa a necessidade de um modelo matemtico para o projeto
do controlador de estabilidade, visto que o mesmo baseado em
regras lingusticas. O controle fuzzy de um quadrotor tem como
vantagem a diminuio do tempo de elaborao e custo do
projeto.
Palavras Chave Desenvolvimento; Controle Fuzzy; VANT;
Custo de projeto;
I.
INTRODUO
A. Dinmica do Sistema
As formulaes matemticas da Equao 1 descrevem o
comportamento dinmico do quadrotor. Neste modelo
possvel executar simulaes computacionais e anlises
detalhadas propondo mtodos de controle de suas variveis,
assim como analisar o comportamento da planta a ser
controlada.
O modelo inclui a resultante dos efeitos giroscpios da
rotao do corpo rgido no espao e a rotao dos quatro
propulsores. Alm disso, pode ressaltar que o modelo
apresenta um comportamento no linear[1].
O quadrotor tem capacidade de rotacionar em trs eixos. A
rotao realizada ajustando-se a velocidade de cada rotor em
relao aos outros trs. A diferena de velocidade entre os
pares de motores faz com que ocorra rotao nos eixos de
rolagem, roll () , e arfagem, pitch (), e guinada, yaw (),
conforme ilustrado na Figura 2.
Definio
Smbolo
Definio
ngulo Roll
Posio X
Posio Y
ngulo Yaw
x
y
z
Inercias do Corpo
Inercia Rotacional
d
m
Fator de Arrasto
Massa do Corpo
ngulo Pitch
Ix , Iy , Iz
Posio Z
Jr
i
Velocidade do rotor
Comprimento
Fator de Rotao
u 1, u 2, u 3
Sinais de Controle
! = . ! ! + ! ! + ! ! + ! !
! = . ! ! ! !
! = . ! ! ! ! (2)
! = . ! ! + ! ! ! ! ! !
= ! + ! ! !
gravidade
! ! !
. . + . !
!
!
!
! ! !
= .
+ . . + . ! (1)
!
!
!
! ! 1
= .
+ . !
!
!
1
= . . + . . . !
1
= . . . . . !
1
= + (. ) . !
= .
(3)
Zero
Negativo
Positivo
0.8
0.6
0.4
0.2
Positivo
0.8
0.6
0.4
0.2
50
Zero
40
30
20
10
10
20
30
40
50
50
40
30
20
10
10
20
30
40
50
Roll
vMedia
vMuitoAlta
0.8
0.6
0.4
0.2
10
15
20
25
30
35
40
45
50
B. Implicao Fuzzy
As regras lingusticas do controlador fuzzy descrevem o
comportamento do sistema mediante combinaes das
entradas dos ngulos a serem controlados atravs de
conectivos lgicos. A base de regras representa as aes a
serem tomadas mediante as possveis entradas, sendo
necessrio o conhecimento especializado do comportamento
da dinmica do sistema. Foi utilizado inicialmente 9 regras
lingusticas aplicadas pela combinao das variveis de
entrada, conforme Tabela 2.
Tabela 2. Comeo de uma Tabela de uma nica Coluna.
Motor
2
e
Motor
1
Z
VA
VA
VM
VA
VM
VB
VM
VB
VB
VM
VB
VB
VA
VM
VB
VA
VA
VM
60
40
20
20
40
60
0
100
200
300
400
500
Amostragem
600
700
800
900
1000
15
10
10
15
20
0
100
200
300
400
500
Amostragem
600
700
800
900
1000
12 bits
8 bits
15
10
ngulo(graus)
Motor
4
e
Motor
3
Velocidade angular
B. Resultados Experimentais
A resposta do sistema apresentando a seguir onde foi
definido o angulo de referencia setpoint em 0 graus com
resoluo do PWM em 8bits e 50% da potencia mxima
aplicada aos motores do sistema, simulando assim a
decolagem do quadrotor. A Figura 9 apresenta o sinal de
controle do giroscpio X onde observa-se a oscilao do
sistema na faixa entre [-20,20] graus por segundo
demonstrando a atuao do controlador.
ngulo (graus)
10
15
20
0
200
400
600
800
Amostragem
1000
1200
1400
1600
ngulo (graus)
10
5
0
5
10
15
20
0
200
400
600
800
1000
Amostragem
1200
1400
1600
1800
2000