A Unified Complementarity-based Approach for Rigid-Body Manipulation and Motion Prediction

Resumo Técnico: Uma Abordagem Unificada Baseada em Complementaridade para Manipulação de Corpos Rígidos e Predição de Movimento (Unicomp)

Declaração do Problema
Os atuais frameworks de manipulação robótica em ambientes não estruturados enfrentam limitações significativas ao raciocinar conjuntamente sobre o movimento em espaço livre e o contato friccional sustentado. Métodos existentes de planejamento local e simulação tipicamente desacoplam esses regimes ou dependem de representações de contato simplificadas, como contatos pontuais ou patches planos aproximados (ex: contato de três pontos). Além disso, essas abordagens frequentemente aproximam cones de fricção para converter problemas de contato em Problemas de Complementaridade Linear (LCP) e frequentemente excluem o planejamento de movimento do manipulador e a desvio de obstáculos da formulação da dinâmica de contato. Consequentemente, há uma falta de um formalismo unificado que permita a geração de trajetórias livres de colisões no nível cinemático para o robô, enquanto simultaneamente computa trajetórias dinâmicas para objetos no nível dinâmico, tudo isso enquanto modela rigorosamente o contato não-pontual e evita aproximações de cone de fricção.

Metodologia
O artigo propõe o Unicomp, um framework de modelagem de tempo discreto unificado que captura tanto o movimento em espaço livre quanto o contato friccional dentro de um único formalismo matemático baseado em restrições de complementaridade. A metodologia integra os seguintes componentes:

1. Framework de Complementaridade Unificado: A abordagem formula o movimento em espaço livre e as interações de contato como Problemas de Complementaridade Linear e Não Linear (LCP e NCP) acoplados. Isso permite transições principadas entre modos de contato (quebra, aderência, deslizamento) sem impor suposições de contato fixo.
2. Ponto de Contato Equivalente (ECP) e Superfície Limite Elipsoidal: Para o contato de patch plano, os autores derivam um modelo de contato friccional baseado no princípio da dissipação de potência máxima. Em vez de assumir uma distribuição de pressão específica, o conjunto de wrenchs de contato admissíveis é representado por uma superfície limite elipsoidal. Esta representação captura efeitos acoplados de força-momento, incluindo fricção torsional, e é agnóstica à distribuição de pressão subjacente. O contato é modelado via um Ponto de Contato Equivalente (ECP) onde o wrench é aplicado.
3. Dinâmica de Tempo Discreto: O sistema emprega um esquema de passo de tempo Euler progressivo. As equações de Newton-Euler são discretizadas para relacionar velocidades generalizadas e wrenchs de contato através de restrições quadráticas. O impulso de contato é parametrizado por componentes normais, tangenciais e torcionais, resolvidos via um Problema de Complementaridade Mista (MCP).
4. Desvio de Colisão de Corpo Inteiro: O desvio de colisão para o manipulador é formulado como uma projeção baseada em complementaridade no mesmo grid de tempo discreto. A geometria do robô é aproximada por um conjunto de esferas. Restrições de separação unilateral são formuladas como um Probleção de Complementaridade Linear (LCP) para corrigir incrementos de junta nominais, garantindo trajetórias livres de colisões no nível cinemático.
5. Integração: O framework combina estes elementos em um pipeline modular (Algoritmo 3) que resolve simultaneamente a dinâmica do objeto (via NCP/MCP) e a cinemática do robô com desvio de obstáculos (via LCP).

Principais Contribuições

• Formulação Unificada: O artigo apresenta um framework de predição de movimento em tempo real que considera tanto o movimento em espaço livre com desvio de colisão quanto a dinâmica de contato intermitente dentro de uma única estrutura baseada em complementaridade.
• Modelagem de Contato Não-Pontual: Ele contabiliza rigorosamente o contato não-pontual (patch plano) sem aproximar as restrições de cone de fricção, utilizando uma superfície limite elipsoidal derivada do princípio da dissipação de potência máxima.
• Planejamento Cinemático-Dinâmico Acoplado: O framework permite a geração de trajetórias de robô livres de colisões no nível cinemático enquanto simultaneamente computa trajetórias de objetos no nível dinâmico, preenchendo uma lacuna nas implementações de software existentes.
• Execução em Tempo Real: A formulação resulta em um modelo preditivo de tempo discreto adequado para planejamento baseado em otimização em tempo real, demonstrado em velocidades interativas (1000 Hz).

Resultados Experimentais
Os autores validam a abordagem através de simulações numéricas e comparações:

• Interações Não-Preensíveis: Experimentos com força direta no centro de massa e empurramento dirigido por ferramenta demonstram que a formulação captura o contato intermitente e transições de stick–slip sem prescrever modos discretos. Os resultados mostram assinaturas de contato consistentes onde o deslizamento satura a superfície limite ($s \approx 1$) e a aderência permanece dentro ($s < 1$).
• Contato Não-Convexo: O sistema lida com sucesso com empurramento planar interativo com objetos não convexos (ex: formas de mesa e de haltere) onde as regiões de suporte mudam abruptamente. O ECP migra através de distintas regiões de solo enquanto mantém o movimento fisicamente consistente a 1000 Hz.
• Comparação com MuJoCo: Em experimentos comparativos, o Unicomp demonstrou trajetórias mais suaves e maior estabilidade do que o MuJoCo durante modos de deslizamento e quebra. Especificamente, o MuJoCo exibiu "forças fantasmas" e injeção de energia não física (aumento rápido de energia cinética) durante eventos de penetração no solo, enquanto o Unicomp permaneceu estável.
• Propagação de Multi-Corpos: O framework modela com sucesso a propagação de impulso em cenas de múltiplos corpos (ferramenta $\to$ bloco 1 $\to$ bloco 2) sem enumeração explícita de modos de contato.
• Aplicações de Planejamento: Os autores implementaram um planejador de empurramento planar de malha fechada e um sistema de empurramento consciente de obstáculos de corpo inteiro, demonstrando a capacidade de conduzir objetos para poses desejadas enquanto evita colisões.

Significância e Alegações
O artigo afirma que o Unicomp fornece uma base prática para manipulação robusta em ambientes não estruturados. Ao unificar o movimento em espaço livre e comportamentos ricos em contato sob um único formalismo baseado em complementaridade, a abordagem permite um comportamento estável e fisicamente consistente em velocidades interativas. Os autores enfatizam que seu método evita as limitações de fidelidade das representações de contato simplificadas e o desacoplamento do planejamento cinemático e dinâmico, apoiando assim a execução robusta de comportamentos complexos e ricos em contato em tempo real. O trabalho é apresentado como uma evidência construtiva de que tal formulação é viável para a execução em tempo real de manobras robóticas complexas.