Академический Документы
Профессиональный Документы
Культура Документы
Resumo Neste artigo, uma sntese de projeto sobre o desenvolvimento de um veculo areo no tripulado (VANT) apresentado. O VANT um helicptero do tipo quadrirrotor. A discusso concentra-se no filtro de Kalman para estimao de posio
e atitude, juntamente com algoritmos para a estabilizao de cmara. Resultados de testes de vo mostram a habilidade do helicptero em realizar voo autnomo com o filtro de Kalman em questo, juntamente com pequenos erros angulares durante a
estabilizao de cmera.
Palavras-chave rob areo, voo autnomo, filtro de Kalman estendido
Introduo
ISBN: 978-85-8001-069-5
systems
914
cmera a bordo do Gyro 200. O objetivo manter invariante a linha de visada da cmera na presena de
movimentos do VANT, possibilitando a aquisio de
melhores imagens. Para isto, utiliza-se a informao
de atitude obtida na navegao e um gimbal de dois eixos, sobre o qual a cmera montada. Uma extenso
natural da estabilizao o seguimento de um objeto
cuja posio conhecida, comumente referida como
ponto de interesse (POI). Este tema tambm abordado.
Assim, o trabalho organizado como se segue: a
seo 2 apresenta as equaes gerais de mecnica de
voo e clculo de parmetros. Na seo 3, discute-se
a arquitetura de sensores e diferentes estratgias para
a utilizao do Filtro de Kalman. A seo 4 trata da
estabilizao da cmera e seguimento do ponto de interesse, mostrando resultados de simulao com dados
extrados de voo. As concluses e trabalhos futuros
so apresentados na seo 5.
2
Sob o ponto de vista de mecnica de voo, o quadrirrotor pode ser tratado como um corpo rgido. Neste
caso, so necessrias 6 equaes de cinemtica: 3 de
rotao e 3 de translao; bem como 6 equaes de
dinmica: 3 de rotao e 3 de translao. Os constituintes bsicos da modelagem so os sistemas de coordenadas, a descrio das foras e momentos e a forma
de parametrizao de atitude.
Os motores do quadrirrotor so numerados de 1 a
4 no sentido horrio. O par 1 e 3 gira no sentido horrio enquanto o par 2 e 4 gira no sentido anti-horrio.
As quatro hlices provocam foras de trao paralelas e estas atuam sobre quatro pontos coplanares. Este
plano denominado plano das hlices. Considera-se
ainda que os quatro motores so idnticos e que a fora
de arrasto desprezvel. Estas convenes so representadas na Fig. 2.
(1)
(2)
00 T
T
(4)
onde:
T = kf 21 + 22 + 23 + 24
(5)
ISBN: 978-85-8001-069-5
L = F4 l F2 l = kf l(24 22 )
(6)
M = F1 l F3 l = kf l(21 23 )
(7)
915
= uT
= uT
= uT
= uT
+ u + u
u u
u + u
+ u u
(9)
onde:
1 L
1M
1N
1T
, u =
, u =
, u =
4 kf
2 kf l
2 kf l
4 km
(10)
Ento, para realizar uma manobra que demande
uma trao T e momentos L, M e N , preciso obter
rotaes 1 , 2 , 3 e 4 segundo as equaes (9)
e (10). Essas rotaes desejadas so obtidas por comandos enviados aos motores eltricos, que, por sua
vez, tambm so sistemas dinmicos. No entanto, geralmente, essa dinmica ignorada, considerando que
o tempo de resposta dos motores bem que a menor
constante de tempo da mecnica de rotao ou translao.
uT =
3 Filtro de Kalman
Para obteno de uma medida de PVAT, empregado
um Filtro de Kalman Estendido (FKE). Como j citado, o quadrirrotor dispe de magnetmetros, acelermetros, giroscpios, barmetro e GPS. O FKE
ento utilizado para a fuso dos dados dos diferentes
sensores.
Fisicamente, a dinmica de translao acoplada
dinmica de rotao. Alm disso, ao estabelecer as
equaes do filtro de Kalman, a dinmica de rotao
tambm torna-se acoplada dinmica de translao.
No entanto, na implementao, gerou-se dois filtros
de Kalman diferentes: um para estimar o estado de rotao, outro para estimar o estado de translao. A razo da separao diz respeito realizao nos processadores embarcados: separando os dois filtros, ambos
podem funcionar a taxas de amostragem diferentes, a
rotao operando a uma taxa mais alta. Fisicamente,
isso justificado pelas constantes de tempo de rotao
serem bem menores que as da translao.
O filtro de rotao estima os ngulos de Euler
e utilizando como representao o quatrnion; enquanto o filtro de translao estima as velocidades
inerciais vn , ve , vd , as coordenadas xn , ye no sistema
NED local, bem como a altura H. As entradas do filtro de rotao so a leitura de velocidade angular dos
giroscpios, a leitura dos acelermetros e a estimativa
de acelerao NED, vinda do filtro de translao. O
valor de dado por uma unidade inercial.
ISBN: 978-85-8001-069-5
916
Altura (m)
20
15
10
5
0
50
40
50
30
40
30
20
20
10
10
0
10
5
0
5
10
ng. de guinada
(graus)
ng. de arfagem
(graus)
ng. de rolamento
(graus)
50
100
150
Tempo (s)
200
250
300
50
100
150
Tempo (s)
200
250
300
50
100
150
Tempo (s)
200
250
300
4
2
0
2
4
355
350
345
340
dados de atitude obtidos pelo FKE. Neste caso, apenas os movimentos rotacionais so compensados.
Para o seguimento de um ponto de interesse, porm, a distncia at o ponto que se quer apontar suposta conhecida. Desta forma, a linha de visada recalculada com base no deslocamento do VANT e os
movimentos translacionais so compensados. No caso
do ponto de interesse, o yaw do quadrirrotor utilizado como grau de liberdade, isto , pode ser comandado automaticamente para seguir um alvo.
A hiptese de que a distncia ao alvo conhecida
razovel no contexto de navegao autnoma onde
um usurio especifica waypoints do voo previamente,
por coordenadas de GPS. Deseja-se observar durante
o percurso um objeto cuja posio pode ser tambm
especificada.
4.1
ISBN: 978-85-8001-069-5
Algoritmo de compensao
(11)
(12)
917
(13)
(14)
+ atan2(ULz ,
(15)
q
atan2(ULy , ULx )
(17)
Esta soluo utiliza a idia de clculo de cinemtica inversa atravs de projees conforme (Sciavicco
et al., 2009). A escolha = assegura que a cmera isolada do movimento de roll do UAV, uma
vez que se tratam de rotaes sucessivas ao redor do
mesmo eixo.
Decompondo-se o vetor linha-de-visada no sistema de coordenadas do quadrirrotor, pode-se observar que o ngulo de yaw dependente apenas de x e y
2
, enquanto o ngulo depende das trs componentes.
A soluo proposta em (15) obtida calculando-se as
tangentes dois dois ngulos em relao s componentes do vetor UL . A soluo foi validada tanto analiticamente quando por simulao e experimentos em
voo.
Note que, no entanto, a soluo proposta compensa apenas os movimentos rotacionais do VANT.
4.2
ISBN: 978-85-8001-069-5
(18)
918
ngulo (graus)
10
5
0
5
10
0
50
100
150
200
250
tempo(s)
Pitch medido e correo calculada
300
ngulo (graus)
20
40
60
0
50
100
150
200
tempo(s)
250
300
0
10
0
0
20
40
60
0
ngulo (graus)
ngulo (graus)
ngulo (graus)
0
1
2
3
0
50
100
150
200
250
tempo(s)
Pitch medido e correo calculada
300
50
100
150
200
tempo(s)
yaw comandado
250
300
50
100
150
200
tempo(s)
250
300
Concluses
Os resultados obtidos com o Filtro de Kalman Estendido mostram a possibilidade de obter um voo
autnomo de razovel preciso utilizando sensores de
baixo custo. O FKE projetado para que o quadrirrotor opere tanto em ambiente externo quando interno,
quando h ausncia de sinal GPS. Alm da navegao, o algoritmo de estabilizao inercial de cmeras
apresentado, mostrando a possibilidade de no apenas compensar os movimentos externos do VANT na
cmera como tambm de seguir um alvo cuja posio
conhecida. Trabalhos futuros incluem a utilizao
de servoviso para posicionamento do quadrirrotor e
auxlio no seguimento de objetos de interesse.
ISBN: 978-85-8001-069-5
0.8
0.6
0.4
0.2
0
0
50
100
150
200
250
tempo(s)
Erro em radianos para ponto de interesse
300
15
ngulo (graus)
ngulo (graus)
10
5
0
0
50
100
150
200
tempo(s)
250
300
919
Referncias
Battistel, A., Lizarralde, F. and Hsu, L. (2012). Inertially stabilized platforms using two gyroscopic
measures and sensitivity analysis to unmodeled
motion, American Control Conference .
de Ftima Bento, M. (2008). Unmanned aerial vehicles: An overview, Inside GNSS 3(1): 5461.
Han, J., Kwon, J. H., Lee, I. and Choi, K. (2011).
Position and attitude determination for uavbased gps, imu and at without gcps, in IEEE
(ed.), Multi-Platform/Multi-Sensor Remote Sensing and Mapping (M2RSM), 2011 International
Workshop on, pp. 15.
Hoffmann, G., Huang, H., Waslander, S. and Tomlin,
C. (2007). Quadrotor helicopter flight dynamics
and control: Theory and experiment, in AIAA
(ed.), AIAA Guidance, Navigation and Control
Conference and Exhibit, Hilton Head, South Carolina. AIAA-2007-6461.
Huang, H., Hoffmann, G. M., Waslander, S. L. and
Tomlin, C. J. (2009). Aerodynamics and control
of autonomous quadrotor helicopters in aggressive maneuvering, in IEEE (ed.), Robotics and
Automation, 2009. ICRA 09. IEEE International Conference on, pp. 32773282.
Sanchez, A., Carrillo, L. R. G., Rondon, E., Lozano,
R. and Garcia, O. (2011). Hovering flight improvement of a quad-rotor mini uav using brushless dc motors, Journal of Intelligent and Robotic
Systems 61(1-4): 85101.
Sciavicco, L., Siciliano, B., Villani, L. and Oriolo, G.
(2009). Robotics: modelling, planning and control, Springer Verlag.
Wen, J. T. and Kreutz-Delgado, K. (1991). The attitude control problem, IEEE Trans. Aut. Contr.
36(10): 11481162.
Wendel, J., Meister, O., Schlaile, C. and Trommer,
G. F. (2006). An integrated gps/mems-imu navigation system for an autonomous helicopter, Aerospace Science and Technology 10(6): 527533.
ISBN: 978-85-8001-069-5
920