Professional Documents
Culture Documents
MODELAGEM, IDENTIFICAC
AO
HELICOPTERO
EM ESCALA REDUZIDA
PARA A OBTENC
AO
EM ENGENHA
RIA ELETRICA.
Aprovada por:
ii
iii
Aos colegas Ccero Ricardo Maximo Bezerra, Filippe Simoes Hallack e Alessandro
Jacoud Peixoto pelas suas contribuicoes ao sucesso deste trabalho.
iv
E CONTROLE DE ALTITUDE DE UM
MODELAGEM, IDENTIFICAC
AO
HELICOPTERO
EM ESCALA REDUZIDA
Abril/2005
Orientador : Ramon Romankevicius Costa
Programa
: Engenharia Eletrica
Este trabalho aborda a modelagem, identificacao e controle de altitude de um helicoptero em escala reduzida. A partir do modelo analtico simplificado da dinamica
do helicoptero, foi obtido um modelo de identificacao linearizado de ordem 11 na
condicao de voo pairado. Deste modelo linearizado completo da aeronave, foi enfocada a dinamica vertical com a finalidade de se identificar suas derivadas de estabilidade para, posteriormente, projetar-se um controlador que regule a altitude em um
valor desejado. Para a identificacao dessas derivadas, foi desenvolvido um conjunto
eletronico, composto de um sensor ultra-sonico de altitude e um computador embarcado, o qual possibilitou a aquisicao dos dados de voo. A precisao das derivadas
identificadas foi verificada pela comparacao entre os valores teoricos e os obtidos na
identificacao. Em seguida, essas derivadas foram utilizadas para o projeto de um
controlador PD para a regulacao da altitude. A robustez do controlador, em relacao
`as incertezas parametricas e ao rudo de medida de altitude, foi verificada atraves
de simulacoes em ambiente Matlab/Simulink. O algoritmo do controlador foi implementado no mesmo computador embarcado utilizado na identificacao parametrica.
Com a finalidade de se diminuir os riscos de acidentes, foi desenvolvido um circuito
comutador, independente do computador embarcado, cuja funcao e chavear o controle de altitude da aeronave entre um piloto humano e o controlador PD embarcado.
O controlador desenvolvido foi capaz de regular a altitude em um valor desejado e
rastrear os comandos de altitude enviados por radio-controle por um piloto humano.
Abstract of the Thesis presented to COPPE/UFRJ as partial fulfillment of the requirements for the degree of Master of Science (M.Sc.)
April/2005
Advisor
vi
Conte
udo
1 Introduc
ao
1.1
Motivacao . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
1.2
Objetivos . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
1.3
Metodos de Modelagem
. . . . . . . . . . . . . . . . . . . . . . . . .
1.3.1
1.3.2
Simulacao/Validacao . . . . . . . . . . . . . . . . . . . . . . .
1.3.3
1.4
2 Modelagem da Din
amica
2.1
Introducao . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
2.2
2.3
2.4
2.5
2.6
2.5.1
Construcao Mecanica . . . . . . . . . . . . . . . . . . . . . . . 19
2.5.2
Aerodinamica do Rotor . . . . . . . . . . . . . . . . . . . . . . 26
2.5.3
Empuxo . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 38
2.6.2
2.6.3
2.6.4
2.7
Torque em Guinada . . . . . . . . . . . . . . . . . . . . . . . . 41
3 Identifica
c
ao
48
3.1
Introducao . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 48
3.2
Identificacao Parametrica . . . . . . . . . . . . . . . . . . . . . . . . . 48
3.3
Fundamentacao Teorica
3.4
. . . . . . . . . . . . . . . . . . . . . . . . . 50
3.3.1
Aquisicao de Dados . . . . . . . . . . . . . . . . . . . . . . . . 50
3.3.2
Modelo de Identificacao . . . . . . . . . . . . . . . . . . . . . 51
3.3.3
Discretizacao . . . . . . . . . . . . . . . . . . . . . . . . . . . 55
3.4.2
3.4.3
3.4.4
3.4.5
Validacao do Modelo . . . . . . . . . . . . . . . . . . . . . . . 57
4 Projeto do controlador
59
4.1
Introducao . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 59
4.2
Projeto do Controlador . . . . . . . . . . . . . . . . . . . . . . . . . . 60
4.2.1
Controlador PID . . . . . . . . . . . . . . . . . . . . . . . . . 60
4.2.2
4.2.3
Requisitos do Controlador . . . . . . . . . . . . . . . . . . . . 62
4.3
4.4
Discretizacao do Controlador . . . . . . . . . . . . . . . . . . . . . . . 70
4.5
Simulacao do Controlador . . . . . . . . . . . . . . . . . . . . . . . . 72
4.6
4.7
viii
5 Descric
ao do Conjunto Eletr
onico
87
5.1
Introducao . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 87
5.2
Eletronica de Terra . . . . . . . . . . . . . . . . . . . . . . . . . . . . 87
5.3
Eletronica Embarcada . . . . . . . . . . . . . . . . . . . . . . . . . . 88
5.3.1
Sonar-Altmetro . . . . . . . . . . . . . . . . . . . . . . . . . . 89
5.3.2
Computador de Bordo . . . . . . . . . . . . . . . . . . . . . . 89
5.3.3
5.3.4
Montagem . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 95
6 Conclus
oes
96
6.1
Introducao . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 96
6.2
Modelagem . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 96
6.3
Identificacao . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 97
6.4
Projeto do Controlador . . . . . . . . . . . . . . . . . . . . . . . . . . 97
6.5
Observacoes . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 98
6.6
Pontos a Desenvolver . . . . . . . . . . . . . . . . . . . . . . . . . . . 99
ix
Lista de Smbolos
a . . . . . . . . . . Inclinacao da curva de sustentacao
a0 . . . . . . . . . Angulo
de cone da pa do rotor principal
a . . . . . . . . . . Angulo
de batimento longitudinal
b . . . . . . . . . . Angulo
de batimento lateral
a . . . . . . . . . . Vetor de estado do Plano de Rotacao (TPP)
x . . . . . . . . . . Eixo longitudinal do sistema de referencia do corpo do helicoptero,
positivo `a frente
y . . . . . . . . . . Eixo lateral do sistema de referencia do corpo do helicoptero, positivo
`a direita do piloto
z . . . . . . . . . . Eixo vertical do sistema de referencia do corpo do helicoptero, positivo
para baixo
X . . . . . . . . . Forca externa que atua na direcao do eixo x
Y . . . . . . . . . . Forca externa que atua na direcao do eixo y
Z . . . . . . . . . . Forca externa que atua na direcao do eixo z
L . . . . . . . . . . Torque externo que atua na direcao do eixo x
M . . . . . . . . . Torque externo que atua na direcao do eixo y
N . . . . . . . . . Torque externo que atua na direcao do eixo z
u . . . . . . . . . . Velocidade linear na direcao do eixo x
v . . . . . . . . . . Velocidade linear na direcao do eixo y
w . . . . . . . . . . Velocidade linear na direcao do eixo z
p . . . . . . . . . . Velocidade angular na direcao do eixo x
q . . . . . . . . . . Velocidade angular na direcao do eixo y
r . . . . . . . . . . Velocidade angular na direcao do eixo z
b . . . . . . . . . Vetor velocidade angular da aeronave no sistema de coordenadas do
corpo
. . . . . . . . . . Angulo
de Euler relativo ao eixo x
. . . . . . . . . . Angulo
de Euler relativo ao eixo y
. . . . . . . . . . Angulo
de Euler relativo ao eixo z
x . . . . . . . . . . Vetor de estado da aeronave
() . . . . . . Angulo
de passo da pa do rotor principal
()f ly . . . . Angulo
de passo da pa do rotor da barra estabilizadora
0 . . . . . . . . . Angulo
de passo medio da pa do rotor principal
ucol . . . . . . . . Entrada de comando de coletivo
ulon . . . . . . . . Entrada de comando cclico-longitudinal
ulat . . . . . . . . Entrada de comando cclico-lateral
uped . . . . . . . . Entrada de comando de guinada (pedal)
col . . . . . . . . Perturbacao da entrada de comando de coletivo
lon . . . . . . . . Perturbacao da entrada de comando cclico-longitudinal
lat . . . . . . . . Perturbacao da entrada de comando cclico-lateral
ped . . . . . . . . Perturbacao da entrada de comando de guinada (pedal)
Xu . . . . . . . . Derivada parcial da forca longitudinal em relacao a u
Xa . . . . . . . . . Derivada parcial da forca longitudinal em relacao a a
Yv . . . . . . . . . Derivada parcial da forca lateral em relacao a v
Yb . . . . . . . . . Derivada parcial da forca lateral em relacao a b
Zu . . . . . . . . . Derivada parcial da forca vertical em relacao a a
Zw . . . . . . . . . Derivada parcial da forca vertical em relacao a w, amortecimento
vertical
Zcol . . . . . . . . Sensibilidade da entrada de coletivo
xi
. . . . . . . . . . Angulo
de azimute da pa do rotor principal
() . . . . . . Angulo
de batimento da pa do rotor principal
()f ly . . . . Angulo
de batimento da pa do rotor da barra estabilizadora
k . . . . . . . . . Constante da mola equivalente de batimento do rotor principal
. . . . . . . . . . Lock number, razao entre as forcas aerodinamicas e inerciais do rotor
principal
I . . . . . . . . . Momento de inercia da pa do rotor principal em relacao `a dobradica
de batimento
mr . . . . . . . . Constante de tempo do rotor principal
f ly . . . . . . . . Constante de tempo do rotor da barra estabilizadora
1cf ly . . . . . . Componente cossenoidal do angulo de batimento da barra estabilizadora, idem a d
d . . . . . . . . . . Componente cossenoidal do angulo de batimento da barra estabilizadora
1sf ly . . . . . . Componente senoidal do angulo de batimento da barra estabilizadora,
idem a c
c . . . . . . . . . . Componente senoidal do angulo de batimento da barra estabilizadora
Rmr . . . . . . . Raio do rotor principal
. . . . . . . . . . Velocidade angular do rotor principal
Alon . . . . . . . Ganho regime permanente da entrada cclica lon
Blat . . . . . . . Ganho em regime permanente da entrada cclica lat
C1 . . . . . . . . . Coeficiente cossenoidal do angulo de passo das pas da barra estabilizadora
xii
A . . . . . . . . . . Area
do disco do rotor principal
CT . . . . . . . . Coeficiente de empuxo
ipairado . . . . Fluxo de ar para voo pairado
hmr . . . . . . . . Distancia do cubo do rotor principal ao centro de gravidade da aeronave
CQ . . . . . . . . Coeficiente de torque de guinada
0 . . . . . . . . . Componente uniforme do fluxo de ar no rotor
. . . . . . . . . . Razao de solidez do rotor
cd0 . . . . . . . . . Coeficiente de arrasto aerodinamico de um aerofolio com angulo de
ataque igual a zero
Qmr . . . . . . . Torque do rotor principal
. . . . . . . . . . Densidade do ar
g . . . . . . . . . . Aceleracao da gravidade
. . . . . . . . . Constante de tempo de acomodacao do fluxo de ar no rotor
U . . . . . . . . . . Resultante da velocidade do ar em relacao `as pas do rotor
UT . . . . . . . . . Componente tangente ao plano de impulsao da velocidade do ar em
relacao `as pas do rotor
xiii
. . . . . . . . . . Angulo
medido entre a velocidade resultante U e o plano de impulsao
. . . . . . . . . . Angulo
de ataque, medido entre a corda da pa e a velocidade resultante
U
c . . . . . . . . . . Corda da pa
b . . . . . . . . . . Comprimento da pa
cl . . . . . . . . . . Coeficiente de sustentacao
cd . . . . . . . . . Coeficiente de arrasto
L . . . . . . . . . . Forca de sustentacao de uma secao elementar da pa
D . . . . . . . . . Forca de arrasto de uma secao elementar da pa
Tmr . . . . . . . . Empuxo do rotor principal
Q . . . . . . . . . . Torque do rotor
P . . . . . . . . . . Potencia do rotor
N . . . . . . . . . N
umero de pas do rotor
AR . . . . . . . . Razao de aspecto de um aerofolio
Fz . . . . . . . . . Forcas aerodinamicas elementar normal ao plano de impulsao
Fx . . . . . . . . . Forcas aerodinamicas elementar paralela ao plano de impulsao
CT . . . . . . . . Coeficiente de empuxo
CP . . . . . . . . Coeficiente de potencia
CQ . . . . . . . . Coeficiente de torque
V . . . . . . . . . . Velocidade de subida
. . . . . . . . . . Razao de solidez do rotor
Tx . . . . . . . . . Componente do empuxo na direcao do eixo x
Ty . . . . . . . . . Componente do empuxo na direcao do eixo y
Tz . . . . . . . . . Componente do empuxo na direcao do eixo z
e(k) . . . . . . . Rudo branco discreto
y(k) . . . . . . . Sada do modelo discreto de identificacao no instante k
y(k na ) . . Sada do modelo discreto de identificacao atrasada de na unidades de
tempo discreto
xiv
Lista de Acr
onimos
P D . . . . . . . . Proporcional e Derivativo
P ID . . . . . . Proporcional, Integral e Derivativo
V AN T . . . . Veculo Aereo Nao-Tripulado
GP S . . . . . . Global Positioning System
IM U . . . . . . Inertial Measurement Unit
CIF ER . . . Comprehensive Identification from FrEquency Responses
N ASA . . . . National Aeronautics and Space Administration
DGP S . . . . Differential Global Positioning System
M IT . . . . . . Massachusetts Institute of Technology
OF E . . . . . . Operational Flight Envelope
SEF . . . . . . Safe Envelope Flight
T P P . . . . . . Tip Path Plane (plano de rotacao do rotor principal
ARX . . . . . . AutoRegressive with eXtra input
ARM AX . . AutoRegressive Moving Average with eXtra input
EEP ROM Memoria Programavel Somente de Leitura Apagavel Eletricamente
SISO . . . . . Single Input Single Output
ZOH . . . . . . Zero Order Holder
RISC . . . . . Reduced Instruction Set Computer)
T X . . . . . . . . Transmissor
RX . . . . . . . . Receptor
xvi
xvii
Captulo 1
Introdu
c
ao
O principal objetivo deste trabalho foi realizar o controle de altitude de um helicoptero em escala reduzida. Tendo-se em vista as caractersticas dinamicas do
sistema a ser controlado, este objetivo e na verdade um desafio. Um erro na implementacao do controlador ou uma falha nos procedimentos dos teste de voo poderia
facilmente destruir o helicoptero. Assim, para assegurar o sucesso do projeto, a
seguinte metodologia foi cuidadosamente aplicada.
Inicialmente foi desenvolvido um modelo dinamico nao-linear de baixa ordem
(contendo apenas 11 estados) para helicopteros em escala reduzida, partindo-se das
equacoes de Newton-Euler para corpos rgidos. O modelo nao-linear foi linearizado
em voo pairado. Para validar parte do modelo linearizado, um helicoptero miniatura RAPTOR-30 foi equipado com um conjunto de avionica digital capaz de fazer
aquisicao de dados em voo e armazena-los para posterior processamento.
A aeronave foi testada em voo pairado e em algumas seq
uencias de manobras
em torno deste ponto de operacao, e o conjunto aeronave-avionica demonstrou ser
adequado `a identificacao da dinamica vertical em voo pairado. Baseado nestes resultados, foram obtidos os parametros do modelo linear simplificado desta dinamica.
Posteriormente, este modelo linear foi utilizado no desenvolvimento de um controlador PD capaz de controlar a altitude da aeronave. O controlador assim projetado
foi exaustivamente simulado antes de se realizar os voos experimentais em malha
fechada.
Utilizando-se um conjunto adequado de sensores, e aplicando-se os mesmos metodos
aqui utilizados para a identificacao e validacao da dinamica vertical, e possvel obterse um modelo completo do RAPTOR-30, como ja realizado por (Mettler 2003) e
(Gavrilets, Mettler & Feron 2001). Esta aeronave, uma vez identificado o seu mo1
delo completo, podera vir a ser uma plataforma de testes para tecnicas de controle
avancadas e simuladores em tempo real, com aplicacoes em helicopteros em escala
reduzida.
1.1
Motiva
c
ao
O interesse em VANTs (Veculos Aereos Nao-Tripulados) vem aumentando consideravelmente, tanto para aplicacoes civis como militares. Entre elas estao filmagem
em locais perigosos ou inacessveis, vigilancia e reconhecimento. Para a maioria das
aplicacoes, as aeronaves em escala reduzida atendem aos requisitos de capacidade de
carga u
til e autonomia, e tendo como vantagens adicionais um menor custo e mais
agilidade.
As principais universidades do mundo que desenvolvem projetos com VANTs
preferem faze-lo utilizando como plataformas os helicopteros em escala reduzida,
principalmente devido `a facilidade operacional e `as peculiaridades de sua dinamica
que permitem testar tecnicas de controle avancadas.
A principal motivacao para o presente trabalho de modelagem dinamica, identificacao e controle de uma helicoptero miniatura foi o desenvolvimento de uma
plataforma versatil e economica que permita o teste de diversas tecnicas avancadas
de controle e que permita comparacoes com tecnicas tradicionais como os controladores PID. Esta plataforma podera vir a servir a futuros trabalhos de projetos de
controladores que permitam manobras completamente autonomas e, ainda, para o
planejamento de trajetorias, em ambos os casos com o auxlio de uma unidade de
medidas inerciais (IMU) em conjunto com um receptor de GPS (Global Positioning
System).
1.2
Objetivos
1.3
M
etodos de Modelagem
Existe farta literatura que aborda a modelagem dinamica de helicopteros de escala normal baseados nos primeiros princpios (princpios basicos da Mecanica e da
Fsica). Alguns servem de referencia como o (Heffley & Mnich 1987), (Harris 1972),
(Padfield 1996) e (Johnson 1980).
Geralmente, os modelos utilizados sao de ordem elevada e possuem uma grande
quantidade de parametros que geralmente nao podem ser medidos diretamente.
Apos seu desenvolvimento, estes modelos requerem uma extensa validacao e refinamentos antes que eles possam predizer o comportamento dinamico da aeronave com
confiabilidade e precisao. Portanto, a modelagem detalhada usando os princpios
basicos da Mecanica e da Fsica nao e uma tarefa trivial, e necessita recursos muitas
vezes indisponveis ou onerosos, como um t
unel de vento, por exemplo.
Os helicopteros desenvolvem suas manobras em um conjunto complexo de condicoes
aerodinamicas. O fluxo de ar descendente gerado pelo rotor principal e, por si so,
um sistema dinamico complexo. A dinamica do helicoptero envolve interacoes complexas deste fluxo de ar com a fuselagem, o rotor de cauda e outras superfcies de
estabilizacao. A complexidade aumenta mais ainda `a medida que a aeronave sai da
condicao de voo pairado para a de voo de cruzeiro e ganha velocidade.
Devido `as diferencas de escala e caractersticas construtivas dos helicopteros em
escala reduzida, estes efeitos sao dominados pelas relativamente grandes forcas e
torques que sao gerados quase que instantaneamente apos aplicadas as entradas de
controle (Gavrilets 2003).
Como opcao `as modelagens fsicas complexas e de ordem elevada, existe a tecnica
de modelagem baseada na identificacao parametrica de sistemas, a qual tem sido
utilizada com freq
uencia para o desenvolvimento de modelos linearizados em pontos
de operacao especficos (principalmente voo pairado e de cruzeiro).
Estes modelos tem se mostrado u
teis em projetos de controladores, estudos de
qualidade de voo e, ainda, em validacao e refinamento de modelos nao-lineares
detalhados baseados nos princpios basicos da Fsica. Metodos como o CIFER
(Comprehensive Identification from FrEquency Responses) da NASA (Heffley &
Mnich 1987) foram usados para o desenvolvimento de modelos linearizados relativamente simples ((Mettler 2003) pp. 30 e 40), os quais capturaram com precisao o
comportamento da dinamica do veculo em torno de pontos de operacao especficos.
4
Embora se buscasse um modelo simplificado, este modelo teria que ter uma boa
precisao e guardar uma direta relacao com os princpios fsicos basicos que regem
os movimentos do helicoptero e os seus parametros mensuraveis, ou seja, o modelo
deveria ter uma visao fsica. Esta visao e imprescindvel, pois permite que falhas
na modelagem, e/ou nas medidas realizadas durante os testes experimentais, fossem
mais visveis, e depuradas com mais facilidade. Uma vantagem adicional advinda
desta abordagem e a possibilidade de se aproveitar boa parte do modelo, se nao todo,
ao se modelar outro helicoptero miniatura, de dimensoes e construcao diferentes,
substituindo-se os parametros mensuraveis, estimando-se outros nao mensuraveis
diretamente, e utilizando-se tecnicas de escalamento (Mettler 2003).
A modelagem parte das equacoes de movimento do corpo rgido dadas pelas
equacoes de Newton-Euler, onde os produtos cruzados das inercias foram desprezados. O rotor principal gera as principais forcas e torques que agem sobre a aeronave
e sua dinamica e fundamental no modelo a ser obtido. A barra estabilizadora, que
esta acoplada ao rotor principal, domina a dinamica do conjunto rotor/barra estabilizadora, e este aumento do sistema dinamico tambem esta explicitado no modelo.
O modelo captura ainda o aumento do sistema dinamico devido a um sistema de
estabilizacao eletronica da dinamica de guinada.
Parametros importantes do helicoptero foram, quando possvel, calculados e/ou
medidos, e reservados para posterior comparacao com os obtidos na fase de identificacao parametrica nos voos experimentais. A semelhanca dos valores medidos ou
calculados com os obtidos no processo de identificacao nos da uma ideia da adequacao do nosso modelo sob as condicoes testadas.
1.3.1
V
oo Experimental de Identificac
ao
1.3.2
Simulac
ao/Valida
c
ao
Figura 1.1: O Raptor-30 tem uma escala aproximada de 1:12 em relacao ao helicoptero Bell UH-1H, um dois mais utilizados helicopteros de emprego m
ultiplo.
1.3.3
V
oo Experimental de Teste do Controlador
1.4
Descric
ao do Veculo de Testes
Figura 1.3: Raptor-30 comparado com outras duas aeronaves utilizadas como plataformas em projetos de VANTs em universidades americanas: o X-Cell-60 do MIT
e o Yamaha R50 da Carnegie Mellon.
Captulo 2
Modelagem da Din
amica
2.1
Introdu
c
ao
2.2
Sistemas de Refer
encia e Transforma
c
oes de
Coordenadas
Com a finalidade de se simplificar a obtencao das equacoes de movimentos translacional e rotacional de um helicoptero sera suposto que:
O helicoptero e um corpo rgido;
Um sistema de eixos de referencia tem sua origem fixada ao centro de massa
Angulos
de Euler
Uma forma usual de se descrever a orientacao angular de uma aeronave em relacao
a um dado sistema de referencia inercial e atraves dos angulos de Euler, que se
10
Figura 2.1: Forcas e torques que atuam no helicoptero. Tmr e Ttr sao os empuxos
gerados pelos rotores principal e de cauda, respectivamente. Fvf , Fht eFf us sao
forcas de arrasto relativas aos estabilizadores vertical e horizontal, e `a fuselagem,
respectivamente. Qe e o torque produzido pelo motor para se contrapor ao torque
aerodinamico das pas do rotor principal Qmr , quando giram para gerar sustentacao.
11
c c
c s
s
Rbi = s s c c s s s s + c c s c .
c s c + s s c s s s c c c
(2.1)
T
O vetor gravidade, expresso no sistema de referencia inercial e gi = 0 0 g ,
g sen
(2.2)
gb = Rbi gi = g cos sen .
g cos cos
2.3
Equac
oes de Movimento do Corpo Rgido
As equacoes de movimento dos seis graus de liberdade da fuselagem sao desenvolovidas a partir da aplicacao da segunda lei de Newton, na forma linear F = ma e na
forma angular M = Iw. A lei de Newton e aplicada em referencia aos eixos do corpo
e levam em conta as forcas da gravidade e de Coriolis. Como em (Gavrilets 2003),
os produtos cruzados de inercia serao desprezados. A derivacao completa destas
equacoes pode ser encontrada no Apendice 3A.1 de (Padfield 1996).
12
Equa
c
oes de For
ca:
u = (wq vr) +
X
g sen ,
ma
(2.3)
v = (ur wp) +
Y
+ g cos sen ,
ma
(2.4)
w = (vp uq) +
Z
+ g cos cos .
ma
(2.5)
Equa
c
oes de Torque:
p =
qr(Iyy Izz )
L
+
,
Ixx
Ixx
(2.6)
q =
rp(Izz Ixx ) M
+
,
Iyy
Iyy
(2.7)
r =
p q(Ixx Iyy )
N
+
,
Izz
Izz
(2.8)
onde, u, v e w sao as velocidades inerciais translacionais, p, q e r sao as velocidades rotacionais inerciais expressas nos eixos do corpo do helicoptero e , e
sao os angulos de rotacao de Euler que definem a orientacao dos eixos do corpo do
helicoptero em relacao ao sistema de referencia inercial na terra. Estes angulos definem as componentes da forca de gravidade nos eixos do corpo, como em (2.2). Ixx ,
Iyy e Izz sao os momentos de inercia da fuselagem em torno dos eixos de referencia
do corpo e ma e a massa da aeronave.
As forcas e os torques externos X, Y , Z, L, M e N podem ser escritos como
a soma das contribuicoes dos diferentes componentes do helicoptero, aqui consideradas apenas as que tem efeito dominante na dinamica da aeronave. Para uma
melhor compreensao, serao utilizados os seguintes subscritos: mr para rotor principal, tr para rotor de cauda, f us para fuselagem, vf para aerofolio vertical, ht para
estabilizador horizontal e e para motor.
13
X = Xmr + Xf us ,
(2.9)
(2.10)
Z = Zmr + Zf us + Zht ,
(2.11)
(2.12)
M = Mmr + Mht ,
(2.13)
N = Qe + Nvf + Ntr ,
(2.14)
de onde se obtem:
sen
p
b = q = cos + sen cos ,
r
cos cos sen
(2.15)
(2.16)
= q cos r sen ,
(2.17)
(2.18)
Uma vez obtidas as seis equacoes diferenciais de primeira ordem do corpo rgido
(Eqs. (2.3) a (2.8)) em funcao de forcas e torques externos, devemos agora derivar
14
as expressoes matematicas que descrevem estas forcas e torques como funcao das
entradas de controle e estados da aeronave. Na sua forma geral, estas equacoes
podem ser representadas como um vetor nao-linear de equacoes diferenciais:
x = f (x, u),
(2.19)
(2.20)
Mais adiante, na Secao 2.5.3, veremos que sera necessario adicionar estados para
incluirmos outros componentes do helicoptero.
As variaveis de entradas de controle sao as usuais de um helicoptero: controles
cclicos lateral (ulat ) e longitudinal (ulon ); angulo de passo coletivo (ucol ); e
angulo de passo coletivo do rotor de cauda, tambem denominado pedal (uped ). Os
termos em negrito serao utilizados ao longo deste trabalho quando nos referirmos a
estas entradas. O vetor de entrada de controle e:
u := [ ulat , ulon , ucol , uped ]T .
(2.21)
f
x
x +
x0 ,u0
f
u
u (t) .
(2.22)
x0 ,u0
15
(2.23)
a qual usa as perturbacoes lineares dos vetores de estado e entrada ((Mettler 2003),
p. 58). A trajetoria dos estados do veculo e as entradas de controle em torno de
um ponto de equilbrio e dado por:
x = x0 + x ,
(2.24)
u = u0 + u .
(2.25)
(2.26)
(2.27)
X
,
ma
(2.28)
v = (u0 r + u r0 + w0 p + w p0 ) +
Y
,
ma
(2.29)
w = (v0 p + v p0 + u0 q + u q0 ) +
Z
,
ma
(2.30)
p = (q0 r q r0 )
(Iyy Izz ) L
+
,
Ixx
Ixx
(2.31)
q = (p0 r p r0 )
(Izz Ixx ) M
+
,
Iyy
Iyy
(2.32)
r = (p0 q p q0 )
(Ixx Iyy ) N
+
.
Izz
Izz
(2.33)
mente. Podemos ver que em voo pairado os termos entre parenteses se anularao
(veja Eqs. (2.26) e (2.27)).
16
Expandindo as For
cas e Torques Externos
As forcas e torques externos podem ser considerados como funcoes contnuas dos estados do veculo e variaveis de controle. Assim, podemos expressar suas perturbacoes
usando expansao em series de Taylor. Uma vez que desejamos uma dependencia linear dos estados e controles, somente serao usados os termos de primeira ordem das
series. Por exemplo, para a componente da forca longitudinal obtemos:
X =
x
x
x
x
lat + . . . .
u +
v +
p + . . . +
u
v
p
lat
(2.34)
As derivadas parciais de forca (ou torque) com respeito aos estados do veculo sao
chamadas derivadas de estabilidade. Por exemplo, a derivada de forca longitudinal
com respeito `a velocidade longitudinal e abreviada como:
x
= Xu .
u
(2.35)
Analogamente, as derivadas parciais de forca (ou torque) com respeito `as entradas
do veculo sao chamadas derivadas de controle. Por exemplo, a derivada de forca
longitudinal com respeito `a entrada cclica lateral e abreviada como:
x
= Xlat .
lat
(2.36)
(2.37)
O mesmo se aplica `as outras componentes das perturbacoes das forcas e torques.
Por exemplo, para a perturbacao do torque de rolagem temos:
L = Lu u + Lv v + Lp p + . . . + Llat lat + Llon lon + . . . .
(2.38)
2.4
2.5
Din
amica Simplificada do Rotor Principal
O rotor e um conjunto de varios corpos, rgidos e flexveis, acoplados atraves de dobradicas e/ou juntas elastomericas com caractersticas amortecedoras. As suas pas,
geralmente, possuem tres graus de liberdade em relacao ao cubo do rotor principal
(estrutura onde sao fixadas as pas ao mastro do rotor): batimento (), avanco-recuo
() e passo (). O movimento de passo varia o angulo de passo das pas e e comandado pelas entradas e pelos acoplamentos com os movimentos do helicoptero. As
pas estao sujeitas `as forcas aerodinamicas e inerciais, que tambem dependem dos
movimentos da aeronave e das pas. Alem de tudo, o rotor opera dentro do fluxo de
ar que ele proprio gera (wake), que por si so ja e um sistema dinamico complexo,
resultando em condicoes aerodinamicas complexas. As condicoes aerodinamicas nas
quais o rotor opera sofrem grandes mudancas em funcao do regime de operacao da
aeronave (voo pairado, voo de cruzeiro, pouso, decolagem, etc). Em resumo, as
equacoes detalhadas de movimento do rotor sao demasiadamente complexas para
sua utilizacao para fins de controle.
Nem todos estes efeitos sao relevantes na identificacao, ou modelagem para projeto de controladores, principalmente quando se trata de helicopteros miniatura.
Baseado em trabalhos de identificacao de aeronaves similares, ja citados, descrevemos os aspectos fundamentais da dinamica de rotor desta classe de helicopteros.
Desenvolvemos um modelo do plano de rotacao do rotor (TPP - Tip Path Plane),
que e o plano descrito pela trajetoria da ponta das pas do rotor principal, que e a
base dos modelos altamente simplificados usados para a identificacao de helicopteros.
2.5.1
Construc
ao Mec
anica
Movimentos da L
amina:
As pas do rotor do RAPTOR-30 possuem tres graus de liberdade (3-DOF - Degrees
Of Freedom) em relacao plano de impuls
ao (plano perpendicular ao mastro e que
passa pelo cubo do rotor principal), como descrito acima, alem de girarem solidariamente ao mastro do rotor, sendo este u
ltimo movimento descrito pela posicao de
azimute e velocidade angular . Estes tres graus de liberdade sao os movimentos:
batimento, avanco-recuo e passo, veja a Fig.(2.2). O movimento de batimento ocorre
na direcao normal ao plano de impuls
ao e e descrito pelo angulo . Este movimento e permitido, no nosso helicoptero, pelo fato do acoplamento das pas `a cabeca
19
do rotor ser feito atraves de uma bucha de elastomero e, tambem, pela flexibilidade
das pas, veja a Fig.(2.3). O movimento de passo ocorre no sentido longitudinal das
pas e e descrito pelo angulo de passo () e e referenciado ao plano de impuls
ao. O
movimento de avanco-recuo e o movimento das pas no plano de rotacao e e descrito
pelo angulo , o qual nao tem relevancia na nossa modelagem e sera desconsiderado.
O Mecanismo do Prato Cclico
O controle translacional do helicoptero, tanto em voo pairado quanto em cruzeiro, se
da atraves da inclinacao do vetor de empuxo do rotor principal, e ha tres maneiras
de se obter esta inclinacao ((Stepniewski 1984), p. 27): pela inclinacao do eixo de
rotacao, do cubo do rotor principal ou do prato cclico. Devido `a sua simplicidade
e eficiencia, o prato cclico se tornou de uso corrente em helicopteros, e o nosso
helicoptero miniatura e dotado deste mecanismo, por isso passamos a descreve-lo
com as peculiaridades do modelo de helicoptero que estamos utilizando (Raptor 30),
as quais sao muito semelhantes `as de outros modelos miniatura.
O prato cclico consiste de dois pratos circulares que, atraves das entradas de
controle do piloto (manche), podem ser arbitrariamente inclinados com respeito ao
plano perpendicular ao eixo do rotor (Figs. 2.4, 2.5 , 2.6 e 2.7). O prato superior
gira solidariamente ao eixo do rotor e esta acoplado a este atraves de uma junta
com tres graus de liberdade, dois de revolucao e um prismatico (rotula), este u
ltimo
permite que o prato cclico suba e desca deslizando ao longo do mastro do rotor.
20
Figura 2.3: Acoplamento das pas `a cabeca do rotor atraves de buchas de elastomero.
21
22
A Barra Estabilizadora
As forcas aerodinamicas produzidas pelo rotor principal precisam ser grandes para
gerarem a sustentacao da aeronave e as necessarias aceleracoes aos seus movimentos. Estas forcas aerodinamicas sao muito grandes comparadas `a massa das pas do
rotor, provocando a tendencia natural das pas responderem muito rapidamente aos
comandos cclicos (lat e lon ). Este efeito e acentuado nos helicopteros miniatura
devido `as suas grandes relacoes potencia/peso.
Para superar esta dificuldade, a quase totalidade dos helicopteros miniatura empregam um sistema de controle mecanico que utiliza uma barra estabilizadora.
A barra estabilizadora tem dois graus de liberdade em relacao ao cubo do rotor
principal, alem de girar solidariamente ao rotor principal: pode pivotear em relacao
a um pivo central (batimento) e girar em torno da barra que une as duas pas (passo),
de tal forma que as bielas de controle possam aplicar um angulo de passo cclico `as
pas.
23
A barra estabilizadora, como ilustrado na Fig. 2.8, consiste de duas pas unidas
por uma barra, a qual esta montada perpendicularmente `as pas do rotor principal,
formando um conjunto que gira solidariamente em relacao ao eixo de rotacao do
mastro do rotor. A barra estabilizadora possui uma dobradica central sem mola
torsional, portanto seu movimento de batimento e livre. As duas pas estao em
um mesmo plano, ou seja, diferentemente do rotor principal, a barra estabilizadora
nao tem angulo de passo coletivo, somente angulo de passo cclico, nao gerando
sustentacao. Desta maneira, ela nao gera forcas nem torques significativos na fuselagem. Ao receber um comando de angulo de passo cclico, a barra estabilizadora
comeca a alterar o angulo de inclinacao do seu plano de rotacao, ate se estabilizar
(angulo de batimento). Este angulo e quem comanda o angulo de passo das pas do
rotor principal atraves de um conjunto de bielas e alavancas.
A barra estabilizadora pode ser vista como um giroscopio que pode ser manobrado pelos controles cclicos, porem, quando nao esta sendo manobrado, tende a
manter fixo seu eixo de rotacao com relacao `a terra (aqui considerada um sistema
de referencia inercial) ao inves do sistema de referencia do corpo do helicoptero ou
do ar.
Existem dois sistemas de controle cuja finalidade e aumentar a estabilidade do
helicoptero, e os dois utilizam a barra estabilizadora. O sistema Hiller e o BellHiller. Apesar de serem utilizados tambem em helicopteros em escala normal, nas
miniaturas e muito difcil um bom controle da aeronave sem estes recursos.
24
a ser aplicado `as pas do rotor principal, que comecam a seguir a barra estabilizadora.
O sistema Hiller aumenta a constante de tempo do conjunto rotor/barra estabilizadora, mas o piloto precisa esperar ate que a barra estabilizadora comece a alterar
25
2.5.2
Aerodin
amica do Rotor
q
UT2 + UP2 ,
= tan1
UP
.
UT
(2.40)
(2.41)
(2.42)
1
U 2 c cl ,
2
(2.43)
D=
1
U 2 c cd ,
2
(2.44)
(2.45)
Fx = L sen + D cos .
(2.46)
28
na pa do rotor:
dT = N Fz dr ,
(2.47)
dQ = N Fx r dr ,
(2.48)
dP = dQ = N Fx r dr ,
(2.49)
onde N e o n
umero de pas. As forcas totais sao obtidas pela integracao pelo comprimento da pa, da raiz `a ponta, ou seja, da raiz a Rmr .
Considerando-se as suposicoes preliminares, e que os rotores trabalham com pequenos angulos, especificamente , , 1 rad, podemos fazer as seguintes apro-
ximacoes:
UP
UT
, cos 1, sen , e U UT .
b
c
tem uma valor tpico de a = 5, 7 ((Johnson 1980), p. 51). Gavrilets, em seu recente
trabalho ((Gavrilets 2003), p. 37), utilizou o valor de a = 5, 5 para um helicoptero
similar (X-Cell-60).
fornecida em ((Munzinger 1998), p. 61), uma expressao para o calculo de a,
E
em funcao do AR:
a=
2
2 .
1 + AR
(2.50)
29
1
UP
UT2 c a(
),
2
UT
(2.51)
1
UT2 c cd ,
2
(2.52)
dT N Ldr ,
(2.53)
dQ N (L + D)rdr .
(2.54)
Em seguida, todas as quantidades sao escritas na forma adimensional, normalizadas com respeito `a densidade do ar, velocidade angular e raio do rotor (, e R).
Em forma de quociente, os resultados da contribuicao de uma secao de pa para o
empuxo e a potencia sao ((Johnson 1980), p. 51):
a
2
dCT =
r dr ,
2
r
a
cd 2
2
(r ) +
r rdr ,
dCP = dCQ =
2
2
(2.55)
(2.56)
2.5.3
Din
amica do Rotor Principal
Equa
c
oes do Plano de Rotac
ao do Rotor (TPP)
Como dito anteriormente, e o rotor principal quem gera as principais forcas e torques externos que agem sobre a fuselagem do helicoptero. A maneira usual de se
representar esta dinamica e atraves da inclusao de dois estados no sistema, que sao
os angulos de batimento, que descrevem a inclinacao do TPP, que e o plano descrito
pelo caminho das pontas das pas ao girarem no ar, os quais passamos a descrever.
A quase totalidade dos helicopteros miniatura possuem acoplamento rgido entre
as pas e o eixo do rotor principal e, devido `a sua flexibilidade, estas pas tem liberdade
para se flexionar, fazendo suas pontas subirem e descerem perpendicularmente ao
30
(2.57)
De acordo com Glessow e Myers (Glessow & Myers 1952), a magnitude do segundo
harmonico e menor que 10% da magnitude do primeiro harmonico e, portanto,
serao desprezados. Desta forma escreveremos o movimento de batimento em sua
forma quasi-steady-state, ou seja, os transitorios do movimento de batimento do
rotor sao desprezados e assume-se que as pas reagem imediatamente a uma entrada
(Banks 1999) e ((Padfield 1996), p. 35):
() = 0 + 1c cos + 1s sen .
(2.58)
(2.59)
ordem do TPP:
a + Da + Ka = F ,
(2.60)
K = 2
"
k
I 2
8
8
k
I 2
(2.61)
(2.62)
4
c a Rmr
.
I
(2.63)
33
(TPP):
a = q
a
mr
p
mr
k
A lon
b + lon
,
2I
mr
b
q
k
B lat
b = p
+
+
a + lat
,
mr mr 2I
mr
(2.64)
(2.65)
16
(2.66)
(2.68)
d
q
D1
d = p
+
.
+
f ly f ly f ly
(2.69)
c = q
c
f ly
(2.67)
f ly
(2.70)
d
D1
d = p
+
,
f ly f ly
(2.71)
c = q
c
f ly
34
(2.72)
Acoplando a Din
amica do Rotor Principal com a da Barra Estabilizadora
Como descrito anteriormente, o batimento da barra estabilizadora aumenta o sistema dinamico do comando de angulo de passo das pas do rotor principal atraves
do misturador Bell-Hiller. Como este acoplamento e mecanico e determinado por
relacoes entre bracos de alavanca e bielas de acoplamento (veja Fig. 2.14), podemos
descrever estes comandos modificados pelas relacoes:
lat = lat + Kd d e lon = lon + Kc c ,
(2.73)
O valor encontrado e coerente com o do X-Cell-60, que foi identificado por Mettler
como sendo Kc = 2, 17 e Kd = 2, 74 ((Mettler 2003), p. 129), e o do Yamaha
R-50, identificado por Munzinger (Munzinger 1998) como sendo Kc = Kd 1, 95.
35
lat e lon nas Eqs. (2.74) e (2.75), obtendo assim as equacoes aumentadas do TPP:
a
k
B lat
b lat
,
2I
mr
(2.74)
k
q
A lon
b
+
+
a lon
,
b = p
mr mr 2I
mr
(2.75)
a = q
mr
mr
onde Alon e Blat sao, respectivamente, os ganhos longitudinal e lateral das entradas
cclicas para os angulos de batimento do rotor principal e dependem da razao entre
os angulos de inclinacao do prato cclico, devidas `as entradas cclicas, e o angulo de
passo resultante nas pas do rotor principal, equivale ao ganho da entrada Bell no
misturador. No Raptor-30 foram encontrados os seguintes valores: Alon = Blat =
0, 38.
Gavrilets ((Gavrilets, Frazzoli, Mettler, Piedmonte & Feron 2001), p. 39) obteve
resultados na identificacao no domnio da freq
uencia de um helicoptero X-Cell-60,
similar ao Raptor-30, mostrando que a razao entre o termo cruzado e o direto dos
acoplamentos entre o batimento e os movimentos angulares da aeronave (arfagem e
rolagem) nas equacoes do TPP e de aproximadamente uma ordem de grandeza e,
por isso, podem ser desprezados.
Mettler ((Mettler 2003), p. 129), para o mesmo helicoptero miniatura, X-Cell-60,
desprezou o termo cruzado de batimento, pois e comum neste tipo de miniatura a
introducao de uma pequena defasagem no prato cclico para compensar este acoplamento, que e funcao direta do coeficiente K do rotor principal.
Fazendo estas simplificacoes obtemos:
a
Alon (lon + Kc c)
,
mr
(2.76)
Blat (lat + Kd d)
b
+
.
b = p
mr
mr
(2.77)
a = q
mr
Gavrilets ((Gavrilets 2003), p. 39), baseado nos resultados obtidos por Mettler
em (Mettler 2003), descreveu as equacoes (2.76) e (2.77) com apenas dois estados,
agrupando os sistemas dinamicos do rotor principal e da barra estabilizadora, resultando nas expressoes:
Alon,ef f lon
,
ef f
(2.78)
b
Blat,ef f lat
b = p
+
,
ef f
ef f
(2.79)
a = q
a
ef f
36
2.6
a = Alon,ef f lon ,
(2.80)
b = Blat,ef f lat .
(2.81)
37
2.6.1
Empuxo
Teoria da Conserva
c
ao da Quantidade de Movimento
Gavrilets (Gavrilets 2003) cita resultados obtidos em t
unel de vento com um rotor de
1,52m de diametro (o do Raptor-30 tem 1,2m), dados por Harris (Harris 1972) e resumidos em ((Bramwell 2001), pp. 109-114), mostrando que a teoria da conservacao
da quantidade de movimento e adequada `a estimacao do empuxo em regime permanente, tanto para voo pairado como para voo rapido para frente. Verificou-se que o
coeficiente de inclinacao da curva de sustentacao (lift curve slope) (a) pode ser determinado experimentalmente, permitindo a utilizacao desta teoria para se predizer
vipairado
= 0, 03 .
mr Rmr
(2.83)
(2.84)
2vi2
ma g
=
= 0, 0018 .
2
2
2
mr Rmr
(mr Rmr )2 Rmr
(2.85)
Observe-se que, para o caso especial de voo pairado, conhecemos T , entao podemos calcular i . Em outros modos de operacao, precisamos conhecer T para
calcular i , e precisamos de i para calcular T . Como um depende do outro,
38
0, 849
.
4ipairado mr
(2.86)
2.6.2
As principais forcas e torques de controle do helicoptero sao produzidos pelo batimento e a conseq
uente inclinacao do TPP, a Fig. 2.15 mostra a relacao entre o
angulo de inclinacao do TPP, o empuxo, forcas e torques produzidos pelo rotor.
For
cas do Rotor
Para voo pairado e baixa velocidade ( < 0, 15) podemos assumir que o vetor de
empuxo e perpendicular ao TPP. Deste modo, as forcas exercidas sobre o cubo do
rotor sao as projecoes do vetor empuxo nas direcoes x e y dos eixos do plano do cubo.
Como, para a classe de helicopteros em estudo, os angulos de batimento do TPP
39
sao inferiores a 10o , o que nos permite fazer outras simplificacoes, e as componentes
do empuxo ao longo dos eixo do corpo do veculo podem ser aproximadas para:
Tx = Tmr sen a cos b Tmr a ,
(2.87)
(2.88)
(2.89)
Torques do Rotor
A inclinacao do rotor faz aparecer na fuselagem um torque devido a existencia da
mola torsional equivalente representativa da elasticidade das pas do rotor k . Outra
componente e devida `a projecao do empuxo no plano do cubo do rotor principal,
equacao (2.87), multiplicado pela distancia hmr do cubo do rotor principal ao centro
de gravidade, resultando nas seguintes projecoes nos eixos do corpo:
Lmr = hmr Tmr b + k b = (hmr Tmr + k ) b ,
(2.90)
(2.91)
40
2.6.3
Equac
oes do Movimento da Din
amica Acoplada RotorFuselagem
(2.92)
v = (u0 r w0 p) + g + Yv v + . . . + Yb b ,
(2.93)
(2.94)
2.6.4
p = Lu u + Lv v + . . . + Lb b ,
(2.95)
q = Mu u + Mv v + . . . + Ma a ,
(2.96)
r = Nr r + . . . + Nped ped .
(2.97)
Torque em Guinada
O torque gerado pelo rotor principal tem uma componente dominante na direcao
do seu eixo, alem de outras menores em arfagem e rolagem, devidas `a inclinacao
do disco definido pelo caminho descrito pelas pontas das pas (TPP - Tip Path
Plane) em relacao ao plano de impulsao (plano perpendicular ao eixo do rotor).
Este torque pode ser aproximado pela soma do torque induzido pelo empuxo gerado
(primeira parcela de (2.98)) e o torque resultante do arrasto aerodinamico das pas
(segunda parcela), o qual e aqui apresentado em sua forma normalizada denominada
coeficiente de torque ( (Padfield 1996), pp. 113-114 e (Gavrilets 2003), p. 37):
Q
cd0
7 2
CQ =
= CT (0 z ) +
1+ ,
(2.98)
3
(mr Rmr )2 Rmr
8
3
onde Q e o torque; 0 e a componente uniforme do fluxo de ar, que em voo pairado
e 0 = itrim = 0, 03; z e o taxa de avanco na direcao z do corpo, que e nula em
voo pairado; = 2c/Rmr = 0, 0513 e a razao de solidez do rotor, que e definida
41
como sendo a razao entre as areas das pas e a do disco do rotor, onde c e a corda
da pa. Embora o valor de cd0 = 0, 0087, fornecido por (Johnson 1980) e citado
anteriormente, seja compatvel com o valor cd0 = 0, 008 utilizado por ((Gavrilets,
Mettler & Feron 2001), p. 4), usaremos o valor 0, 014, estimado com base na potencia
gasta com as perdas de arrasto de um helicoptero classe 30 em voo pairado (Mill
1996). Uma vez obtido CQ , reescrevendo-se (2.98) pode-se calcular o torque de
guinada:
Qmr = CQ (mr Rmr )2 R3 .
(2.99)
Din
amica de Guinada
As equacoes do movimento para a dinamica de guinada sao derivadas da equacao
de Euler (2.8). A principal contribuicao para o torque de guinada externo vem
do torque gerado pela forca aerodinamica do rotor de cauda, que e controlada pelo
angulo de passo de sua pa ped . Devido ao seu pequeno tamanho e grande velocidade
angular, a resposta desta forca a uma variacao do angulo de passo das pas pode
ser considerada instantanea. Esta resposta e muito mais rapida que a dinamica
de guinada, deste modo a dinamica do rotor de cauda nao precisa ser modelada
(Mettler 2003). Um tempo de retardo e, usualmente, suficiente para representar a
dinamica nao modelada. A velocidade do ar tambem produz torques, tanto atraves
das forcas aerodinamicas da empenagem vertical como atraves de alteracoes no
empuxo do rotor de cauda. Tais efeitos sao modelados usualmente atraves das
derivadas de velocidade Nu e Nv . Finalmente o mastro da cauda e o rotor de cauda
produzem torques de amortecimento que podem ser modelados atraves da derivada
Nr . A base do modelo de derivadas de estabilidade e:
r = Nv v + Nr r + Nped ped .
(2.100)
Todos os helicopteros miniatura contam com um sistema dinamico de amortecimento de guinada, baseado em um girometro (sensor que mede velocidade angular)
que mede r e um circuito eletronico associado. Para incluir este sistema na dinamica
de guinada, Mettler (Mettler 2003) sugere a inclusao de mais um estado rf b (fb de
feedback ), resultando nas seguintes equacoes diferenciais:
r = Np p + Nr r + Nrf b rf b + Nped ped ,
rf b = 2Nrf b rf b + Kr r .
42
(2.101)
(2.102)
X_a
43
phi
L_b
1
s
p
3
X_u
1/Tal
L_u
1
s
1
s
L_v
1
s
L_w
Y_b
2
delta_lon
B_lat
1
delta_lat
A_lon
b
8
7
M_w
g
1
s
1
s
M_u
delta_ped
Y_ped
Y_v
M_col
4
delta_col
1
s
M_v
Z_col
1
s
teta
1/Tal
1
s
M_a
Z_w
fuselagem
N_r
K_rfb
N_ped
flybar
1
s
N_col
N_p
K_r
giroscopio_yaw
r
10
N_rfb
1
s
r_fb
11
entradas
Din
amica do Movimento de Transla
c
ao Vertical
A base do modelo de derivadas de estabilidade para dinamica de translacao vertical
e:
w = (v0 p + uo q) + Zw w + Zcolcol Nv v + Nr r + Nped ped .
(2.103)
Os termos entre parenteses sao forcas centrfugas que estao presentes em condicoes
de voo de cruzeiro, e para voo pairado serao desprezadas.
Em voo pairado, a aceleracao vertical pode ser representada pela relacao linear
((Gavrilets 2003), p. 37):
az = w = Zw w + Zcol col ,
(2.104)
2aR2 (R)ipairado
,
(16ipairado + a)ma
(2.105)
Zcol =
(2.106)
para uma entrada de coletivo col expressa em radianos, cuja faixa de valores e
0, 1 col 0, 1 para o nosso helicoptero, assim como para a maioria dos helicopteros miniatura. Se utilizamos uma entrada adimensional normalizada de 1
sera normalizada para 1, desta forma o valor de Zcol utilizado nas simulacoes sera o
valor calculado na Eq. (2.106) dividido por 10, devido ao fato de termos multiplicado
o valor da entrada por 10. A segunda forma sera utilizada na implementacao do
44
1
.
sa s + 1
(2.107)
2.7
(2.108)
x = [ u, v, p, q, , , a, b, w, r, rf b ]T ,
(2.109)
(2.110)
e o vetor de entradas e:
A dinamica completa do veculo pode ser descrita pelas nove seguintes equacoes
diferenciais de primeira ordem acopladas:
45
46
u
v
p
q
a
b
w
r
rf b
Xu 0
0
0 0
0 Yv 0
0 g
Lu Lu 0
0 0
Mu Mv 0
0 0
0
0
1
0 0
0
0
0
1 0
0
0
0 1 0
0
0 1 0 0
0
0
0
0 0
0
0 Np 0 0
0
0
0
0 0
g Xa
0
0
0
0
0
Ma
0
0
0
0
0 ef1 f
0
0
0
0
0
0
0
0
0
Yb
Lb
0
0
0
0
ef1 f
0
0
0
0
0
0
0
0
Yped
0
0
0
0
0
0
0
0
0
0
0
0
0 Alon
0
Blat
0
0
0
0
0
0
0 Nped
0
0
0
47
0
0
0
u
0
0
0
Lw 0
0 p
Mw 0
0
q
0
0
0
0
0
0
0
0
0
a
0
0
0
b
Zw 0
0
0 Nr Nrf b r
rf b
0 Kr Krf b
0
0
Mcol
lat
lon . (2.111)
0
ped
0
col
0
Zcol
Ncol
0
Captulo 3
Identificac
ao
3.1
Introdu
c
ao
3.2
Identificac
ao Param
etrica
(hcg ).
Dinamica vertical para se obter a derivada de amortecimento vertical (Zw ) e
a sensibilidade da entrada de coletivo (Zcol ).
(Nped ).
Acoplamento da dinamica vertical e de guinada para se obter as derivadas de
coletivo-para-guinada (Ncol ) e guinada-para-coletivo (Zr ).
3.3
Fundamentac
ao Te
orica
3.3.1
Aquisic
ao de Dados
50
P (j)
1/C(j) para < c , e
1 + P (j)C(j)
(3.1)
(3.2)
3.3.2
Modelo de Identificac
ao
(3.3)
e chamado de autoregressao, ou modelo AR, devido `a dependencia das sadas passadas. Ja o modelo de descricao dado pela equacao:
y(k) + a1 y(k 1) + . . . + ana y(k na ) = b1 u(k 1) + . . . + bnb u(k nb ) + e(k) , (3.4)
onde u(k) e uma entrada externa, e chamado de modelo ARX. Na denominacao
ARX, AR se refere `a parte auto-regressiva e o X se refere aos termos de entrada
extra u() ((Ljung 1999), p. 81).
A descricao de um modelo atraves de equacoes lineares a diferenca tem a seguinte
expressao geral ((
Astrom & Wittenmark 1997), p. 507),
A(q) y(k) = B(q) u(k) + C(q) e(k) ,
51
(3.5)
possui outros termos diz-se que o modelo do erro e do tipo MA (Moving Average)
(k) = y(k 1)
bn1
T
T
y(k n) u(k 1) u(k n) .
52
3.3.3
Crit
erio de Otimizac
ao dos Mnimos-Quadrados
(3.9)
X
=1
2 ,
J()
2 i=1 i
i = yi yi = yi 1 1 (xi ) . . . n n (xi ) ,
53
(3.10)
i = 1, 2, . . . , N .
T
Y = y1 y2 yN ,
T
Y = y1 y2 yN ,
T
= 1 2 N ,
T (x1 )
..
=
.
.
T
(xN )
O problema dos mnimos-quadrados pode ser agora apresentado de forma compacta. A funcao custo pode ser escrita como:
=
J()
1 T
1
= kk2 ,
2
2
(3.11)
onde
= Y Y ,
e
y = .
A solucao do problema dos mnimos-quadrados e a determinacao do parametro
tal que kk2 seja mnimo. E esta solucao e dada pelo seguinte teorema:
Teorema 3.1 ((
Astrom & Wittenmark 1997), p. 511)
(3.12)
(3.13)
54
3.4
3.4.1
Identificac
ao da Din
amica Vertical do Raptor30
Discretizac
ao
Para possibilitar a identificacao parametrica da dinamica vertical, e necessario expressa-la na forma da equacao (3.8). Partindo da equacao (2.104), obtemos a funcao
de transferencia da posicao vertical z em relacao `a entrada de coletivo col :
z
Zcol
=
.
col
s(s + Zw )
(3.14)
Ka
,
s(s+a)
seu equivalente
(3.15)
3.4.2
b1 =
Zcol
(Zw h 1 eZw h ) ,
Zw2
(3.16)
b2 =
Zcol
(1 eZw h Zw heZw h ) ,
Zw2
(3.17)
a1 = (1 + eZw h ) ,
(3.18)
a2 = eZw h .
(3.19)
Aplicac
ao do M
etodo dos Mnimos-Quadrados
55
tados da forma:
y(3)
y(4)
Y = .. ,
.
y(N )
y(2)
y(3)
=
..
.
(3.20)
y(1)
y(2)
..
.
u(2)
u(3)
..
.
u(1)
u(2)
..
.
(3.21)
3.4.3
V
oo Experimental de Identificac
ao
3.4.4
Resultados da Identificac
ao Param
etrica
3.4.5
Validac
ao do Modelo
57
0.4
0.2
0.2
0.4
0.6
0.8
10
15
Tempo segundos
20
25
30
58
Captulo 4
Projeto do controlador
4.1
Introdu
c
ao
59
4.2
4.2.1
Projeto do Controlador
Controlador PID
(4.1)
4.2.2
Controlador PID Pr
atico
Em (
Astrom & Wittenmark 1997) sao apresentadas algumas das modificacoes na
versao classica do controlador PID que se baseiam no conhecimento obtido em trabalhos anteriores com controladores analogicos, que passamos a descrever.
A funcao de transferencia do PID, descrito em (4.1), tem a seguinte expressao:
1
U (s) = Kp E(s) +
E(s) + Td sE(s) ,
(4.2)
s Ti
onde U e E representam, respectivamente, as transformadas de Laplace de u e e.
A implementacao pratica dos PIDs mostrou que uma simples derivada nao deve
ser implementada, pois isto iria gerar um amplificacao muito grande do rudo de
medida. O ganho da derivada deve, entao, ser limitado. Para tanto, devemos
substituir o termo s Td pela seguinte aproximacao:
s Td
sTd
,
d
1 + sT
N
(4.3)
61
4.2.3
Requisitos do Controlador
(4.5)
para a frente) faz a aeronave subir, ou seja, se movera no sentido negativo de z que
e direcionado para baixo. Como visto anteriormente, o calculo de Zw resulta em um
valor negativo, porem, para efeito de clareza, preferiu-se introduzir esta inversao,
posteriormente, no sinal de controle, para que pudessemos trabalhar com um valor
positivo no numerador.
Devido ao fato da planta possuir um polo na origem a acao integral do controlador
e desnecessaria. O controlador PD resultante tem a seguinte expressao:
!
sTd
Y (s) .
U (s) = Kp Uc (s) Y (s)
d
1 + sT
N
(4.7)
passa a ser:
(4.9)
N
= + 2, 8 ,
Td
Zw N
+ (1 + N )Zcol Kp = 2, 8 + 4 ,
Td
Zcol N Kp
= 4 .
Td
(4.10)
(4.11)
(4.12)
4N + (4Zw 11)Td
.
N Zcol
(4.15)
As duas solucoes da equacao (4.13) devem ser testadas para o calculo do valor
de , deve-se entao escolher aquela que resultar no maior valor de (polo mais
`a esquerda no plano complexo). Obtido o valor de Td , os calculos de Kp e sao
diretos.
Foram realizadas simulacoes em ambiente Matlab/Simulink para se verificar o
desempenho do controlador projetado. Foram utilizados os valores de Zw = 1, 1 e
s3
3, 3s + 34
.
+ 11s2 + 28s + 34
64
(4.16)
Step Response
1.4
N=3
N=4
N=5
1.2
Amplitude
0.8
0.6
0.4
0.2
0.5
1.5
2.5
Time (sec)
3.5
4.5
4.3
65
(4.17)
1 [x1 , y1 ],
...,
n [xn , yn ] .
(4.18)
Escreva
:= [ 0 , 1 , . . . , n ]
(4.19)
(4.20)
(4.21)
K 2 (s) = x0 + y1 s + y2 s2 + x3 s3 + x4 s4 + y5 s5 + y6 s6 + . . . ,
(4.22)
K 3 (s) = y0 + x1 s + x2 s2 + y3 s3 + y4 s4 + x5 s5 + x6 s6 + . . . ,
(4.23)
K 4 (s) = y0 + y1 s + x2 s2 + x3 s3 + y4 s4 + y5 s5 + x6 s6 + . . .
(4.24)
(4.28)
(4.29)
(4.30)
(4.31)
67
1.5
0.5
0.5
1.5
2
10
Figura 4.3: Espaco das razes de (s) para uma variacao de 20% dos parametros
Zcol e Zw .
68
5
14
12
10
Figura 4.4: Espaco das razes de (s) para uma variacao de 75% dos parametros
Zcol e Zw .
69
4.4
Discretizac
ao do Controlador
Para implementar-se o controlador PD projetado em um microcontrolador embarcado no helicoptero, e preciso primeiro discretiza-lo, ou seja, os sinais de entrada
de comando e de sada serao amostrados a uma determinada taxa de amostragem.
Duas etapas importantes da discretizacao sao as escolhas da taxa de amostragem
e da aproximacao da funcao de transferencia do controlador expressa na forma de
equacoes diferenciais ou na sua transformada de Laplace. Estas escolhas devem levar em conta criterios de estabilidade e desempenho do sistema amostrado. Taxas
de amostragens muito baixas podem levar `a instabilidade e degradar o desempenho do sistema, por outro lado, taxas elevadas podem exceder a capacidade de
processamento do microcontrolador. Tambem deve ser observada a complexidade
do algoritmo do controlador, devido `as limitacoes de processamento e recursos de
memoria do microcontrolador.
Taxa de Amostragem
Um criterio pratico para a escolha da taxa de amostragem e dado em ((
Astrom &
Wittenmark 1997), p.66), que recomenda que sejam feitas de 4 a 10 amostragens
durante o tempo de subida do sistema em malha fechada, quando e excitado por uma
entrada em degrau que, para um sistema de segunda ordem, e dado pela expressao:
Tr =
e/ tan
,
n
(4.32)
70
(4.33)
Osciloscpio
U(s)
Dinmica Vertical
Uc(s)
Degrau
0.14
P(s)
24
U(s)
Y(s)
s2+1.1s
U(s)
Kp
D(s)
0.56s
s+10
Tds / 1+Tds/4
(4.34)
Uma vez que o termo proporcional e estatico (nao depende de valores passados),
este pode ser discretizado de forma direta, sem aproximacao:
P (k) = Kp (uc (k) y(k)) ,
(4.35)
0, 56s
s
Y (s) ,
Y (s) =
sTd
s + 10, 3
1+ N
(4.36)
Td
s D(s) = Kp Td s Y (s) .
N
(4.37)
z1
zh
71
u(t)
y(t)
Dinmica Vertical
u_c(k)
0.14
Degrau
Osciloscpio
24
P(k)
U(k)
u(t)
s2+1.1s
y(t)
ZOH
D(k)
y(t)
1
z
D(k)
0.26
1
z
0.46
(4.38)
ou melhor,
z1
Y (z) ,
z 0, 46
que, voltando para o domnio do tempo discreto, resulta:
D(z) = 0, 26
(4.39)
(4.40)
(4.41)
(4.42)
(4.43)
4.5
Simulac
ao do Controlador
sada
1.4
0.12
1.2
0.1
entrada
0.14
0.08
0.06
0.04
0.02
0.8
0.6
0.4
0.2
0
0.02
4
tempo segundos
4
tempo segundos
entrada
sada
0.14
1.4
0.12
1.2
0.1
0.08
0.06
0.04
0.02
0.8
0.6
0.4
0
0.2
0.02
0.04
4
tempo segundos
4
tempo segundos
73
Osciloscpio
U(s)
Dinmica Vertical
0.14
Uc(s)
Degrau
P(s)
U(s)
U(s)
24
s2+1.1s
Y(s)
Kp
D(s)
0.56s
Y(s) + ruido
s+10
Y(s) + ruido
Tds / 1+Tds/4
Rudo Branco
siderando como entrada de comando o degrau unitario com incio em t = 1s. Inicialmente foram feitas simulacoes sem levar em conta o rudo de medida da sada.
A Fig. 4.7 mostra os resultados obtidos com o controlador contnuo e a Fig. 4.8
mostra os resultados do discreto.
Desempenho com Rudo de Medida
Presumir que o rudo de medida e nulo nao e realista, por isso foram feitas novas
simulacoes, nas quais foi somado `a sada do sistema (que corresponde `a variacao de
altitude da aeronave) um rudo branco com banda limitada com variancia aproximada de 0, 05 m. Os diagramas de blocos com estas alteracoes podem ser vistos nas
figs. 4.9 e 4.10.
Pode-se verificar que a introducao do rudo de medida nao provoca alteracoes
significativas nas caractersticas do sistema em malha fechada e, tambem, que o
sistema continua estavel, tanto para o controlador contnuo como para o discreto.
Desempenho com Rudo de Medida e Varia
c
ao Param
etrica
Os dois controladores foram analisados nas simulacoes anteriores considerando-se a
planta com seus valores nominais. Mas, como ja mencionado na Secao 4.3, devido
`as incertezas relativas `a identificacao e possveis variacoes parametricas devidas a
diversos outros fatores, foram realizadas simulacoes dos dois controladores considerando variacoes independentes de 20% nos parametros Zcol e Zw da planta. Os
resultados podem ser vistos nas figs. 4.11, 4.12 e 4.13 , para o controlador contnuo
74
u(t)
y(t)
y(t) + rudo
Dinmica Vertical
u_c(k)
0.14
Degrau
P(k)
U(k)
u(t)
24
s2+1.1s
Osciloscpio
y(t)
ZOH
D(k)
y(t) + rudo
1
z
Rudo Branco
D(k)
0.26
1
z
0.46
75
0.14
1.4
zcol=19.2 ; zw=0.88
0.12
1.2
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
0.1
u(t) normalizada
zcol=28.8 ; zw=1.32
0.08
0.06
0.04
0.8
0.6
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
0.02
zcol=28.8 ; zw=0.88
0.4
zcol=28.8 ; zw=1.32
0.02
0.04
4
6
tempo segundos
10
4
6
tempo segundos
10
Figura 4.11: Resposta ao degrau unitario, com controlador contnuo, sem rudo de
medida e com variacao de Zcol e Zw . Entrada u(k) normalizada e sada y(t).
0.2
1.2
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
zcol=28.8 ; zw=1.32
zcol=24 ; zw=1.1 NOMINAL
0.15
0.8
y(t) metros
u(t) normalizada
0.1
0.05
0.6
0.4
0.05
0.2
0.1
0.15
4
6
tempo segundos
0.2
10
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
zcol=28.8 ; zw=1.32
zcol=24 ; zw=1.1 NOMINAL
4
6
tempo segundos
10
Figura 4.12: Resposta ao degrau unitario, com controlador contnuo, com rudo de
medida e com variacao de Zcol e Zw . Entrada u(t) e sada y(t).
76
1.2
0.8
0.8
y(t) +rudo metros
y(t) metros
1.2
0.6
0.4
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
0.6
0.4
zcol=28.8 ; zw=0.88
zcol=28.8 ; zw=1.32
0.2
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
0.2
zcol=28.8 ; zw=1.32
zcol=24 ; zw=1.1 NOMINAL
0.2
4
6
tempo segundos
0.2
10
4
6
tempo segundos
10
Figura 4.13: Resposta ao degrau unitario, com controlador contnuo, com rudo de
medida e com variacao de Zcol e Zw . Sada y(t) e y(t) + rudo de medida.
0.14
1.4
zcol=19.2 ; zw=0.88
0.12
zcol=19.2 ; zw=1.32
1.2
zcol=28.8 ; zw=0.88
0.1
0.08
y(t) metros
u(k) normalizada
zcol=28.8 ; zw=1.32
0.06
0.04
0.8
0.6
zcol=19.2 ; zw=0.88
0.02
0.4
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
0.02
0.04
zcol=28.8 ; zw=1.32
0.2
4
6
tempo segundos
10
4
6
tempo segundos
10
Figura 4.14: Resposta ao degrau unitario, com controlador discreto, sem rudo de
medida e com variacao de Zcol e Zw .
77
1.2
0.15
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
zcol=28.8 ; zw=1.32
zcol=24 ; zw=1.1 NOMINAL
1
0.1
u(k) normalizada
y(t) metros
0.8
0.6
0.4
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
zcol=28.8 ; zw=1.32
zcol=24 ; zw=1.1 NOMINAL
0.2
0.05
0.05
0.2
4
6
tempo segundos
0.1
10
4
6
tempo segundos
10
1.2
0.8
0.8
metros
1.2
0.6
0.4
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
zcol=28.8 ; zw=1.32
zcol=24 ; zw=1.1 NOMINAL
0.2
0
0.2
4
6
tempo segundos
y(t) + rudo
y(t) metros
Figura 4.15: Resposta ao degrau unitario, com controlador discreto, com rudo de
medida e com variacao de Zcol e Zw . Sada (y(t) e entrada u(k) da planta
0.6
0.4
zcol=19.2 ; zw=0.88
zcol=19.2 ; zw=1.32
zcol=28.8 ; zw=0.88
zcol=28.8 ; zw=1.32
zcol=24 ; zw=1.1 NOMINAL
0.2
0
10
0.2
4
6
tempo segundos
10
Figura 4.16: Resposta ao degrau unitario, com o controlador discreto ,com rudo de
medida e com variacao de Zcol e Zw . Sada da planta y(t) e sada da planta com
rudo y(t) + rudo.
78
Dinmica Vertical
u_c(k)
0.14
Degrau
P(k)
U(k)
D(k)
24
s2+1.1s
u(t)
ZOH
u_sat(t)
u(t)
+500 500
delta(k)
Osciloscpio
1
z
0.26
+100 100
Atraso 20 ms
1
0.46
4.6
Aspectos Pr
aticos da Implementac
ao do Controlador
Podemos ver na Fig. 4.17 o diagrama de blocos do controlador em sua versao final,
como foi implementado em microcontrolador embarcado na aeronave.
Entre as diferencas que podem ser notadas em relacao aos diagramas de blocos do
controlador utilizados nas secoes anteriores esta a inclusao de duas saturacoes. A primeira, na entrada da planta previne que se envie para o servo que comanda o angulo
de passo coletivo um pulso com uma variacao de largura superior a 500 s, que e
diferenca entre duas medidas consecutivas de altitude, visa a filtrar eventuais erros
de leitura do sonar-altmetro que poderiam gerar a desestabilizacao da aeronave.
Partindo-se do princpio que o helicoptero tem um limite de velocidade vertical,
a diferenca entre duas medidas consecutivas da altitude e limitada. O valor de
saturacao permite velocidades verticais de aproximadamente 1 m/s.
importante observar que essas saturacoes nao introduziram nao-linearidades
E
no sistema durante os voos experimentais de identificacao, uma vez que estes sao
realizados em malha-aberta.
Na figura 4.18 encontra-se a simulacao do sistema em Simulink para uma entrada em degrau de 0, 6 m de amplitude. Verifica-se que tal entrada nao leva os
termos delta(k) (diferenca entre duas medidas consecutivas de altitude saturada em
100 mm) e u(t) `a saturacao, e na figura 4.19 encontra-se a mesma simulacao para
79
(t)
sat
microsegundos
100
50
0
50
10
10
10
altitude y(t)
milmetros
1000
500
0
4
delta(k)
milmetros
100
50
0
50
tempo segundos
80
microsegundos
200
100
0
100
10
10
4
5
6
tempo segundos
10
altitude y(t)
milmetros
1500
1000
500
0
5
delta(k)
milmetros
100
50
0
50
81
4.7
Testes Experimentais em V
oo do Controlador
Comutador
malha aberta/
malha fechada
Girmetro
de guinada
Computador de
bordo
Receptor
Futaba
Bateria do
receptor e servos
Bateria do conjunto
computador/sonaraltmetro
Sonar-altmetro
83
Scope
Dinmica Vertical
u_c(k)
0.53
Degrau
u_sat(t)
24
P(k)
U(k)
D(k)
s2+1.1s
u(t)
ZOH
u(t)
+500 500
delta(k)
1
z
1.19
+100 100
Atraso 20 ms
1
0.56
Figura 4.21: Diagrama de blocos do controlador PD implementado em microcontrolador embarcado calculado considerando Zcol = 5 e Zw = 0, 5.
conseq
uente saturacao das medidas de altura, nos levou a subestimar os valores de
Zcol e Zw .
Os valores utilizados para os calculos do primeiro controlador foram Zcol = 5
(para uma entrada normalizada) e Zw = 0, 5, o que nao seria suficiente para provocar
a instabilidade observada, porem um erro no algoritmo do controlador introduzia
um ganho adicional de 2 na sada do controlador, o que, conforme se verificou nas
simulacoes realizadas provocou a instabilidade.
A figura 4.21 mostra o diagrama de blocos do controlador PD implementado em
microcontrolador embarcado no helicoptero com os valores de ganhos calculados
baseados em valores subestimados de Zcol e Zw . O atraso de 20 ms entre a sada
da planta e a entrada do controlador representa o tempo que o sonar-altmetro leva
para de medir a altitude do helicoptero. Foi verificado nas simulacoes que este tempo
de atraso nao influencia significativamente o comportamento do controlador, nem a
identificacao parametrica. As figuras 4.22 e 4.23 apresentam a simulacao e os dados
obtidos em voo experimental em malha fechada. Pode-se observar a boa semelhanca
entre a simulacao e os dados reais.
Apos a correcao dos ganhos do controlador, foi realizado um segundo voo experimental com a malha fechada, em conjunto com o terceiro voo de identificacao.
Desta vez foi possvel fechar a malha e a aeronave se manteve estavel, permitindo
ao piloto manter uma posicao constante no manete de controle de altitude para aeronave manter a altitude comandada mesmo sob a influencia do vento que soprava
84
500
500
10
10
10
milmetros
2000
1000
0
1000
2000
5
tempo segundos.
Figura 4.22: Simulacao do controlador PD implementado em microcontrolador embarcado calculado com Zcol = 50 e Zw = 0, 5.
1800
1700
altitude milmetros
1600
1500
1400
1300
1200
1100
1000
5
tempo segundos
10
Figura 4.23: Dados obtidos em voo experimental com o controlador PD implementado em microcontrolador embarcado calculado com Zcol = 50 e Zw = 0, 5.
85
Vo em mala fechada
1850
1800
altitude milmetros
1750
1700
1650
1600
1550
1500
1450
10
15
tempo segundos
moderadamente.
Foi solicitado ao piloto que comandasse ao helicoptero entre os dois extremos de
altitude determinados pela posicao do manete do radio controle ( 1000 a 1800 mm).
O grafico da Fig. 4.24 apresenta a variacao da altitude quando o piloto comandou
a aeronave para ir da sua posicao inicial em 1500 ate a posicao 1830 mm, ficando
estabilizada nesta posicao dentro de uma variacao de 30 mm, no intervalo de tempo
86
Captulo 5
Descric
ao do Conjunto Eletr
onico
5.1
Introdu
c
ao
5.2
Eletr
onica de Terra
87
Figura 5.1: A altitude (z) e estimada com base no tempo que a onda ultra-sonica
leva para percorrer o caminho de ida e volta entre a aeronave e o solo.
5.3
Eletr
onica Embarcada
88
5.3.1
Sonar-Altmetro
5.3.2
Computador de Bordo
89
90
AVR - versao 1.24.0), com diversas funcoes extras incorporadas, como por
exemplo as de controle de mostrador LCD (mostrador de cristal lquido) e
comunicacao serial,
91
baixo consumo.
Para a Interface Homem-Maquina (IHM) foi utilizado um mostrador do tipo
LCD de duas linhas de 16 caracteres alfanumericos cada, e um teclado matricial
de membrana de 16 teclas. Esse conjunto permite ao operador introduzir dados;
alterar configuracoes; selecionar trechos de memoria a serem gravados, apagados ou
descarregados para um PC pela serial, e ressetar o computador de bordo.
Descri
c
ao do Circuito
A porta A do microcontrolador ATmega162 (U1) esta ligada a um teclado matricial
de 16 teclas para a entrada de dados e comandos pelo operador (vide Fig. 5.4), a
porta C esta ligada a um mostrador LCD (LCD1) de 2 linhas de 16 caracteres cada, a
porta E esta ligada a um banco de memorias do tipo FLASH (nao-volateis) formado
por 4 memorias seriais 24LC256, de 32Kx8 bits de capacidade cada (U4 a U7), com
o qual se comunica atraves de um barramento I 2 C. A interface entre o computador
de bordo e um PC, para se possibilitar a descarga dos dados gravados durante os
voos experimentais, e constituda pelo transistor PNP BC557 (Q2), o CI regulador
de tensao 78L05 (U3) e outros componentes que formam o bloco INTERFACE
SERIAL RS-232 no diagrama esquematico. O CI 7805 (U2) regula a tensao de
alimentacao de entrada, proveniente de uma bateria de 9V, para o valor de +5V
que alimenta o microcontrolador, o mostrador LCD e o banco de memorias. O
transistor NPN BC547 (Q1) compatibiliza o nvel de tensao que sai de U1 (+5V)
com o utilizado pelo circuito do sonar-altmetro (+9V).
Na Fig. 5.3 pode ser vista a montagem final do computador de bordo.
Descric
ao do Programa
O programa que e executado no microcontrolador foi escrito em linguagem C-ANSI, e
compilado com o CodeVisionAVR versao 1.24.0 da HP InfoTech (www.hpinfotech.ro),
que e um ambiente integrado de desenvolvimento (IDE) e compilador especficos
para a famlia AVR da Atmel. As principais funcoes do programa do computador
de bordo sao:
92
R2
4K7
OUT
IN
GND
L78L05/TO92
Mostrador LCD 16
carac x 2 linhas
C1
.1u
C2
.1u
U3
C3
47u x 25V
LCD1
1
2
3
4
5
6
7
8
9
10
11
12
13
14
Q2
BC557
R5
4K7
TECLADO MATRICIAL
Comunicao
RS-232
D1
1N4148
D3
1N4148
5
9
4
8
3
7
2
6
1
SADA DE TXD
ENTRADA DE RXD
4 x 1N4148
D101
Reset
F1
7
Limpa
D102
D103
F2
Entra Volta
fio branco
Sinal de sada do
amplificador/detector
do sonar
R12
5k6
PA0 (AD0/PCINT0)
PC0 (A8/PCINT8)
PA1 (AD1/PCINT1)
PC1 (A9/PCINT9)
PA2 (AD2/PCINT2)
PC2 (A10/PCINT10)
PA3 (AD3/PCINT3)
PC3 (A11/PCINT11)
PA4 (AD4/PCINT4)PC4 (A12/TCK/PCINT12)
PA5 (AD5/PCINT5)PC5 (A13/TMS/PCINT13)
PA6 (AD6/PCINT6)PC6 (A14/TDO/PCINT14)
PA7 (AD7/PCINT7) PC7 (A15/TDI/PCINT15)
21
22
23
24
25
26
27
28
1
2
3
4
5
6
7
8
PB0 (OC0/T0)
PD0/RXD
PB1 (OC2/T1)
PD1/TXD
PB2 (RXD1/AIN0)
(INT0/XCK1) PD2
PB3 (TXD1/AIN1)
(INT1/ICP3) PD3
PB4 (SS/OC3B) PD4(TOSC1/XCK0/OC3A)
PB5/MOSI
PD5(OC1A/TOSC2)
PB6/MISO
PD6/WR
PB7/SCK
PD7/RD
10
11
12
13
14
15
16
17
9
7
5
3
1
VDD
D7
1N4148
XTAL1
XTAL2
+5V
Y1
4MHz
RST
40
VCC
PE0 (ICP/INT2)
PE1 (ALE)
PE2 (OC1B)
P1
C4
47u x 25V
R110
J101
10
8
6
4
2
39
38
37
36
35
34
33
32
19
18
Programao serial
STICK M 2 X 5 90 graus
R9
4K7
U1
D104
+
5K6
31
30
29
R13
5k6
D109
1N4148
ATmega162
+5V
C101
.1u
R109 10k
ALIMENTAO EXTERNA DE 9V
1
2
3
1
+
C8
100u
C9
.1u
VIN
GND
J103
VOUT
U4
+5V
U2 7805/SIP
1
2
3
SDA
6
7
SCL
WP
24LC256
U5
VDD
A0
A1
A2
1
2
3
SDA
6
7
SCL
WP
24LC256
U6
VCC
A0
A1
A2
VSS
SCL
WP
VDD
A0
A1
A2
1
2
3
SDA
SDA
6
7
VCC
1
2
3
fio verde
A0
A1
A2
VSS
SCL
WP
VSS
6
7
VDD
R107
470R
D17
1N4148
R108
10k
R15
4K7
Q1
BC547
VCC
Pulsos de 40 KHz
para o sonar
fio marrom
VSS
VDD
VCC
SONAR-ALTMETRO
93
MOSTRADOR LCD
24LC256
U7
24LC256
VDD
3
+
C7
.1u
C6
100u
5.3.3
94
AO SERVO DE COLETIVO
AO CANAL 3 DO RECEPTOR
+5V
5
3
4
1N4148
D1
2
AO COMPUTADOR DE BORDO
R1
LS1
Q1
BC547
2K2
U1
100u 25V
C2
+5V
0.1
RA3/MCLR/VPP
RA0/AN0/CIN+/ICSPDAT
RA1/AN1/CIN-/VREF/ICSPCLK
RA2/AN2/COUT/T0CKI/INT
RA4/~T1G/OSC2/AN3/CLKOUT
RA5/T1CKI/OSC1/CLKIN
VDD
C3
RC0/AN4
RC1/AN5
RC2/AN6
RC3/AN7
RC4
RC5
10
9
8
7
6
5
R3
GND
C1
13
12
11
3
2
14
TERRA
+5V
+5V
2k
PIC16F676
100n
D3
O programa do microcontrolador U1 foi escrito em linguagem C-ANSI e compilado na IDE PicantIDE, que inclui o compilador C2C, ambos produtos da Picant
(www.picant.com).
A escolha do microcontrolador PIC16F676 teve motivacoes semelhantes `as da
escolha do ATmega162 para o computador de bordo.
Na Fig. 5.3 pode ser vista a montagem final do circuito do circuito comutador.
5.3.4
Montagem
95
Captulo 6
Conclus
oes
6.1
Introdu
c
ao
6.2
Modelagem
6.3
Identificac
ao
6.4
Projeto do Controlador
Um dos principais desafios do projeto do controlador era garantir sua robustez contra
a incerteza nos parametros Zcol e Zw , a presenca de rudos de medida, alem das
perturbacoes impostas principalmente pelo vento. O controlador escolhido foi o
PD, e suas caractersticas como: robustez; comportamento na presenca de rudo de
medida; e resposta a uma entrada em degrau; foram verificadas por meio de uma
serie de simulacoes em ambiente Matlab/Simulink, para variacoes independentes de
Zcol e Zw na faixa de 20%, e os resultados obtidos foram satisfatorios. Verificou-
se, tambem, qual seria o limite de variacao parametrica suportada pelo sistema em
malha fechada, e chegou-se a resultados que indicam que o sistema se manteria
estavel ate uma faixa limite de 75%, o que conferia uma boa margem para erros
na realizacao do primeiro voo em malha-fechada.
97
6.5
Observa
c
oes
98
6.6
Pontos a Desenvolver
A utilizacao dos angulos de Euler nas equacoes cinematicas impedem a sua utilizacao em voos acrobaticos, com manobras do tipo loopping, por exemplo, uma vez
que esta descricao possui singularidades. Este problema pode ser solucionado pela
substituicao dos angulos de Euler pelos quaternions, que possuem representacao
global para as transformacoes de sistemas de coordenadas.
A falta de um sistema de avionica adequado, incluindo um receptor de DGPS
e uma IMU (Inertial Measurement Unit), impossibilitou uma identificacao mais
completa do modelo desenvolvido.
O desenvolvimento de um sistema de avionica mais complexo demandara, tambem,
um sistema de comunicacao, como por exemplo uma rede sem fio, capaz de realizar
em tempo-real a aquisicao de dados de voo, alteracao de parametros do controlador
e a redefinicao de trajetorias, para efeitos de identificacao e testes de desempenho
do controlador.
99
Bibliografia
Ahmad, S. S., Bhattacharyya, S. P. & Keel, L. H. (1995), Toolbox Robust Parametric
Control, Mathworks.
100
Gomes,
V.
A.
(2002),
Mecanica
de
voo,
Technical
report,
http://www.aerotecnologia.com.br.
Haintz, P., Mierau, M., Tsai, J., Georgiou, T. & Tcaciuc, D. (2003), Helicopter
flight automation, Technical report, School Of Engineering Science Simon Fraser University.
Harris, F. D. (1972), Articulated rotor blade flapping motion at low advance ratio,
J. Amer. Helicopter Soc. January .
Heffley, R. & Mnich, M. (1987), Minimum-complexity helicopter simulation mathematical model, NASA (Technical Report number 87-A-7).
Johnson, W. (1980), Helicopter Theory, Dover Publications, Inc., New York.
Keys, C. N. (1984), Rotary-Wing Aerodynamics Volume 2, Dover Publications, Inc.,
New York.
Ljung, L. (1999), System Identification: Theory for the User, Prentice Hall, Upper
Saddle River, N.J.
Mettler, B. (2003), Identification Modeling and Characteristics of Miniature Rotorcraft, Kluwer Academic Publishers, Boston, MA.
MIL-STD-1797A (1990), Flying qualities of piloted aircraft, MIL-STD-1797A.
Mill, C. (1996), Practical theories, Technical report, http://www.w3mh.co.uk/.
Munzinger, C. (1998), Development of a real-time flight simulator for an experimental model helicopter, Georgiatech. Diploma Thesis.
Padfield, G. (1996), Helicopter Flight Dynamics: The Theory and Application of
Flying Qualities and Simulation Modeling, AIAA Education Series, Reston,
VA.
Saripalli, S. & Roberts, J. M. (2003), A tale of two helicopters, Technical report,
Robotics Research Lab, USC,Los Angeles, USA; CSIRO Manufacturing and
Infrastructure Technology, Australia and University of Queensland, Australia.
Stepniewski, W. Z. (1984), Rotary-Wing Aerodynamics Volume 1, Dover Publications, Inc., New York.
Thu (1999), Raptor 30 class helicopter, Manual of Assembly and Maintenance.
101
102