5.5 Simulac¸˜oes num´ericas utilizando o controlador auxiliar por sliding mode
5.5.2 Resultados num´ericos utilizando o controlador auxiliar por sliding mode
A Figura 5.14 mostra, em azul, a evoluc¸˜ao no tempo das sa´ıdas desejadas, ou seja, a posic¸˜ao do centro de massap(t) = [px(t), py(t), pz(t)]⊤e o ˆangulo de yawψ(t), e, em tracejado vermelho, mostra a trajet´oria desejada. Observe que o quadric´optero convergiu para pr´oximo da trajet´oria desejada. Na teoria, foi visto que a utilizac¸˜ao das leis de controle auxiliares (4.31) e (4.32) faz com que os erros de rastreamentoep(t) e eψ(t) convirjam para regi˜oes delimitadas por bolas centradas na origem e de raiosεpeεψ respectivamente. Pode-se observar, na Figura 5.15, os erros de rastreamento convergem para uma regi˜ao pr´oxima `a origem estando de acordo com os valoresεp = 0.1 e εψ = 0.05, calculados a partir dos parˆametros do controlador.
0 10 20 -2 -1 0 1 0 10 20 -3 -2 -1 0 1 0 10 20 -2 0 2 4 6 0 10 20 -0.5 0 0.5 1 px (t ) [m ] py (t ) [m ] pz (t ) [m ] ψ (t ) [r ad ] Tempo [s] Tempo [s] Tempo [s] Tempo [s]
Figura 5.14: Sa´ıdas desejadas (linha cont´ınua azul) e trajet´orias desejadas (linha tracejada ver- melha) para o controlador auxiliar por sliding mode.
0 5 10 15 20 -3 -2.5 -2 -1.5 -1 -0.5 0 0.5 epx epy epz eψ A m p li tu d e [m ] o u [r ad ] Tempo [s]
Figura 5.15: Erros de trajet´oria para o controlador auxiliar por sliding mode.
trolador auxiliar por sliding mode. As curvas de evoluc¸˜ao dos empuxos com o tempo, para o controlador auxiliar por sliding mode, s˜ao muito parecidas com as curvas obtidas para o controladorH∞, apresentadas na Figura 5.13, com a excec¸˜ao de que nos instantes iniciais, o controlador auxiliar por sliding mode n˜ao possui uma variac¸˜ao t˜ao grande na amplitude.
0 10 20 -10 0 10 20 0 10 20 -10 0 10 20 0 10 20 -10 0 10 20 0 10 20 -10 0 10 20 f1 [N ] f2 [N ] f3 [N ] f4 [N ] Tempo [s] Tempo [s] Tempo [s] Tempo [s]
Figura 5.16: Sinais de controle para o controlador auxiliar por sliding mode.
Apesar do bom desempenho obtido pelo controlador auxiliar por sliding mode, a necessidade de conhecer a acelerac¸˜ao e a derivada da acelerac¸˜ao nas leis de controle (4.31) e (4.32) ´e a grande desvantagem da t´ecnica proposta em relac¸˜ao ao controlador auxiliarH∞.
6 CONCLUS ˜AO
Este trabalho apresentou leis de controle para quadric´opteros com o objetivo de se rastrear uma trajet´oria de referˆencia e rejeitar perturbac¸˜oes que podem afetar a dinˆamica de voo do ve´ıculo. Sabe-se que um quadric´optero ´e naturalmente dif´ıcil de se controlar devido `a presenc¸a de n˜ao linearidades no modelo dinˆamico e subatuac¸˜ao. A estrat´egia adotada foi utilizar a t´ecnica de controle n˜ao linear feedback linearization, como uma malha de controle interna, com o objetivo de simplificar o sistema, neutralizando as n˜ao linearidades e lidando com a subatuac¸˜ao, para que uma segunda lei de controle, respons´avel pela estabilidade, desempenho e rejeic¸˜ao a dist´urbios, possa ser aplicada.
Primeiramente, foi necess´ario levantar um modelo dinˆamico de um quadric´optero sujeito a perturbac¸˜oes, que podem ser provenientes de efeitos dinˆamicos n˜ao modelados ou dist´urbios ex´ogenos. N˜ao foram consideradas simplificac¸˜oes de pequenos ˆangulos na dinˆamica de rotac¸˜ao durante o levantamento das equac¸˜oes de movimento, o que torna o modelo apre- sentado diferente dos encontrados na literatura, podendo representar um modelo real de qua- dric´optero mesmo durante manobras mais agressivas.
Durante o projeto do controlador por feedback linearization, foi mostrado que n˜ao ´e poss´ıvel projetar uma lei de controle est´atica utilizando linearizac¸˜ao entrada-sa´ıda, que ´e um dos m´etodos que comp˜oe a t´ecnica feedback linearization, quando a posic¸˜ao do centro de massa e o ˆangulo de yaw do quadric´optero s˜ao escolhidos como sa´ıdas, uma vez que essa escolha de sa´ıdas faz com que o sistema n˜ao possua um vetor de grau relativo. Utilizando a extens˜ao dinˆamica proposta por Mistler et al. (2001), foi poss´ıvel projetar uma lei de controle dinˆamica utilizando a linearizac¸˜ao entrada-sa´ıda. Essa lei de controle foi crucial para lidar com a subatuac¸˜ao inerente do sistema, bem como neutralizar as n˜ao linearidades do modelo dinˆamico do quadric´optero. Assim como toda lei de controle por feedback linearization, ´e necess´ario projetar uma segunda lei de controle, denominada lei de controle auxiliar, que ´e respons´avel pela estabilidade e de- sempenho do sistema em malha fechada. Neste trabalho foram apresentadas trˆes leis de controle
auxiliares distintas, cada uma projetada utilizando t´ecnicas de controle diferentes. S˜ao elas o controle LQR, controleH∞e controle por sliding mode.
O controlador auxiliar LQR foi projetado considerando o sistema sem a presenc¸a de perturbac¸˜oes. O objetivo principal da utilizac¸˜ao desse controlador auxiliar foi para verificar, atrav´es de simulac¸˜oes, se a lei de controle por feedback linearization foi projetada corretamente. Foi tamb´em mostrado, atrav´es de simulac¸˜oes, que, quando a presenc¸a de perturbac¸˜oes ´e des- considerada na etapa de projeto das leis de controle, fica invi´avel encontrar uma lei de controle que consiga rejeitar as perturbac¸˜oes suficientemente bem.
O controlador H∞ foi projetado com o objetivo de minimizar a influˆencia das perturbac¸˜oes nos erros de rastreamento. Esse controlador n˜ao necessita do conhecimento da acelerac¸˜ao e nem da derivada da acelerac¸˜ao do quadric´optero para a implementac¸˜ao, o que ´e uma vantagem significativa em relac¸˜ao ao controlador por sliding mode. Como uma desvanta- gem, ´e um controlador dinˆamico de 14 estados, o que dificulta o c´alculo da lei de controle em tempo real. As simulac¸˜oes com o controlador auxiliarH∞se mostraram bastante satisfat´orias, sendo que a ´unica ressalva que pode ser feita ´e a grande variac¸˜ao dos sinais de controle no in´ıcio da simulac¸˜ao, fato esse que est´a relacionado com as condic¸˜oes iniciais dos estados do controlador.
O controlador sliding mode foi projetado para anular completamente a influˆencia das perturbac¸˜oes nos erros de rastreamento, sendo que o ´unico pr´e-requisito necess´ario para o projeto do controlador ´e que as perturbac¸˜oes devem ser limitadas por func¸˜oes limitantes conhe- cidas. A lei de controle obtida ´e uma lei de controle n˜ao linear descont´ınua, onde, na maior parte do tempo, ela opera pr´oximo `a descontinuidade. Isso acarreta um fenˆomeno indesejado deno- minado chattering, que ´e um chaveamento de alta frequˆencia que, al´em de causar uma alta ativi- dade de controle, pode excitar altas frequˆencias do sistema que foram negligenciadas durante a modelagem. Este trabalho apresenta uma maneira de eliminar a descontinuidade presente na lei de controle apenas trocando a func¸˜ao sinal por uma func¸˜ao de saturac¸˜ao. Essa mudanc¸a na lei de controle ´e crucial para eliminar o chattering, por´em os erros de rastreamento n˜ao convergem mais para zero. De fato, ´e mostrado, tanto teoricamente quanto em simulac¸˜oes que, utilizando a lei de controle cont´ınua, os erros convergem para o interior de bolas centradas na origem cu- jos raios pode ser alterados ajustando os parˆametros do controlador. A grande desvantagem do controlador auxiliar por sliding mode ´e a necessidade de se medir tanto a acelerac¸˜ao do qua- dric´optero quanto a derivada da acelerac¸˜ao, tornando necess´ario o desenvolvimento de algum
tipo de observador para estimar essas grandezas.
6.1
Temas para trabalhos futuros
Esse trabalho teve como objetivo o desenvolvimento de leis de controle para qua- dric´opteros robustas a perturbac¸˜oes que podem afetar a dinˆamica de voo do ve´ıculo. Como um poss´ıvel tema de pesquisa futura, os projetos e resultados aqui apresentados poderiam ser esten- didos para incluir ru´ıdos de medic¸˜ao. Um outro poss´ıvel tema compreende o desenvolvimento de um observador para estimar a acelerac¸˜ao e a derivada da acelerac¸˜ao do quadric´optero, que s˜ao informac¸˜oes cruciais para o controlador por sliding mode aqui apresentado.
REFER ˆENCIAS BIBLIOGR ´AFICAS
Anderson, B. D. O. and Moore, J. B. (1989). Optimal Control: Linear Quadratic Methods. Prentice-Hall, Englewood Cliffs, NJ, USA.
AscTec (2015). Asctec hummingbird.
Balas, G., Chiang, R., Packard, A., and Safonov, M. (2015). Robust Control Toolbox User’s
Guide. Mathworks.
Bonna, R. and Camino, J. F. (2015). Trajectory tracking control of a quadrotor using feed- back linearization. In Proceedings of the International Symposium on Dynamic Problems of
Mechanics, pages 1–9, Natal, Brazil.
Bouabdallah, S. (2007). Design and control of quadrotors with application to autonomous
flying. PhD thesis, ´Ecole Polytechnique F´ed´erale de Lausanne.
Bouabdallah, S., Noth, A., and Siegwan, R. (2004). PID vs LQ control techniques applied to an indoor micro quadrotor. In Proceedings of the IEEE/RSJ International Conference on
Intelligent Robots and Systems, pages 2451–2456, Sendai, Japan.
Bryson, A. E. and Ho, Y.-C. (1975). Applied Optimal Control: Optimization, Estimation and
Control. CRC Press, Boca Raton, FL, USA.
Castillo, P., Lozano, R., and Dzul, A. (2005). Modeling and Control of Mini-Flying Machines. Springer-Verlag, London, UK.
Cutler, M. and How, J. (2015). Analysis and control of a variable-pitch quadrotor for agile flight. Journal of Dynamic Systems, Measurement and Control, Transactions of the ASME, 137(10):1–14.
Das, A., Subbarao, K., and Lewis, F. (2008). Dynamic inversion with zero-dynamics stabiliza- tion for quadrotor control. IET Control Theory and Applications, 3(3):303–314.
Doyle, J., Glover, K., Khargonekar, P. P., and Francis, B. A. (1989). State-space solutions to standardH2andH∞control problems. IEEE Transactions on Automatic Control, 34(8):831– 847.
Fantoni, I. and Lozano, R. (2002). Non-linear Control for Underactuated Mechanical Systems. Springer-Verlag, London, UK.
Greenwood, D. T. (2003). Advanced Dynamics. Cambridge University Press, New York, NY, USA.
How, J., Bethke, B., Frank, A., Dale, D., and Vian, J. (2008). Real-time indoor autonomous vehicle test environment. IEEE Control Systems Magazine, 28(2):51–64.
Isidori, A. (1995). Nonlinear Control Systems. Springer-Verlag, London, UK.
Khalil, H. K. (1996). Nonlinear Systems. Prentice-Hall, Upper Saddle River, NJ, USA.
Kirk, D. E. (2012). Optimal Control Theory: An Introduction. Dover Publications, Mineola, NY, USA.
Lee, D., Kim, H. J., and Sastry, S. (2009). Feedback linearization vs. adaptive sliding mode control for a quadrotor helicopter. International Journal of Control, Automation, and Systems, 7(3):419–428.
Lupashin, S., Hehn, M., Mueller, M., Schoellig, A., Sherback, M., and D’Andrea, R. (2014). A platform for aerial robotics research and demonstration: The flying machine arena. Mecha-
tronics, 24(1):41–54.
Madani, T. and Benallegue, A. (2006a). Backstepping control for a quadrotor helicopter. In
Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems, pages 3255–3260, Beijing, China.
Madani, T. and Benallegue, A. (2006b). Backstepping sliding mode control applied to a minia- ture quadrotor flying robot. In Proceedings of the IECON Industrial Electronics Conference, pages 700–705, Paris, France.
Mahony, R., Kumar, V., and Corke, P. (2012). Multirotor aerial vehicles: Modeling, estimation, and control of quadrotor. IEEE Robotics & Automation Magazine, 19(3):20–32.
Michael, N., Mellinger, D., Lindsey, Q., and Kumar, V. (2010). The GRASP multiple micro- UAV testbed. IEEE Robotics and Automation Magazine, 17(3):56–65.
Mistler, V., Benallegue, A., and M´Sirdi, N. K. (2001). Exact linearization and noninteracting control of a 4 rotors helicopter via dynamic feedback. In Proceedings of the IEEE Internati-
onal Workshop on Robot and Human Interactive Communication, pages 586–593, Bordeaux, France.
Raffo, G., Ortega, M., and Rubio, F. (2010). An integral predictive/nonlinear H∞ control structure for a quadrotor helicopter. Automatica, 46(1):29–39.
Skogestad, S. and Postlethwaite, I. (2005). Multivariable Feedback Control: Analysis and
Design. John Wiley and Sons.
Slotine, J. J. and Li, W. (1991). Applied Nonlinear Control. Prentice-Hall, Englewood Cliffs, NJ, USA.
Spong, M. W. (1998). Control Problems in Robotics and Automation, chapter Underactuated Mechanical Systems. Springer-Verlag.
Tayebi, A. and McGilvray, S. (2006). Attitude stabilization of a VTOL quadrotor aircraft. IEEE
Transactions on Control Systems Technology, 14(3):562–571.
Zhou, K., Doyle, J. C., and Glover, K. (1996). Robust and Optimal Control. Prentice-Hall, Upper Saddle River, NJ, USA.
A FERRAMENTAS MATEM ´ATICAS
A.1
Gradiente e Jacobiano
Dada uma func¸˜ao escalar suaveh(x) : Rn → R, o gradiente de h, denotado por ∇h, ´e o vetor coluna cujos elementos s˜ao dados por
(∇h)i = ∂h ∂xi
Similarmente, dado um campo vetorialf (x) : Rn → Rn, o Jacobiano def , denotado por ∇f, ´e uma matriz cujos elementos s˜ao dados por
(∇f)ij = ∂fi ∂xj