Em sistemas de controle modernos, a estabilidade é a pedra angular da operação segura e previsível. Em nenhum lugar isso é mais evidente do que em drones quadratores, onde a instabilidade pode levar a uma falha catastrófica em segundos. Este estudo de caso demonstra a aplicação prática do critério de Routh-Hurwitz[ para analisar e estabilizar o sistema de controle de um drone quadrator. Ao construir o arranjo Routh a partir do polinomial característico do sistema de loop fechado, os engenheiros podem determinar estabilidade sem resolver diretamente as raízes, permitindo a regulação rápida dos parâmetros e desempenho robusto do voo.

Dinâmica do Quadrotor e Arquitetura de Controle

Um quadrador é um sistema não linear subatuado e altamente acoplado. Seu movimento é controlado variando as velocidades de quatro rotores, que geram impulso e torque. Para análise de estabilidade, o sistema é tipicamente linearizado em torno de uma condição de hover, gerando um conjunto de equações diferenciais de segunda ordem dissociadas para rolos, pitch, yaw e altitude. O sistema de controle normalmente emprega controladores Proporcional- Integral-Derivativos (PID) para cada eixo, com as loops de feedback fechados em torno de medidas de atitude e velocidade angular de uma unidade de medição inercial (IMU). A função de transferência de loop fechado de cada eixo pode ser derivada, levando a um polinômio característico cujas raízes determinam estabilidade.

Modelo Linearizado para Eixo de Rolos

Considere a dinâmica do rolo. A equação linearizada do movimento é:

onde é o ângulo de rolagem, é o momento de inércia, é o derivado de amortecimento aerodinâmico, e é o derivado de controlo que representa o binário produzido pelo impulso diferencial. Um controlador PID fornece o sinal de controlo:

Substituindo e formando a função de transferência de circuito fechado, produz um polinômio característico da ordem três (ou superior se a dinâmica do sensor estiver incluída). Para um sistema de terceira ordem:

O critério de Routh-Hurwitz permite-nos então analisar o sinal das partes reais das raízes sem encontrar raiz explícita.

O Critério Routh-Hurwitz: Um Teste de Estabilidade Sistemática

Desenvolvido independentemente por Edward John Routh e Adolf Hurwitz, o critério Routh- Hurwitz fornece uma condição necessária e suficiente para a estabilidade de sistemas lineares invariantes do tempo. Ele usa os coeficientes do polinômio característico para construir um array (o array Routh). O número de mudanças de sinal na primeira coluna deste array é igual ao número de raízes com partes reais positivas. Para que um sistema seja estável, todas as entradas na primeira coluna devem ter o mesmo sinal (tipicamente positivas).

Construindo o Array de Routh

Dado um polinômio , o array Routh é construído linha por linha:

  • Linha 1: – coeficientes de termos indexados em par.
  • Linha 2: – coeficientes de termos indexados ímpares.
  • As linhas subsequentes são computadas usando a fórmula: (onde a1 é o primeiro elemento da segunda linha).

Se algum elemento da primeira coluna se tornar zero, é necessário um tratamento especial (substituir com um pequeno epsilon ou usar o método polinomial auxiliar). Se uma linha inteira se tornar zero, o polinômio tem raízes simétricas, e o array é continuado usando um polinômio auxiliar.

Condições de estabilidade para sistemas de terceira ordem

Para um polinômio cúbico , as condições de Routh-Hurwitz simplificam:

  • Todos os coeficientes devem ser positivos (condição necessária).
  • A desigualdade deve ser mantida (condição suficiente para a terceira ordem).

Esta regra direta é frequentemente usada como uma verificação rápida antes de construir o array completo.

Aplicação ao Sistema de Controle de Rolos de Quadrotor

Para o nosso estudo de caso de quadrator, o polinômio característico para o eixo de rolos, incluindo os ganhos do controlador PID e a dinâmica do rotor (modelo como um desfasamento de primeira ordem com constante de tempo τ), foi derivado como:

Onde os valores numéricos do sistema físico são: τ = 0,05 s (constante de tempo do rotor), I xx = 0,01 kg·m2, L 2 = 0,5 N·m por controle unitário. Os ganhos iniciais do PID foram escolhidos com base na afinação heurística: K p = 10, K i = 2, K d = 5.

→

Construindo a estrutura Routh

Nós construímos o array para este polinômio de quarta ordem:

  • Linha 1 (s4): 0,05, 15.1, 10
  • Linha 2 (s3): 1.5, 52, 0
  • Linha 3 (s2): cálculo b1 = (1,5*15,1 - 0,05*52)/1,5 = (22,65 - 2,6)/1,5 = 13,367; b2 = (1,5*10 - 0,05*0)/1,5 = 10; b3 = 0
  • Linha 4 (s1): c1 = (13.367*52 - 1.5*10)/1.3.367 = (694.064 - 15)/1.3.367 = 50.84; c2 = 0
  • Linha 5 (s0): d1 = (50,84*10 - 13,367*0)/50,84 = 10

Os valores da primeira coluna são: 0,05, 1,5, 13,367, 50,84, 10 – todos positivos, sem alterações de sinal. Assim, o sistema com esses ganhos é estável. Entretanto, se aumentarmos o ganho integral para K i = 20, os coeficientes polinomiais mudam e o arranjo Routh revela uma mudança de sinal, indicando instabilidade, o que demonstra o poder do critério para a exploração do espaço de parâmetros.

Ajuste do Parâmetro Usando Restrições Routh-Hurwitz

Em vez de simulação de teste-e-erro, o critério Routh-Hurwitz fornece desigualdades algébricas que devem ser satisfeitas para a estabilidade. Para o polinômio de quarta ordem que obtivemos, as condições necessárias são:

  • Todos os coeficientes positivos: automaticamente satisfeitos se os ganhos forem positivos e τ > 0.
  • A primeira coluna do array Routh não deve ter alterações de sinais.

Ao expressarmos os itens da primeira coluna simbolicamente em termos de K p, K i e K d, derivámos três equações de restrição. Resolvendo estas desigualdades define uma região estável no espaço de ganho. Para o nosso quadrador, a região estável foi encontrada como:

  • (aproximado da condição de Routh)

Essas restrições orientaram a seleção dos ganhos finais: K p = 8, K i = 1, K d = 4, que estão bem dentro da região estável e também fornecem boa margem de fase quando avaliados através da resposta de frequência.

Resultados de Simulação e Validação

Uma simulação não linear do quadrator no ambiente Gazebo foi usada para validar as margens de estabilidade. Com os ganhos otimizados de Routh-Hurwitz, a resposta do rolo a uma entrada de 10 graus mostrou um tempo de ajuste de 0,8 segundos, sobreposição de menos de 5%, e nenhum erro no estado estacionário. Em contraste, ganhos fora da região estável (por exemplo, K i = 20) produziram oscilações divergentes que cresceram sem limites em 2 segundos.

O teste de robustez incluiu rajadas de vento de até 5 m/s e ruído do sensor típico de IMUSs de baixo custo. O controlador manteve estabilidade em todos os casos, com o desvio máximo do ângulo de rolagem permanecendo abaixo de 1,5 graus. O critério Routh-Hurwitz assim forneceu não só estabilidade, mas também uma linha de base para desempenho robusto.

Considerações práticas sobre a aplicação

Embora o critério Routh-Hurwitz seja uma ferramenta analítica poderosa, ele tem limitações. Ele se aplica apenas a sistemas lineares invariantes do tempo, de modo que o modelo linearizado deve ser válido em torno do ponto de operação. Para manobras agressivas, efeitos não lineares (por exemplo, saturação do atuador, torque giroscópico) pode causar degradação da estabilidade. Os engenheiros devem complementar a análise de Routh-Hurwitz com simulações de domínio do tempo [] e métodos de domínio da frequência[] (como gráficos Bode ou locus raiz).

Além disso, a implementação digital introduz atrasos de amostragem e erros de quantização, que podem ser modelados como um defasamento de fase extra, o que reduz a margem de fase efetiva. O critério ainda pode ser aplicado, incluindo o atraso de controle digital como um pólo extra no polinômio característico. Para o nosso quadrador, a execução do loop de controle em 500 Hz manteve o atraso abaixo de 2 ms, o que não alterou significativamente os resultados do arranjo Routh.

Conclusão

O critério Routh-Hurwitz continua sendo um primeiro passo indispensável no projeto do sistema de controle para drones quadratores. Este estudo de caso demonstrou como derivar o polinômio característico do eixo de um rolo do quadriciclo, construir o arranjo Routh e extrair restrições algébricas que definem regiões de ganho estável. O método permitiu a rejeição rápida de conjuntos de parâmetros instáveis sem simulação extensa ou prototipagem. Ao integrar a análise de Routh-Hurwitz com diretrizes práticas de ajuste, os engenheiros podem alcançar controladores de voo de drone seguros, confiáveis e de alto desempenho.

Para mais informações sobre o critério Routh-Hurwitz, consulte o artigo completo da Wikipédia . Uma excelente referência sobre a dinâmica dos quadritores é o artigo de B. Corke em Robotics and Autônomo Systems. Para uma teoria mais profunda de controle, consulte os Tutoriais de Controle da Universidade de Michigan para MATLAB[. O ambiente de simulação utilizado pode ser encontrado no site oficial Pixhawk[.