Professional Documents
Culture Documents
CENTRO DE TECNOLOGIA
DEPARTAMENTO DE ENGENHARIA DE TELEINFORMTICA
PROGRAMA DE PS-GRADUAO EM ENGENHARIA DE TELEINFORMTICA
REJANE CAVALCANTE S
FORTALEZA
2012
REJANE CAVALCANTE S
FORTALEZA
2012
Dados Internacionais de Catalogao na Publicao
Universidade Federal do Cear
Biblioteca de Ps-Graduao em Engenharia - BPGE
CDD 621.38
A Deus e minha famlia.
AGRADECIMENTOS
AD Analgico Digital
BLDC Brushless Direct Current
CAD Computer-Aided Design
CC Corrente Contnua
DSP Processador Digital de Sinais
ESC Electronic Speed Control
LiPo Polmero de Ltion
MEMS Micro Electro Mechanical Systems
MIPS Milhes de Instrues por Segundo
PID Proporcional, Integrativo e Derivativo
PWM Pulse Width Modulation
UART Universal Asynchronous Receiver/Transmitter
RAM Random Access Memory
RPM Rotaes Por Minuto
VANT Veculo Areo no Tripulado
LISTA DE SMBOLOS
1 INTRODUO ..................................................................................................................... 1
1.2 APLICAES....................................................................................................................... 1
1.3 DEFINIO DOS PROBLEMAS .............................................................................................. 2
1.4 OBJETIVOS ......................................................................................................................... 2
1.4.1 Objetivos Gerais ......................................................................................................... 2
1.4.2 Objetivos especficos .................................................................................................. 3
1.5 PRODUO CIENTFICA ...................................................................................................... 3
1.6 ORGANIZAO GERAL DA DISSERTAO .......................................................................... 3
2 QUADRIROTORES ............................................................................................................. 5
6 RESULTADOS .................................................................................................................... 49
REFERNCIAS ..................................................................................................................... 64
1 INTRODUO
1.2 Aplicaes
1.4 Objetivos
Esta dissertao est dividida em sete captulos nos quais apresentam uma
sequncia que mostra passo a passo a construo e controle de um quadrirotor.
4
2 QUADRIROTORES
2.1 Introduo
Neste captulo so apresentados os primeiros quadrirotores que obtiveram sucesso
em seus vos, alguns quadrirotores produzidos comercialmente e algumas das plataformas
utilizadas para pesquisa em universidades pelo mundo e no Brasil, sendo prtica comum que
cada grupo de pesquisa desenvolva seu prprio dispositivo.
2.3.1 AR.Drone
O AR.Drone (PARROT, 2012) foi comercializado para diverso sendo controlado
remotamente por celular usando wi fi, contendo vrios jogos de vdeos e utilizando realidade
aumentada, estando j na segunda verso, Figura 4. Surgiu em 2010 e seu processador um
ARM9, contendo acelermetros, giroscpios, magnetometro, cmera de vdeo, motores sem
escovas de 3500 RPM.
2.3.2 Draganflyer
Draganflyer, mostrado na Figura 5, uma estrutura comercializa pela RC Toys
(DRAGANFLYER, 2012) e utilizada em vrias pesquisas. Muitos destes pesquisadores
trocam a placa de desenvolvimento por suas prprias placas e testam seus controladores
aproveitando sua estrutura.
8
2.3.3 X4-Flyer
O X-4 Flyer desenvolvido na Austrlia (POUNDS, MAHONY, CORKE, 2010),
utilizado em diversos trabalhos de Pounds e de outros pesquisadores. Construda com fibra de
carbono e alumnio pesa 4 kg e tem capacidade de levar cargas extras de at 1 kg, Figura 6.
Essa estrutura caracterizada por suas hlices serem invertidas, os motores ficam
na parte superior da estrutura e as hlices posicionadas abaixo dos motores, sendo testada sua
eficcia com vrios controladores.
2.3.4 STARMARC
Na Califrnia foi desenvolvido o STARMAC (Stanford Testbed of Autonomous
Rotorcraft for Multi-Agent) que j est na segunda verso, apresentada na Figura 7. Hoffmann
et al. (2011) mostram a nova verso de seu trabalho modificando os sensores, rotores e novos
sistemas eletrnicos.
9
2.3.5 OS4
Na Escola Politcnica Federal de Lausanne, Bouabdallah (2007) em suas
pesquisas com veculos areos no tripulados contribuiu com diversos trabalhos e apresentou
o quadrotor OS4, Omnidirectional Stationary Flying Outstretched Robot, mostrado na Figura
8.
Este quadrirotor faz malabarismos com uma bola de ping-pong podendo interagir
com outros quadrirotores de forma autnoma (MLLER; LUPASHIN; DANDREA 2011).
Este quadrirotor tem um vdeo no YouTube mostrando sua performance que j tem mais de 2
milhes de acessos com o nome Quadrocopter Ball Juggling, ETH Zurich (2012).
11
Figura 12: Quadrirotor importado utilizado para aplicao de VANT na agricultura pela Universidade de So
Paulo.
Figura 13: VANT desenvolvido pelo Instituto Federal do Rio Grande do Norte, pela Universidade Estadual de
Feira de Santana e pela Universidade Federal de Rio Grande do Norte.
Projetado para comportar carga til extra de 2 kg o quadrirotor com sua estrutura
em alumino, motores sem escovas, hlices de 12 polegadas e controladores tem uma
aproximada de 3 kg (GUIMARES et al., 2012).
2.4 Concluso
Neste captulo foram apresentados os principais VANTs do tipo quadrirotor da
histria, de pesquisas em todo o mundo e alguns trabalhos que esto sendo desenvolvidos no
Brasil.
O sucesso e os desafios das plataformas desenvolvidas por outros pesquisadores
foram de suma importncia para o design do quadrirotor desenvolvido nesta dissertao.
Vale destacar aqui que existem vrios modelos disponveis e que no existe uma
padronizao de projeto para este tipo de estrutura mecatrnica (i.e. quadrirotores). Assim
cada pesquisador interessado em utilizar quadrirotores ter que adquirir estruturas comerciais,
13
3.1 Introduo
Um quadrirotor controlado variando-se as velocidades angulares de seus quatro
motores, sendo necessrio especificar os principais efeitos decorrentes destas variaes
angulares. As equaes da dinmica do quadrirotor descrevem as coordenadas e velocidades
em relao ao tempo.
Neste captulo ser apresentado o funcionamento do sistema, detalhando cada
movimento, apresentando o sistema de coordenadas utilizado para construo das equaes e,
posteriormente, apresentadas as equaes diferenciais que descrevem a dinmica de um
quadrirotor.
Figura 14: Descrio das rotaes dos propulsores (setas em preto) e resultado do movimento (setas em
vermelho)
Figura 15: Sistemas de coordenadas usados para descrever o modelo dinmico do quadrirotor.
J5 OP(RST RTT )
IJ K M = N OP(R4T RWT ) Y.
(2)
JL X(R + R R R )
T T T T
T S W 4
1
aj = (cde efg_cde\ + efg efg\) k,
2 W
(6)
1
`j = (cde efg_cde\ efg efg\) k,
2 W
(7)
18
1
^j = l + Qcde cde_V k,
2 W
(8)
nKK nLL pq 1
j = _9\9 m o _9 + k,
n55 n55 n55 T
(9)
nLL n55 pq 1
_j = 9 \9 r s 9 + k,
nKK nKK nKK 4
(10)
n55 nKK 1
\j = 9 _9 m o+ k,
nLL nLL S
(11)
k4 = POQR4T RWT V,
(14)
XRQvV
Jt Ju = pq + wRQvV,
Xv
(16)
|}T
X |}
R9 { = RZ RZT +
~} (p} + pq ) p} + pq ~} (p} + pq )
(18)
a massa da caixa que contm os componentes eletrnicos, bem como suas posies na
estrutura (AMIR; ABBASS, 2008).
A massa do motor de aproximadamente 39 g e a massa da caixa que contm os
componentes de aproximadamente 388 g. Suas dimenses so mostradas na Tabela 2.
2OT
nL = r s = 0,5949 104 xl. 24 .
12
(22)
Para o clculo dos momentos de inrcia dos motores Imx, Imy e Imz , nos eixos x, y e
z respectivamente, considerado que este tem formato cilndrico. Logo:
}T }
T
n}5 = } r + + O}
T
+ O T s = 2,2454 104 xl. 24 .
4 12
(23)
}T
n}L = } r + O T s = 2,2815 104 xl. 24 .
2
(25)
4,9523a104 0 0
3= 0 4,9523a104 0 . (29)
0 0 9,7209a10 4
3.6 Concluso
Neste captulo foi apresentado o modelo dinmico de um quadrirotor, combinando
os principais efeitos aerodinmicos, as equaes de momento dos rotores com outras foras
externas e outras equaes dinmicas usando as Leis de Newton.
O modelo dinmico apresentado ser posteriormente implementado em Simulink,
servindo como uma ferramenta adequada para avaliar tcnicas e controles antes de
implement-los na plataforma desenvolvida.
O captulo a seguir descreve a plataforma desenvolvida especificando
detalhadamente todos os seus componentes.
23
4 PLATAFORMA DESENVOLVIDA
4.1 Introduo
O ponto de partida do projeto em questo foi definir aproximadamente o tamanho
final e peso do sistema para que fosse possvel dimensionar adequadamente todas as partes.
O design da estrutura e a escolha dos componentes utilizados foram determinados
de acordo com os sucessos de outras plataformas, como as descritas em (MELO, 2010; LEE,
KIM; SASTRY 2009; FOWERS, 2008; CZYBA, 2009; GUERRERO-CATELLANOS et al.,
2011; COLORADO et al., 2010; VOOS, 2009), alm das plataformas mostradas no Captulo
2. O projeto e os componentes de estrutura desenvolvida nesta dissertao so descritos a
seguir, mostrando detalhadamente cada componente utilizado para sua construo.
Figura 16: Estrutura desenvolvida em alumnio em CAD. As dimenses das peas a, b e c indicadas na figura so
mostradas na Tabela 3.
Uma simulao para verificar qual a mxima tenso que a estrutura suporta foi
feita utilizando um ensaio de estresse Von Mises, realizado com o plugin NX Nastran, (NX
NASTRAN, 2012) do software Solid Edge ST3 CAD. No teste, verificou-se que a estrutura
desenvolvida em alumnio 1060 comea a deformar plasticamente a 27 Mpa, como visto na
Figura 17. Neste teste, as extremidades foram fixadas e sua superfcie sujeitas fora da
gravidade.
Figura 17: Ensaio de estresse Von Mises na estrutura utilizando o plugin NX Nastran, Solid Edge ST3 CAD.
O ensaio foi feito fixando as extremidades devido a posio dos rotores nas
extremidades, que o impulsiona para cima e pelo fato da maior parte do peso quadrirotor estar
esta
concentrado no centro da estrutura.
estrutura A Figura 18 (a) e (b) mostra a estrutura desenvolvida com
as hlices.
Figura 18:
18: Foto da vista superior do chassi depois de construdo.
(a) (b)
Fonte: Prprio autor.
a) Motores e Hlices
Os motores usados so motores sem escovas, Brushless Direct Current (BLDC)
do fabricante Emax, modelo CF2822,
2822, indicado por muitos que trabalham com
aeromodelismo,
eromodelismo, tendo 1200 RPM/V (EMAX, 2012).. Este pesa aproximadamente 39 g e sua
faixa de corrente em uso contnuo de 7 a 12 A,
A Figura 19.
Figura 19:
19 Foto do motor utilizado na construo
o do quadrirotor.
Figura 22: Diagrama bsico do fluxo de informao entre as principais partes compondo o quadrirotor
desenvolvido.
a) Placa microcontroladora
A integrao e otimizao depende tambm da capacidade de processar os dados
de sensores e calcular os algoritmos de controle em tempo real, gastar um mnimo de energia
e tentar economizar ao mximo os custos. Assim, a placa microcontrolada foi toda
desenvolvida em laboratrio, apresentando seu circuito eltrico no Apndice C.
O circuito responsvel em passar os comandos aos motores do quadrirotor foi
desenvolvido utilizando o microcontrolador dsPIC30F4011, da famlia Microchip. Este
microcontrolador de 16 bits pode trabalhar em at 30 MIPS (milhes de instrues por
segundo) e tem memria RAM de 2 Kbytes e memria EPROM de 1 Kbyte (MICROCHIP,
2012). O diagrama dos pinos deste microcontrolador mostrado na Figura 23.
b) Comunicao
O sistema de comunicao por radiofrequncia foi constitudo por dois mdulos
transceptores da Low Power Radio Solutions (LPRS), Easy-Radio ER400TRS, que prov um
alto desempenho, simplicidade de uso e possibilidade de transferncia bidirecional de dados
(LPRS, 2012). Os rdios, dispostos em pares, transmitem dados atravs de sinalizao digital
numa frequncia de 433 MHz, com potncia de sada e velocidade de processamento de dados
programveis. Estes emissores-receptores tm uma capacidade de buffer limitada a 120 Bytes,
o que significa que possvel enviar at 60 amostras de cada vez e seu alcance de 200 m.
Os rdios e o microcontrolador foram configurados para trabalhar em uma
velocidade de transmisso de 19200 bits por segundo, onde um rdio fica junto a um
computador e o outro com o quadrirotor como mostrado na
Figura 22.
No computador foi utilizado um software para enviar comandos pela porta serial,
onde foi conectado o rdio. Uma placa faz a adaptao do rdio para a comunicao com o
computador utilizando um MAX232, tambm desenvolvida no laboratrio, seu circuito
eltrico mostrado no Apndice D.Com o uso do rdio, possvel enviar os comandos de
1
Duty cycle: proporo de tempo durante o qual o componente est em operao.
30
altitude para a placa responsvel pelo controle e esta envia ao computador as medidas dos
sensores e o valor do PWM de todos os motores para uma avaliao do controle embarcado.
4.6 Sensores
Os sensores utilizados para navegao do quadrirotor desenvolvido foram um
acelermetro triaxial, dois giroscpios biaxiais e um sonar. O acelermetro e os giroscpios
so usados para verificar a inclinao nos eixos, enquanto usado o sonar para verificar a
altura da estrutura em vo, necessrio para o controle de altitude.
a) Acelermetro
Os sinais do acelermetro triaxial so verificados por uma placa de suporte,
(POLOLU, 2012), para o CI MMA7361L do tipo Micro-Electro-Mechanical Systems
(MEMS) da Freescale (FREESCALE, 2008). As sadas X, Y e Z deste acelermetro so trs
tenses analgicas separadas, centralizadas na metade da tenso de alimentao que de 3,3
V. Aceleraes positivas ao longo de um eixo aumentam a tenso, sendo usado para verificar
a inclinao da estrutura em trs eixos. Sua posio de acordo com o eixo da estrutura
mostrada na Figura 24.
31
Figura 24: Ilustrao do posicionamento correto do sensor MMA7361L, fixado no centro da estrutura, onde as
referncias mostradas na placa do acelermetro correspondem a referncia mostrada na estrutura.
b) Giroscpio
O Giroscpio biaxial LPR510AL do tipo MEMS tambm tem uma placa de
suporte (POLOLU, 2012). Este giroscpio pode atuar nas faixas de 100/s e 400/s . A
faixa de sensibilidade utilizada para a navegao foi a de 100/s
(STMICROELECTRONICS, 2009), para verificar a velocidade angular em cada eixo da
estrutura.
Dois giroscpios biaxiais mensuram as inclinaes da plataforma nos trs eixos,
onde dois dos eixos so mensurados por um sensor e ou outro eixo mensurado pelo segundo
sensor. A Figura 25 (a) e (b) mostra a disposio destes sensores na estrutura de acordo com o
sistema de coordenadas B.
Figura 25: Vista lateral do quadrirotor indicando a posio corretas dos sensores LPR510AL.
c) Sonar
Outro sensor utilizado
utilizado o sonar EZ3 da famlia de sonares LV-MaxSonar-EZ.
LV
Este sensor detecta objetos na faixa de 0 a 6,45 m e fornece informaes com uma resoluo
de 2,5 cm. Contendo trs interfaces de sada, todas
todas elas ativam simultaneamente as seguintes
sadas: sada por comprimento de pulso digital, sada de voltagem analgica e sada digital
serial assncrona. O sensor se encontra no centro do veculo,, abaixo da caixa contendo os
componentes eletrnicos.
A correta posio, a garantia de que os sensores no iro inclinar
incl em relao a
estrutura, o alinhamento
linhamento e a leitura correta so de fundamental importncia para que o
controle de estabilidade da estrutura seja realizado de forma correta.
(a) (b)
Fonte: Prprio autor.
4.8 Concluso
A experincia de outros grupos de pesquisa contribuiu para o projeto e a escolha
dos componentes a serem usados na plataforma desenvolvida. O diferencial da estrutura
proposta nesta dissertao est no uso dos cordes de ao para fixao e evitar trepidaes na
estrutura.
A escolha de usar dois giroscpios de dois eixos foi por no se ter disponvel, na
poca da construo da plataforma, fornecedores no pas que tivessem giroscpios de trs
eixos. Assim, foram necessrios dois giroscpios biaxiais para verificar as inclinaes nas trs
direes. Os motores e ESCs foram escolhidos de acordo com trabalho de Melo (2010) e a
escolha do microcontrolador foi de acordo com o sucesso no trabalho de Hoffmann et al.
(2004).
Neste captulo foram apresentados todos os componentes utilizados para a
construo de um quadrirotor, detalhando o chassi e os principais sensores necessrios para o
controle da plataforma.
O prximo captulo descreve o controle utilizado para estabilizar o quadrirotor
desenvolvido neste trabalho.
34
5.1 Introduo
Em ltima instncia, o objetivo desta dissertao estabilizar o quadrirotor em
uma determinada posio pairando no ar. O quadrirotor um sistema subatuado2 e
dinamicamente instvel, com seis graus de liberdade, trs translaes e trs rotaes. O
objetivo deste captulo descrever o controlador proporcional, integrativo e derivativo (PID)
projetado para estabilizar as trs rotaes, onde comandos de referncia so enviados para a
plataforma por um computador como mostrado no captulo anterior.
A resposta em malha aberta do quadrirotor instvel e, por conseguinte, um lao
de realimentao necessrio para ser capaz de estabilizar o quadrirotor (WIEREMA, 2008).
Usando os sinais do acelermetro e dos giroscpios para realimentar a informao de posio
ao sistema, controladores so elaborados para controlar as posies desejadas.
Neste captulo uma breve reviso da teoria do controle clssico ser feita para em
seguida descrever a aplicao do controlador PID para estabilizar a rotao da plataforma
desenvolvida.
kW P P RW
T
P P
kT
= 0 PO 0 PO RT
T
k4 PO 0 PO 0 R4T
(30)
kS X X X X R T
S
2
Sistema subatuado: sistema que possui um nmero maior de graus de liberdade do que atuadores.
35
1 1 1
0
WT 4P 2PO 4X
T 1 1
0
1 kW
T = 4P 2PO 4X kT
T 1 1 1 k4
4 0
(31)
S 4P
T 2PO 4X kS
1 1 1
4P 0
2PO 4X
ajustados dos ngulos que junto ao valor de altitude so convertidos nos sinais de PWM de
cada motor. A posio do quadrirotor estimada utilizando a leitura dos sensores de momento
de inrcia fixados na estrutura.
No controle proporcional a sada do controlador diretamente proporcional a sua
entrada, sendo e(t) o sinal de erro e Kp a constante proporcional, dada por (OGATA, 2011).
q QvV = | fQvV.
(32)
y
Zy QvV = |Z fQvV.
(33)
XfQvV
tq QvV = | .
Xv
(34)
Os parmetros dos trs controladores para cada posio (nove, no total) foram
selecionados manualmente atravs da anlise dos plos da funo de transferncia do sistema
em malha fechada.
|Z
kQeV = m| + + | eo QeV.
e
(36)
|Z |
kQeV = | + + QeV,
e 1 + | e
|
(37)
|}T
XZ
w} = + ,
~} (p} + pq ) p} + pq
(38)
|}
} = ,
~} (p} + pq )
(39)
9 { = w} Z + } . (40)
O
j= kT ,
n55
(41)
39
O
_j = k4 ,
nKK
(42)
kS
\j = .
nLL
(43)
} T O
QeV = T k QeV,
e Qe + w} VT n55 T
(44)
} T O
_QeV = T k QeV,
e Qe + w} VT nKK 4
(45)
} T
\QeV = T k QeV.
e Qe + w} VT nLL S
(46)
onde Ui, i=2, ..., 4 dado pelo controle PID. Assim, a equao de malha de controle fechada
para estabilizar em vo pairando no ngulo roll dada substituindo a equao (37) na
Equao (44),
QeV =
<e T | | } O + e} T O| | + | + |Z | + |Z | } T O= QeV
T
= .
(47)
e - | n55 + e n55 | + 2| w} + e S w} n55 2| + | w} + e 4 | wT} n55
fechada utilizando um controlador PID para cada um, onde Kesc representa o modelo dos
ESCs utilizados para gerar sinal para os motores.
Figura 30: Esquema dos controladores para estabilizao dos ngulos roll, pitch e yaw.
Nesta Seo so apresentadas todas as partes que contm o simulador com todos
os parmetros necessrios para simular o funcionamento deste, e assim validar o controle
proposto.
ytqZq + w
yu = .
2
(48)
45
Figura 35: Lgica para limitar o valor de velocidade dos motores usando o timer.
Incio
contador =0
timer estourando
com 4 us
contador ++
limite motork S
I/O motork = 0
=contador?
N
N contador S
contador=0
=250?
timer estourando
com 1 ms
contador ++
S contador
I/O motores = 1
=18?
N
S contador N
=19?
Logo, tem-se
fQxV fQx 1V
QxV = | fQxV + |Z fQzV + | ,
(51)
ZW
47
W
fQx 1V fQx 2V
Qx 1V = | fQx 1V + |Z fQzV + | .
(52)
ZW
| | |
QxV = m| + |Z + o fQxV m| + 2 o fQxV + fQx 2V.
(53)
onde u(k) a sada do controlador PID clssico, e(k) corresponde a diferena entra o ngulo
desejado e o mensurado, k a interao atual e T a taxa de amostragem.
5. Concluso
Ao longo do captulo foi apresentada a proposta de controle para estabilizar em
uma dada posio de referncia o quadrirotor desenvolvido, sendo escolhidos controladores
PID. Foram apresentadas todas as partes responsveis por simular o quadrirotor, detalhando o
funcionamento de cada bloco e os aspectos importantes da implementao da estrutura.
O simulador desenvolvido ainda apresenta a caracterstica de poder ser
posteriormente utilizado com outro controlador, desenvolvido de forma genrica, pode
tambm se adaptar a outras estruturas quadrirotricas, precisando somente mudar os
parmetros fixos da estrutura no simulador.
48
6 RESULTADOS
6.1 Introduo
Este captulo apresenta os resultados obtidos com o quadrirotor desenvolvido
desde o incio de sua construo at o controle do vo.
Para apresentar os resultados obtidos eles foram divididos em sees que tratam
de cada parte do trabalho apresentado anteriormente, desde os resultados com a construo da
plataforma at o controle usado para sua estabilizao.
Resultados do controlador clssico simulado so descritos com e sem rudos,
adicionando distrbios no sistema e mudando os ngulos desejados ao longo da simulao do
vo. Bem como a simulao para o controlador PID com sada diferenciada e os resultados
iniciais do controlador na plataforma real.
Figura 36: Ilustrao da estrutura de teste conectada ao quadrirotor para testar seus movimentos.
moviment
Figura 37: Resposta do sistema usando controlador PID clssico para estabilizao, com um erro inicial de 0,5
rad no ngulo roll, -0,2 no ngulo pitch e 0,2 no ngulo yaw.
0.6
desejado
0.4
Roll (rad)
medido
0.2
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
0.1
desejado
Pitch (rad)
0 medido
-0.1
-0.2
-0.3
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
0.3
desejado
0.2
Yaw (rad)
medido
0.1
-0.1
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
Para simular as leituras dos sensores na plataforma real foi adicionando sada do
sistema um rudo gaussiano de mdia nula e varincia unitria (vide Figura 38).
Figura 38: Resposta do sistema usando controlador PID clssico para estabilizao, com um erro inicial de 0,5
rad no ngulo roll, -0,2 no ngulo pitch e 0,2 no ngulo yaw, com adio de rudo na sada do sistema.
0.6
desejado
0.4
Roll (rad)
medido
0.2
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
0.2
desejado
Pitch (rad)
0.1 medido
-0.1
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
0.3
desejado
0.2
Yaw (rad)
medido
0.1
-0.1
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
O filtro, Equao (37), foi utilizado para a simulao apresentada na Figura 39,
mostrando uma notria melhora nos resultados em relao a simulao apresentada na Figura
38. Assim, com a adio do rudo e o uso do filtro o simulador se aproxima mais da
plataforma real.
Figura 39: Resposta do sistema usando controlador PID clssico para estabilizao, com um erro inicial de 0,5
rad no ngulo roll, -0,2 no ngulo pitch e 0,2 no ngulo yaw, com adio de rudo na sada do sistema e
utilizando um filtro passa baixa.
0.6
desejado
0.4
Roll (rad)
medido
0.2
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
0.2
desejado
Pitch (rad)
0.1 medido
-0.1
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
0.3
desejado
0.2
Yaw (rad)
medido
0.1
-0.1
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
Figura 40: Resposta do sistema usando controlador PID clssico para estabilizao, com um erro inicial de 0,5
rad no ngulo roll e -0,2 rad no ngulo pitch.
0.6
desejado
0.4
Roll (rad)
medido
0.2
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
0.2
desejado
Pitch (rad)
0.1 medido
-0.1
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
0.15
desejado
0.1
Yaw (rad)
medido
0.05
-0.05
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Tempo (s)
O distrbio foi adicionado aos valores medidos dos ngulos logo aps a
estabilizao, nas figuras a seguir possvel ver o comportamento do sistema com a adio de
um distrbio entre 4 e 5 segundos, Figura 42.
Figura 42: Resposta do sistema usando controlador PID clssico para estabilizao, com o ngulo roll iniciando
em 0,5 rad, o ngulo pitch em -0,2 rad e yaw em 0,2 rad, com um distrbio de 0.5 rad em pitch entre os instantes
4 s e 5 s.
0.6
desejado
0.4
Roll (rad)
medido
0.2
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.1
desejado
Pitch (rad)
0 medido
-0.1
-0.2
-0.3
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.6
desejado
0.4
Yaw (rad)
medido
0.2
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
Figura 43: Resposta do sistema usando controlador PID clssico para estabilizao, com o ngulo roll iniciando
em 0.5 rad, o ngulo pitch em -0.2 rad e yaw em 0.2 rad, com um distrbio de 0.5 rad em pitch entre os instantes
4 s e 5 s, com adio de rudo na sada do sistema e utilizando um filtro passa baixa.
0.6
desejado
0.4
Roll (rad)
medido
0.2
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.2
desejado
Pitch (rad)
0.1 medido
-0.1
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.3
desejado
0.2
Yaw (rad)
medido
0.1
-0.1
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
Figura 44: Resposta do sistema usando controlador PID clssico para estabilizao, com o ngulo roll iniciando
em 0,5 rad, o ngulo pitch em -0,2 rad e yaw em 0,2 rad, com mudana de referncia para 0.2 rad no ngulo roll
depois de 5s.
0.6
desejado
0.4 medido
Roll (rad)
0.2
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.1
desejado
0
Pitch (rad)
medido
-0.1
-0.2
-0.3
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.3
desejado
0.2
Yaw (rad)
medido
0.1
-0.1
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
Figura 45: Resposta do sistema usando controlador PID clssico para estabilizao, com o ngulo roll iniciando
em 0,5 rad, o ngulo pitch em -0,2 rad e yaw em 0,2 rad, com mudana de referncia de 0 rad para 0,2 rad no
ngulo roll e -0,5 em pitch depois de 5s.
0.6
desejado
0.4 medido
Roll (rad)
0.2
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.2
desejado
0
Pitch (rad)
medido
-0.2
-0.4
-0.6
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.3
desejado
0.2
Yaw (rad)
medido
0.1
-0.1
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
Nos casos analisados por simulao os ngulos roll e pitch estabilizam em entre
os segundos 2 e 3, que para uma altitude baixa, a baixas velocidades dos rotores, o
controlador proposto para estabilizar a plataforma consistindo de vo pairando se mostra
adequado. Analisando o ngulo yaw pode se notar que a estabilizao demora mais que os
outros ngulos, no entanto, a variao em yaw produz um movimento de rotao em z,
fazendo a plataforma girar no prprio eixo, tornando a estabilizao prxima a 3 segundos
satisfatria, pois girar no eixo z a baixas velocidades no produz grandes movimentaes.
Figura 46: Resposta do sistema usando controlador PID com sada diferenciada para estabilizao, com um erro
inicial de 0,5 rad nos ngulos roll, -0,2 no ngulo pitch e 0,2 no ngulo yaw, com adio de rudo na sada do
sistema e utilizando um filtro passa baixa.
0.6
desejado
0.4
Roll (rad)
medido
0.2
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.2
desejado
Pitch (rad)
0.1 medido
-0.1
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.3
desejado
0.2
Yaw (rad)
medido
0.1
-0.1
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
Figura 47: Resposta do sistema usando controlador PID com sada diferenciada para estabilizao, com um erro
inicial de 0,9 rad nos ngulos roll, -0,5 no ngulo pitch e 0,2 no ngulo yaw, com adio de rudo na sada do
sistema e utilizando um filtro passa baixa.
1.5
desejado
1
Roll (rad)
medido
0.5
-0.5
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.2
Pitch (rad)
-0.2
-0.4 desejado
medido
-0.6
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.6
desejado
0.4
Yaw (rad)
medido
0.2
-0.2
0 1 2 3 4 5 6 7 8 9 10
Tempo (s)
0.02
desejado
0.01
Roll (rad)
medido
-0.01
-0.02
50 100 150 200 250 300
amostras
0.02
Pitch (rad) desejado
0.01 medido
-0.01
0 50 100 150 200 250 300
amostras
0.2
desejado
0.1
Yaw (rad)
medido
-0.1
-0.2
0 50 100 150 200 250 300
amostras
6.6 Concluso
Foram apresentados neste captulo todos os resultados de construo e controle do
quadrirotor desenvolvido.
Com os resultados apresentados pode-se observar que a escolha dos componentes
para a construo do quadrirotor atendeu aos requisitos para vo e comunicao sem fio. O
simulador desenvolvido para o comportamento da dinmica do quadrirotor forneceu
importantes informaes, analisando a resposta do sistema, para o ajuste dos parmetros do
controlador PID.
A partir de diversos testes feitos com o simulador, observou-se que para pequenas
variaes no erro o controlador atua de forma eficaz, porm, para variaes grandes do erro
ou perturbaes fortes, como a inclinao de 90 graus da estrutura, o uso do controlador PID
utilizando os parmetros apresentados no apresentou bons resultados, levando
instabilidade.
60
REFERNCIAS
g x = g .sen ( ) (51)
Figura 50: Ilustra a linearidade entre a tenso de sada do sensor e a acelerao medida em g.
1, 6
V = . g x + 1, 65 (52)
2g
Onde V representa o valor de tenso dado em volts pelo sensor e gx o valor de g
em relao ao eixo x. Substituindo a Equao (51) em (52) temos o valor da inclinao no
eixo x dado por:
Para que fossem iniciados os testes da plataforma com segurana, foi construda
uma estrutura em alumnio para os testes iniciais (vide desenho CAD no ANEXO F).
O quadrirotor fixado na estrutura de teste por duas varas de fibra de carbono de
1 m e as pontas presas a estrutura de teste por cordes. A escolha de fibra de carbono foi pela
sua caracterstica de fora e tensionamento, combinao ideal para evitar, em uma situao
no favorvel, o contato das hlices com os cordes.