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

Resumen Técnico: Compensación de Gravedad del Manipulador del Lado del Paciente dVRK-Si basada en la Identificación del Modelo Dinámico

Planteamiento del Problema
El da Vinci Research Kit (dVRK) es una plataforma de código abierto fundamental para el avance de la investigación en cirugía asistida por robot. Mientras que el sistema original dVRK Classic utilizaba un Manipulador del Lado del Paciente (PSM) donde los efectos de la gravedad eran insignificantes, el nuevo sistema dVRK-Si, derivado del Sistema Quirúrgico da Vinci Si, presenta un PSM con una actualización estructural. Este cambio estructural resulta en un desfase de gravedad significativo que ya no puede ignorarse. La gravedad no compensada en el dVRK-Si PSM conduce a una reducción en la precisión del control y a un aumento en los tiempos de respuesta. Aunque la identificación del modelo dinámico se ha abordado para el dVRK Classic, las diferencias mecánicas del dVRK-Si requieren nuevas investigaciones en control basado en modelos para lograr un rendimiento mejorado.

Metodología
Los autores proponen un enfoque integral para la compensación de gravedad (GC) del dVRK-Si PSM, centrado en la identificación de los parámetros completos del modelo dinámico y el aislamiento del término de gravedad, $G(q)$, para su compensación. La metodología procede a través de cinco pasos distintos:

1. Modelado Cinemático: Se construyó un modelo cinemático completo del dVRK-Si PSM basado en las especificaciones del fabricante y mediciones físicas. Este modelo utiliza parámetros Denavit-Hartenet (DH) modificados (detallados en la Tabla I) y define una estructura de marcos específica (Fig. 2) para dar cuenta de la compleja articulación del Si PSM, incluyendo el Centro Remoto de Movimiento (RCM).
2. Modelado Dinámico: El modelo dinámico se derivó utilizando el enfoque Euler-Lagrangiano. Las ecuaciones de movimiento se expresan como $M(q)\ddot{q} + C(q, \dot{q})\dot{q} + G(q) = \tau$, donde el objetivo es identificar el vector de parámetros $\delta$ que representa la inercia del eslabón, la inercia del motor, la fricción y la rigidez.
3. Diseño de Trayectoria de Excitación: Se calculó una trayectoria de excitación óptima basada en las restricciones de las articulaciones y el modelo dinámico para asegurar una recolección de datos rica para la identificación de parámetros.
4. Recolección de Datos: La trayectoria de excitación se ejecutó en el dVRK-Si PSM físico para recolectar datos cinemáticos y dinámicos.
5. Identificación de Parámetros: Los parámetros dinámicos se resolvieron utilizando un enfoque de optimización convexa. Para evitar el sobreajuste y asegurar la validez física, la optimización incorporó restricciones específicas: las masas de los eslabones deben ser positivas, los centros de masa deben permanecer dentro del envolvente convexo del eslabón, y los coeficientes de fricción, la inercia del motor y la rigidez del resorte deben ser positivos.

Contribuciones Clave
El artículo presenta dos contribuciones primarias:

• Un nuevo modelo cinemático completo del dVRK-Si PSM, definiendo explícitamente las relaciones de los marcos y los parámetros requeridos para un modelado preciso.
• Una estrategia de compensación de gravedad basada en la identificación del modelo dinámico. Al identificar el modelo dinámico completo, los autores extraen el término $G(q)$ para proporcionar el torque necesario para la compensación de gravedad, en lugar de depender de modelos heurísticos o simplificados.

Resultos
La eficacia de la propuesta de compensación de gravedad fue validada mediante una prueba de deriva. En este experimento, el PSM se movió a una pose deseada utilizando un controlador de posición PD estándar, y luego se cambió a un modo de compensación de gravedad de lazo abierto basado en torque durante 5 segundos. La deriva se definió como un movimiento superior a 1 grado o 1 mm.

• Desempeño de la Deriva: El sistema mantuvo la pose del robot sin una deriva perceptible a través de cinco configuraciones de prueba aleatorias.
• Reducción de Error: El enfoque de compensación de gravedad demostró errores de estado estacionario más pequeños en comparación con el controlador PD por sí solo.
• Análisis de Torque: Los torques de las articulaciones generados por el método de GC para las tres primeras articulaciones (las más afectadas por la gravedad) se situaron dentro de los límites inferior y superior calculados necesarios para mantener las articulaciones en posición contra la fricción estática. En la mayoría de los casos, estos torques estuvieron cerca del punto medio del rango factible.
• Observaciones de la Articulación 3: Para la tercera articulación (una articulación prismática), se observó cierta desviación del punto medio del torque, lo que los autores atribuyen a la fricción significativa en la articulación prismática y la cánula.

Significancia y Reivindicaciones
Los autores afirman que el enfoque de compensación de gravedad propuesto mantiene eficazmente la pose del dVRK-Si PSM sin una deriva perceptible, abordando una limitación crítica de la actualización estructural del sistema. El estudio demuestra que la identificación basada en modelos puede generalizarse con éxito a través de diferentes dVRK-Si PSM, siempre que compartan la misma configuración de ángulo de montaje. Al permitir una compensación de gravedad precisa, este trabajo facilita una mayor precisión de control y tiempos de respuesta más rápidos, apoyando así aplicaciones de investigación y control más avanzadas para la plataforma dVRK-Si. El trabajo no pretende resolver todos los desafíos de control dinámico, sino que se dirige específicamente al problema del desfase de gravedad inherente al diseño del Si PSM.