Adept Viper

1. Adept Viper s650 Un paso hacia el futuro Javier Sogorb

2. Índice • Presentación del problema • Cinemática del robot Cinemética directa Cinemática inversa • Dinámica del robot Dinámica directa – Formulación de Newton Euler - Dinámica inversa – Walker-Orin - • Selección de servoaccionamientos • Simulación y control

3. Planteamiento del problema Objetivo Diseñar un robot para que sea capaz de efectuar una perforación en la rótula de un paciente. Esta operación se utiliza en osteosíntesis de rodilla, donde se fija un tornillo distal para evitar que exista movimiento relativo de pivotamiento entre los dos segmentos del hueso fracturado.

4. Posee más precisión de la que cualquier humano puede tener. El robot sostiene y maneja la cámara, lo cual da libertad de tener ambas manos libres para cortar, explorar y suturar al paciente. Reduce los tiempos quirúrgicos en cirugías muy largas. Cuando han pasado varias horas en una operación el asistente humano se cansa y comienza a temblar. En cambio el brazo robótico no se cansa, lo que nos ayuda a realizar el trabajo con más destreza. . Ventajas de la utilización de un robot . “Realizamos con éxito un ensayo de tele-medicina satelital con el ISSSTE. Llevamos el brazo robótico al Hospital Belisario Domínguez de Tuxtla Gutiérrez, Chiapas, y desde el Hospital 20 de Noviembre de la Ciudad de México un grupo de expertos asesoró a médicos en Chiapas y controlamos el robot desde aquí” Arturo Minor (UPN Mexico) Problemas • La sensibilidad no es la misma. Retroalimentación de fuerzas • Retardo en las comunicaciones en la tele-medicina vía satélite.

5. El extremo del robot debe poder penetrar perpendicularmente a una esfera centrada en la rodilla del paciente, que será el espacio de trabajo. El peso del robot no debe ser excesivo El elevado peso propio aumenta la dinámica, lo que reduce la precisión. Debe cumplir la normativa de sanidad correspondiente. Debe poderse colgar del techo Evaluación de alternativas .

6. Adept Viper s650

7. Características • El grado de protección del robot cumple la especificación de “Robot de habitación limpia”. • El peso del robot es tan sólo de 28 kg, lo cual supone una ventaja frente a otros robots que realizan la misma tarea y tienen un peso de más de 200 Kg. • La carga máxima que puede soportar el robot en su efector final es de 5 Kg, lo cual permite añadir la séptima articulación prismática junto con la broca necesaria para realizar el taladro. • La precisión del robot es de tan sólo 20 μm, lo que significa que el máximo error que se puede producir en el posicionamiento del efector final se encuentra dentro de una circunferencia de radio 20 μm. • Espacio de trabajo adecuado .

8. Cinemática del robot - Cinemática directa - Cinemática inversa - Matriz Jacobiana

9. Problemas de la cinemática • Problema cinemática directo Consiste en determinar la posición y orientación del extremo del robot con respecto a un sistema de coordenadas de referencia, conocidos los ángulos de las articulaciones y los parámetros geométricos de los elementos del robot. • Problema cinemática inverso Consiste en determinar la configuración que debe adoptar el robot para una posición y orientación del extremo, conocidas.

10. Problema cinemático directo Resolución mediante matrices de transformación homogénea Utilizando la representación de Denavit - Hartenberg

11. Parámetros DH

12. Problema cinemático inverso Utilizando métodos geométricos Se debe aplicar el principio de Piepper’s para separar: 1. Cálculo de la posición del extremo del robot Requiere calcular el punto muñeca 2. Cálculo de la orientación del extremo del robot

13. Problema de posición: Cálculo de las 3 primeras articulaciones Articulación 1

14. Articulación 2 Codo arriba Codo abajo

15. Articulación 3 Codo arriba Codo abajo

16. Problema de orientación: Cálculo de las 3 últimas articulaciones Articulación 4 Cálculo de 0A3 X3, Y3, Z3 M = muñeca · signo(Ω) 0A4 = 0A3 · 3A4 X4, Y4, Z4

17. Articulación 5 0A5 = 0A4 · 4A5 X5, Y5, Z5 Articulación 6

18. Comprobación del código generado

19. Matriz Jacobiana Transforma las variables de velocidad en el espacio articular en el vector de estado de velocidad en el espacio cartesiano Configuraciones singulares En las inmediaciones de las configuraciones singulares, se pierde alguno de los grados de libertad del robot, siendo imposible que su extremo se mueva en una determinada dirección cartesiana Se distinguen dos tipos: - Singularidades en los límites del espacio de trabajo - Singularidades en el interior del espacio de trabajo

20. Comprobación del código generado Podemos comprobar que funciona correctamente pasando como parámetro un vector de coordenadas articulares para el cual el extremo del robot se encuentra en la frontera de su espacio de trabajo (singularidad externa).

21. Dinámica del robot - Dinámica inversa - Dinámica directa

22. Dinámica inversa Expresa las fuerzas y pares que intervienen en función de la evolución temporal de las coordenadas articulares. Es decir, consiste en obtener la fuerza que debe existir en cada articulación prismática y el par, en cada articulación rotacional, para que el movimiento del elemento terminal se produzca con las velocidades y aceleraciones deseadas Utiliza un procedimiento recursivo basado en operaciones vectoriales 1) Primero propaga recursivamente hacia delante la información cinemática 2) A continuación, propaga recursivamente hacia atrás la información de fuerzas

23. Datos necesarios 1) Masa de cada eslabón 2) Posición del centro de gravedad de cada eslabón

24. Datos necesarios 3) Factor de rozamiento articular 4) Matriz de inercia de cada eslabón 5) Parámetros D-H

25. Comprobación del código generado Para verificar que la dinámica inversa se ha resuelto de forma correcta, colocamos el robot en una posición estática concreta (velocidades y aceleraciones angulares nulas) y comprobamos si el valor del par en cada articulación coincide con el calculado teóricamente.

28. Dinámica directa Se obtienen primero las aceleraciones de las coordenadas articulares con el método de Walker-Orin y, después, se va integrando para obtener velocidad y posición. Método de Walker-Orin Es un método numérico utilizado para obtener la aceleración de las coordenadas articulares a partir del vector generalizado de pares. Para ello, utiliza el algoritmo de Newton-Euler cuando

29. Selección de motores

30. Peor configuración del robot Perfil de velocidades

32. Resultados

33. Resultados

34. Observación

35. Motores seleccionados Características

36. Simulación y control

37. Control desacoplado o monoarticular Se considera que las articulaciones del robot están desacopladas, de modo que un par en un determinado actuador únicamente tendrá efecto sobre el movimiento de la articulación correspondiente. De esta forma, existirá un controlador para cada articulación. • Control acoplado o multiarticular Las técnicas de control acoplado consideran el modelo dinámico real del robot. Estructuras de control Elección: Control eje a eje El control monoarticular únicamente es aceptable cuando el factor de reducción de los reductores es elevado

38. Sintonizado de los motores El sintonizado de una articulación consiste en ajustar los parámetros del regulador que actúa sobre ella para que su respuesta cumpla unas determinadas especificaciones referidas tanto al régimen permanente como transitorio. 1) En primer lugar se aumenta la constante proporcional KP hasta obtener el tiempo de subida sea el deseado. 2) A continuación se aumenta la constante derivativa KD para disminuir la sobreoscilación. 3) Por último, se introduce KI para eliminar el error en régimen permanente.

40. Resultados

42. Simulación

43. Planificación en cartesianas El simulador efectúa una planificación de la trayectoria del extremo del robot en línea recta entre la posición cartesiana inicial y final especificadas Referencia Trayectoria real

44. Análisis de resultados Al anularse el Jacobiano, un incremento infinitesimal de las coordenadas cartesianas supone un incremento infinito de las coordenadas articulares, lo que en la práctica se traduce en que en las inmediaciones de las configuraciones singulares, el pretender que el extremo del robot se mueva a velocidad constante obligaría a movimientos de las articulaciones a velocidades inabordables por sus actuadores.

45. Planificación en articulares El simulador efectúa una planificación de la trayectoria del extremo del robot en línea recta entre la posición articular inicial y final especificadas Referencia Trayectoria real

46. Representación en VRML VRML (“Virtual Reality Modeling Language”) proporciona un método eficiente para describir todo tipo de objetos y mundos tridimensionales. Supongamos que tenemos varias imágenes de un edificio y un fichero vrml que contiene datos que describen ese mismo edificio. Las imágenes sólo muestran una zona determinada del edificio y todo lo que podemos hacer con ellas es mirarlas. En cambio, con el fichero vrml, podemos observar el edificio desde cualquier punto de vista e incluso visualizar su interior.

49. Fin