Coordinated Trajectory Control Algorithm for Quadcopter Motion along a Smooth Spatial Trajectory

Resumo Técnico: Algoritmo de Controle de Trajetória Coordenada para Movimento de Quadricóptero ao Longo de uma Trajetória Espacial Suave

Enunciado do Problema
O artigo aborda o desafio de controlar um quadricóptero para se mover ao longo de uma trajetória espacial tridimensional suave. Os autores distinguem entre dois paradigmas de controle primários: controle de rastreamento, onde o robô tenta alcançar uma posição específica em um tempo específico (frequentemente levando a soluções de caminho mais curto que podem falhar em ambientes ricos em obstáculos), e controle coordenado. No controle coordenado, a trajetória e o perfil de velocidade ao longo dessa curva são pré-especificados. O objetivo de controle é minimizar o desvio do caminho, em vez da distância a um ponto específico no tempo, permitindo que o veículo navegue ao redor de obstáculos ajustando sua velocidade ao longo da curva.

O problema específico tratado aqui envolve um modelo dinâmico não linear de um quadricóptero onde o grau relativo dos canais de controle não é idêntico, complicando a decomposição do modelo. Além disso, a solução proposta deve basear-se exclusivamente em medições de saída (coordenadas lineares $x, y, z$ e ângulo de guinada $\psi$) em vez de medições do vetor de estado completo, o que é uma restrição significativa em comparação com as abordagens existentes de realimentação de estado.

Metodologia
Os autores desenvolvem uma síntese de controle baseada em uma abordagem geométrica e realimentação de saída robusta:

1. Modelagem Dinâmica e Definição de Desvio:
   Um modelo não linear completo do quadricóptero é estabelecido, considerando coordenadas lineares e orientação (guinada, arfagem e rolagem). O desvio da trajetória desejada $S$ é definido usando uma transformação de coordenadas. Isso envolve:

   • Uma coordenada de caminho $s$ representando o ponto mais próximo na curva.
   • Duas coordenadas de erro linear ($e_1, e_2$) representando a distância a dois planos que se intersectam no vetor de velocidade desejado.
   • Erros angulares ($\delta\phi, \delta\theta, \delta\psi$), onde a arfagem e a rolagem desejadas são assumidas como zero, e a guinada desejada é derivada da projeção da trajetória.

2. Transformação para Forma Normal:
   Para facilitar o projeto de controle, o sistema é transformado em uma "forma normal" usando uma sequência de diferenciações e mudanças de coordenadas. Os autores introduzem variáveis auxiliares e integradores para lidar com a saturação da entrada de controle de empuxo ($u_1$). Essa transformação resulta em um sistema onde as variáveis reguladas ($\xi_1$) e suas derivadas ($\xi_2, \xi_3, \xi_4$) formam um vetor de estado estendido. O sistema é mostrado como invertível, permitindo a reconstrução das entradas de controle originais a partir das variáveis da forma normal.

3. Síntese de Controle por Realimentação de Saída Robusta:

   • Realimentação de Estado Ideal: Inicialmente, uma lei de controle é sintetizada assumindo a disponibilidade total do estado. Essa lei usa uma estrutura de realimentação linear com ganhos ($\gamma_1$ a $\gamma_4$) escolhidos para formar um polinômio de Hurwitz, garantindo estabilidade assintótica local da dinâmica de erro.
   • Implementação por Realimentação de Saída: Reconhecendo que a medição completa do estado não está disponível, os autores empregam um método de observador estendido. Um observador de alto ganho é projetado para estimar os estados não medidos ($\hat{\xi}_2, \hat{\xi}_3, \hat{\xi}_4$) e o termo de perturbação desconhecido ($\hat{\sigma}$).
   • Lei de Controle: A lei de controle final utiliza esses estados estimados e inclui uma função de saturação suave para garantir que as entradas de controle permaneçam dentro dos limites físicos. As forças de empuxo para os quatro propulsores são calculadas invertendo a matriz de transformação derivada da forma normal.

Contribuições Principais

• Modelo 3D Completo: Diferentemente de trabalhos anteriores que utilizavam modelos incompletos ignorando a dinâmica de guinada ou eram restritos a movimento planar, este artigo apresenta um modelo dinâmico completo para o movimento de quadricóptero no espaço 3D.
• Controle Coordenado por Realimentação de Saída: O artigo sintetiza uma lei de controle coordenado que depende apenas de medições de coordenadas lineares e ângulo de guinada, abordando a dificuldade de graus relativos não idênticos nos canais de controle.
• Sintonização Simplificada: Ao utilizar integradores adicionais e um algoritmo de controle dinâmico, os autores propõem uma metodologia com sintonização de regulador simplificada em comparação com algoritmos de controle de rastreamento anteriores que exigiam seleção complexa de parâmetros para satisfazer condições de prova.
• Robustez: A inclusão de um observador estendido permite que o sistema lide com termos e perturbações desconhecidos, fornecendo uma solução robusta para o seguimento de trajetória.

Resultados e Afirmações
O artigo fornece uma prova teórica de estabilidade local para o sistema de malha fechada. Os autores demonstram que, se os parâmetros do controlador forem escolhidos como coeficientes de um polinômio de Hurwitz, as variáveis de desvio ($\tilde{\xi}$) tendem assintoticamente a zero. Isso garante que o quadricóptero irá:

1. Seguir a curva espacial prescrita.
2. Manter o perfil de velocidade prescrito ao longo da curva.
3. Manter os erros de orientação dentro de limites limitados.

A derivação matemática confirma que a lei de controle atinge os objetivos de minimizar o desvio da trajetória e manter a velocidade e orientação desejadas, desde que a curvatura da trajetória seja limitada e as condições iniciais estejam dentro da região de atração.

Significado
O artigo afirma preencher uma lacuna na literatura ao estender o controle coordenado de trajetória de robôs móveis planares para o movimento de quadricóptero 3D usando apenas realimentação de saída. Contrasta com trabalhos anteriores que usavam modelos incompletos ou exigiam medições de estado completo. O significado reside em fornecer um algoritmo robusto e teoricamente fundamentado para seguimento de caminho espacial que é praticamente implementável dadas as restrições padrão de sensores (posição e guinada), sem a necessidade de estimativa complexa de estado de taxas angulares ou vetores de orientação completos. Os autores observam que, embora o arcabouço teórico esteja estabelecido, estudos experimentais em escala real estão planejados para trabalhos futuros para validar a lei de controle sintetizada.