Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
AGRADECIMENTOS
A Deus, ao Universo, ao Todo. esta Fora Motriz presente em todos ns, e que cada um
busca entend-la sua maneira, tratando-a como uma divindade ou no.
Aos meus pais, por terem me educado, me guiado e me dado todo o suporte para chegar at
aqui. Minha eterna gratido.
Aos meus orientadores, Prof. Dr. Luiz de Siqueira Martins Filho e Prof. Dr. Andr Lus da
Silva, pela oportunidade e pelo aprendizado durante esta etapa da minha vida. Sou grato pelos
conselhos e pelos socorros. Agradeo ao Prof. Dr. Andr Lus por aceitar ser meu coorientador no
segundo ano do curso e pelas consideraes durante o trabalho, que me ajudaram a chegar aqui.
minha psicloga, Viviane Corra de Mello Aleixo Ganana, por estar me ajudando nesta
etapa. Agradeo por saber me ajudar nos momentos mais difcies.
Agradeo a Akira Toriyama, Masami Kurumada, Yoshihiro Togashi, Hayao Miyazaki, J R.
R. Tolkien, Neil Gaiman e a tantos outros mangaks e escritores pelas suas obras. Por trazerem ao
mundo estrias inspiradoras, que do nimo ao dia-a-dia.
Ao Stefano Manzano, Guilherme Vaz e toda galera do RPG pelas picas sesses que temos
feito desde fevereiro de 2014 at aqui.
Ao Hugo Tamotsu Takahashi, Daniel Anese, Diogo Yoshimori Takahashi e toda galera do
Magic pelas partidas memorveis. Pelas boas lembranas do tempo do comeo da graduao em
que eu, o Hugo, o Yoshi, o Yuri Kirejian Veira e muitos outros iamos at o Oficina dos Espetos
almoar, depois voltavamos para a UFABC e iamos jogar buraco at a hora da aula (isso quando
tinhamos tempo). Pelos Counter-Striker Day que realizavamos nos finais de quadrimestre.
Agradeo por todas as boas lembranas que vou levar dos dias na UFABC.
Por fim, agradeo minha namorada, Bianca Bueno Silva, por estar presente em minha
vida. Por ser a mesma massinha da qual Shenlong nos criou. Por cada Voc tambm?!. Por cada
sorriso, risada e coincidncia ao seu lado. Pela sensao de te conhecer h muito, muito tempo. Por
ser a pessoa especial em minha vida e que eu espero que esteja nela por muito, muito tempo.
Qualquer rvore que queira tocar os cus precisa ter razes to profundas a ponto de tocar os
infernos.
Carl Gustav Jung, psiquiatra e psiclogo suo (1875 1961)
RESUMO
Esse estudo trata do problema da explorao de reas com o propsito de vigilncia e de
busca, utilizando um veculo areo no tripulado baseado na tecnologia dos quadricpteros. Os
quadricpteros so aeronaves que podem realizar decolagens e pousos verticais, e pairagens. A
agilidade de movimentao prov muita flexibilidade operacional a esses veculos, tornando-os uma
tima opo para aplicaes em misses de busca e vigilncia. Nessas misses, as caractersticas de
voo mais desejveis so a imprevisibilidade da trajetria de movimento (do ponto de vista de
eventuais intrusos) e a varredura rpida da rea de interesse. Em muitos casos, no h
disponibilidade de um mapa do terreno, o que torna o planejamento de trajetria para a varredura
completa uma tarefa difcil. Nesse caso, um movimento previamente no planejado, no sentido
estrito do termo, pode ser uma soluo atraente para o problema. A busca aleatria por trajetrias, e
aquelas baseadas em caos (um comportamento de alguns sistemas dinmicos no lineares), tm sido
estudadas em aplicaes desta natureza. Em nosso estudo, priorizamos a anlise de gerao de
trajetrias com base em movimentos aleatrios muito particulares, denominados na literatura de
voos de Lvy. O voo de Lvy um movimento aleatrio (random walk) baseado na funo
densidade de probabilidade de Lvy, proposta pelo matemtico francs Paul Pierre Lvy, cujo
padro de trajetrias caracterizado por seguidos passos de comprimentos curtos intercalados por
um passo de comprimento longo. Alm das trajetrias a serem realizadas pelo quadricptero, esse
trabalho compreende o estudo da modelagem da dinmica de voo e de uma proposta de controle do
veculo para alcanar os objetivos das misses.
Os controles desenvolvidos, backstepping e sliding mode, so implantados em modelo de
simulao, onde so testados juntamente com o gerador de trajetrias de referncia baseado no voo
de Lvy. Um procedimento para clculo dos ganhos dos controles proposto, baseado nos
requisitos do voo de Lvy e restries dinmicas de um quadrirrotor. Resultados de simulao
mostram que os controles proposto so capazes de relaizar o voo de Lvy dentro das restries
dinmicas e operacioanis do veculo.
ABSTRACT
This study addresses the problem of exploration of areas for the purpose of surveillance and
searching using an unmanned aerial vehicle (quadrotor). Quadrotors are aircraft that can perform
vertical take-off and landing, and hovering. Their moving agility provides them operational
flexibility, making them a great choice for applications in searching and surveillance missions. In
such operations, the most desirable flight characteristics are unpredictable movement path (from the
point of view of possible intruders) and fast scan of the area of interest. In many cases, there is no
availability of a map of the terrain, which makes the path planning for complete scanning a difficult
task. In this case, an unplanned movement, in the strict sense, can be an attractive solution to the
problem. Random trajectories, and those based on chaos, a behavior of some nonlinear dynamical
systems, have been studied in applications of this nature. In our study, we prioritize the generation
of trajectories based on very specific random movements, known in the literature as Lvy flights.
The Lvy flight is a random motion (random walk) based on the probability density function of
Lvy, proposed by the French mathematician Paul Pierre Lvy, whose default paths are
characterized by repeated steps of short lengths interspersed with a step of long length. In addition
to the trajectories to be performed by quadropter, this work concerns the study of the flight
dynamics modeling and a proposal of vehicle control to achieve the mission objectives.
The developed controls, backstepping and sliding mode, are implemented in simulation
model, where they are tested together with Lvy flight reference path generator. A procedure to
determine the control gain in order to satisfy the Lvy flight requeriments ans quadrotor constraints
is proposed. Simulation results show that these controls are suitable for the execution of the Lvy
flight respecting the operational and dynamic constraints of the vehicle.
SUMRIO
Captulo 1 - Introduo.......................................................................................................................01
1.1.Objetivos.......................................................................................................................................03
1.2.Organizao do Trabalho..............................................................................................................03
Captulo 2 - Misso de Busca e Vigilncia Inspirada no Voo de Lvy...............................................05
2.1.VANTs: Aplicaes e Histrico....................................................................................................05
2.2. O Voo de Levy.............................................................................................................................09
2.3.Planejamento de Misses.............................................................................................................12
2.4. Localizao, Planejamento e Navegao.....................................................................................15
2.5. Modelo de Misso.......................................................................................................................16
2.6. Planejamento de Trajetrias........................................................................................................22
Captulo 3 - Modelagem da Dinmica de Voo do Quadrirrotor ........................................................25
3.1.Sistemas de Coordenadas.............................................................................................................26
3.2.Formulao de Newton-Euler.......................................................................................................27
3.2.1.Cinemtica e Dinmica de Translao......................................................................................27
3.2.2.Cinemtica e Dinmica de Rotao...........................................................................................29
3.3.Modelagem do Sistema-Formulao de Euler-Lagrange.............................................................31
3.3.1.Dinmica de Translao............................................................................................................33
3.3.2.Dinmica de Rotao.................................................................................................................33
3.4.Modelos Aerodinmicos de Foras e Momentos..........................................................................34
3.4.1.Foras no quadrirrotor...............................................................................................................34
3.4.2.Momentos no quadrirrotor.........................................................................................................37
3.5.Parmetros do Modelo..................................................................................................................39
Captulo - 4 - Controle de Voo do Veculo Quadrirrotor....................................................................41
4.1. Controle no-linear Backstepping...............................................................................................41
4.1.1Avaliao Conceitual do Controle Backstepping.......................................................................48
4.1.2.Controle de Altitude..................................................................................................................50
4.1.3.Controle de Guinada.................................................................................................................54
4.1.4.Controle de Arfagem e Rolamento............................................................................................58
4.1.5.Controles fictcios ux e uy...........................................................................................................62
4.2. Controle no-linear Sliding Mode...............................................................................................69
4.2.1.Controle de Altitude..................................................................................................................72
4.2.2.Controle de Guinada.................................................................................................................75
4.2.3.Controle de Arfagem e Rolamento............................................................................................76
4.2.4.Controles fictcios ux e uy...........................................................................................................78
4.3.Consideraes finais.....................................................................................................................83
Captulo 5 Validao e Teste............................................................................................................87
5.1. Controle no-linear Backstepping...............................................................................................87
5.1.1. Deslocamento Vertical..............................................................................................................87
5.1.2. Movimento de Guinada..........................................................................................................90
5.1.3. Movimento Horizontal.............................................................................................................93
5.1.4. Voo de Lvy..............................................................................................................................98
5.2. Controle no-linear Sliding Mode.............................................................................................108
5.2.1. Deslocamento Vertical............................................................................................................109
5.2.2. Movimento de Guinada..........................................................................................................112
5.2.3. Movimento Horizontal...........................................................................................................115
5.2.4. Voo de Lvy............................................................................................................................119
6.Concluso......................................................................................................................................131
Trabalhos Futuros.............................................................................................................................133
Referncias Bibliogrficas................................................................................................................135
Apncide A: Controle Backstepping - Clculo dos Ganhos.............................................................144
A.1.Controle de Altitude...................................................................................................................145
A.2.Controle de Guinada..................................................................................................................149
A.3.Controle de Arfagem e Rolamento............................................................................................152
A.4.Controles fictcios ux e uy...........................................................................................................154
Apncide B: A Plataforma Gyro-200ED-X4....................................................................................156
B.1.Principais Caractersticas...........................................................................................................157
B.2.Unidade Inercial e de Orientao...............................................................................................159
B.3.Receptor de GPS........................................................................................................................160
B.4.Sensor Baromtrico....................................................................................................................160
B.5.Arquitetura de Hardware...........................................................................................................161
B.6.Motorizao...............................................................................................................................162
Apncide C: Diagramas de Blocos...................................................................................................166
LISTA DE ILUSTRAEs
Figura 2.1 Ryan 147 Lightning Bug...............................................................................................06
Figura 2.2: VANT da TAG..................................................................................................................08
Figura 2.3: VANT tipo helicptero da Yamaha..................................................................................08
Figura 2.4. Exemplos de caminhadas aleatrias.................................................................................11
Figura 2.5: Misso de um VANT........................................................................................................14
Figura 2.6: Esquema de controle de referncia genrico para robs mveis.....................................15
Figura 2.7: Mudana de direo do movimento do VANT.................................................................18
Figura 2.8: Etapas da misso..............................................................................................................19
Figura 2.9: Clculo do tamanho da subrea de vigilncia..................................................................20
Figura 2.10:Distncia total percorrida em funo do comprimento da rea de vigilncia para = 40...........21
LISTA DE TABELAS
Tabela 2.1 - Distncia total percorrida mdia.....................................................................................21
Tabela B.1 Caractersticas do Gyro 200ED...................................................................................158
Tabela B.2 - tens da Arquitetura de Hardware................................................................................159
LISTA DE ABREVIATURAS
AHRS: Attitude and Heading Reference System
CEP : Circular Error Probability
CRW: Correlated Random Walk
MEMS: Micro Electro Mechanical Systems
NED: North-East-Down
SEP: Spherical Error Probability
VANT: Veculo Areo No-Tripulado
LISTA DE SMBOLOS
l: comprimento de trajetria escolhido aleatriamente segundo o voo de Lvy;
: expoente da funo densidade de probabilidade de Lvy;
R = [xn ye zd]T: vetor posio do c.m. do VANT no sistema NED;
V = [vn ve vd]T: vetor velocidade do c.m. do VANT no sistema NED;
Fb: somatrio de foras no gravitacionais que atuam sobre o corpo, escrito no sistema do
corpo;
m: massa do corpo;
g: acelerao da gravidade;
C0B: matriz de transformao de coordenadas do sistemado corpo para o sistema NED;
, e : ngulos de Euler: rolamento, arfagem e guinada, ou roll, pitch e yaw,
respectivamente;
= [p q r]T: velocidade angular do corpo, escrita em seu referencial, tomada com respeito
ao referencial inercial;
I: matriz inrcia do corpo escrita em seu sistema de referncia;
M: soma de todos os momentos que agem sobre o corpo, escrito em seu sistema de
referncia;
L, M e N : momentos de rolamento, arfagem e guinada, respectivamente;
q: vetor das coordenadas generalizadas, segundo o formalismo de Euler-Lagrange;
: lagrangiano do sistema do quadrirrotor;
E: energia cintica do sistema do quadrirrotor;
V: energia potencial do sistema do quadrirrotor;
Fx: fora atuante no quadrirrotor na direo x do sistema inercial;
Fy: fora atuante no quadrirrotor na direo y do sistema inercial;
Fz: fora atuante no quadrirrotor na direo z do sistema inercial;
: momento atuantes relacionados aos ngulos de Euler ;
Captulo 1
Introduo
Este trabalho trata do estudo da aplicao do voo de Lvy, um movimento do tipo random
walk, em um Veculo Areo No Tripulado (VANT) para misses de busca e vigilncia. O voo de
Lvy tem sido observado em algumas espcies de animais como uma soluo tima para o
problema da busca por alimento, abrigo ou outro tipo de alvo (VISWANATHAN et al., 1996;
VISWANATHAN et al., 2000; VISWANATHAN et al., 2001; DA LUZ et al., 2001;
VISWANATHAN et al., 2002; RAPOSO et al., 2003; VISWANATHAN; RAPOSO; DA LUZ,
2008; VISWANATHAN, 2010; BOYER et al., 2006; BUNIMOVICH, 2004). Em misses de busca
e vigilncia, a rpida varredura de uma rea e a imprevisibilidade da trajetria so caractersticas
desejveis para um buscador/vigilante tornando-se uma opo interessante o estudo de sua
implementao em um VANT. Neste trabalho, o VANT de interesse trata-se de um quadrirrotor, um
veculo relativamente simples, barato.
A utilizao de VANT em misses muito diversas tem se mostrado cada vez mais eficiente,
dada a sua capacidade de realizar tarefas onde a presena de um piloto pode oferecer risco de vida,
tais como: misses militares; atuao em reas de difcil acesso ou em condies ambientais no
favorveis, etc. Devido ao seu tamanho relativamente menor em relao a outras aeronaves e
ausncia de um piloto, os VANTs tambm possuem um custo menor em relao a uma aeronave
convencional que desempenha a mesma tarefa. Possuem maior manobrabilidade e menor
probabilidade de serem detectados. Sua emisso de infravermelho extremamente baixa e nveis de
rudos bem inferiores aos dos sistemas tripulados (PEREIRA, 2001; COSTA, 2008; GARRIDO,
2009).
dito anteriormente, o voo de Lvy tem sido apontado como uma soluo tima para o problema da
busca por alvos escassos distribudos aleatoriamente, ou quando no se sabe a localizao exata dos
mesmos. Este tipo de problema tem sido estudado desde meados da dcada de 1960, onde sua
caracterstica tima tem sido observada, levando em conta uma hiptese de evoluo desenvolvida
no contexto do comportamento de alguns animais.
1.1. Objetivos
O trabalho est organizado da seguinte forma: o Captulo 2 trata do voo de Lvy, apresenta
um pouco a respeito da histria e utilizao dos VANT e os elementos bsicos de misses de
veculos areos. Com base nesses elementos, tambm descrito o modelo da misso e o planejador
de trajetrias. O Captulo 3 trata da modelagem do voo do quadrirrotor. No Captulo 4, so
elaboradas as leis de controle que levaro o VANT execuo satisfatria da misso baseada no voo
de Lvy. Neste captulo so desnvolvidos os controles no-lineares backstepping e sliding mode,
dada a carectsitca no-linear do modelo de projeto desenvolvido a partir do Captulo 3. No
Captulo 4 o clculo dos ganhos de cada controle feito a partir dos requisitos da misso e das
restries dinmicas do quadrirrotor. O Captulo 5 trata das simulaes de ambas as tcnicas de
controle desenvolvidas, testadas juntamente com o gerador de trajetrias de referncia baseado no
voo de Lvy. Neste captulo tais tcnicas so comparadas, com o intuito de verificar qual delas
provm ao quadrirrotor o melhor desempenho. O Captulo 6 encerra o trabalho com a concluso.
Captulo 2
Este captulo trata dos itens e etapas existentes na misso de um VANT, tais como: seu
contexto operacional, as fases da misso e modos operacionais. A seo 2.1 relata um pouco da
histria e utilizao dos VANT; A seo 2.2 trata do voo de Lvy; A seo 2.3 trata do planejamento
e etapas da misso, levando em conta fatores como: o objetivo, tipo de regio, parmetros
operacionais e sob quais circunstncias; A seo 2.4 trata da pilotagem, da guinada e da navegao
do VANT; Por fim, a seo 2.5 descreve o modelo da misso, e a seo 2.6 descreve o planejador de
trajetrias.
tornou-se uma central de pesquisa e desenvolvimento de VANT (EXRCITO DOS E.U.A., 2010).
J na dcada de 1960, o rob areo lanador de torpedo QH-50 Gyrodyne, e as aeronaves no
tripuladas de asa fixa Lightning Bug, foram utilizados na Guerra do Vietn. As aeronaves Lightning
Bug tiveram o papel de: tomadas de fotografias; transmisso de imagens em tempo quase real; e
confirmao do atingimento de um determinado alvo (PEREIRA, 2001). A Figura 2.1 mostra esta
aeronave:
A partir 1994, outro tipo de aeronave comeou a ser desenvolvida: o VANT Predator. Sua
aplicao principal realizar misses de reconhecimento e vigilncia, realizando a aquisio de
imagens de alvos. Seu alcance de 400 milhas, sendo capaz de fornecer dados e imagens em tempo
prximo do real. J em 1994, os sistemas Dark Star e o Global Hawk foram desenvolvidos com a
finalidade de executar misses em altas altitudes e de longa durao. O primeiro apresenta baixa
observabilidade, sendo utilizado para misses de reconhecimento em territrio inimigo. J o
segundo tem como funo fornecer dados e imagens em quaisquer condies (de posio e/ou
climticas). A partir de 2001, o investimento e a popularidade dos VANT aumentaram notoriamente,
devido ao atentado s Torres Gmeas (CHAVES, 2013).
No somente no mbito militar, mas tambm no mbito agrcola, pode-se citar exemplo da
aplicao dos VANT. A ideia de voos agrcolas surgiu na Alemanha, em 1911, onde o agente
florestal alemo Alfred Zimmermann realizou o registro de patente do mtodo. A primeira aplicao
de veculos areos para o uso de inseticidas em lavouras ocorreu nos EUA, em 1921, contra uma
praga de mariposas que atacava uma rea de reflorestamento. Os entomologistas C.R. Nellie e H.A.
Gossard utilizaram um avio biplano Curtiss JN-6H para aplicar arsenato de chumbo contra a
populao de mariposas. Etienne Darmoy, construiu um equipamento capaz de espalhar o
inseticida: uma caixa com uma porta de sada deslizante e uma alavanca girada a mo, que
promoveria a sada do p de inseticida (RASI, 2008). Em 1950 foi projetado o primeiro avio
especificamente para uso agrcola: o AG-1, construdo pela Texas A.&M. Aircraft Research Centre.
Esse projeto foi iniciado pela the National Flying Farmers Associations. No Brasil, o primeiro voo
agrcola foi realizado no dia 19 de agosto de 1947, em Pelotas, devido a um ataque de gafanhotos,
com a aeronave Muniz M-9. (que at ento era utilizado como avio de testes da FAB) com
capacidade de carga de aproximadamente 100 kg, utilizando como inseticida o BHC (hexabenzeno
de cloro) (RASI, 2008). Com o desenvolver da tecnologia, a ideia de utilizar VANT para o controle
de pragas em lavouras tem ganhado forma. Um exemplo disso so os VANT da empresa americana
TAG, que projeta e constri VANTs, oferecendo quatro tipos de aeronaves. Um dos tais pode ser
usado como plataforma de aplicao area de inseticidas, com a instalao de tanques e barras de
spray, possuindo carga paga de 20 kg e sistema de GPS (ZDEMIR, 2005). Outro exemplo, so os
VANTs produzidos pela Yamaha. A produo de VANTs pela empresa foi iniciada aps a ocorrncia
de xodo rural no Japo nos ltimos anos, resultando na falta de mo de obra nas lavouras de arroz,
soja e trigo (ZDEMIR, 2005). Um recente trabalho na rea de VANTs agrcolas, (COSTA, 2012)
descreve uma arquitetura para o emprego de inseticidas por um VANT, utilizando comunicao sem
fio para o monitoramento. As Figuras 2.2 e 2.3 mostram o VANT da TAG e da Yamaha:
Tambm pode ser citado (COLOMINA; MOLINA, 2014). Neste trabalho, discutida a
evoluo do estado da arte do uso de VANT no campo da Fotogrametria e Sensoriamento Remoto,
campo que tem notado o potencial do uso dos VANT.
Os modelos citados anteriormente tendem a ter uma funo distribuio do tipo gaussiana.
Isso que dizer que, para uma certa funo densidade de probabilidade f(l) dos passos individuais do
buscador, a probabilidade de ach-lo depois de N passos (em que N suficientemente grande) segue
uma funo distribuio de probabilidade do tipo gaussiana.
A ideia da funo de Lvy vem do problema de encontrar uma funo densidade dos passos
individuais com a mesma forma de sua funo distribuio a menos de um fator de escala. Cauchy
foi o primeiro a perceber que existiam outras solues para o problema da adio de N variveis
aleatrias. Entretanto, o matemtico francs Paul Lvy generalizou o resultado, obtendo as funes
-estveis de Lvy (LIMA, 2010). A funo densidade de Lvy tem a seguinte forma:
p (l)=Al
1
, ll 0 .
l
(2.1)
em que:
1<3
(2.2)
de modo que para > 3 o movimento do tipo browniano, e Al uma constante que torna a integral
de p(l), entre l0 e um certo valor mximo de l, igual a 1.
O que torna um movimento baseado na funo de Lvy interessante que este prov ao
caminhante um movimento superdifusivo:
(t )t H
(2.3)
Na Eq. (2.3), representa o desvio padro dos valores das distncias entre o ponto onde o
caminhante se encontra e o ponto inicial da caminhada, em funo do tempo. Um movimento
10
browniano possui H = , e dito como tendo uma difuso normal. Movimentos com H < so
denominados subdifusivos. Neste caso, o caminhante evita continuar em uma certa direo,
mudando de direo mais frequentemente do que na caminhada browniana. Processos onde H >
so chamados de superdifusivos, que o caso do voo de Lvy. Neste caso, o caminhante tende a
continuar na direo do ltimo passo mais frequentemente. Quanto maior for o valor de H, maior a
tendncia em permanecer na mesma direo. (LIMA, 2010). A Figura 2.4 mostra tais casos:
Figura 2.4. Exemplos de caminhadas aleatrias: Voo de Lvy e Movimento Browniano. Em ambos
os casos, o caminhante percorre 100 passos.
H uma diferena entre caminhadas de Lvy e voos de Lvy. No caso dos voos de Lvy a
durao de cada passo assumida como sendo constante, de forma que a velocidade proporcional
ao comprimento do passo, e o tempo total de percurso proporcional ao nmero de passos. Nesse
caso, o deslocamento mdio quadrtico no existe como funo do tempo. Essa propriedade impede
aplicaes diretas de voos de Lvy em fenmenos fsicos. De outro modo, nas caminhadas de Lvy
o buscador viaja com velocidade constante, independente do tamanho do passo. Ento, o tempo de
percurso proporcional distncia total percorrida, fazendo com que o deslocamento mdio
quadrtico exista como funo do tempo.
11
Decolagem e Ascenso: so as manobras iniciais de voo para que a aeronave atinja a altitude
de cruzeiro;
12
Retorno: retorno da aeronave at o ponto no qual a mesma foi lanada, ou outro ponto
designado para seu recolhimento;
sequncia de manobras que a aeronave ir realizar durante as fases da execuo da misso. O plano
de voo para cada trecho pode ser especificado de dois modos:
13
As etapas de um voo podem ser especificadas de modo a definir uma sequncia entre elas,
determinando a ordem das etapas e quando ocorre uma transio entre uma etapa e outra. As
condies que determinam a transio de uma etapa para a prxima so especificadas por
parmetros a serem determinados. Normalmente, uma janela de tempo associada a cada transio
de etapa, indicando em que intervalo do tempo total da misso a aeronave deve passar pelo ponto
considerado. Quanto operao da aeronave, esta pode ser operada de dois modos diferentes:
Trata-se de um modo automtico de gerao de trajetria. Isso realizado pela leitura dos sensores.
Seus dados so processados por um algoritmo automtico de clculo de trajetria.
14
Figura 2.6: Esquema de controle de referncia genrico para robs mveis. Adaptado de
(SIEGWART; NOURBAKHSH, 2004).
A percepo compreende tarefa de aquisio dos sinais pelos sensores de forma a extrair
dados significativos do ambiente e de seu prprio funcionamento; A localizao compreende
capacidade do rob de determinar sua posio no ambiente; Por sua vez, a cognio abrange a
tarefa do rob de decidir qual ser seu prximo passo; Por fim, o controle do movimento abrange a
execuo do movimento planejado, de forma a cumprir o objetivo naquele instante.
15
Como dito, neste trabalho o objetivo estudar a aplicao do voo de Lvy em um veculo
areo no tripulado (VANT) do tipo quadrirrotor para misses de busca e vigilncia. A inteno vem
do fato do voo de Levy ser um movimento aleatrio e que conta com uma hiptese evolutiva. Um
movimento deste tipo uma opo de mtodo de busca e proveria ao rob imprevisibilidade em seu
movimento, dificultando a previso de seu prximo passo por parte de um intruso e/ou alvo que
deseja se ocultar. O fato do rob executar um movimento aleatrio garante a varredura completa da
rea de vigilncia (considerando que a autonomia seja suficiente para isto) sem a necessidade do
uso de um mapa a priori. Esta a doutrina da misso.
Alguns exemplos de aplicaes do voo de Lvy so dados em (NURZAMAN et al., 2009;
NURZAMAN et al., 2010; SUTANTYO et al., 2013). Em (SUTANTYO et al., 2013) o voo de Lvy
aplicado ao problema de uma busca realizadas por mltiplos robs. J em (NURZAMAN et al.,
16
Voo operando no modo pr-programado. O VANT deve ser autnomo, onde a escolha do
prximo ponto o qual deve atingir realizada segundo o voo de Lvy. A cognio do rob
biologicamente inspirada, e o plano de voo ser definido pela passagem por waypoints, os
quais sero calculados segundo o comprimento de trajetria determinado aleatoriamente;
O voo de deslocamento restrito a um plano, sendo sua altitude de voo 60m (MANUAL DE
BUSCA E SALVAMENTO-SAR, 2012);
Caso a varredura completa da rea no tenha sido atingida, o processo volta etapa 2, at
que a varredura completa seja realizada. Caso contrrio, o veculo volta ao ponto de
lanamento e pousa;
Caso o prximo waypoint seja especificado fora da rea de vigilncia, o VANT se desloca
at o limite da rea, na direo previamente determinada, percorrendo a distncia restante
com um ngulo rebatido. A Figura 2.7 exemplifica tal movimento:
18
19
=20
x=60 2 tan( 20 ) 30m
(2.4)
O valor da rea total foi considerado com base na autonomia do quadrirrotor. No manual do
VANT adotado, uma velocidade mxima recomendada de 20km/h, e a autonomia (sem payload)
de 20 min. Considerando a massa de uma cmera desprezvel, o comprimento mximo percorrido
de:
20 km/h
20 min
6,667 km
60 min/h
(2.5)
Para o Voo de Levy executado pelo VANT, foi escolhido o valor de expoente = 1,125
(valor prximo de 1, permitindo um movimento superdifusivo). Tal valor foi escolhido por ser um
valor seguro para a completa varredura da rea pelo VANT.
A partir disto, foram realizadas 200 simulaes para o cobrimento da rea de vigilncia para
diferentes valores de comprimento da rea. Tais simulaes consistiram em implementar o voo de
Lvy considerando o movimento de mudana de direo do VANT, com o intuito de verificar o
20
comprimento total percorrido mdio (comprimento de cobrimento) para cada valor de comprimento
da rea. Os valores escolhidos foram 120, 240, 360 e 480 m. Em cada caso, 200 simulaes foram
feitas. A Tabela 2.1 e a Figura 2.10 mostram a distncia total percorrida mdia em cada caso:
120 m
240 m
360 m
480 m
2.6788e+003
8.8616e+003
2.1579e+004
4.3776e+004
Distncia total
percorrida mdia (m)
Figura 2.10:Distncia total percorrida em funo do comprimento da rea de vigilncia para = 40.
Assim, considerando a Eq. (2.5), um valor escolhido como razovel para a aplicao do voo
de Lvy neste caso foi de 180 m (que, pela interpolao dos valores do grfico, corresponde
aproximadamente a uma distncia total mdia de 5,77 km):
21
l 180 =
(8861,62678,8)
(180120)+2678,8=5770,2 m
(240120)
l180 5770 m
(2.6)
Vale ressaltar, que = 40 foi escolhido por ser um valor de amplitude considerado mdio
(CHAVES, 2013). O valor da altitude, de 60m, foi escolhida baseando-se no Manual de Busca e
Salvamento da Aeronutica (MANUAL DE BUSCA E SALVAMENTO-SAR, 2012).
22
23
aquele que estiver na posio indicado pelo valor de cont. Como tambm pode ser visto na Figura
2.9, a outra condio que implica no final do lao o caso de cont ser igual ao comprimento do
vetor l, ou seja, o valor de comprimento de trajetria selecionado ser igual ao valor mximo de
comprimento. Por sua vez, o ngulo de trajetria (ngulo de guinada/azimute) escolhido segundo
uma funo densidade uniforme (entre e ), como dito anteriormente.
Pode-se dizer que o sistema de controle do VANT se assemelha a um sistema de controle
deliberativo, em que o modelo SMPA (Sense - Model - Plan Act) utilizado e os dados do
ambiente so lidos atravs dos sensores do VANT. Aqui nenhum modelo a respeito do espao de
trabalho construdo, e considerado um espao de trabalho sem obstculos. Por outro lado, o
sistema de controle do VANT tambm se assemelha a um sistema de controle reativo, uma vez que
o mesmo no possui uma representao do espao de trabalho e seu movimento baseado no
princpio da reatividade (movimento biologicamente inspirado dentro do espao de trabalho e zigzag na tentativa de deix-lo).
24
Captulo 3
As quatro hlices esto contidas no mesmo plano (denominado plano das hlices). A
distncia entre o centro de massa e o plano das hlices desprezvel;
A seo 3.1 descreve os sistemas de coordenadas adotados; As sees 3.2 e 3.3 abordam o
problema segundo o formalismo de Newton-Euler e Euler-Lagrange, respectivamente; A seo 3.4
25
trata da descrio das foras e dos momentos produzidos pelos conjuntos hlice-motor do VANT; A
seo 3.5 descreve os motores utilizados e seu acionamento.
A Figura 3.1 mostra os sistemas de coordenadas adotados neste trabalho. Esses sistemas so
idnticos ou muito similares aos adotados em diversos trabalhos (ROSKAM, 1995; STEVENS;
LEWIS, 2003; HOFFMANN et al., 2007; DA SILVA 2012; COSTA, 2008). As Figuras 3.1 e 3.2
ilustram os sistemas de coordenadas adotados:
26
Figura 3.2: Sistema de coordenadas inercial e do corpo do VANT. Extrado de (ADIGBLI, 2007).
27
Dessa forma, a velocidade do centro de massa do quadrirrotor em relao a este sistema ser:
R=V
=[v n v e v d ]
(3.1)
O somatrio de foras que atuam sobre o corpo, excluindo a fora gravitacional, escritas no
sistema do corpo, dado por:
F b = F i
(3.2)
em que cada termo Fi uma fora no gravitacional atuante no quadrirrotor, descritas no sistema do
corpo. Seja tambm C0B a matriz de transformao de coordenadas, que leva do sistema do corpo
para o sistema inercial, que dada por (SHUSTER, 1993):
c c s s c c s c s c +s s
C 0 B= c s s s s +c c c s s s c
s
s c
c c
(3.3)
em que c e s representam cosseno e seno de cada ngulo, respectivamente. Por sua vez, os ngulos
de Euler, , e representam a orientao em relao ao sistema inercial por meio de sucessivas
rotaes fictcias em torno dos eixos xB, yB e zB. Tal sequncia de rotaes leva a orientao do
sistema do corpo orientao do sistema inercial, que pode ser representada por uma equao
matricial, que ser vista logo adiante.
A relao entre as foras atuantes em relao ao sistema inercial e FB pode ser dada por:
m V =mg e 3+C 0 F i
B
(3.4)
28
(3.5)
29
ou:
p 1
0
sin()
q = 0 cos () sin()cos()
(3.6)
Assim, a cinemtica de rotao descrita. A partir de p, q e r, a dinmica de rotao pode ser escrita
como (LANCZOS, 1952; MEIROVITCH, 1970):
I =M
X I
(3.7)
I xx I xy I xz
I = I xy I yy I yz
I xz I yz I zz
(3.8)
M = M i
(3.9)
1
=I
( M X I )
(3.10)
30
0
0
p 1 / I xx
L
p I xx
q = 0
1/ I yy
0 (M q X 0
r
0
0
1/ I zz N r
0
0
I yy
0
0 p
0 q)
I zz r
0
0
p 1 / I xx
L
p I xx p
q = 0
1/ I yy
0 ( M q X I yy q )
r
0
0
1/ I zz N r
I zz r
(3.11)
(3.12)
0
0
p 1 / I xx
L ( I zz I yy ) qr
=
(
q
0
1/ I yy
0
M (I xx I zz ) pr )
r
0
0
1/ I zz N ( I yy I xx ) pq
(3.13)
( I yy I zz )
L
qr+
I xx
I xx
( I zz I xx )
M
q=
pr +
I yy
I yy
(I xxI yy )
N
r =
pq+
I zz
I zz
(3.14)
p =
31
q={ x
(3.15)
z }
(3.16)
= EV
em que E a energia cintica total do corpo e V a energia potencial. A energia cintica total e a
energia potencial do quadrirrotor podem ser escritas:
E=(1/2)[m( x + y + z )+I xx p +I
yy q+I zz r ]
(3.17)
s )2+ I yy ( c + c s )2+ I zz ( c c s )2 ]
E=(1/2)[m( x + y + z )+I xx (
(3.18)
(3.19)
V =mgz
Vale ressaltar que o sinal negativo se deve ao fato do eixo e D estar apontado para baixo. Alm disso,
na Eq. (3.17), o termo referente energia cintica de rotao possui tal forma devido considerao
de que os termos da matriz de inrcia que no pertencem diagonal principal so nulos. Assim, o
Lagrangeano definido:
s ) +I yy ( c + c s ) +I zz (
c c s ) ]+
L=(1/ 2)[ m( x + y + z )+I xx (
(3.20)
+mgz
32
d L
L
(
)
=Q k
dt q k q k
(3.21)
F x =m x
(3.22)
F y =m y
(3.23)
F z =m z mg
(3.24)
F i =m g +C 0 F B
(3.25)
c
s )+( I zz I
=I xx (
+ c s )( s + c
c )
yy)( c
(3.26)
c s )c ]
=I yy [( c s +
s s +' c c ) c (
c + c s ) s ]
+I yy [(
s )+ s + c ]( s )
c c + (
s c + c
+I zz [
s )
c
+I zz [ ( s c c )( c )]I xx (
+I yy ( c + c s ) s s I zz ( s c c )
sc
(3.27)
]
c + s )
s + ( s )c
=I xx [(
s s + c
c )s c ]
+I yy [( c s + c s
c )]
c s )( s s + c
+I yy [( c +
( c c )]
+I zz [ c c ( s c + s c ) s c
+I zz [+( s c
c )( ' s c + c s )]
(3.28)
Considerando a Eq. (3.5) e a Eq. (3.6), e tomando as derivadas primeira e segunda de cada
ngulo de Euler, pode-se mostrar que os momentos aqui escritos so os mesmos colocados segundo
o formalismo de Newton-Euler Eq. (3.14), conforme em (SHUSTER, 1993).
Em voo pairado, a fora de trao produzida por cada um dos motores do quadrirrotor
34
proporcional velocidade angular de rotao de cada um deles. A relao entre a fora produzida e
a velocidade angular descrita por:
(3.29)
F i=k f i
em que Fi o modulo da fora produzida no motor i, k f chamado coeficiente de fora das hlices e
i a velocidade angular do motor i. O valor de k f uma funo da rea projetada da hlice na
direo do movimento, da densidade do ar e ao raio da hlice. Em (BOUABDALLAH, 2007;
LEISHMAN, 2006; FAY, 2001), a relao entre a fora produzida pela hlice do motor e sua
velocidade angular :
F i=C T A R2 2i
(3.30)
Fb=
0
0
F 1+F 2+F 3+F 4
(3.31)
Uma vez que os motores e as hlices so considerados como sendo idnticos, k f ser o mesmo para
35
0
0
F b = 0 =k f
0
2
2
T
1 +2+23+24
(3.32)
Na Eq (3.4), Fb levado do sistema do corpo para o sistema inercial, para o calculo da velocidade
de translao do quadrirrotor. A forma da Eq. (3.31) e da Eq. (3.32) vem do fato de que a direo de
Fb normal ao plano das hlices e o sinal negativo devido considerao do eixo z B apontando
para baixo.
Substituindo a Eq. (3.32) na Eq. (3.4), tem-se:
vn
0
c s c +s s
2
2
2
2
m ve =mg 0 k f (1+2 +3 +4) c s s s c
1
c c
vd
(3.33)
Aqui, possvel ver que o movimento de translao do quadrirrotor dependente dos ngulos de
Euler. No caso de = 0 e = 0, a Eq. (3.16) torna-se:
vn
0
0
m ve =mg 0 k f (21+22 +23 +24) 0
1
1
vd
(3.34)
Alm disso, vale ressaltar que a ao da fora de sustentao atua somente na direo z, e interfere
exclusivamente no controle de altitude do quadrirrotor. Isso se d devido ao fato de que e esto
associados s rotaes nos eixos x e y, respectivamente. Quando e so no-nulos, uma
componente da fora de sustentao projetada no plano definido por eN e eE. Portanto, o
movimento horizontal do quadrirrotor dependente do movimento de rotao, mais
36
Dadas as hipteses inicialmente feitas a respeito das foras de trao nos motores, o
momento descrito na Eq. (3.7) composto por dois tipos de momentos aplicados ao quadrirrotor: os
momentos gerados pelos empuxos que atuam perpendicularmente ao brao do quadrirrotor; e pelos
momentos aerodinmicos de reao em cada hlice, devido ao arrasto que atua nas mesmas. Os
momentos L e M so do primeiro tipo. L igual diferena entre o momento produzido pela fora
de sustentao do motor 4 e o momento produzido pela fora de sustentao do motor 2, onde lc o
comprimento do brao do quadrirrotor (distncia do centro de cada hlice at o centro de massa do
quadrirrotor, medida ao longo do plano das hlices). Analogamente, M igual diferena entre os
momentos produzidos pelos motores 1 e 3, respectivamente:
L=k f l c (4 2 )
(3.35)
M =k f l c (1 3 )
(3.36)
37
(3.37)
M i=k m i
N ser o somatrio dos momentos aerodinmicos produzidos por cada motor. Diferentemente da
Eq. (3.13), aqui o sentido de rotao de cada motor levado em conta, j que o sentido de cada
momento depende destes. Uma vez que os motores 1 e 3 geram momentos positivos, e os motores 2
e 4, negativos, N :
N =k m (1 2 +3 4 )
(3.38)
k f l c (24 22)
L
M = M i = M =
k f l c ( 21 32)
N k (22+22 )
M
1
2
3
4
(3.39)
A partir da Eq. (3.33) e da Eq. (3.39), possvel perceber que as quatro rotaes das hlices,
1, 2, 3 e 4, so as variveis de controle dos movimentos de rotao e translao. As
velocidades das hlices podem ser escritas em funo da fora de sustentao e dos momentos
requisitados para a realizao de uma determinada manobra. Do mesmo modo que em (DA SILVA,
2012), as velocidades das hlices podem ser definidas como:
1= u T +u +u
2= u T u u
3= u T u +u
4= u T +u u
(3.40)
em que:
38
T
4k f
L
u =
2l c k f
M
u =
2 lc k f
N
u =
4k m
uT =
(3.41)
16,83103
0
5,72106
I=
kgm2
0
16,83103
0
5,72106
0
28,34103
(3.42)
39
40
Captulo 4
41
(4.1)
(4.2)
x1
x2
x3
x4
x5
x
X= = 6
z
x7
z
x8
x x9
x x
10
y
x 11
y
x 12
e:
x1
x2
x2
x 4 x 6 a 1+( L/ I xx )
x3
x4
x4 x 2 x 6 a 2 +( M / I yy )
x6
x5
x
x x a +( N / I zz )
X = 6 = 2 4 3
x7
x8
x8 g (1 /m) c x1 c x3 T
x 10
x9
x10
(1/ m)(u x )T
x11
x 12
x12
(1/ m)(u y )T
42
(4.3)
(4.4)
1 0 0 p p
0 1 0 q = q
0 0 1 r r
Assim, dada esta aproximao, as expresses em Eq. (3.14) podem ser reescritas, substituindo os
termos p,q e r pelos seus valores aproximados, como:
I zz I yy )
L=I xx +(
I xx I zz )
M =I yy +(
N =I zz +(
I yy I xx )
(4.5)
(I yy I zz )
I xx
(I I )
a 2= zz xx
I yy
( I I )
a 3= xx yy
I zz
(4.6)
u x =c s c +s s
u y =c s s s c
(4.7)
a 1=
A expresso na Eq. (4.7) vem da multiplicao matricial na Eq. (3.4) (matriz escrita na Eq. (3.3) e o
vetor FB).
Com o vetor de estados definido, possvel ento determinar uma lei de controle que force o
43
sistema estabilidade. Vale ressaltar que o modelo dado pela Eq. (4.2) vlido dadas as
linearizaes feitas s velocidades angulares, onde p,q e r se aproximam das derivadas de , e
respectivamente. Isso faz do modelo dado na Eq. (4.2) um modelo de projeto factvel. Aqui, seguese a abordagem realizada em (BOUABDALLAH, 2007; SANTANA; BORGES, 2009). Para x 2k-1 (k
= 1,2,3,4,5,6), a seguinte mudana de varivel adotada:
ref
z 2k 1=x 2k 1 x 2k1
(4.8)
V ( z 2k1 )=
(z 2k1)
2
(4.9)
(4.10)
ref
V ( z 2k1 )=z 2k 1( x 2k1 x 2k )
(4.11)
ref
x 2k = x 2k 1+2k 1 z 2k1
(4.12)
44
(4.13)
ref
z 2k =x 2k x 2k 1 2k 1 z 2k1
(4.14)
V ( z 2k1 , z 2k)=
( z 2k1)+( z 2k )
2
(4.15)
(4.16)
z 2k = x 2k x ref
2k1
2k1 2k1 z
z 2k 1=(z 2k + 2k1 z 2k1)
(4.17)
e sabendo que:
a Eq. (4.17) vem da Eq. (4.14), uma vez que x2k a derivada em relao ao tempo de x2k-1. Logo:
ref
V ( z 2k1 , z 2k )=( z 2k1)( z 2k+ 2k1 z 2k 1 )+( z 2k )( x 2k x 2k 1 2k1 z 2k1)
(4.18)
ref
V ( z 2k1 , z 2k )=( z 2k1)(z 2k+ 2k1 z 2k 1 )+( z 2k )[ x 2k x 2k1+ 2k 1 ( z 2k+ 2k1 z 2k 1 )]
(4.19)
45
(4.20)
x 2k =z 2k 1 2k z 2k2k 1 ( z 2k+2k 1 z 2k 1 )
(4.21)
(4.22)
de modo que: 2k-1 > 0 e 2k > 0. A Eq. (4.22) mostra que, ao definir as variveis z 2k-1 e z2k de acordo
com as Eqs. (4.8) e (4.14), demonstra-se a convergncia dos erros de rastreio. Ento, tais expresses
definem formas gerais para o clculo do controle de cada varivel. Dessa forma, para k = 1 tem-se:
x 2 =z 1 2 z 2 1 (z 2 +1 z 1 )
(4.23)
(4.24)
M =I yy [a 2 x 2 x 6+ z 3 4 z 4 3 ( z 4+ 3 z 3)]
(4.25)
46
N = I zz [a3 x 2 x 4+ z 5 6 z 6 5 ( z 6+ 5 z 5 )]
T=
(4.26)
m
[ g z 7+ 8 z 8 +7 ( z 8+ 7 z 7)]
c x1 c x3
(4.27)
m
[ z 10 z 109 ( z 10+9 z 9 )]
T 9
(4.28)
m
[ z 12 z 1211 ( z 12+ 11 z 11)]
T 11
(4.29)
u x=
u y=
u x s x5 u y c x5 =s x1 (s x5 ) +s x1 (c x5 )
u x s x5u y c x5 =s x1
ref
x 1 =arcsen(u x s x5u y c x5 )
(4.30)
(4.31)
47
A lei de controle dada pela Eq. (4.21) leva a uma equao diferencial de segunda ordem:
ref
ref
ref
x 2k =2k 1 ( x 2k x 2k1
2k1 z 2k1+2k 1 z 2k 1 ) 2k [ x 2k x 2k 12k 1 ( x 2k1 x 2k1)]
ref
+(x 2k
1 x 2k1 )
(4.32)
(4.33)
ref
ref
x 2k =(2k 1+2k )( x 2k1
x 2k )+(1+ 2k1 2k)( x 2k1
x 2k1)
(4.34)
ref
ref
ref
ref
(4.35)
(4.36)
ref
ref
1
(1+2k 1 2k)
x 2k1+
( 2k1+2k )
( x 2k1)+x 2k 1=(x ref
2k1)
(1+ 2k1 2k )
(4.37)
(4.38)
48
(4.39)
Sabendo disso, a escolha dos ganhos do controle backstepping ser feita tentando no ultrapassar
este valor (para certos valores das amplitudes das referncias), fazendo com que o sistema tenha um
desempenho desejado.
A segunda considerao a ser feita a imposio de um movimento criticamente amortecido
para cada um dos estados principais do quadrirrotor: os ngulos de Euler (, e ) e a altitude. Esta
escolha feita com a inteno de prover um tempo de subida mnimo antes da ocorrncia de
sobressinal. Considerando condies iniciais nulas, e uma entrada de referncia degrau unitrio, a
Eq. (4.38) pode ser escrita no domnio de Laplace como:
X 2k1=(
ref
(1+ 2k1 2k ) X 2k
1
)
2
s [s +( 2k1+ 2k )s+(1+ 2k1 2k )]
X ref
2k 1
)
s
(4.40)
(4.41)
Aqui deseja-se relacionar os ganhos com o valor mximo de rotao de cada hlice-motor.
Portanto, sabendo a expresso para a fora de sustentao e para os momentos atuantes no
quadrirrotor, os valores dos ganhos podem ser determinados em funo do valor mximo de
rotao. A seguinte equao matricial relaciona as rotaes e os esforos:
49
1
4k f
21
1
2
2 4k f
=
1
23
2
4 4k f
1
4k f
1
2k f l
1
2k f l
1
2k f l
1
2k f l
1
4k m
1
4k m
1
4k m
1
4k m
T
L
M
N
(4.42)
(4.43)
ou:
kf
kf
kf
kf
T
0 k f l
0
kfl
L
=
M kfl
0
k f l
0
N
k m k m
k m k m
21
22
2
3
T=
m
ref
ref
ref
ref
[ g( x 7 x 7)+8 ( x8 x 7 7 ( x7 x 7 ))+7 ( x8 x 7 7 z 7+ 7 z 7)]
c x1 c x3
(4.44)
50
m
[ g( x 7ref x 7)+8 ( x8 x 7ref 7 ( x7 ref x 7 ))+7 ( x8 x 7ref )]
c x1 c x3
(4.45)
m
ref
ref
ref
ref
[ g( x 7 x 7)+8 ( x8 x 7 ) 7 8 (x 7 x 7)+7 ( x8 x 7 )]
c x1 c x3
(4.46)
T=
T=
x 7ref =0
(4.47)
tem-se:
T=
m
[ g( x 7ref x 7)+8 ( x8 ) 7 8 ( x 7ref x 7)+7 ( x 8)]
c x1 c x3
(4.48)
m
[ g+( 7+ 8) x 8+(1+7 8)( x 7 x 7ref )]
c x1 c x3
(4.49)
T=
x 1=0
x 3=0
(4.50)
(4.51)
A Eq. (4.41) representa uma equao diferencial linear de segunda ordem na forma padro,
com amortecimento e frequncia natural no amortecida n. Assim, para o controle de altitude, a
51
7=
( 7+8 )
2 (1+7 8 )
(4.52)
( 7 8)2=4
( 7 8)=2
(4.53)
e para os estados:
ref
n t
(4.54)
A partir daqui adota-se uma conveno: a diferena entre os ganhos 7 e 8 sempre ser igual a 2 (7
> 8), bem como os outros pares de ganhos. Vale ressaltar que a condio de ambos os valores
serem positivos conservadora. Como pode ser visto na Eq. (4.54), a estabilidade depende que n >
0, e no necessariamente que 7 > 0 e 8 > 0. Essa condio vlida devido ao critrio de
movimento criticamente amortecido. Dessa forma:
(4.55)
52
ref
ref
n t
n t
T =m{ g +2 n [ x 7 x 7( 0)]n t e
n t
ref
n t
ref
ref
ref
+n { [ x 7 x 7 (0)][ 1e
t
t
T =m{ g +3n [ x ref
+ n2 { [ x ref
)+ x 7( 0)x ref
7 x7 (0)]t e
7 x 7(0)](1e
7 }}
n
n t
ref
T =m{ g + n [ x 7 x 7 (0)]t e
n t
ref
(4.56)
n [ x 7 x 7(0)]e
(4.58)
(4.59)
(4.60)
Durante a decolagem, o valor mximo de trao, que ocorre no instante inicial, no deve ser maior
do que a trao mxima dada pelos motores:
2 t
4k f max 2m { g+[ x ref
( n t1) }
7 x 7( 0)] n e
n
ref
4k f max m { g[ x 7 x 7(0)]n }
(4.61)
(4.62)
Durante a decolagem tambm, o valor mnimo de trao, que ocorre em t = 2/n, no deve ser
menor do que 0, uma vez que este caso representaria um valor de rotao complexo (i2 < 0):
2 t
0m[ g+[ x ref
( n t1)]
7 x 7 (0)]n e
n
2 2
0m( g 60 n e )
(4.63)
(4.64)
53
ref
(4.65)
Durante a aterrissagem tambm, o valor mximo de trao, que ocorre em t = 2/n, no deve ser
maior do que a trao mxima dada pelos motores:
(4.66)
As ultimas duas restries so quanto aos valores das razes mximas de subida e descida. Dada a
condio de movimento criticamente amortecido, a altitude e as razes mximas de subida e
descida da plataforma tem-se:
7[ x7ref x 7 (0)] 2n t e t
n
ref
n t
4[ x 7 x 7 ( 0)] n t e
(4.67)
(4.68)
Estas seis condies levam a seis conjuntos de valores dos ganhos 7 e 8. O desenvolver das
seis condies pode ser consultado no Apndice A. A melhor condio oriunda da Eq. (4.68):
1< 71,181
1<80,819
(4.69)
1 =3 =
T
N
+
4k f 4k m
(4.70)
22=42=
T
N
4k f 4k m
(4.71)
Novamente, a inteno aqui fazer com que a seguinte desigualdade seja satisfeita:
0i mx
(4.72)
Durante o movimento no sentido positivo do ngulo de guinada , os valores dos quadrados das
velocidades angulares tero a forma da Eq. (4.70) e da Eq. (4.71). Entretanto, durante o movimento
no sentido contrrio, tais pares de rotaes tero um o valor do outro: a Eq. (4.71) ser igual Eq.
(4.70) e vice-versa. Isso ocorre devido dualidade das equaes. Assim, considerando um
movimento no sentido positivo, ambas sero satisfeitas, levando novamente quatro condies:
2mx
T
N
+
4k f 4k m
T
N
+
4k f 4k m
2mx
T
N
4k f 4k m
(4.73)
(4.74)
(4.75)
55
T
N
4k f 4k m
(4.76)
2mx
mg
N
+
4k f 4k m
2mx
N
mg
+
4k f 4k m
mg
N
4k f 4k m
(4.77)
(4.78)
(4.79)
mg
N
4k f 4k m
(4.80)
mg
4k f
(4.81)
em que:
20=
N = I zz [a3 x 2 x 4+ z 5 6 z 6 5 ( z 6+ 5 z 5 )]
(4.82)
Tendo em mente as expresses nas Eqs. (4.8) e (4.14) e considerando a variao do valor de
56
ref
(4.83)
x 2 =0
x 4 =0
(4.84)
t
x 5=[ x ref
[1+n t ] }+x 5 (0)
5 x5 (0)]{ 1e
ref
x 6=[ x5 x 5 (0)] 2n t e t
( + 6)
( 5+ 6)
n= 5
5 =
=1
2
2 (1+5 6 )
n
(4.85)
assim:
2 n t
ref
N = I zz [( x 5 x 5 (0)) n e
(1 n t )]
(4.86)
ref
2 n t
mg
(1n t)]
km
I zz [(x 5ref x 5 (0)) n2 e t (1 n t )]
kf
n
(4.87)
(4.88)
57
2 n t
ref
4k m (mx0 )I zz [( x 5 x5 (0)) n e
mg
(1n t)]
km
2 t
I zz [( x ref
(1n t)]
5 x5 (0)) n e
kf
n
(4.89)
(4.90)
Em todos os casos:
ref
x 5 x 5 (0)=
(4.91)
que corresponde mxima rotao considerada. O movimento no sentido oposto no escrito (x 5ref
x5(0) = ) pois est implicitamente considerado, dada a dualidade das Eqs. (4.70) e (4.71).
Novamente, os instantes de interesse sero o instante inicial (onde o mdulo de N mximo) para
as Eqs. (4.87) e (4.90), e o instante t = 2/n (onde o mdulo de N mnimo) para as Eqs. (4.88) e
(4.89). Desta forma, quatro conjuntos de valores dos ganhos so determinados, de forma que o mais
restritivo tomado. O desenvolvimento das equaes pode ser visto no Apndice A.
Assim, para o controle de guinada tem-se:
1<5 2,382
1<6 0,382
(4.92)
rolamento tambm utilizado, para corrigir desvios devido a fatores de erro, por exemplo, rudos ou
distrbios. Alm disso, a malha interna de controle de rolamento e arfagem, alm de servir para
controlar o deslocamento horizontal, tambm serve para estabilizar a dinmica de rotao, que
instvel por natureza.
Para o controle do movimento de arfagem, a relao entre as velocidades angulares e os
esforos dada por:
21=
T
M
+
4k f 2k f l
(4.93)
T
4k f
(4.94)
T
M
4k f 2k f l
(4.95)
T
4k f
(4.96)
22=
3=
4=
2max
T
M
+
4k f 2k f l
T
M
+
4k f 2k f l
(4.97)
(4.98)
59
2max
T
M
4k f 2k f l
(4.99)
T
M
4k f 2k f l
(4.100)
em que:
M =I yy [a 2 x 2 x 6+ z 3 4 z 4 3 ( z 4+ 3 z 3)]
(4.101)
Novamente, tendo em mente as expresses nas Eqs. (4.8) e (4.14),considerando a variao do valor
de referncia como sendo nula, e, considerando um movimento criticamente amortecido para o
movimento de arfagem, o momento M :
2 n t
ref
M =I yy [( x 3 x 3 (0))n e
(1n t)]
(4.102)
ref
2 n t
2k f l c (max0 )I yy [( x 3 x 3 (0)) n e
(1 n t)]
2 t
2k f l c 02I yy [(x ref
( 1 n t)]
3 x 3 (0)) n e
n
2 n t
ref
2k f l c (max0 )I yy [( x 3 x 3 (0)) n e
(1n t )]
2 t
2k f l c 20 I yy [( x ref
(1n t)]
3 x 3 (0)) n e
n
(4.103)
(4.104)
(4.105)
(4.106)
60
Para o momento de arfagem, alm das restries referentes aos limites de velocidades dos
atuadores, imposta uma restrio quanto ao valor do ngulo de arfagem:
45
(4.107)
(t=0)=45
ref =45
=0
(4.108)
1< 18,153
1< 26,153
1< 38,153
1< 46,153
(4.109)
61
Os valores de referncia dos ngulos de rolamento e arfagem so dados pelas Eqs. (4.30) e
(4.31). Para a misso idealizada neste trabalho, no h o movimento de rolamento. Assim, a Eq.
(4.31) pode ser reescrita como:
ref
x 3 =arcsen(u x c x5+u y s x5 )
(4.110)
m
ref
ref
[( 9+ 10)( x10 x 9 )+(1+ 9 10)(x 9 x 9 )]
T
(4.111)
m
ref
[(11+12)( x12 x ref
11 )+(1+9 10 )(x 11 x 11 )]
T
(4.112)
u x=
u y=
Para:
ref
ref
x 9 = x 11 =0
(4.113)
m
ref
[( 9+ 10)(x 10 )+(1+ 9 10)( x 9 x 9 )]
T
c
u x = x3 [( 9+ 10)( x 10)+(1+9 10 )(x 9 x ref
9 )]
g
(4.114)
u x=
62
m
[( 11+ 12)(x 12)+(1+11 12)( x 11 x ref
11 )]
T
c
ref
u y = x3 [(11+ 12)( x 12)+(1+11 12)( x11 x11
)]
g
u y=
(4.115)
9= 11 =
10=12=2
n =1
(4.116)
tem-se:
c x3
t
{ 2n [ x ref
(n t1) }
9 x 9 (0)]e
g
(4.117)
c x3
t
{ 2n [ x ref
(n t1) }
11 x 11 (0)]e
g
(4.118)
u x=
u y=
[x 9ref x 9 (0)]=lc x5
[ x ref
11 x 11 (0)]=ls x5
(4.119)
u x =l c x5
c x3 2 t
[n e ( n t 1)]
g
n
(4.120)
63
u y =l s x5
c x3 2 t
[n e ( n t 1)]
g
n
(4.121)
ref
l c x3 2 t
[ n e ( n t1)]
g
n
lc
2 t
)= x3 [n e ( n t1)]
g
(4.122)
Aqui, trs restries so levadas em conta para os valores dos ganhos. A primeira aquela
expressa na Eq. (4.107). A segunda, quanto ao valor de velocidade mxima as trajetrias
executadas pelo quadrirrotor durante cada passo do movimento baseado no voo de Lvy. A terceira
quanto a velocidade mdia em cada passo. Esta ltima vem do fato de que o a velocidade durante
o voo deve ser constante.
Para a primeira restrio, com a inteno de que o controle do movimento horizontal gere
valores de referncia dentro da faixa de valores adotada para , tem-se que os valores mximos e
mnimos do termo entre colchetes da Eq. (4.122) ocorre em t = 2/n: e no instante inicial,
respectivamente. Assim no instante inicial:
sen( x ref
3 )=
l c x3 2
( n)
g
(4.123)
e em t = 2/n:
sen( x ref
3 )=
l c x3 2 2
( n e )
g
(4.124)
64
Uma vez que a condio dada pela Eq. (4.107) deve ser respeitada, para o calculo dos ganhos
considera-se o valor mximo de cos(). Assim:
1
2 2
sen( 45 ) (l n e )
g
(4.125)
1
sen(45) (l 2n)
g
1
2
sen ( 45) (l n)
g
1
sen ( 45) (l 2n )
g
(4.126)
O termo exponencial na primeira equao faz com que esta imponha uma restrio menos restritiva
do que a segunda. Portanto, a Eq. (4.126) tomada:
2
2l
2
111+ g
2l
91+ g
(4.127)
ref
2
t 2
ref
2
t 2
v l= { [ x 9 x 9 (0)]n t e } +{ [ x 11 x 11( 0)] n t e }
n
(4.128)
em que cada um dos termos entre chaves representam as velocidades na direo x e y do sistema
inercial. E tendo em mente a Eq. (4.119):
2
t 2
2
t 2
v l=(l c x5 n t e ) +(l s x5 n t e )
n
(4.129)
65
2
t 2
v l=(l n t e )
(4.130)
v l=l n2 t e t
(4.131)
vmx l n2 t e t
(4.132)
5,56l n e
5,56 e
l
5,56 e
111+
l
(4.133)
91+
(4.134)
66
5
5
x 2k 1 ( )=[ x ref
2k1x 2k 1 (0)](16 e )+ x 2k1 (0)
n
(4.135)
Portanto a velocidade mdia tomada entre o instante inicial do movimento e 5/n segundos aps
este instante dada por:
5
n
1
x dt
5 0 2k
( n )
(4.136)
n
5
[x
( ) x 2k1 (0)]
5 2k1 n
(4.137)
n
5
{ [ x ref
2k1x 2k 1(0)](16 e )+x 2k1 (0) x 2k1 (0) }
5
(4.138)
n ref
[ x 2k1x 2k 1(0)](16 e 5)
5
(4.139)
x 2k =
x 2k =
x 2k =
x 2k =
ref
x 2k 0,192 n [ x 2k1x 2k1( 0)]
(4.140)
ref
x 100,192 n [ x 9 x 9 (0)]=0,192 n l c x5
x 120,192 n [ x ref
11 x 11 (0)]=0,192 n l s x5
(4.141)
E a velocidade mdia vh :
v h= x 210+x 212
(4.142)
67
2
2
v h= (0,192 n l c x5) +( 0,192 n l s x5 )
(4.143)
v h=0,192 n l
(4.144)
5,21 v h
l
5,21 v h
111+
l
(4.145)
91+
Como visto, as Eqs. (4.127), (4.134) e (4.145) levam estratgia de ganho escalonado, onde
em os conjuntos de valores possveis dos ganhos vo depender dos comprimentos de trajetria de
cada passo. Entre as trs condies aqui abordadas a ultima apresenta maior relevncia. Dessa
forma, o procedimento utilizado para determinar o conjuntos dos valores dos ganho foi definir um
valor da velocidade mdia vh que implicasse que a Eq. (4.145) sempre fosse menor do que as Eqs.
(4.127) e (4.134). Deste como, foi determinado que:
v h1,96 m/ s
(4.146)
O desenvolver das equaes que levam a estes resultados detalhado no Apndice A. Portanto:
10,2
l
10,2
10=1+
l
10,2
11=1+
l
10,2
12=1+
l
9=1+
(4.147)
68
A outra tcnica de controle adotada neste trabalho o controle no-linear sliding mode. Para
isso, as Eqs. (4.1) (4.8) so consideradas. Similarmente a (BOUABDALLAH, 2007), pode-se
definir as superfcies de chaveamento:
(4.148)
em que k = 1,2,3,4,5,6 e 2k-1 > 0, de modo que a superfcie de chaveamento dada pela Eq. (4.148)
representa uma trajetria estvel. O sliding mode define uma resposta de primeira ordem para o erro
de rastreio, que converge para zero em regime permanente. Uma vez o termo correspondente
derivada do valor de referncia nulo, tem-se que:
s k = x 2k 2k1 z 2k 1
(4.149)
s 2k + z 22k1
V k=
2
(4.150)
V k =s k s k + z 2k1 z 2k 1
(4.151)
Portanto:
Como sabido, a estabilidade atingida quando a Eq. (4.150) definida positiva e a Eq. (4.151)
semi-definida negativa. A partir da ltima, pode-se definir que:
69
(4.152)
(4.153)
Analisando a Eq. (4.153), uma forma de aplicar o formalismo do segundo mtodo de Lyapunov
dado da seguinte forma:
(4.154)
A inteno disso impor que o produto entre s k e sua derivada em relao ao tempo seja menor do
que zero, do mesmo modo que em (BOUABDALLAH, 2007). A Eq. (4.154) tem essa forma pois:
(4.155)
(4.156)
2
V k =[ z 2k1 s k k 2k1 s k k 2k s k sgn ( s k )]+z 2k1 z 2k1
(4.157)
2
V k =[ z 2k1 ( x 2k 2k1 z 2k1)k 2k 1 s k k 2k s k sgn ( s k )]+z 2k1 z 2k1
(4.158)
(4.159)
2
2
V k = 2k1 z 2k1k 2k1 s k k 2k s k sgn (s k )
(4.160)
Vale ressaltar, que a presena do termo referente funo sinal na Eq. (4.154) garante tambm a
70
estabilidade, onde k2k-1 > 0 e k2k > 0, atingindo a estabilidade em z2k-1 = sk = 0. A insero do termo
referente funo sinal da superfcie de chaveamento o cerne da tcnica sliding mode. Devido a
ele, todas as trajetrias que iniciam a partir de um ponto no pertencente superfcie de
chaveamento so direcionadas a ela (UTKIN, 1977; DECARLO, et al. 1988; KHALIL, 2002).
Reescrevendo a Eq. (4.154):
(4.161)
(4.162)
ref
(4.163)
Como pode ser visto, a Eq. (4.163) anloga Eq. (4.37). Esta equao deve ser obtida para a
dinmica da varivel x2k-1 a partir de um controle adequado. A partir daqui pode-se adotar a mesma
relao que foi adotada para os controles backstepping, de modo que:
k 2k 1 = 2k= 2k12
(4.164)
k 2k =k
(4.165)
e renomeando:
71
ref
(4.166)
Com exceo do termo referente funo sinal, a Eq. 4.166 idntica quela que descreve
os valores dos estados x2k-1 ao longo do tempo para o controle backstepping. Novamente, deseja-se
relacionar os valores dos ganhos da lei de controle com o valor mximo de rotao de cada hlicemotor.
(4.167)
T =(
m
)[ g( 7+ 8) z 7(1+ 7 8) z 7+4 sign(s 4)]
c x1 c x3
(4.168)
t it<t tr
(4.169)
72
em que ti o instante inicial do movimento e ttr o instante da primeira transio pela superfcie de
chaveamento. Este ltimo no pode ser determinado analiticamente. Assim, para um instante de
tempo t que esteja em tal intervalo:
x 7=[ x ref
7 x 7( 0)
4 sign(s 4)
2
n
x 8=[ x ref
7 x7 ( 0)
ref
4 sign(s 4)
2n
4 sign( s 4 )
2
n
]2n t e t
n
] n2 e t (n t1) }
n
(4.170)
(4.171)
(4.172)
A Eq. (4.170) e a Eq. (4.171) so facilmente deduzidas considerando o fato de que o termo
da funo sinal comporta-se como um valor modificador do valor de referncia. A Eq. (4.172) pode
ser determinada considerando a Eq. (4.55) e substituindo as Eqs. (4.170) e (4.171) nesta. Do mesmo
modo que a abordagem adotada para o controle backstepping, pretende-se determinar um conjunto
de valores que torne o movimento em questo possvel, sem ultrapassar os limites dos atuadores.
No controle sliding mode o ganho entra neste quesito. Conforme desenvolvido no controle
backstepping, a condio mais restritiva aquela relativa razo mxima de descida (pendice A).
Dessa forma, para o valor considerado (dada a condio do instante de velocidade mxima, t = 1/n,
ser menor do que o da primeira transio), tem-se que:
4( 60+
2
n
) n e1
(4.173)
73
4 n e( 60+
4
2
n
) 2n
(4.174)
4 n e60 n 4
(4.175)
(4 e60 n )n4
(4.176)
O lado esquerdo da Eq. (4.176) denota claramente uma parbola com um ponto de mxima. Dada a
condio de que 4 > 0:
0<n <
4e
60
(4.177)
4e
4e
n<
120
60
0,091n<0,182
(4.178)
16 e 2
240
0<4 0,492
(4.179)
Dessa forma:
0< 4
74
Para k = 3:
(4.180)
Inserindo o termo referente a 3 na Eq. (4.102) (analogamente ao caso da Eq. (4.168), porm aqui a
substituio da Eq. (4.180) feita na sexta linha da Eq. (4.2)):
(4.181)
N = I zz { [ x ref
5 x5 (0)
3 sign( s 3)
2
n
]n2 e t (1n t ) }
n
(4.182)
Valendo-se da dualidade das Eqs. (4.70) e (4.71), a abordagem aqui partir da condio
definida pela Eq. (4.80), uma vez que para o controle backstepping esta implicou numa condio
mais restritiva para os ganhos. Assim:
I zz { [ x ref
5 x 5 (0)
3 sign(s3 )
2
n
] n2 e t (1 n t ) }
n
mg k m
kf
(4.183)
No instante inicial, uma vez que a diferena entre o valor de referncia e o valor inicial do estado
75
positiva e que no h movimento de guinada, de acordo com a Eq. (4.148), sign(s3) = 1. Portanto:
I zz [( +
2
n
) n2 ]
(4.184)
mg k m
I zz k f
(4.185)
mg k m
n2
I zz k f
(4.186)
( n2+3)
mg k m
kf
35,982 n
(4.187)
0<35,982
(4.188)
Uma vez que a nica restrio imposta para a escolha dos ganhos neste caso provm dos
valores limites das rotaes das hlices, o valor mximo de 3 poder assumir um valor nulo (caso
onde no h um termo referente superfcie de chaveamento), at o valor mximo oriundo da
condio do valor de rotao das hlices do quadrirrotor nunca ser menor que zero.
Para k = 2:
76
(4.189)
M =I yy [( 3+ 4 ) z 3+(1+3 4) z 32 sign( s 2 )a 2 x 2 x 6 ]
M =I yy { [ x ref
3 x 3 (0)
2 sign(s 2)
2
n
] n2 e t (1n t) }
n
(4.190)
(4.191)
I yy { [ x ref
3 x 3 (0)
2 sign( s 2 )
2
n
] n2 e t (1 n t ) }2k f l c 20
n
(4.192)
I yy [ ( )+ 22 ]n 22k f l c 20
4
4 n
(4.193)
I yy ( n2+2)2k f l c 20
2
(4.194)
2(
2k f l c 20 2
n )
I yy
2
280,164 2n
2
(4.195)
(4.196)
77
Para k = 5:
(4.197)
(4.198)
e para k = 6:
m
)[( 9+ 10) z 9+(1+ 9 10) z 95 sign( s 5)]
T
(4.199)
m
)[(11+ 12) z 11+(1+11 12) z 116 sign(s 6)]
T
(4.200)
u x =(
u y =(
Adotando as mesmas consideraes feitas para a abordagem no controle backstepping, tem-se que:
u x=
c x3
5 sign( s 5) t
{ 2n [ x ref
]e ( n t1) }
9 x 9 (0)
g
2n
n
(4.201)
78
u y=
c x3
6 sign( s6 ) t
{ 2n [ x ref
]e (n t1) }
11 x 11 (0)
2
g
n
(4.202)
u x=
c x3 2
c
[n l c x5 e t ( n t1)] x3 [5 sign(s 5)e t ( n t1)]
g
g
(4.203)
u y=
c
c x3 2
[ n l s x5 e t ( n t1)] x3 [6 sign(s 6 )e t (n t1)]
g
g
(4.204)
e determinando que 5 = 6 = ,:
sen( x 3ref )=
c x3
{ (c 2x5+s 2x5 ) 2n l [c x5 sign(s 5 )+s x5 sign( s 6)] }e t ( n t1)
g
sen( x 3ref )=
c x3
{ 2n l[c x5 sign(s5 )+s x5 sign(s 6)] }e t ( n t1)
g
n
(4.205)
(4.206)
Considerando agora o instante inicial (que levou determinao do conjunto dos valores dos
ganhos no caso do controle backstepping), tem-se que:
sen( x 3ref )=
c x3
{ 2n l[c x5 sign( s 5)+s x5 sign( s 6)] }
g
c
2
sen(45 )= x3 { 2n l[c x5 sign( s5 )+s x5 sign( s 6)] }
2
g
(4.207)
(4.208)
79
2
1
{ 2n l[ c x5 sign(s 5)+s x5 sign( s 6)] }
2
g
(4.209)
Primeiro, para a Eq. (4.209), o termo entre chaves sempre ser menor do que zero. O mdulo ser
dado apenas pelos valores do seno e do cosseno de x 5. O termo entre chaves pode ser reescrito
como:
[c x5s x5]
(4.210)
2 ( 2 l+ 2)
(4.211)
g
2
2n l
2
2
(4.212)
v l { [ x ref
9 x 9 (0)
v l { [l c x5
sign(s5 )
2
n
sign(s 5)
2
n
]n2 t e
v ln 2 t e t l 2 c 2x5 2 l c x5
n
n t
] n2 t e
n t
} 2+{ [ x ref
11 x11 (0)
} 2+{ [l s x5
sign(s 6)
sign(s 6)
2
n
2
n
]n2 t e
]n2 t e
n t
}2
sign( s 5) 2 2 2
sign( s 6) 2
+
+l
s
2
l
s
+ 4
x5
x5
2n
4n
2n
n
n t
}2
(4.213)
(4.214)
(4.215)
80
2 2
+ 4
2
n n
(4.216)
Em t = 1/n:
v ln e
2
l 2 l [sign(s 5) c x5+sign(s 6) s x5 ] 2 + 4
n n
2
v ln e
2 2
l +2 2 l 2 + 4
n n
2
(4.217)
(4.218)
assim:
2 2
)
2n
(4.219)
(4.220)
Dessa forma, o valor de ser dado em funo da Eq. (4.147) e das restries impostas pelas Eqs.
(4.212) (4.220):
g (10,2)2 2
2
2l
(5,56 e
(4.221)
10,2
10,2
10,2
) (l 2 (
) +2 2 l (
) +22 )
l
l
l
(4.222)
81
(5,56 e
10,2 2 (10,2)4
(10,2)2
) [
+2
2
+2 2 ]
2
l
l
l
(4.223)
A abordagem utilizada por meio da escolha do valor de velocidade horizontal mdia, como
no caso do controle backstepping, no pode ser utilizada aqui, devido condio da Eq. (4.169).
Uma vez que > 0, a Eq. (4.223) pode ser reescrita como:
10,2
(10,2)4
(10,2)2
(5,56 e
) +2 2
+22 ]
0[
2
l
l
l
(4.224)
(4.225)
182,56
35,44
l
l
(4.226)
(10,2) 2 2 35,44 35
l
l
l
(4.227)
E deste modo:
Alm disso:
l18,62 m
(4.228)
em que a Eq. (4.227) sempre ser maior do que o limite superior da Eq. (4.226). Portanto,para o
controle horizontal, definido:
82
35
l
(4.229)
83
(3.3), (3.4), (3.6), (3.10), (3.14), representando o modelo de projeto desenvolvido em (DA
SILVA,2012).
Por fim, a estimao dos valores realizada por meio de um filtro de Kalman, que estima os
valores de x, y e de altitude, bem como, as respectivas velocidades. Alm disso, so determinados
os ngulos de Euler. As velocidades angulares (p, q e r) so medidas pelos giroscpios, que devido
so utilizadas nas leis de controle, devido aproximao definida na Eq. (4.4). A descrio dos
sensores feita no Apndice B.
No Apndice C, as Figuras C.1 C.21 mostram os diagramas de blocos implementados no
ambiente Simulink do software MATLAB.
85
86
Captulo 5
Simulaes
88
89
Analisando a Figura 5.1, pode-se notar que o quadrirrotor foi capaz de atingir a altitude
desejada. O deslocamento horizontal ocorre devido aos pequenos valores dos ngulos de rolamento
e arfagem, como pode ser visto na Figura 5.2. Na Figura 5.3, pode-se notar que o valor mximo do
mdulo da razo de subida e de descida 4 m/s (devido aos valores dos ganhos aplicados). Em
seguida, as Figuras 5.5 a 5.8 mostram os valores dos esforos atuantes. Como era de se esperar, os
valores da trao seguiram o enunciado na subseo 4.1.2. Nos instantes iniciais de decolagem e
pouso tem-se:
(5.1)
90
91
Figura 5.19: Momento de Arfagem no Quadrirrotor. Figura 5.20: Momento de Guinada no Quadrirrotor.
92
As Figuras 5.13 e 5.14 mostram que a altitude desejada e o movimento de rotao foram
executados como esperados. Novamente, pode-se perceber a presena dos pequenos deslocamentos
horizontais e angulares, e, na Figura 5.15, o valor mximo do mdulo da razo de subida e de
descida 4 m/s (como no caso passado). A Figura 5.17 mostra que a trao no quadrirrotor
praticamente a mesma para o caso anterior, como esperado, j que a altitude a ser atingida aqui a
mesma, e durante o movimento de guinada o valor de trao deve ser igual fora peso do
quadrirrotor. Para a Figura 5.20, o valor de pico que ocorre no instante inicial do movimento de
guinada :
N = I zz (1,3) 0,15 Nm
(5.2)
Isso ocorre devido condio da Eq. (4.80). Assim, como tambm esperado, os valores das rotaes
dos motores no ultrapassam o valor mximo de rotao e nem so menores do que zero. Outro
item que pode ser notado o aumento repentino da velocidade nos motores 1 e 3 e uma diminuio
nos motores 2 e 4, devido ao movimento de guinada, fazendo jus Eq. (4.42).
Etapas:
-Decolagem para altitude de 60m;
-Rotao de 45 em torno do eixo zB;
-Deslocamento de 20m;
-Pouso.
Valores dos ganhos: idem aos casos anteriores. As Figuras 5.25 a 5.39 mostram os resultados:
93
94
95
As Figuras 5.25 5.28 mostram que o voo foi executado conforme planejado. As Figuras
5.27 e 5.28 mostram a trajetria do quadrirrotor no espao (a primeira seu deslocamento horizontal
e a segunda seu deslocamento nas trs dimenses). Na Figura 5.26, alm de ser possvel ver o
movimento de guinada, tambm possvel visualisar o valor dos ngulos de rolamento e arfagem (
e , respectivamente). Conforme o enunciado no Captulo 3, o deslocamento horizontal do
quadrirrotor depende de sua atitude. Assim, o controle do movimento horizontal implica em valores
de referncia de e . Uma vez que o movimento ocorre apenas na direo do eixo x B, o
movimento do quadrirrotor exigir que o controle horizontal especifque apenas valores de
referncia significativos para . Alm disso, a Figura 5.26 mostra que o valor do mdulo do ngulo
de arfagem, para este caso, no ultrapassou 25 (neste instante, 22).As Figuras 5.31 a 5.34
mostram os esforos solicitados para o voo. Do mesmo modo que nos casos anteriores, os valores
dos esforos obedeceram os limites impostos e se comportaram conforme o enunciado na seo 4.1.
Na Figura 5.31, pode ser observado um pico no valor da trao T (t 40 s). Isso ocorre devido ao
incio do movimento horizontal. Uma vez que o quadrirrotor executa um movimento de arfagem, o
mdulo da componente vertical da fora T diminui, exigindo que a rotao dos motores aumente (o
que tambm pode ser notado nas Figuras 5.33 a 5.36). Fazendo um calculo a grosso modo:
96
T=
10,1
mg
=10,894 N
cos (22 ) 0,927
(5.3)
Tal valor aproximado condiz com o mostrado na Figura 5.31. Do mesmo modo, a amplitude do
momento de arfagem condizente com o valor do ngulo de arfagem:
(5.4)
N = I zz (2,31)2 ( 0)0,038 Nm
4
(5.5)
Um pouco mais do 4 m/s a velocidade mxima atingida durante o movimento. Para n = 0,51, o
instante t = 5/n e a velocidade mdia so:
t=
5
5
=
9,8 s
n 0,51
v h20/9,8=2,04 m/ s
(5.6)
(5.7)
que um valor muito prximo daquilo expresso na Eq. (4.146). Vale ressaltar que este valor
aproximado, bem como o escrito na Eq. (4.146), uma vez que aps 5/n segundos do incio do
movimento horizontal o quadrirrotor ainda no atingiu o ponto esperado, de forma que a velocidade
mdia real um pouco menor do que o escrito na Eq. (5.7).
Por fim, tem-se o voo do quadrirrotor baseado no voo de Lvy. Como definido, a misso
deve cobrir uma rea quadrada de lado igual a 180 m, no excedendo este limite. Etapas:
1.Decolagem para altitude de 60m;
2.Movimento de guinada;
3.Deslocamento na direo do eixo xB (comprimento segundo funo de Lvy);
4.Volta segunda etapa;
5.Retorno
5.Pouso.
As etapas 2 e 3 sero realizadas 5 vezes (cinco pontos escolhidos). Os ganhos so os mesmos dos
casos anteriores. Os ganhos relacionados aos movimentos horizontais seguem o enunciado na Eq.
(4.147). Dessa forma, as Figuras 5.40 a 5.55 mostram os resultados:
98
Por fim, dada a validade dos controles dos estados do quadrirrotor, tem-se aqui a sntese de
todos os controles aplicados, de forma a prover ao quadrirrotor um movimento baseado no voo de
Lvy. Como pode ser observado, as Figuras 5.40 e 5.41 mostram o voo do quadrirrotor. O
quadrirrotor executa os passos, compondo um movimento baseado no voo de Lvy, retornando ao
ponto de decolagem ao final destes. A Figura 5.42 mostra sua decolagem e pouso, e seu
deslocamento horizontal para cada valor de comprimento de trajetria escolhido segundo a funo
de Lvy. A Figura 5.43 mostra os valores dos ngulos de Euler ao longo do tempo. Na Figura 5.42,
bem como para o ngulo de guinada na Figura 5.43, so mostrados os valores de referncia (linha
verde claro). As Figuras 5.44 e 5.45 mostram os erros de rastreio dos deslocamentos horizontais, da
altitude, e do ngulo de guinada ao longo do tempo, respectivamente. O quadrirrotor executou como
esperado cada uma das etapas da misso, atingindo os pontos desejados. Na Figura 5.48 possvel
ver os pequenos valores de picos presentes entre a decolagem e o pouso, devido ao movimento de
arfagem que implica em uma menor componente de trao na direo vertical, fazendo-se
necessrio um valor de trao maior. Conforme mostra a Figura 5.43, o mdulo mximo deste
ngulo no ultrapassa 20, satisfazendo a Eq. (4.107). Nas Figuras 5.49 5.51, os valores dos
momentos ao longo do tempo podem ser vistos. Nas Figuras 5.50 e 5.51, a presena dos valores de
pico indicam o nico de cada movimento angular. As Figuras 5.49 e 5.50 mostram os momentos de
rolamento e arfagem, respectivamente, que condizem com o movimento na direo do eixo x B. Em
todos os casos, os esforos no excederam seus valores limites, o que pode ser visto nas Figuras
5.51 a 5.55, fazendo jus Eq. (4.42).
107
v h=
l 10,2 l
l
= n=
=2,04 m/s2 m/ s
5
5
5l
( n )
(5.8)
A fim de demonstrar a validade do controle sliding mode estudado na seo 4.2, foram
executadas algumas simulaes para as etapas da misso baseada no voo de Lvy.
108
Aqui, simulado um voo idntico ao considerado na subseo 5.1.1. Com o intuito de testar
o controle sliding mode, os valores dos ganhos so os seguintes. Para o controle de altitude:
4e
1,091
8=0,909
120
4=[4 e60 (7 1)](71)0,492
7=1+
(5.9)
3=5
5,9825
2n =
n0,56
5=1,56 6 =0,44
(5.10)
1=2=60
2
2n=( )(80,16460)
n=3,583
1 =3=4,583 2= 4=2,583
(5.11)
5=6=
35 35
= 1,75
l 20
(5.12)
(5.13)
109
Figura 5.59: Velocidades Horizontais e Razo de Subida. Figura 5.60: Velocidades Angulares.
110
111
Analisando a Figura 5.57 pode-se notar que o quadrirrotor foi capaz de atingir a altitude
desejada. Como no caso anterior, o pequeno deslocamento horizontal ainda presente, bem como
os valores do ngulos de Euler. De acordo tambm com o enunciado na Eq. (4.174), o valor
mximo do mdulo da razo de subida e de descida 4 m/s (Eqs. (4.178) e (4.179)). A Figura 5.61
mostra o valor da trao no quadrirrotor ao longo do tempo. Como era de se esperar, os valores da
trao seguiram o enunciado na subseo 4.2.1, no excedendo os limites. Para os instantes iniciais
dos movimentos de decolagem e de pouso:
(5.14)
estando de acordo com a Figura 5.61 .As Figuras 5.62 5.64 mostram valores esperados para os
momentos no quadrirrotor, uma vez que o objetivo o movimento vertical. As Figuras 5.65 5.68
mostram as velocidades das rotaes dos motores.
Etapas:
-Decolagem para altitude de 60m;
-Meia rotao completa em torno do eixo zB;
-Pouso.
Os ganhos so idnticos aos do caso anterior. As Figuras 5.69 a 5.80 mostram os resultados:
112
Figura 5.71: Velocidades Horizontais e Razo de Subida. Figura 5.72: Velocidades Angulares.
113
114
A Figura 5.69 mostra que o deslocamento vertical ocorreu como esperado. Em seguida, a
Figura 5.71 mostra que a exigncia de velocidade mxima tambm foi respeitada. Novamente, a
trao no quadrirrotor seguiu um perfil praticamente idntico ao do caso anterior. A Figura 5.70
mostra o valor do ngulo de guinada ao longo do tempo, onde este atinge o valor de 180, como
desejado, o que leva a Figura 5.76. Nesta, como no caso do controle backstepping, pode ser visto
um valor de pico, que corresponde ao incio do movimento de guinada:
(5.15)
Entretanto, a Figura 5.74 mostra um valor de pico um pouco menor que 0,15 Nm. As Figuras 5.75 a
5.78 mostram os valores das rotaes, que condizem com os movimentos realizados (para o erro do
valor do ngulo de guinada positivo, os motores 1 e 3 possuem picos com valores positivos e 2 e 4
com valores negativos).
Etapas:
-Decolagem para altitude de 60m;
-Rotao de 45 em torno do eixo zB;
-Deslocamento de 20m;
-Pouso.
Mesmos valores dos ganhos dos casos anteriores. As Figuras 5.81 a 5.95 mostram os resultados:
115
Figura 5.83: Velocidades Horizontais e Razo de Subida. Figura 5.84: Velocidades Angulares.
116
117
Aqui, a voo tambm atinge as etapas estipuladas. Nas Figuras 5.80 a 5.86 pode ser visto que
o controle sliding mode implementado cumpriu o objetivo estipulado. Os esforos e as rotaes dos
motores so condizentes com as etapas. O valor inicial do esforo de trao idntico aos casos
anteriores, bem como o valor do incio do movimento de decolagem. Tambm possvel observar
um valor de pico, que corresponde ao incio do movimento horizontal (devio menor valor da
componente de trao na direo vertical). Para o incio dos movimentos de arfagem e guinada:
N = I zz [( /4)2n+3 ]=I zz [0,25( / 4)+5]0,147 Nm
(5.16)
118
(5.17)
ambos prximos aos mostrados nas figuras. Novamente, o valor do mdulo das razes de subida e
descida no ultrapassam 4 m/s. O mdulo do valor do ngulo de arfagem tambm condizente com
o definido, tendo como valor mximo algo em torno de 30. Na Figura 5.92, pode ser visto que a
velocidade horizontal mxima ultrapassa o valor de 5 m/s. Tal valor no chega a atingir 5,4 m/s,
portanto, no sendo maior do que 5,56 m/s. Para a velocidade mdia, considerado que o
movimento horizontal cessa aps aproximadamente 8 s aps seu incio. Assim:
v h=
20 m
2,5 m/s
8s
(5.18)
Como dito, devido validade das equaes apenas no intervalo entre os instantes iniciais
dos movimento e os instantes das transies das superfcies de chaveamenteo, no se pode inferer o
mesmo para a velocidade mdia aqui. Entretanto, quanto maior for o instante de transio, mais
prximo o valor da velocidade mdia aqui estar do enunciado na Eq. (4.146).
Etapas:
1.Decolagem para altitude de 60m;
2.Escolha de um valor de rotao para o movimento de guinada;
3.Deslocamento na direo do eixo xB de um valor l de comprimento;;
4.Volta segunda etapa;
5.Pouso.
Novamente, os valores dos ganhos seguem com nos casos anteriores.
119
As Figuras 5.96 e 5.97 mostram o trajeto percorrido pelo quadrirrotor, bem como as Figuras
5.98 e 5.99 mostram os valores dos estados ao longo do tempo. As linhas verdes representam os
valores de referncia nas Figuras 5.98 e 5.99, enquanto que nas Figuras 5.96 e 5.97 indicam um
caminhos em linha reta entre os pontos-alvos. As figuras 5.100 e 5.101 mostram o mesmo, uma vez
que os erros tornam-se nulos com o passar do tempo para cada etapa da misso Portanto, o
quadrirrotor foi capaz de atingir todos os pontos estipulados. As Figuras 5.102 e 5.103 mostram as
velocidades de translao e as velocidades angulares. A Figura 5.102 mostram que novamente, o
valor do mdulo das razes de subida e descida no excederam 4 m/s. Pode-se notar, que para o
caso sliding mode, os valores de referncias so atingidos mais rapidamente, devido presena da
funo sinal da superfcie de chaveamento.
As Figuras 5.104 5.107 mostram os esforos associados ao movimento e as Figuras 5.108
128
5.111 mostram as rotaes dos motores. Os limites dos esforos foram respeitados, possibilitando
o movimento. O mesmo se diz para o valor de trao. As Figuras 5.105 e 5.106 mostram os valores
dos momentos de rolamento e arfagem, que fazem jus aos valores dos respectivos ngulos, na
Figura 5.99. O mesmo pode ser dito quanto ao momento de guinada. Os valores dos ngulos de
Euler seguem conforme o esperado, bem como os momentos associados a estes. Entretanto, pode-se
notar aqui valores um pouco maiores para o ngulo de rolamento do que os apresentados nos casos
anteriores (mdulo menor do que aproximadamente 1). De qualquer forma, tal comportamento no
prejudicou o cumprimento da misso, uma vez que os pontos-alvos foram atingidos. O ngulo de
interesse para o movimento horizontal, o ngulo de arfagem, no ultrapassou os limites estipulados.
Na Figura 5.112 possvel ver o valor da velocidade horizontal ao longo do tempo. Foi
observado que apenas o terceiro pico ultrapassa o valor limite, atingindo 5,63 m/s, que um valor
tolervel, enquanto que os outros valores de pico no ultrapassam 5,5 m/s. Devido presena da
funo sinal no controle, a velocidade mdia neste caso maior do que no caso do controle
backstepping. De fato, uma comparao entre os movimentos horizontais de cada controle mostra
que o controle sliding mode oferece uma velocidade maior para o quadrirrotor, o tornando mais
rpido. Para os valores dos ganhos dos movimentos de translao so observados pequenos
valores de sobressinais.
Dessa forma, o controle sliding mode se mostrou capaz de prover ao quadrirrotor um
movimento baseado no voo de Lvy.
129
130
6. Concluso
A partir dos resultados obtidos, possvel ver que ambas as tcnicas de controle se mostram
capazes de levar o quadrirrotor a executar uma misso de busca e vigilncia de uma rea baseada no
voo de Lvy. Foi possvel impliementar o voo de Lvy para uma misso de busca/vigilncia restrito
a uma certa rea, para as condies estabelecidas no Captulo 2 (dimenso da rea, cmera utilizada,
altitude de voo e expoente da funo de Lvy). Tanto a tcnica de controle backstepping quanto a
sliding mode produziram voos satisfatrios para o quadrirrotor.
Ambas satisfizeram os quesitos referentes aos esforos (conforme estipulado para os valores
dos ganhos), de forma que para os valores de referncia de altitude, ngulo de guinada,
deslocamento na direo norte e deslocamento na direo leste, o quadrirrotor gerou valores
adequados de ngulo de rolamento e arfagem (devido sua natureza de controle subatuado), de
modo a prover o movimento desejado ao quadrirrotor.
Quanto ao controle de altitude, ambos os casos se mostraram capazaes de prover ao
quadrirrotor, movimento vertical comportando-se como esperado. Nos casos do controle sliding
mode, podem ser observadas as variaes repentinas para os valores de trao, devido
caracterstica de transio da superfcie de chaveamento de controle. Outro fator observado que
para o sliding mode os valores mximos e mnimos de trao foram menores. De qualquer forma,
ambos so vlidos e cumpriram o objetivo.
Quanto ao controle do ngulo de guinada, ambos os casos se mostram satisfatrios, onde o
mdulo no ultrapassou o valor de 0,16 Nm em nenhum dos casos. Os resultados das subsees
5.1.3 e 5.2.2 mostram a eficincia do controle notriamente, uma vez que nestes casos
considerado um movimento de meia rotao (caso limite).
Os controles de rolamento e arfagem e os controles dos movimentos horizontais tambm se
131
mostraram adequados. Em nenhum dos casos de ambos os controle o mdulo do ngulo de arfagem
ultrapassou o limite imposto (|| < 45). Na verdade, o valor mais distante do valor nulo identificado
foi = 30 (subseo 5.2.3). O mesmo pode ser dito do controle de rolamento, que devido
natureza da misso. Dessa forma, o quadrirrotor consegui o xito do movimento horizontal em
ambos os casos.
Por fim, considera-se os perfis de velocidade em cada controle. Vale ressaltar aqui, que o
objetivo do trabalho no foi o controle da velocidade do quadrirrotor, e sim, o controle de posio e
de atitude, impondo limites velocidade horizontal e s razes de subida e descida. Ambos os casos
mostram-se capazes de prover um valor limite de velocidade horizontal e de razes de subida e
descida ao quadrirrotor.
Entre as duas tcnicas de controle adotadas, o sliding mode mostrou conseguir prover
movimentos mais rpidos. Entretanto, comparando as Figuras 5.40 e 5.41 com as Figuras 5.96 e
5.97, possvel perceber que o controle backstepping proveu um movimento mais prximo das
linhas de referncia entre os pontos-alvos. De qualquer forma, o objetivo no necessariamente o
seguimento de uma linha reta entre os pontos-alvos, mas sim, o alcance dos mesmos. Outra
vantagem do controle backstepping o fato deste levar o sistema dado na Eq. (5.2) a um sistema
linear. Como dito, aplicao do controle backstepping resultou em um mtodo de feedback
linearization, sendo possvel uma abordagem por controle PID. O mesmo para o controle sliding
mode, entretanto, devido presena da funo sinal tal abordagem se limita apenas a um certo
intervalo (entre o instante inicial e o instante em que a superfcie de chaveamento cruzada pela
primeira vez.
Dessa forma, conclui-se que ambas tcnicas foram capazes de levar o quadrirrotor a executar
um movimento baseado no voo de Lvy, dadas as condies a respeito dos ganhos desenvolvidas no
Captulo 4.
132
Trabalhos Futuros
Dentre as perspectivas de continuidade do estudo aqui apresentado esto:
Implementao das propostas de controle de voo no quadrirrotor Gyro200XD4;
Comparar o desempenho desses controles em termos de cumprir as trajetrias planejadas;
Avaliar eficincia nas misses de busca e vigilncia em experimentos de laboratrio.
133
134
Referncias Bibliogrficas
ADIGBLI, P. Nonlinear attitude and position control of a micro quadrotor using sliding mode and
backstepping techniques. In: 3rd US-European Competition and Workshop on Micro Air Vehicle
Systems and European Micro Air Vehicle;
AMIR, M.; ABBASS, V. Modeling of quadrotor helicopter dynamics. In: IEEE. International
Conference on Smart Manufacturing Application, 2008. ICSMA 2008. Gyeonggi-do, Korea, p.
100105, 2008;
BASRI, M. A. M.; HUSSAIN, A. R.; DANAPALASINGAM, K. A. Robust Chattering Free
Backstepping Sliding Mode Control Strategy for Autonomous Quadrotor Helicopter. International
Journal of Mechanical & Mechatronics Engineering, vol. 14, No. 03, p. 36-44, jun. 2014;
BOUADI, H.; CUNHA, S. S.; DROUIN, A.; MORA-CAMINO, F. Adaptive sliding mode control
for quadrotor attitude stabilization and altitude tracking. Computational Intelligence and
Informatics (CINTI), 2011 IEEE 12th International Symposium on, p. 449 455, 21-22 nov., 2011;
BOUABDALLAH, S. Design and Control of Quadrotors with Application to Autonomous Flying.
2007. 154. Tese (Docteur s Sciences) - cole Polytechnique Fdrale de Lausanne, Facult des
Sciences et Techniques de L'Ingnieur, Lausanne, 23 de fevereiro de 2007;
BOUCHOUCHA, M.; SEGHOUR, S.; OSMANI, H.; BOURI, M. Integral Backstepping for
Attitude Tracking of a Quadrotor System. Elektronika ir Elektrotechnika, vol. 116, No. 10, p. 75-80,
2011;
BOYER, D.; RAMOS-FERNNDEZ, G.; MIRAMONTES, O.; MATEOS, J. L.; COCHO, G.;
LARRALDE, H.; RAMOS, H.; ROJAS, F. Scale-free foraging by primates emerges from their
135
interaction with a complex environment. Proceedings of the Royal Society B, vol. 273, p. 17431750, jul., 2006;
BROWN, R. A brief account of microscopical observations made in the months of June, July and
August, 1827, on the particles contained in the pollen of plants; and on the general existence of
active molecules in organic and inorganic bodies. Philosophical Magazine, 4, p. 161, 1828;
BROWN, C. T.; LIEBOVITCH, L. S.; GLENDON, R. Lvy flights in Dobe Ju/hoansi foraging
patterns. Human Ecol. 35, p. 129-138, 2007;
BUNIMOVICH, L. A. Deterministic walks in random environments. Physica D, 187, p. 2029,
jan., 2004;
CHAVES, A. N. Proposta de Modelo de Veculos Areos no Tripulados (VANT) Cooperativos
Aplicados Misses de Busca. 2013. 149 f. Dissertao (Mestrado em Cincias). Escola Politcnica
da Universidade de So Paulo, So Paulo. 2013;
COLOMINA, I; MOLINA, P. Unmanned aerial systems for photogrammetry and remote sensing:
A review. ISPRS Journal of Photogrammetry and Remote Sensing, 92, p. 7997, 2014;
COSTA, G. S. Utilizao da Verificao de Modelos Para o Planejamento de Misses de Veculos
Areos no Tripulados. 2008. 104 f. Dissertao (Mestrado em Engenharia Eltrica) - Instituto
Militar de Engenharia, Rio de Janeiro. 2008;
DA LUZ, M. G. E; BULDYREV, S. V.; HAVLIN, S.; RAPOSO, E. P.; STANLEY, H. E.;
VISWANATHAN, G. M. Improvements in the statistical approach to random Lvy flight searches.
Physica A, vol. 295, p. 89-92, jun., 2001;
DAS, A.; LEWIS, F.; SUBBARAO, K. Backstepping Approach for Controlling a Quadrotor Using
136
Lagrange Form Dynamics. Journal of Intelligent and Robotic Systems vol. 56, p. 127151, abr.,
2009;
DAS, A.; LEWIS, F.; SUBBARAO, K. Sliding Mode Approach to Control Quadrotor Using
Dynamic Inversion. Challenges and Paradigms in Applied Robust Control, Cap. 1, nov., 2011;
DECARLO, R.A.; ZAK, S.H.; MATTHEWS, G.P. Variable structure control of nonlinear
multivariable systems: a tutorial. Proceedings of IEEE 76, p. 212-232. 1988;
EINSTEIN, A. Investigations on the Theory .of the Brownian Movement Ann.Phys. 17, 549, 1905;
EXRCITO DOS E.UA. Eyes of the Army-U.S. Army Roadmap for Unmanned Aircraft
Systems 2010-2034. Fort Trucker, Alabama. U.S. Army UAS Center of Excellence. 2009;
FAY, G. Derivation of the Aerodynamic Forces for the Mesicopter Simulation. Stanford University,
February 14, 2001. http://adg.stanford.edu/mesicopter/progressreports/mesicopteraeromodel.pdf.;
GARRIDO, R. O. Aplicao de Sntese de Supervisores de Sistemas Hbridos ao Planejamento de
Misses de Veculos Areos no Tripulados. 2009. 106 f. Dissertao (Mestrado em Engenharia
Eltrica) - Instituto Militar de Engenharia, Rio de Janeiro. 2001;
GENTLE, J.E. Random Number Generation and Monte Carlo Methods. New York, SpringerVerlag, p. 398, 1998;
GYROFLY INNOVATIONS, G. GYRO-200ED-X4 MANUAL DO USURIO, 2014;
HOFFMANN, G. et al. Quadrotor helicopter ight dynamics and control: Theory and experiment.
In: AIAA (Ed.). AIAA Guidance, Navigation and Control Conference and Exhibit. Hilton Head,
South Carolina: [s.n.], 2007;
137
Mobile Robots with CHAOS. ABCM Symposium Series in Mechatronics, vol. 1, p. 40-46, 2004;
MELLINGER D., MICHAEL, N., KUMAR, V. Trajectory generation and control for precise
aggressive maneuvers. The International Journal of Robotics Research, p. 11, 2010;
MEIROVITCH, L. Methods of Analytical Dynamics. New York, Mc Graw Hill, p. 540, 1970;
MIAN, A. A.; DAOBO, W. Modeling and Backstepping-based Nonlinear Control Strategy for a 6
DOF Quadrotor Helicopter. Chinese Journal of Aeronautics, vol. 21, p. 261-268, 2008;
MINISTRIO DA DEFESA COMANDO DA AERONUTICA. Manual de Busca e
Salvamento-SAR, 2012;
NOLAN, J. P. Stable Distributions - Models for Heavy Tailed Data, Birkhuser, Boston, 34 p.,
2010;
NURZAMAN, S. G. et al. Yuragi-Based Adaptive Searching Behavior in Mobile Robot: From
Bacterial Chemotaxis to Levy Walk. International Conference on Robotics and Biomimetics,
Bangkok, Tailndia, 2009;
NURZAMAN, S. G. et al. Biologically Inspired Adaptive Mobile Robot Search With and Without
Gradient Sensing. IEEE/RSJ International Conference on Intelligent Robots and Systems, St. Louis,
E.U.A., 2010;
ZDEMR, S. Multi Objective Conceptual Design Optimazation of an Agricultural Aerial Robot
(AAR). 2004. 205 f. Dissertao (Mestrado em Engenharia Aeroespacial) Middle East Technical
University, Department of Aerospace Engineering. 2005;
PATEL, A. R.; PATEL, M. A.; VYAS, D. R. Modeling and Analysis of Quadrotor using Sliding
Mode Control. 44th IEEE Southeastern Symposium on System Theory, University of North Florida,
139
140
motors. Journal of Intelligent and Robotic Systems, v. 61, n. 1-4, p. 85-101, 2011;
SHUSTER, M. D. A Survey of Attitude Representations. The Journal of the Astronautical Sciences,
Vol 41, No. 4, pp. 439-517, 1993;
SIEGWART, R.; NOURBAKHSH, I. R.; Introduction to Autonomous Mobile Robots.
Massachusetts Institute of Technology, R. MIT Press, Cambridge, Mass, USA, p. 336, 2004;
SILVA, A. L. 2012. Voo Autnomo de Veculo Areo No Tripulado Tipo Quadrirrotor. 2012. 71.
Relatrio Final de Ps Doutorado Universidade de So Paulo. Apresentado em 13 de julho de
2012 ao Departamento de Telecomunicaes e Controle;
SMOLUCHOWSKI, M. Drei Vortrge ber Diffusion, Brownsche Molekularbewegung und
Koagulation von Kolloidteilchen. Physik. Zeit, 17, pp. 557-571, p. 585-599, 1916;
STEVANOVIC, S.; KASAC, J.; STEPANIC, J. Robust Tracking Control of a Quadrotor
Helicopter Without Velocity Measurement. Annals of DAAAM for 2012 & Proceedings of the 23rd
International DAAAM Symposium, vol. 23, No.1, p. 595-600, 2012;
STEVENS, B. L.; LEWIS, F. L. Aircraft Control and Simulation. 2nd. ed. [S.l.]: John Wiley &
Sons, Inc., 2003;
SUTANTYO, D. et al. Collective-Adaptive Lvy Flight for Underwater Multi-Robot Exploration.
IEEE International Conference on Mechatronics and Automation (ICMA), p. 456-462, 2013;
SWARUP, A.; SUDHIR. Comparison of Quadrotor Performance Using Backstepping and Sliding
Mode Control. Proceedings of the 2014 International Conference on Circuits, Systems and Control,
Interlaken, Sua, 22-24 fev., 2014;
UTKIN, V. I. Variable structure systems with sliding modes. IEEE Transactions of Automatic
141
142
of Mobile Robot Based on Double-Scroll Chaotic Circuits, WSEAS Trans. Syst., Vol. 11(9), p. 479
488, 2012;
WEISS, G. H. Aspects and Applications of the Random Walk. North Holland, Amsterdam, 378 p.,
1994;
XU, R.; ZGNER, . Sliding Mode Control of a Quadrotor Helicopter. Proceedings of the 45th
IEEE Conference on Decision & Control, Manchester Grand Hyatt Hotel, San Diego, CA, E.U.A.,
13-15 dez., 2006;
ZAZZERA, F. B. Spacecraft Attitude Dynamics and Control. Course Notes. Politecnico di Milano,
2012.
143
Apndice A
Controle Backstepping Clculo dos Ganhos
144
Para decolagem:
2 n t
ref
( n t1) }
(A.1)
No instante inicial:
ref
4k f max m { g[ x 7 x 7(0)]n }
(A.2)
O termo entre colchetes representa o salto do quadrirrotor naquele movimento. Uma vez que, pelo
sistema de referncia considerado neste trabalho, o eixo e D aponta no sentindo do centro da Terra, a
altitude de referncia ter valores negativos. Para uma altitude de 60m:
(A.3)
(A.4)
4k f max2
1
(
g ) 2n
m
60
(A.5)
0,3222n
(A.6)
0,322( 71)
(A.7)
145
71,567
(A.8)
No instante t = 2/n:
2 2
(A.9)
0m(g 60 n e )
ge
n
60
2
( 71) 2
(A.10)
g e2
60
(A.11)
72,099
(A.12)
Para a aterrissagem:
ref
0m { g[ x 7 x7 ( 0)] n }
(A.13)
0m { g[0(60)] n }
0m(g 60 n )
n 2
g
60
(A.14)
(A.15)
(A.16)
146
( 71) 2
g
60
(A.17)
71,404
(A.18)
(A.19)
4k f max2
e2
(
g ) 2n
m
60
(A.20)
4k f max2
e2
(
g ) ( 71)2
m
60
(A.21)
72,542
(A.22)
No instante t = 2/n:
3 t
T =m[ x ref
(2n t)
7 x7 ( 0)] n e
n
(A.23)
2
t=
(A.24)
Para o movimento vertical, um outro fator ainda considerado para o clculo do conjunto
147
7[ x7ref x 7 (0)] n2 t e t
(4.25)
7[600]n 2 t e t
(4.26)
O valor mnimo se deve ao sistema de referncias adotado. Assim, e o valor mnimo ocorrer em t =
1/n:
760 n e
(4.27)
760 n e1
(4.28)
7e
n
60
(4.29)
7e
71
60
(4.30)
60+7 e
7
60
(4.31)
71,317
(4.32)
Portanto:
148
1<7 1,317
1<80,683
(4.33)
4[0(60)] n2 t e t
n
4( 0+60) n e
(4.34)
(4.35)
4e
n
60
(4.36)
4e
71
60
(4.37)
1,181 7
(4.38)
1< 71,181
1<80,819
(4.39)
e assim:
2 n t
4k m (mx0 )I zz [ n e
(1n t)]
(A.40)
149
4k m (mx0 )I zz n
4k m
(mx 0)
n2
I zz
(A.41)
(A.42)
( 0)
4k m mx
( 51)2
I zz
(A.43)
5 2,936
(A.44)
km
I zz [ n2 e t (1n t)]
kf
(A.45)
km
I zz [ n2 e2 (1)]
kf
(A.46)
km
I zz n 2 e 2
kf
(A.47)
k m e2
n2
k f I zz
(A.48)
k m e2
(51)2
k f I zz
(A.49)
No instante t = 2/n:
mg
mg
mg
mg
150
5 4,751
(A.50)
4k m (2mx20 )I zz [ n2 e t (1 n t )]
(A.36)
4k m (2mx20 )I zz [ n2 e2 (1)]
(A.37)
No instante t = 2/n:
2 2
4k m (mx0 )I zz n e
4k m (2mx20 )
4k m (2mx20 )
n2
(A.54)
( 51)2
(A.55)
I zz
I zz
(A.53)
5 6,262
(A.56)
mg
km
I zz [ n2 e t (1 n t )]
kf
n
(A.42)
151
mg
km
I zz n 2
kf
(A.57)
mg k m
n2
I zz k f
(A.58)
mg k m
(51)2
I zz k f
(A.59)
5 2,382
(A.60)
Como pode ser visto, a ultima condio a mais restritiva, implicando na Eq. (4.92). As
Eqs. 4.(86) e (4.87) implicaram em condies menos restritivas, uma vez que estas inferem sobre
uma possvel mudana de sinal no instante no qual a derivada do momento N nula. Isto anlogo
ao caso do controle de altitude (Eqs. (4.64) e (4.66)).
ref
2 n t
2k f l (max 0 ) I yy [( x 3 x3 ( 0))n e
(1n t)]
(A.61)
(A.62)
4k f l (2max20 )
n2
I yy
(A.63)
152
11,0223
(A.64)
2k f l 0I yy [( ( )) n e
4
4
2
2 n t
(1n t)]
(A.65)
No instante t = 2/n:
mgl
I yy [( ) n 2 e2 ]
2
2
2n
(A.66)
4 k f l 20 e 2
I yy
(A.67)
320,42
(A.68)
2 t
2k f l (2max 02)I yy [( ( )) n e (1n t)]
4
4
n
(A.69)
No instante t = 2/n:
2 k f l (max 0 ) I yy [( ) n e ]
2
2
4k fl
2 2
(2max20 ) 2
e n2
I yy
(A.70)
(A.71)
153
328,241
(A.72)
2k f l 20 I yy [( ( )) n2 e t (1 n t )]
4
4
(A.73)
2k f l 20 I yy [( )n2 ]
2
(A.74)
4k f l 20
n2
I yy
(A.75)
38,153
(A.76)
No instante inicial:
Este ultimo valor mostra-se como o mais restritivo, levando ao resultado dado pela Eq.
(4.107).
Comparando as Eqs. (4.134) e. (4.145), a segunda ser menor do que a primeira quando:
5,21 v h 5,56 e
l
l
(A.77)
154
v h
5,56 e
2,9 m/ s
5,21
(A.78)
Entretanto, para a Eq. (4.127), o que ocorre um pouco diferente. Devido radiciao da Eq.
(4.127) o que ocorre o seguinte:
5,21 v h
2
g
l
2l
(A.79)
2
(5,21 v h )2gl
2
(A.80)
v h0,505 l
(A.81)
2,631
l
(A.82)
v h=1,96 m/ s
(A.83)
O que leva a um valor de velocidade horizontal mdia que satisfaz ambas as condies. Assim:
n =
10,2
l
(A.84)
155
Apndice B
A Plataforma Gyro-200ED-X4
156
157
1200 g
500 g;
7 m/s
4 m/s
90/segundo
500 m
Raio de operao
500 m
Autonomia
25 km/h
A Figura B.3 mostra a unidade inercial de orientao. utilizada uma unidade de medio
inercial (do ingls, Inertial Measuring Unit) com mdulo de orientao AHRS (Attitude and
Heading Reference System). Possui um acelermetro e um giroscpio de trs eixos e de tecnologia
MEMS. disposto de modo a corresponder com o sistema coordenadas usual em aplicaes com
aeronaves tripuladas. A Figura B.4 mostra seu sistema de coordenadas:
A plataforma possui um barmetro de tecnologia MEMS. Sua presso de 2.5 mbar, o que
corresponde aproximadamente a 2.5 cm. O vento, ou, o escoamento de ar das hlices, afetam o
resultado de altitude. Devido ao Efeito Solo praticamente invivel a utilizao do sensor
baromtrico na decolagem. Entretanto, a principal referncia de atitude de voo.
160
ndice
tem
Motores brushless
161
Baterias de Li-Po
Antena GPS
B.6. Motorizao
O motor utilizado do tipo brushless, e tratado da mesma forma que em (DA SILVA,
2012; SANCHEZ et al., 2011; ADIGBLI, 2007). A Figura B.7 mostra o modelo de um motor
genrico de corrente contnua:
Figura B.7: Modelo clssico de motor de corrente contnua, com hlice acoplada. Extrado de
(ADIGBLI, 2007).
Denotando:
Ve como sendo a tenso contnua na entrada do motor;
Ia a corrente de armadura;
R a resistncia de armadura;
Lm a indutncia do motor, desprezvel;
162
V e = I a R+k e
(B.1)
em que ke a fora eletromotriz induzida resultante da rotao do rotor. E da parte mecnica por:
k T I a =J +k
M
(B.2)
kT V e ke kT
k
M 2
JR
JR
J
(B.3)
163
Figura B.8: Motor trifsico com inversor constitudo por mosfets. Extrado de (SANCHEZ et al.,
2011)
u i2c= f (ss )
(B.4)
ss=g ( ui2c )
(B.5)
=0
(B.6)
Portanto:
164
V e =k e ss +
kM R 2
ss
kT
(B.7)
Testes envolvendo o motor e o modelo em questo, apresentados em (DA SILVA, 2012), mostram a
(3.46) que relaciona ss e ui2c:
SS =k 2 ui2c +k 1 ui2c+k 0
(B.8)
165
166
167
168
A Figura C.1 mostra o Diagrama de Blocos do Modelo de Simulao. Este composto dos
Blocos Fligth_Control, Motors_with_Control e Quadrorotor_Dynamics. O primeiro,
implementa as leis de controle consideradas no trabalho, a partir dos valores de referncia. Dentro
deste bloco, so implementados os controles de translao e o controle de atitude, de forma que os
valores de referncia dos ngulos de rolamento e arfagem so dados pelo controle de posio. A
partir das leis de controle, so originados os esforos (a trao T e os momentos L, M e N), que por
sua vez, determinam os valores das referncias das velocidades de rotao de cada motor (Eq.
(4.42)). Tal bloco corresponde aos blocos Controle de Translao e Controle de Atitude da
Figura 4.1.
O bloco Motors_with_Control corresponde ao bloco Controle do Motor, da mesma
figura. Este bloco representa o controle de velocidade de rotao e a dinmica dos motores
brushless da plataforma em questo. O controlador de velocidade tem como sada um sinal discreto
segundo o Protocolo I2C (Eqs. (B.4) e (B.5)), que possui um valor mximo igual a 1023 (2 10 1).
Este valor corresponde ao valor de tenso de entrada mdio do motor, levando a velocidade
desejada (Eqs. (B.7) e (B.8)).
A partir dos valores de rotao oriundos deste bloco, o bloco Quadrotor_Dynamics
representa a dinmica do quadrirrotor (Eqs. (3.3), (3.4), (3.6), (3.10), (3.14)), dando origem ao
movimento.
Por meio do filtro de Kalman desenvolvido em (DA SILVA, 2012) os valores dos
deslocamentos nas direes x e y, o valor de altitude e dos ngulos de Euler so estimados, e os
valores das velocidades angulares p,q e r so medidas pelos giroscpios.
169
A Figura C.2 mostra o bloco Fligth_Control. Tal bloco composto pelos blocos
Translation_Control (que implementa os controles de altitude e de deslocamento norte e leste),
Attitude_Control (que implementa os controles dos ngulos de Euler) e pelo bloco
Forces_and_Moments
(que
representa
Eq.
(4.42)).
ultimo
bloco
171
172
C.4.
Analogamente
entrada
Pos_Hold_Flag,
entrada
Alt_Cont_Flag
habilita/desabilita o controle de altitude. Caso Alt_Cont_Flag faa com que a sada do bloco
Alt_Control_Off seja selecionada, ao invs da sada de Alt_Control_On, o valor de T_N ser
igual ao valor da fora peso do quadrirrotor. Caso o contrrio, a trao dada pela sada de
Alt_Control_On. Dentro deste bloco, encontrado o esquema dado pela Figura C.5
173
174
175
177
179
180
Figura C.14: Tomada dos valores dos quadrados das rotaes dos motores por meio dos esforos.
As Figuras C.15 a C.19 detalham o modelo dos motores brushless da plataforma. A Figura
C.15 mostra o diagrama correspondente a cada um dos quatro motores, tendo como sinal de entrada
o valor de referncia da velocidade de rotao, e como sada, a velocidade de rotao em si. Os
quatro blocos so idnticos, uma vez que os motores tambm so.
A Figura C.16 mostra o modelo em si: o controlador discreto de velocidade
(Speed_Control, Figura C.17), o carter discreto e limitado do sinal dado pelo Protocolo I2C
(I2C_discretization, Figura C.18) e a Dinmica dos Motores (BLDCM).
181
Figura C.16: Modelo Dinmico dos Motores (esta indicado que a figura faz referncia ao motor 1,
entretanto, todos os motores so indnticos).
182
183
Uma vez que o valor de ui2c tomado, a velocidade de rotao dada, conforme as Eqs.
(B.3), (B.7) e (B.8).
Por fim, o bloco Quadrotor_Dynamics composto pelo esquema da Figura C.21, onde o
bloco Forces_and_Moments dado pela Figura C.20:
Figura C.20: Tomada dos valores dos esforos por meio dos valores das rotaes dos motores.
Aqui, feito o inverso do que ocorre na bloco Forces_and_Moments do bloco
Fligth_Control: os valores dos esforos so calculados por meio dos valores de rotao dos
motores. Eem outras palavras, este bloco representa a equao matricial inversa da Eq. (4.42) (onde
os valores de velocidade em questo no so os valores de referncia, mas sim, os valores reais).
Por fim, o movimento do quadrirrotor executado, tendo os valores dos esforos.
184
185