Compliant Explicit Reference Governor for Contact Friendly Robotic Manipulators

Resumo Técnico: Governador de Referência Explícito Conformável para Manipuladores Robóticos Amigáveis ao Contato

Declaração do Problema
O planejamento de movimento robótico tradicional prioriza a evitação de colisões para garantir a segurança, frequentemente tratando o contato ambiental como um obstáculo. No entanto, a robótica moderna exige cada vez mais capacidades "ricas em contato", onde a interação física é um recurso. O desafio central reside em gerenciar a transição entre movimento livre e contato, satisfazendo simultaneamente dois tipos distintos de restrições:

1. Restrições Rígidas: Limites não negociáveis, como faixas de juntas, limites de torque e superfícies proibidas.
2. Restrições Suaves: Condições onde o contato é permitido, mas deve ser manuseado com segurança. Estas criam condições altamente não convexas do tipo "OU": o robô deve ou evitar o contato completamente ou operar sob restrições específicas de contato seguro.

Estratégias existentes baseadas em otimização (por exemplo, Controle Preditivo por Modelo) frequentemente exigem redesenhos completos de leis de controle e aproximações complexas de dinâmica de contato variantes no tempo, o que é pouco atraente para praticantes com controladores legados. Por outro lado, abordagens hierárquicas como Funções de Barreira de Controle ou conformidade baseada em energia frequentemente carecem de garantias estritas de restrição ou estabilidade assintótica. O Governador de Referência Explícito (ERG) oferece um filtro de segurança hierárquico que modifica referências sem alterar o controlador subjacente, mas implementações anteriores tratavam o contato como indesejável, interrompendo o movimento ao entrar em contato. Este artigo aborda a necessidade de um quadro que permita operação contínua e segura durante o contato sem modificar o controlador de baixo nível.

Metodologia: O Governador de Referência Explícito Conformável (CERG)
Os autores propõem o Governador de Referência Explícito Conformável (CERG), um sistema modular de gerenciamento de referência posicionado entre um planejador de alto nível e um controlador de baixo nível. O CERG impõe restrições operacionais e permite transições suaves entre operações de movimento livre e de contato, manipulando o sinal de referência $v(t)$ enviado a um controlador pré-estabilizado.

A metodologia baseia-se em três componentes-chave:

1. Camada de Pré-estabilização: Um controlador PD padrão com compensação de gravidade guia o robô em direção a uma configuração de referência $v$. A energia total do sistema (cinética + potencial virtual) é definida por uma função de Lyapunov $V(x, v)$, que é monotonamente decrescente quando $v$ é constante.
2. Margem de Segurança Dinâmica Conformável (DSM): A inovação central é um DSM, $\Delta(x, v)$, projetado para lidar com a natureza disjuntiva (OU) das restrições de contato. A condição de segurança é formulada como:
   $$s(q(t)) < 0 \quad \lor \quad V(x(t), v(t)) \le E_{\max}$$
   onde $s(q) < 0$ representa movimento livre e $V \le E_{\max}$ representa contato seguro com energia limitada. O CERG constrói um DSM composto:
   $$\Delta(x, v) = \min(\Delta_h, \max(\Delta_s, \Delta_E))$$
   • $\Delta_h$: Impõe restrições rígidas (limites de juntas, etc.).
   • $\Delta_s$: Uma margem baseada em trajetória para a superfície de restrição suave $s(q)$.
   • $\Delta_E$: Uma margem baseada em energia definida como $\kappa_E(E_{\max} - V(x, v))$.
     Esta estrutura garante que, se o robô estiver em movimento livre, a restrição de energia seja relaxada; se ocorrer contato, a energia total do sistema seja estritamente limitada por $E_{\max}$.
3. Campo de Navegação Suave (NF): Ao contrário das restrições rígidas que repelem a referência, o CERG emprega um campo de repulsão "suave" $\rho_s(v)$ que permite à referência $v$ penetrar na fronteira de restrição até um limite $\delta_s$. Esta penetração é necessária para gerar a força requerida para o contato conformável. O campo de navegação total combina atração ao alvo, repulsão de restrições rígidas e esta repulsão suave.

Contribuições Principais
O artigo reivindica três contribuições primárias:

• Filtragem Modular de Referência: Um quadro que transita perfeitamente entre movimento sem contato e rico em contato, respeitando restrições de ângulo de junta, velocidade e torque, sem exigir redesenho do controlador.
• Tratamento de Restrições Disjuntivas: Um mecanismo de segurança especificamente projetado para restrições do tipo "OU", garantindo satisfação provável de evitar o contato ou manter energia limitada durante o contato.
• Diretriz de Segurança Baseada em Energia: Uma métrica de segurança baseada na energia mecânica total (potencial + cinética) do sistema em malha fechada. Esta métrica é invariante de quadro, vincula-se diretamente a garantias de estabilidade e é facilmente interpretável.

Resultados e Validação
O CERG foi validado numericamente e experimentalmente em sistemas de crescente complexidade:

• Braço Plano de Duas Ligações (Simulação): O CERG foi testado com controladores no espaço das juntas e no espaço do efetuador final. Os resultados mostraram que o CERG reduziu com sucesso as forças de interação em comparação com a operação sem ele e respeitou os limites de energia. O estudo observou que, embora a formulação no espaço do efetuador final minimize o erro cartesiano, a formulação no espaço das juntas é preferível para arquiteturas hierárquicas.
• Simulação Franka Emika Panda (Drake): Utilizando um modelo de contato conformável com atrito e dissipação, o CERG foi testado em uma tarefa que exigia que o braço deslizasse ao longo de uma parede. A simulação confirmou que o CERG aderiu ao limite $E_{\max}$ durante o contato, enquanto um ERG padrão (que para ao entrar em contato) e um sistema não modificado falharam em gerenciar efetivamente a transição de energia.
• Experimentos no Mundo Real (Franka Emika Panda): Duas tarefas foram realizadas:
  1. Limpeza de Quadro Branco: Uma tarefa não altamente sensível à energia. CERG, ERG e controle de impedância completaram a tarefa, mas apenas o CERG impôs restrições rígidas (prevenindo violações de velocidade da junta) e limites de energia durante o contato.
  2. Empurrar Torre de Jenga: Uma tarefa altamente sensível à energia. O controlador de impedância falhou devido a violações de limite de junta ou ao derrubar a torre. O ERG padrão falhou em prevenir o derrubamento devido à energia de contato excessiva. Apenas o CERG empurrou com sucesso a torre sem derrubá-la, impondo estritamente $E_{\max}$ durante o contato enquanto permitia energia mais alta no movimento livre.

Significância e Reivindicações
O artigo afirma que o CERG fornece uma solução prática para manipulação rica em contato, atuando como um filtro de segurança "plug-and-play". Sua significância reside em permitir que robôs tratem o contato como um recurso em vez de um perigo, sem o ônus computacional de redesenhos completos de MPC ou os riscos de instabilidade de controladores não modificados. O quadro garante segurança através de restrições prováveis na energia total do sistema, permitindo transições de fase perfeitas entre movimento livre e contato. Os autores concluem que a abordagem é viável e eficaz, com trabalhos futuros planejados para interfacear o CERG com planejadores orientados a tarefas.