Delatorre Roberto Brazo Robot PDF
Delatorre Roberto Brazo Robot PDF
Delatorre Roberto Brazo Robot PDF
La endoscopia es una técnica que permite al cirujano ver al interior del paciente
usando una microcámara que es insertada a través de una pequeña incisión hecha al
paciente. Esta técnica puede aplicarse a diferentes partes del cuerpo, cuando se
aplica al estómago es llamada laparoscopia y cuando se aplica a la rodilla se le
conoce como artroscopia.
El propósito del presente trabajo de tesis es iniciar una línea de trabajo en cirugía
robótica mediante el estudio de los asistentes robóticos para cirugía y el uso de la
tecnología robótica disponible en la Pontificia Universidad Católica del Perú (PUCP).
La importancia del diseño del circuito de control radica en el control del movimiento de
la cámara que explora la articulación de la rodilla, por otra parte la simulación busca
obtener datos que muestren las ventajas de usar tecnología robótica para movimientos
precisos de cirugía.
Índice
Pág.
ÍNDICE .............................................................................................................. 1
INTRODUCCIÓN ................................................................................................. 2
CAPÍTULO 1
PROBLEMÁTICA DE LA CIRUGÍA ROBÓTICA EN EL PERÚ .......................................... 4
1.1 Introducción .............................................................................................. 4
1.2 Problemática de cirugía laparoscópica ..................................................... 4
1.3 Problemática de artroscopia ..................................................................... 5
1.4 Cirugía con tecnología robótica ................................................................ 6
1.5 Problemática de la cirugía robótica en el Perú ......................................... 7
CAPÍTULO 2
MARCO TEÓRICO ............................................................................................... 8
2.1 Introducción .............................................................................................. 8
2.2 Laparoscopia ............................................................................................ 8
2.3 Artroscopia.............................................................................................. 11
2.4 Robótica y el brazo robot SCORBOT ..................................................... 13
2.5 Análisis cinemático del brazo robot SCORBOT ER V plus ..................... 19
2.6 Procesos actuales de laparoscopia y artroscopia................................... 20
2.7 Modelo teórico ........................................................................................ 23
CAPÍTULO 3
DISEÑO DEL CIRCUITO DE CONTROL Y SELECCIÓN DEL ACTUADOR PARA EL BRAZO
ROBOT............................................................................................................ 26
3.1 Introducción ............................................................................................ 26
3.2 Hipótesis y objetivos ............................................................................... 27
3.3 Metodología ............................................................................................ 28
3.4 Selección del actuador del brazo robot para artroscopia ........................ 29
3.5 Diseño del circuito de control.................................................................. 30
CAPÍTULO 4
SIMULACIÓN DEL CONTROL DEL ARTROSCOPIO USANDO EL BRAZO ROBOT
SCORBOT .................................................................................................... 33
4.1 Sistema de mando del brazo robot SCORBOT ER V plus aplicado al
control del artroscopio................................................................................... 33
4.2 Algoritmo de la simulación ...................................................................... 33
4.3 Simulación del control del artroscopio usando el brazo robot SCORBOT
ER V plus...................................................................................................... 37
CAPÍTULO 5
RESULTADOS .................................................................................................. 57
5.1 Resultados de la simulación del circuito de control................................. 57
5.2 Resultados de la simulación del movimiento del artroscopio.................. 58
CONCLUSIONES............................................................................................... 61
RECOMENDACIONES ........................................................................................ 62
GLOSARIO ...................................................................................................... 63
FUENTES ........................................................................................................ 64
1
Introducción
obtenidos.
tecnologías.
robóticos, la tecnología del brazo robot SCORBOT ER V plus que será usado en la
artroscopia de rodilla.
2
En el capítulo tres se realiza el diseño del circuito de control. Se selecciona el actuador
basado en las características del brazo robot SCORBOT y se realiza el diseño del
mando del brazo robot SCORBOT ER V plus, luego se muestra la definición del
realizada.
comprobar que las características del brazo y el control de las articulaciones son los
3
Capítulo 1
Problemática de la cirugía robótica en el Perú
1.1 Introducción
4
que cuentan con cuatro sistemas de video para laparoscopia: para cirugía, neurología,
cardiovascular y urología [Anexo 1].
La información obtenida indica que existe una demanda alta de cirugía endoscópica y
la versatilidad con la que se aplica dicha tecnología en Lima, a pesar de su elevado
costo.
Ha habido mejoras continuas al artroscopio desde el año 1918, cuando Takagi inició la
visión de la articulación de la rodilla usando un cistoscopio. La refinación del
artroscopio vino acompañado con la extensión del procedimiento a articulaciones
como la cadera, tobillo, hombro, codo y muñeca. Las empresas proveedoras de estos
instrumentos aportaron con un progresivo refinamiento del artroscopio, además de
otros instrumentos relacionados, que fueron mejorados durante las siguientes décadas
debido al interés de los médicos por este tipo de tecnología. Numerosos trabajos de
los años 70 y 80 establecieron el valor de la artroscopia, tanto en el diagnóstico como
en el tratamiento de una variedad de enfermedades, especialmente de la articulación
de la rodilla. Un ejemplo de esto es Chile, donde la artroscopia se inició en 1980 y se
difundió ampliamente entre los años 1985-1990, siendo actualmente una técnica
habitual en sus hospitales [1].
5
la complejidad del caso y la pericia del cirujano. En el caso de los equipos utilizados,
no hay una gran variedad debido al costo de estos, sin embargo esto no impide que un
equipo de endoscopia sea usado en procedimientos de laparoscopia, artroscopia de
rodilla, de cadera, de hombro, de muñeca y otros. La frecuencia con que se realizan
procedimientos es de 5 a 7 artroscopias por semana, incluyendo tratamientos de
hombro, muñeca o rodilla.
Los últimos avances en cirugía robótica aplicada a laparoscopia, tratados por Córdova
y Garth son los del AESOP (Automated Endoscopic System for Optimal Positioning)
desarrollado por Computer Motion Incorporated, Santa Barbara, California que permite
un mejor control de la cámara del endoscopio usando un sistema de reconocimiento
de voz que es usado por el cirujano a través de una computadora; el sistema Da Vinci
(Intuitive Surgical, Mountain View, California), capaz de crear un espacio virtual de
operación usando un laparoscopio e instrumentos automatizados con el fin de permitir
que un solo cirujano realice la operación; y el Endoassist (Armstrong Health Limited,
High Wycombe, Reino Unido) que consta de un sistema de video-endoscopia
posicionado por láser. Las ventajas de estos nuevos sistemas son la mayor precisión
de movimientos y la reducción de errores humanos, así como la posibilidad de realizar
la cirugía a distancia [2].
Desde el punto de vista económico se puede hacer una comparación de precios entre
las diferentes alternativas de cirugía robótica como muestra la siguiente tabla.
Uno de los mejores trabajos en cirugía robótica es el realizado por Nabil Simaan en
“Analysis and synthesis of parallel robots for medical aplications” [5] en el cual muestra
el uso de brazos robóticos paralelos como la mejor opción para desempeñar funciones
de un cirujano, sin embargo tiene un punto débil en su elevado costo como se ha visto
en la tabla anterior.
6
1.5 Problemática de la cirugía robótica en el Perú
7
Capítulo 2
Marco teórico
2.1 Introducción
2.2 Laparoscopia
8
laparoscopio) para obtener información de la anatomía interna del paciente y
monitores para su visualización [9].
a. Laparoscopio
Debido a que es necesario iluminar el interior del abdomen se debe agregar luz
usando una fuente de luz fría en el mismo laparoscopio, la cual se transmite a través
de una fibra óptica [11].
9
En la figura 2.1 se muestra un conjunto de artroscopios, el extremo delgado es
introducido al espacio de trabajo y el otro extremo se conecta a la fuente de luz.
b. Insuflador
c. Trocar
Los trocares son instrumentos que permiten la entrada y salida de los diversos
instrumentos quirúrgicos, su longitud es de 33-40cm y su diámetro es de 5-10mm.
10
Estos constan de dos partes: el punzón que atraviesa la pared abdominal y la
camiseta o funda que queda para la parte operativa y que permite la inserción de
instrumentos sin perder la presión del gas dentro del paciente [11]. En la siguiente
figura se ve como se introducen el artroscopio y otro instrumento a través de los
trocares.
2.3 Artroscopia
Los extremos de los dos huesos opuestos en una articulación están recubiertos con un
amortiguador natural denominado cartílago. Este tiene una superficie lisa y viscosa
que facilita el movimiento de los huesos. La rodilla es la articulación más grande del
Cada articulación está envuelta y protegida por una cápsula externa resistente. En la
11
membrana sinovial, que produce el líquido sinovial. Dicho líquido lubrica la articulación,
Los huesos se mantienen fijos en su lugar por los ligamentos. Estos son gruesas
cintas de tejido, que sirven como medio de unión de los huesos dentro o fuera de la
Están insertados en los huesos por los tendones. Cuando un músculo se contrae, se
12
muestras del tejido interno, además se pueden reparar los ligamentos o meniscos de
la rodilla con un tiempo de recuperación más corto al de una cirugía abierta [13] [11].
2.3.3 Artroscopio
13
2.4.2 Robot
2.4.3 Sensor
Los movimientos que realiza el robot son debido a actuadores o accionadores, que
son elementos encargados de transformar una señal de control o la salida de un
microprocesador en acciones controladas de una máquina o dispositivo. Transforma
las señales de control de velocidad y posición en un movimiento de cada una de las
articulaciones del robot. Pueden ser de tres tipos: eléctricos, neumáticos e hidráulicos.
14
eléctricos. En robótica interesan aquellos capaces producir movimiento capaz de
mover una articulación, es decir los motores eléctricos [3].
El laboratorio del CETAM en la PUCP cuenta con un brazo robot SCORBOT del
fabricante ESHED ROBOTEC. El controlador de este robot tiene las siguientes
funciones: dar instrucciones de los movimientos del brazo robot y otros dispositivos
que compongan el sistema robótico, monitorear estos movimientos y hacer ajustes
automáticos para corregir cualquier error [15].
Servo control
Control digital
15
oscilaciones. La mayor desventaja es que este parámetro no puede eliminar por
completo el error.
En control diferencial la salida es una función del cambio del error, mientras más
rápido cambia este, mas rápido cambiara la salida. El parámetro diferencial es
responsable de reducir la velocidad del error. La mayor desventaja es que si el error es
constante este tipo de control no tomara ninguna acción.
En control integral la salida reduce la señal de error a cero en una tasa proporcional al
tamaño del error, mientras mayor sea el error mayor es la salida. Su mayor ventaja es
que el error en estado estable siempre es cero [15].
Se pueden simular los movimientos del artroscopio en una cirugía usando el robot
SCORBOT debido a sus características de alcance. Se realizarán los movimientos
necesarios en una cirugía, con lo cual se comprobará que es posible su uso en
cirugía.
Parte de este trabajo de tesis es seleccionar lo actuadores del brazo robot, selección
que considera la estructura del brazo robot SCORBOT- ER V plus.
En la figura 2.6 se muestra la estructura del robot SCORBOT-ER V plus, el cual será
usado en la simulación de control del artroscopio y sobre el cual se basa el diseño de
la estructura del brazo robot para artroscopia.
16
Figura 2.6. Estructura del robot SCORBOT-ER V plus [15]
Figura 2.7. Ejes o grados de libertad del brazo robot SCORBOT-ER V plus [15]
Al final del brazo tiene una pinza accionada por un servomotor que usa un encoder
óptico. El movimiento de los dedos de la pinza es paralelo y la fuerza de presión de
ellas se determina con sensores y software.
17
El movimiento de los ejes está limitado por micro-switches. Además se tiene una
realimentación del movimiento de cada eje dado por encoders ópticos. Cada eje es
accionado por un servomotor de 12VDC, torque de 15oz.in con 70W de potencia.
Otras especificaciones del brazo robot que también se ven en la tabla 2.1 son: la
transmisión del movimiento de los motores a cada articulación se realiza con fajas, el
máximo peso que lleva el brazo es de 1kg, la máxima velocidad de movimiento es de
600mm/sec.
18
2.5 Análisis cinemático del brazo robot SCORBOT ER V plus
El análisis cinemático es necesario en todo diseño de brazo robot. Existen dos tipos de
análisis cinemático: la resolución del problema cinemático directo y la del inverso. El
problema cinemático directo permite conocer la posición en coordenadas del efector
final dadas las posiciones de las articulaciones y la geometría del brazo robot. La
resolución del problema cinemático inverso permite conocer las posiciones de las
articulaciones a través de las coordenadas del efector final del brazo robot.
19
Tabla 2.2. Parámetros de coordenadas del brazo robot SCORBOT
Parámetros de coordenadas
Articulación Θ Α A D Rango
0 90 -90 0 0 -155 a 155
1 0 0 220mm 0 -35 a 130
2 90 90 220mm 0 -130 a 130
3 0 -90 0 220mm -130 a 130
Usando los ejes definidos se obtienen las matrices de transformación que resuelven el
problema cinemático directo, es decir se pueden definir coordenadas del efector final
en función de la posición de cada articulación.
20
La preparación y reconocimiento del espacio de trabajo consiste en usar un insuflador
para llenar la cavidad donde se encuentra el órgano a tratar con un gas, este
procedimiento debe mantener el espacio de trabajo constante mientras dure la cirugía,
sin afectar ningún otro órgano. Además se instalan los trocares, por donde ingresarán
los diversos instrumentos usados en la cirugía, incluyendo el laparoscopio. El primer
trocar se instala a través del ombligo para comprobar la salida del gas, los demás se
instalan en orificios hechos de acuerdo a la ubicación del órgano que se quiere tratar,
es necesario que los trocares sean instalados precisamente y que permanezcan
estáticos durante el resto de la cirugía. Después se procede con la laparoscopia de
rutina, donde se realiza una evaluación del espacio de trabajo, visualizándolo usando
un laparoscopio para adquirir imágenes desde dentro del paciente, este procedimiento
se realiza siempre antes de iniciar el tratamiento de los órganos enfermos.
De acuerdo a la información proporcionada por el doctor José Cortez Soto (ver Anexo
2), un cirujano del Hospital Rebagliati con 4 años de experiencia en artroscopia,
realizar una artroscopia es un proceso complejo de aprender y realizar. A pesar de ello
es un procedimiento realizado frecuentemente, según señala respecto al número de
artroscopias realizadas en un mes:
21
2.6.3 Procedimiento de artroscopia de rodilla
22
Procedimiento de artroscopia diagnóstica
Inicio
Tomar medidas de
asepsia y
antisepsia
Colocación de la
articulación
Distensión de la
articulación con
solución salina
Inserción del
artroscopio
Conexión de la
fibra óptica
Iniciar el recorrido
visual
Fin
23
manera que se pueda operar a una persona con rodilla estrecha, que sea posible
identificar el punto de quiebre del artroscopio y conocer las maniobras en la rodilla (ver
Anexo 2).
Una solución que permitiría a los médicos realizar una operación más precisa y más
rápida es la automatización de alguna parte del proceso de cirugía. En este caso una
alternativa es la automatización del sistema de visión, con lo cual es más fácil para el
médico realizar la cirugía dentro del espacio de trabajo.
El sistema de visión para cirugía artroscópica tiene dos partes principales: la parte de
control del sistema y el brazo robot encargado del control del artroscopio.
Las órdenes del cirujano se transmiten al brazo robot usando una paleta de
programación, la cual, a través de un microcontrolador y actuadores eléctricos (que
proporcionan mayor precisión), se encarga de llevar a cabo el movimiento del brazo
robot. El brazo robot debe contar con al menos cinco grados de libertad, lo cual
permitiría el movimiento dentro del espacio de trabajo, área de la articulación de la
rodilla, donde el uso de los sensores de posición, proximidad, velocidad y cámara de
video permiten la realimentación y control del sistema. Especialmente se deberá usar
un sensor de fuerza para evitar el quiebre de la cámara debido a excesiva fuerza. Los
elementos del sistema de artroscopia planteado se muestran en la siguiente figura.
24
Figura 2.11. Representación gráfica del modelo teórico para artroscopia con asistente
robótico
Para el control del sistema se debe proporcionar al robot variables que le permitan
realizar el control de los movimientos que realiza, estas variables son:
Proximidad: indican la presencia del objeto y permiten medir distancias entre objeto y
sensor.
25
Capítulo 3
Diseño del circuito de control y selección del actuador para el
brazo robot
3.1 Introducción
En los capítulos anteriores se ha mostrado que la cirugía laparoscópica es una buena
opción para los pacientes, ya que permite una recuperación post-operatoria más
rápida debido al mínimo daño hecho al paciente. Sin embargo, la cirugía laparoscópica
es un procedimiento complejo, principalmente por la observación indirecta del espacio
de trabajo y el manejo restringido de los instrumentos de operación. También se ha
mostrado otra forma de cirugía endoscópica: la artroscopia, que actualmente ayuda en
el diagnóstico y tratamiento del problema de ligamento cruzado anterior y que desde
los años 80 ha incrementado el uso de reconstrucción de este ligamento con técnicas
mínimamente invasivas [1].
26
tecnología en el sector salud, para mejorar su calidad y disponibilidad para más
personas. Además, se desea contribuir con el inicio de una nueva línea de
investigación y desarrollo en cirugía robótica.
27
6. Simular el control de un artroscopio, durante una artroscopia de diagnóstico,
usando el brazo robot SCORBOT-ER V plus.
3.3 Metodología
Este capítulo presenta la evaluación y selección de actuadores del brazo robot, los
cuales se usan para el control del artroscopio. Se basa la selección en las exigencias
de cirugía artroscópica y el funcionamiento del robot SCORBOT-ER V plus. Además,
se presenta el diseño de un circuito de control para los actuadores seleccionados en
este trabajo de tesis.
Por otra parte, este trabajo de tesis también incluye una simulación del uso de un
artroscopio, la cual se realiza utilizando el brazo robot SCORBOT-ER V plus en el
laboratorio del Centro de Tecnologías Avanzadas de Manufactura (CETAM). El
objetivo de esta simulación es el de comprobar el cumplimiento de los requerimientos
28
de artroscopia de rodilla usando un brazo robot industrial, esta investigación servirá
para definir las exigencias del brazo robot tales que cumplan los requerimientos de la
artroscopia de rodilla.
Por otra parte es necesario definir la articulación para la cual se elegirá el actuador,
por ello se opta por la articulación de la muñeca, debido a que esta mueve la menor
parte del brazo, lo cual facilita su adaptación a posibles cambios que se hagan al
momento de diseñar la estructura del brazo robot para artroscopia.
Tabla 3.1 Características del actuador del brazo robot SCORBOT [15]
Torque pico con el motor frenado 15 oz.in (1.0802 kgf.cm)
mínimo
Potencia en torque pico mínimo 70W
Voltaje DC nominal 12
29
Tabla 3.2. Motores del distribuidor Superrobótica
Torque pico con Potencia en torque Voltaje Precio
el motor frenado pico DC euros
S330120 MOTOR DC 8,87 kgf.cm 1500mA*12= 18W 12 22.46
REDUCTOR 12V 120
RPM
S330125 MOTOR DC 8,87 kgf.cm 1500mA*12= 18W 12 20.65
REDUCTOR 12V 200
RPM
S330142 MOTOR DC 10 kgf·cm 3800mA*12= 45.6W 12 27.46
REDUCTOR 12V 253
RPM
30
Tabla 3.6. Parámetros del motor seleccionado
1. Control del motor seleccionado. Voltaje = 12V
Corriente máxima=3.4A
Potencia máxima=40,8W
Torque=1.1kgf.cm
2. Precisión del movimiento del motor. Tiempo de conmutación=2-100ms
31
Figura 3.2 Diagrama esquemático del circuito de control para el actuador
32
Capítulo 4
Simulación del control del artroscopio usando el brazo robot
SCORBOT
Comandos Movimiento
en lenguaje en la
ATS articulación
Computadora
personal con Brazo
programa de robot
control ATS
Coordenadas
cartesianas del
efector final
Figura 4.1. Diagrama de bloques del sistema de mando del brazo robot SCORBOT ER
V plus usado en la simulación.
33
En la simulación del procedimiento de diagnóstico artroscópico el brazo robot
SCORBOT realizará los movimientos del artroscopio durante la cirugía, cuyo
procedimiento está basado en la experiencia expuesta por Jorge González Griego
[11]. También se definirá el espacio de trabajo (dimensiones de la articulación de la
rodilla) y se usarán herramientas que representan al artroscopio y al trocar (punto de
entrada para el artroscopio).
34
La figura 4.2 muestra la simulación del procedimiento de artroscopia que se realizará.
Programa Principal
Inicio
Definir punto
inicial
Movimiento
bolsa
supratelar
Movimiento
compartimento
medial
Movimiento
escotadura
intercodilea
Movimiento
compartimento
lateral
Fin
35
Además se ve en la figura 4.3 los diagramas de flujo correspondientes a los 4
movimientos de artroscopia que realizará el brazo robot.
Inicio Inicio
Fin
Inicio Inicio
Introducción hasta
ligamento cruzado Introducción hasta
anterior plieges sinoviales
Fin
36
4.3 Simulación del control del artroscopio usando el brazo robot
SCORBOT ER V plus
Las dimensiones tomadas para la simulación son valores medios de las mediciones
hechas en el trabajo mencionado, estos valores son presentados en la tabla 4.1.
37
Modelo simplificado del espacio de trabajo y simulación del algoritmo de
artroscopia diagnóstica
En las siguientes tablas (4.2, 4.3, 4.4, 4.5) se muestran los algoritmos de cada etapa
de movimiento: bolsa suprapatelar, compartimento medial, escotadura intercodilea y
compartimento lateral. La descripción del movimiento es la forma descrita por el
ciruano, mientras que el tipo de movimiento es la forma del movimiento programado
con el brazo robot.
38
Tabla 4.4 Algoritmo del movimiento en la escotadura intercondílea
Descripción del movimiento Tipo de movimiento
1. Se introduce el artroscopio hasta movimiento de vertical
visualizar el ligamento cruzado anterior movimiento de ingreso
2. Se mueve el artroscopio lateralmente
movimiento horizontal
para ver completamente el ligamento
movimiento horizontal
cruzado anterior
3. Se retira el artroscopio hasta visualizar movimiento de ingreso
el menisco medial movimiento vertical
39
control del artroscopio se consigue realizar cada una de las etapas del algoritmo
definido.
Primero se definió el punto de entrada para el artroscopio en la coordenada (0, 35, 0),
a partir de donde se definen los movimientos del artroscopio realizados por el brazo
robot usando los puntos por los cuales pasa el artroscopio. Las tablas (4.6, 4.7, 4.8,
4.9) muestran las coordenadas de la trayectoria de los movimientos en cada etapa del
algoritmo descrito.
40
Finalmente usando estas coordenadas y los movimientos programados
correspondientes se realiza la simulación del control del artroscopio con el objetivo de
comprobar la precisión de un brazo robot de tipo serial al realizar esta tarea.
Se verifica además que dadas las dimensiones del alcance del brazo robot (tabla 4.10)
y el espacio de trabajo del modelo simplificado definido, este brazo debe ser capaz de
realizar los movimiento dentro del espacio de trabajo; se enfocará la simulación en que
los movimientos realizados puedan realizarse usando un artroscopio que pase por un
punto fijo, tal como sería en una artroscopia real.
41
Tabla 4.10. Dimensiones de alcance del brazo robot SCORBOT que simula el espacio
de trabajo del modelo de la articulación de rodilla
El movimiento que el brazo robot realiza se enfoca en la punta del brazo (TCP o tip of
griper) donde se ubicará el artroscopio. La figura 4.7 muestra la ventana del ATS al
momento de iniciarla, así como la ejecución de la instrucción home para hacer que el
brazo se ubique en su posición inicial.
42
En la figura 4.8 se muestra el brazo robot SCORBOT en su posición inicial
Figura 4.9. Sistema de coordenadas cartesianas del brazo robot SCORBOT ER V plus
43
El efector final del brazo robot SCORBOT ER V plus es la pinza, la cual se muestra en
la figura 4.10.
Se usa el programa ATS para hacer que el brazo SCORBOT se mueva en el eje
deseado usando los modos manual y edit del programa.
44
Tabla 4.11. Información de coordenadas del brazo robot SCORBOT usando el
comando listpv
Coordenadas de articulación (unidades de paso de cada motor)
1: 0 2: 1791 3: 2746 4: 0 5: -1
Coordenadas cartesianas
X: 1690 Y: 0 Z: 6011 P: -636 R: -1
Una vez definidas las dimensiones y las partes se tiene un espacio de trabajo definido,
entonces se pueden determinar movimientos simples, que permitan que el artroscopio
explore la articulación formando movimientos más complejos. Se realizan simulaciones
en modo manual (1 a 3) para definir los puntos inicial y final de los movimientos
vertical, horizontal y de ingreso; además se realizan simulaciones en modo edit (4 a 6)
para mover el artroscopio en una trayectoria definida. Luego de las simulaciones de
movimientos básicos se pueden simular los movimientos de artroscopia usándolos
para mover el artroscopio a través de la trayectoria definida por el algoritmo definido
anteriormente.
45
articulaciones usadas son la 2 y la 3 (hombro y codo). La posición inicial ART0 se
muestra en la tabla 4.12.
ART0
Coordenadas articulares
1:21759 2:5086 3:-3920 4:-710 5:696
Coordenadas cartesianas
X:-2616 y:1313 z:3823 p:-888 r:-3
ART1
Coordenadas articulares
1:21759 2:7976 3:-2722 4:-710 5:696
Coordenadas cartesianas
X:-3415 y:1714 z:3783 p:-888 r:-3
Las posiciones inicial ART2 y final ART3 se muestran en las tablas 4.14. y 4.15.
46
Tabla 4.15. Coordenadas de la posición final de la simulación 2.
ART3
Coordenadas articulares
1:22274 2:7152 3:-3190 4:-1728 5:-343
Coordenadas cartesianas
X:-3316 y:1409 z:3790 p:-884 r:-372
47
Simulación 4: movimiento de ingreso a la rodilla con trayectoria definida
Se define el vector de posiciones INGRESO [I] con el comando DIMP (modo editor)
para grabar las posiciones de la trayectoria .Este es un comando de definición, cuando
se escribe se ejecuta el comando pero no se crea línea de programa, ni en modalidad
de edición.
El ingreso del artroscopio será de 8cm (800 unidades en coordenadas del brazo
probablemente muy grande si se toma en cuenta que el movimiento será dentro de
una rodilla, pero es una dimensión adecuada para visualizar el movimiento). La
variación del movimiento en el eje X será de 80 para 10 pasos.
Las articulaciones modificadas en este movimiento son: el hombro (2) y el codo (3). El
programa que guarda las posiciones en el vector es MOV1A
;----Program MOV1A----
SET PIN = -2626
FOR I = 1 TO 10
SET PIN=PIN - 80
SETP ING[I]=ART0
SETPVC ING[I] X PIN
SETPVC ING[I] Y 1318
SETPVC ING[I] Z 3824
SETPVC ING[I] P -883
SETPVC ING[I] R 322
ENDFOR(2864)
PRINTLN "vector creado"
END
48
Tabla 4.18. Coordenadas de la posición inicial de la simulación 5.
ART2
Coordenadas articulares
1:21311 2:7152 3:-3190 4:-96 5:1289
Coordenadas cartesianas
X:-3127 y:1791 z:3790 p:-884 r:213
Articulación 1: +48
Articulación 2: -81
Articulación 4: -81
49
;----Program MOV2A----
;Definición de posiciones para movimiento horizontal
DIMP HOR[19]
;definición de variables locales
DEFINE H01
DEFINE H04
DEFINE H05
DEFINE IH
;proceso
SET H01 = 21311
SET H04=-96
SET H05 = 1289
FOR I H= 1 TO 19
SET H01=H01+48
SET H04=h04-81
SET H05=H05-81
SETP HOR[IH]=ART2
SETPV HOR[IH] 1 H01
SETPV HOR[IH] 2 7152
SETPV HOR[IH] 3 -3190
SETPV HOR[IH] 4 H04
SETPV HOR[IH] 5 H05
ENDFOR
PRINTLN "vector HOR creado"
END
50
Tabla 4.21. Coordenadas de la posición final de la simulación 6.
ART5
Coordenadas articulares
1:21762 2:7582 3:-2872 4:-1185 5:962
Coordenadas cartesianas
X:-3025 y:1516 z:3846 p:-1021 r:-40
;----Program MOV3A----
;posiciones
DIMP VRT[39]
;var locales
DEFINE V02
DEFINE V03
DEFINE V04
DEFINE V05
DEFINE IV
;proceso
SET V02=5550; valores iniciales de art4
SET V03=-4678
SET V04=39
SET V05=-137
FOR IV=1 TO 39
SET V02=V02+50
SET V03=V03+45
SET V04=V04-30
51
SET V05=V05+27
SETP VRT[IV]=ART4
SETPV VRT[IV] 1 21762
SETPV VRT[IV] 2 V02
SETPV VRT[IV] 3 V03
SETPV VRT[IV] 4 V04
SETPV VRT[IV] 5 V05
ENDFOR
PRINTLN “Vector VRT creado”
END
;----Program Vert0----
SPEED 25
MOVED ART4
MPROFILE PARABOLE
MOVES VRT 1 39
MOVES VRT 38 1
MOVED ART4
END
Escotadura
Compartimento
intercodilea
medial
Compartimento
lateral
Punto de entrada a
la rodilla
Bolsa suprapatelar
52
P1 (20,0,10)
P0 (0,35,0)
a)
P2 (20,0,15)
P4=P1 (20,0,10)
P5 (20,10,10)
P3 (20,0,5)
b)
Figura 4.13. Trayectoria del movimiento en la bolsa suprapatelar. a) P0-P1. b) P1-P5
53
Las coordenadas para el movimiento en el compartimento medial se muestran en la
siguiente figura:
P3 (0,0,5) P5 (0,5,5)
P4 (0,-10,5)
P1 (0,10,10)
P2 (0,10,5)
P0 (20,10,10)
54
Las coordenadas para el movimiento en la escotadura intercodilea se muestran en la
figura 4.15.
P3 (-5,0,15)
P0=P6 (0,5,5)
55
Las coordenadas en el compartimento lateral se muestran en la siguiente figura:
P2 (0,-20,0.5)
P0 (0,5,5)
P4 (0,5,0)
P1= P3 (0,5,0.5)
P5 (0,35,0)
56
Capítulo 5
Resultados
57
Figura 5.2 Simulación en SPICE del circuito de control de giro del motor
En la figura anterior la curva (1) es el voltaje que se aplica al motor y que depende de
las entradas dadas por las curvas (2) y (3) de la forma señalada en la tabla 5.1. En la
figura se aprecia que el voltaje en el motor cambia de +12V a -12V, lo cual indica la
inversión de giro por cambio de polaridad del voltaje en el motor.
Se comprueba que el circuito hace posible controlar el giro del motor invirtiendo la
corriente en el motor, el siguiente paso sería usar este circuito para el control de cada
articulación, luego de lo cual se debe realimentar al controlador los datos de posición y
velocidad de giro para comprobar la precisión del movimiento de la articulación.
58
siguiente tabla muestra los datos obtenidos, el promedio y el error de repetibilidad en
cada articulación. Las medidas son en unidades de encoder.
Movimiento horizontal
1 2 3 4 5
22274 7152 -3190 -1728 -343
22273 7155 -3190 -1722 -344
22277 7152 -3199 -1723 -344
22281 7153 -3193 -1726 -345
22276 7152 -3192 -1719 -343
22274 7156 -3190 -1727 -346
22270 7157 -3196 -1728 -344
22273 7155 -3193 -1727 -343
22275 7154 -3192 -1728 -342
22274 7153 -3190 -1727 -342
22274,7 7153,9 -3192,5 -1725,5 -343,6 Promedio
2,907843798 1,791957 2,990726 3,100179 1,264911 Error
Movimiento vertical
1 2 3 4 5
21762 7582 -2872 -1185 962
21766 7582 -2872 -1183 966
21762 7582 -2870 -1183 964
21763 7583 -2872 -1184 964
21760 7580 -2873 -1185 963
21764 7583 -2871 -1180 960
21762 7583 -2871 -1182 961
21763 7581 -2873 -1183 962
21763 7582 -2170 -1183 964
21764 7584 -2872 -1186 962
21762,9 7582,2 -2801,6 -1183,4 962,8 Promedio
1,595131482 1,14 221,9235 1,712698 1,75119 Error
59
Movimiento de ingreso
1 2 3 4 5
21759 7976 -2722 -710 696
21755 7977 -2723 -710 696
21756 7978 -2722 -711 697
21757 7977 -2721 -712 696
21759 7978 -2720 -709 695
21758 7978 -2723 -710 694
21758 7978 -2721 -709 695
21757 7977 -2722 -711 697
21756 7975 -2723 -711 695
21759 7976 -2722 -710 697
21757,4 7977 -2721,9 -710,3 695,8 Promedio
1,429840706 1,054093 0,994429 0,948683 1,032796 Error
Se ve que el error en general para todos los actuadores esta alrededor de 1%, lo cual
representaría un error aceptable en el movimiento del artroscopio.
60
Conclusiones
En relación al objetivo del diseño de un circuito de control para un actuador del brazo
robot, se comprobó que es posible controlar el giro de un actuador eléctrico, usando
un circuito de inversión de giro basado en MOSFETS.
61
Recomendaciones
4. Para escoger un determinado actuador en el diseño del brazo robot para cirugía
artroscópica es necesario realizar un levantamiento de información de los
diferentes actuadores en el mercado, de esta manera se puede elegir el más
adecuado en función de las características del actuador de brazo robot SCORBOT.
En este trabajo se eligió en base a una evaluación el actuador HG42KD de 3600
RPM de la marca HENNKWELL, debido principalmente a sus características de
Torque pico con el motor frenado y Potencia en torque pico adecuados.
62
Glosario
Artroscopia
1. f. Med. Exploración de las cavidades articulares mediante un artroscopio.
Artroscopio
1. m. Med. Endoscopio especial que se utiliza para explorar las cavidades articulares.
Pronóstico
4. m. Med. Juicio que forma el médico respecto a los cambios que pueden sobrevenir
durante el curso de una enfermedad, y sobre su duración y terminación por los
síntomas que la han precedido o la acompañan.
Robótica
f. Técnica que aplica la informática al diseño y empleo de aparatos que, en sustitución
de personas, realizan operaciones o trabajos, por lo general en instalaciones
industriales.
Endoscopia
(De endo- y -scopia).
1. f. Med. Técnica de exploración visual de una cavidad o conducto del organismo.
2. f. Med. Esta exploración.
Laparoscopia
(Del gr. λαπ ρα, costado, lado del vientre, y -scopia).
1. f. Med. Exploración visual de la cavidad abdominal con el laparoscopio.
2. f. Med. Técnica de esta exploración.
63
Fuentes
[1] J. PAULOS ARENAS, D. FIGUEROA POBLETE. Cirugía Artroscópica, Boletín Esc.
de Medicina, P. Universidad Católica de Chile, 1994
[3] TORRES, F.; POMARES, J.; GIL, P.; PUENTE, S. T., y ARACIL, R. Robots y
sistemas sensoriales. Pearson Educación, S.A., Madrid, 2002
[5] SIMAAN N., “Analysis and synthesis of parallel robots for medical aplications”,
Master thesis. Israel. 1999.
[6] MADRID, ERICKA P., TAFUR, JULIO C., ROBLES, SANDRA C., CURAY JULIO C.
Diseño y fabricación de un brazo robot de cinco grados de libertad articulado
verticalmente: control y potencia. Octavo congreso iberoamericano de ingeniería
mecánica. 2007.
[7] DIRECCIÓN DE COMUNICACIÓN. Universidad de Piura. 1972.
[8] NUÑEZ RIVERA, WALTER. Telemedicina. Universidad Nacional de San Agustín.
2000.
64
[15] ESHED ROBOTEC INC., “Controller B ACL version 2.28 User’s manual”, ESHED
ROBOTEC INC., 1999.
65