Actuator-Aware Inverse Kinematics with Joint-Limit Admissibility for Torque-Controlled Redundant Robots

Resumo Técnico: Cinemática Inversa Consciente de Atuadores com Admissibilidade de Limite de Junta para Robôs Redundantes Controlados por Torque

Definição do Problema
Robôs redundantes possuem mais juntas atuadas do que o necessário para realizar um movimento específico no espaço da tarefa, oferecendo graus de liberdade extras para satisfazer objetivos secundários, como a evasão de limites de junta. No entanto, em arquiteturas controladas por torque, a saída da cinemática inversa (CI) não é a entrada de controle final, mas sim uma referência de velocidade fornecida a um controlador de nível de torque subsequente (ex.: Controle de Decomposição Virtual). Consequentemente, minimizar apenas o resíduo cinemático pretendido não garante um bom movimento realizado. Se a referência de velocidade conjunta gerada for incompatível com a dinâmica do controlador de torque ou com os limites dos atuadores, o sistema físico pode falar em rastrear a tarefa, particularmente próximo aos limites de junta. Os métodos de CI existentes frequentemente resolvem a redundância com base em critérios cinemáticos (ex.: norma mínima, projeção no espaço nulo) sem considerar explicitamente a compatibilidade da referência com o loop de controle específico de torque ou com as restrições de capacidade do atuador.

Metodologia
O artigo propõe uma formulação de CI compatível com o controlador que gera velocidades de junta requeridas ($\dot{q}_r$) via um problema de Programação Quadrática (QP) convexa. O método é projetado para funcionar como uma camada intermediária entre uma trajetória do endpoint e o controlador de nível de torque de um robô redundante.

1. Objetivo de Compatibilidade com o Controlador: A QP minimiza uma função de custo que equilibra a preservação da tarefa com a compatibilidade do controlador. A matriz de ponderação ($W_c$) inclui:

   • Linha de Base Isotrópica: Garante o bom condicionamento.
   • Consistência da Comando Anterior ($W_\Delta$): Penaliza mudanças abruptas na velocidade requerida em relação ao passo anterior, promovendo suavidade.
   • Ponderação de Capacidade de Torque do Atuador ($W_\tau$): Penaliza o uso de juntas com menor capacidade de torque em relação à junta mais forte do sistema. Esta ponderação é derivada de limites de atuadores conhecidos, não de torque medido.

2. Admissibilidade de Limite de Junta: Em vez de restrições rígidas que poderiam tornar a QP infactível, o método emprega desigualdades do tipo Função de Barreira de Controle (CBF) para definir um conjunto admissível de velocidades requeridas ($D_r(q)$). Esses limites garantem que a velocidade comandada não leve a junta muito rapidamente em direção aos seus limites mecânicos.

3. Restrição de Tarefa Suave: Para lidar com casos onde o comando da tarefa é incompatível com o conjunto de velocidade admissível, a equação da tarefa ($J\dot{q}_r = V_r$) é tratada como uma restrição suave usando uma variável de folga ($s$). O resíduo da tarefa é penalizado na função objetivo em vez de ser o alvo principal de minimização, permitindo que o solver priorize a compatibilidade do controlador quando necessário.

Principais Contribuições

• Formulação: Uma nova formulação de CI baseada em QP que incorpora explicitamente a capacidade de torque do atuador e a consistência do comando anterior na resolução de redundância para robôs controlados por torque.
• Segurança ao Nível de Referência: A introdução de limites do tipo CBF sobre a velocidade requerida (a saída da CI) em vez da entrada do processo, fornecendo admissibilidade de limite de junta ao nível de referência sem modificar o controlador de torque subsequente.
• Compromisso de Admissibilidade da Tarefa: Um mecanismo para equilibrar a preservação da tarefa e a compatibilidade do controlador usando uma variável de folga para a equação da tarefa, impedindo que o resíduo da tarefa sobreponha a necessidade de referências suaves e factíveis.

Resultos Experimentais
O método foi avaliado em um exoesqueleto de membro superior de 7-DoF utilizando um framework de Controle de Decomposição Virtual (VDC). Foi comparado contra quatro baselines: Pseudoinversa (PINV), Mínimos Quadrados Amortecidos (DLS), Evasão de Limite de Junta no Espaço Nulo (NS-JLA) e uma QP de Preservação de Tarefa (TP-QP) que utiliza as mesmas restrições de admissibilidade, mas carece do objetivo de compatibilidade do controlador.

• Desempenho Realizado: O método proposto alcançou os menores erros de RMS de posição e orientação, bem como os menores resíduos de velocidade de tarefa realizados, superando todos os baselines. Notavelmente, reduziu o erro RMS de posição em 29,6% e o erro RMS de orientação em 20,2% em comparação com o baseline TP-QP.
• Comportamento de Limite: O método proposto demonstrou um índice de "pressão de limite" (comandos direcionando o movimento para os limites) significativamente menor, reduzindo-o em até 96% em comparação com outros métodos.
• Eficiência de Torque: Resultou no menor RMS de norma de torque, sugerindo um uso mais eficiente dos recursos dos atuadores.
• Admissibilidade: O método manteve zero violações dos limites de velocidade requerida admissível, enquanto os baselines cinemáticos (PINV, DLS, NS-JLA) excederam frequentemente esses limites.

Significância e Alegações
O artigo alega que, para robôs redundantes controlados por torque, a CI não deve apenas minimizar o erro cinemático, mas deve gerar referências de junta que sejam compatíveis com o controlador de torque e as capacidades dos atuadores. Os resultados indicam que a formulação proposta alcança um equilíbrio superior entre preservação de tarefa e admissibilidade. Ao gerar referências que respeitam as capacidades dos atuadores e evitam a pressão agressiva nos limites, o método melhora o comportamento da tarefa realizada sem exigir qualquer redesenho do controlador de nível de torque existente. Os autores enquadram modestamente essas descobertas como "consciência de limite de junta ao nível de referência" e "resolução de redundância compatível com o controlador", em vez de uma prova formal de segurança ao nível do processo. O trabalho futuro é identificado como a investigação de formulações de restrição acopladas entre CI e controle de torque e análise de restrição de malha fechada formal.