Gravity Compensation of the dVRK-Si Patient Side Manipulator based on Dynamic Model Identification

Resumo Técnico: Compensação de Gravidade do Manipulador do Lado do Paciente dVRK-Si baseada na Identificação do Modelo Dinâmico

Definição do Problema
O da Vinci Research Kit (dVRK) é uma plataforma de código aberto crucial para o avanço da pesquisa em cirurgia assistida por robô. Embora o sistema dVRK Classic original utilizasse um Manipulador do Lado do Paciente (PSM) onde os efeitos da gravidade eram desprezíveis, o novo sistema dVRK-Si, derivado do Sistema Cirúrgico da Vinci Si, apresenta um PSM com atualização estrutural. Essa mudança estrutural resulta em um deslocamento de gravidade significativo que não pode mais ser ignorado. A gravidade não compensada no PSM do dVRK-Si leva à redução da precisão do controle e ao aumento dos tempos de resposta. Embora a identificação do modelo dinâmico tenha sido abordada para o dVRK Classic, as diferenças mecânicas do dVRK-Si exigem novas pesquisas em controle baseado em modelo para alcançar um desempenho aprimorado.

Metodologia
Os autores propõem uma abordagem abrangente para a compensação de gravidade (GC) do PSM do dVRK-Si, centrada na identificação dos parâmetros do modelo dinâmico completo e no isolamento do termo de gravidade, $G(q)$, para compensação. A metodologia procede através de cinco etapas distintas:

1. Modelagem Cinemática: Um modelo cinemático completo do PSM do dVRK-Si foi construído com base nas especificações do fabricante e medições físicas. Este modelo utiliza parâmetros Denavit-Hartenberg (DH) modificados (detalhados na Tabela I) e define uma estrutura de frames específica (Fig. 2) para dar conta da complexa ligação do PSM Si, incluindo o Centro Remoto de Movimento (RCM).
2. Modelagem Dinâmica: O modelo dinâmico foi derivado utilizando a abordagem Euler-Lagrange. As equações de movimento são expressas como $M(q)\ddot{q} + C(q, \dot{q})\dot{q} + G(q) = \tau$, onde o objetivo é identificar o vetor de parâmetros $\delta$ representando a inércia do elo, a inércia do motor, o atrito e a rigidez.
3. Design de Trajetória de Excitação: Uma trajetória de excitação ideal foi calculada com base nas restrições das juntas e no modelo dinâmico para garantir uma coleta de dados rica para a identificação de parâmetros.
4. Coleta de Dados: A trajetória de excitação foi executada no PSM físico do dVRK-Si para coletar dados cinemáticos e dinâmicos.
5. Identificação de Parâmetros: Os parâmetros dinâmicos foram resolvidos utilizando uma abordagem de otimização convexa. Para evitar o sobreajuste (overfitting) e garantir a validade física, a otimização incorporou restrições específicas: as massas dos elos devem ser positivas, os centros de massa devem permanecer dentro do invólucro convexo do elo, e os coeficientes de atrito, a inércia do motor e a rigidez da mola devem ser positivos.

Principais Contribuições
O artigo apresenta duas contribuições primárias:

• Um novo modelo cinemático completo do PSM do dVRK-Si, definindo explicitamente as relações de frames e os parâmetros necessários para uma modelagem precisa.
• Uma estratégia de compensação de gravidade baseada na identificação do modelo dinâmico. Ao identificar o modelo dinâmico completo, os autores extraem o termo $G(q)$ para fornecer o torque necessário para a compensação de gravidade, em vez de depender de modelos heurísticos ou simplificados.

Resultos
A eficácia da compensação de gravidade proposta foi validada através de um teste de deriva (drift test). Neste experimento, o PSM foi movido para uma pose desejada usando um controlador de posição PD padrão, sendo então alternado para um modo de compensação de gravidade baseado em torque de malha aberta por 5 segundos. A deriva foi definida como movimento excedendo 1 grau ou 1 mm.

• Desempenho de Deriva: O sistema manteve a pose do robô sem deriva perceptível através de cinco configurações de teste aleatórias.
• Redução de Erro: A abordagem de compensação de gravidade demonstrou erros de estado estacionário menores em comparação com o controlador PD sozinho.
• Análise de Torque: Os torques das juntas gerados pelo método de GC para as três primeiras juntas (que são as mais afetadas pela gravidade) situaram-se dentro dos limites inferior e superior calculados para manter as juntas em posição contra o atrito estático. Na maioria dos casos, esses torques estavam próximos do ponto médio da faixa viável.
• Observações da Junta 3: Para a terceira junta (uma junta prismática), observou-se algum desvio do ponto médio de torque, o qual os autores atribuem ao atrito significativo na junta prismática e na cânula.

Significância e Alegações
Os autores alegam que a abordagem de compensação de gravidade proposta mantém efetivamente a pose do PSM do dVRK-Si sem deriva perceptível, abordando uma limitação crítica da atualização estrutural do sistema. O estudo demonstra que a identificação baseada em modelo pode generalizar com sucesso entre diferentes PSMs do dVRK-Si, desde que compartilhem a mesma configuração de ângulo de montagem. Ao permitir uma compensação de gravidade precisa, este trabalho facilita maior precisão de controle e tempos de resposta mais rápidos, apoiando assim aplicações de pesquisa e controle mais avançadas para a plataforma dVRK-Si. O trabalho não pretende resolver todos os desafios de controle dinâmico, mas foca especificamente no problema do deslocamento de gravidade inerente ao design do PSM Si.