MODELADO Y CONTROL DE MANIPULADORES ROBÓTICOS PARA APLICACIONES BIOMÉDICAS
RESUMEN Palabras clave: Robot manipulador, modelado, control, prótesis de brazo, bioseñales, aplicaciones biomédicas ABSTRACT Considering the physical similarities and performance requirements between the robot manipulator and the artificial prosthetic for the superior limb, most of the control schemes used in manipulators may be adapted to be used by prosthetic arms. This is why a robot manipulator can be considered as a good representation of the human arm and might be used as a platform to develop control strategies that can be used in prototypes of future artificial prosthetics. However, the design of suitable control strategies involves the consideration of mathematical representations of the system, such as kinematics and dynamics models. Mathematical modelling is fundamental in the designing process depending of the objectives of the implementation, the constraints of the task to be executed, and the desired robot’s performance. The difficulty in obtaining these models varies according to the complexity of the kinematics of the mechanical structure and the number of degrees of freedom (DOF) of the manipulator. Keywords: Robot manipulator, modelling, control, arm prosthesis, biosignals, biomedical applications. INTRODUCCIÓNLos avances tecnológicos han llevado al desarrollo de diversos tipos de dispositivos prostéticos diseñados para asistir a personas con algún tipo de discapacidad. Estos dispositivos están diseñados para compensar la incapacidad que los órganos o extremidades del usuario pudieran tener ofreciendo una sensación natural y comodidad al paciente. Para cumplir con esto último, el control de los dispositivos prostéticos está basado generalmente en el uso de bioseñales. Entre las prótesis basadas en bioseñales se pueden mencionar las prótesis neurales, las prótesis mioeléctricas y las prótesis robóticas. Las prótesis mioeléctricas usan la actividad eléctrica de los músculos para controlar dispositivos mecánicos usados para ejecutar una tarea, por ejemplo la rotación de una muñeca, la flexión de un codo o el agarre de una mano. Las prótesis neurales son dispositivos basados en actividad cerebral que son capaces de compensar por daño neural que afecta los procesos motores, sensoriales o cognitivos. Hay varios tipos de prótesis neurales: las prótesis visuales, los implantes auditivos, las prótesis cognitivas y los implantes motores. Las prótesis visuales estimulan las neuronas del sistema visual para crear imágenes en el cerebro. Los implantes auditivos como el implante coclear y el implante auditivo de tronco cerebral estimulan los nervios auditivos ayudando al cerebro a procesar el sonido. Las prótesis cognitivas se usan para replicar funciones cerebrales que son originalmente ejecutadas por el tejido que se ha dañado. Los implantes motores se utilizan para control de movimiento consciente de extremidades mecánicas, o prótesis robóticas. Las prótesis robóticas se construyen como sistemas completos que incluyen sensores, controladores y actuadores para controlar estructuras mecánicas sofisticadas como brazos robóticos. Cuando se utiliza una computadora para procesar actividad neuronal que será utilizada para controlar un dispositivo, el sistema se conoce como Interface Cerebro Computadora o Brain Computer Interface BCI. Hay varios desarrollos que han ayudado a estimular la investigación en el área de BCI. Braingate, por ejemplo, es un sistema sofisticado que consiste en un arreglo de microelectrodos que se pueden implantar en el cerebro para registrar señales, y utiliza un decodificador para encontrar comandos útiles para el control de dispositivos externos como una computadora, una silla de ruedas, o la prótesis de una extremidad. En la mayoría de los casos el desarrollo de las interfaces diseñadas para controlar extremidades prostéticas robóticas superiores, se lleva a cabo usando brazos robóticos comerciales cuya anatomía es similar al brazo humano. Dos dispositivos populares que cumplen con esta descripción son el DLR Light Weight Robot desarrollado por el Instituto de robótica y mecatrónica en el German Aeroespace Center, y el DEKA que pertenece a un proyecto patrocinado por la Defense Advanced Research Projects Agency y la U.S. Army Research Office. Los manipuladores robóticos han estado en la industria desde 1950. En general, la estructura mecánica de un robot manipulador consiste en una secuencia de cuerpos rígidos llamados eslabones que están interconectados por mecanismos de rotación o translación que funcionan como articulaciones. Generalmente se conecta un efector final en el último eslabón cuya arquitectura le permita agarrar objetos. La configuración específica de los eslabones y articulaciones trazan los requerimientos que deben ser considerados en el diseño del esquema de control usado para mover el manipulador. Recientemente, los manipuladores de brazo completo o Whole Arm Manipulators WAM han llamado la atención de los investigadores debido a su cinemática similar a la del ser humano. En el caso de los manipuladores de brazo completo, como en otros manipuladores con configuración serial de eslabones, las ecuaciones dinámicas se pueden calcular usando métodos recursivos como el método de Euler-Lagrange, el método de Newton-Euler o una combinación de ambos. Muchos de los modelos matemáticos que han sustentado el diseño de controladores para los manipuladores WAM están basados en la computación de las ecuaciones matemáticas de robots seriales de múltiples eslabones. Las ecuaciones pueden ser obtenidas usando el método recursivo de Newton-Euler para encontrar las fuerzas de Coriolis, las fuerzas centrifugas y las fuerzas inerciales observadas cuando el elemento final está en movimiento. Además, se hace uso del Jacobiano para minimizar las condiciones de singularidad que incrementan la carga computacional del algoritmo de control, esta metodología involucra tanto las fuerzas operacionales como las fuerzas de la articulación. Para evitar tiempos de ejecución significativos, algunos autores han encontrado en MATLAB-SimMechanics una herramienta cómoda y sencilla para diseñar sistemas mecánicos usados en verificación experimental. La computación del modelo dinámico del robot manipulador tiene un rol importante en la simulación de movimiento, en el análisis de la estructura del manipulador y en el diseño de algoritmos de control óptimos. El desempeño de manipuladores robóticos de múltiples elementos se ve frecuentemente comprometido por la influencia de la fuerzas de gravedad que afectan la dinámica del sistema, entre otras no linealidades como las fuerzas de fricción y las fuerzas inerciales. En la mayoría de los casos la minimización del error en la ejecución de tareas demandará la implementación de un controlador adecuado capaz de lidiar con los efectos de la gravedad, o la adición de un módulo de compensación de la gravedad al lazo de control. MODELADO MATEMÁTICODesde el punto de vista de la mecánica, un manipulador se representa como una secuencia de cuerpos rígidos llamados eslabones, interconectados por medio de articulaciones. Cada uno de estos eslabones simboliza un elemento importante de la arquitectura del manipulador: un brazo para posición, una muñeca para dar destreza y un efector final que realiza una tarea específica. Existen dos tipos de análisis matemáticos usados por el controlador para posicionar el manipulador en una ubicación requerida: el estudio dinámico y el estudio cinemático. El análisis cinemático le dice al controlador a dónde hay que moverse, mientras que el análisis dinámico revela qué hacer para llegar ahí. Por lo tanto, los modelos matemáticos se han desarrollado para entender y controlar efectivamente el comportamiento del manipulador considerando la posición del efector final, las fuerzas de los actuadores, las velocidades y las aceleraciones de las articulaciones. Hay dos problemas cinemáticos que se pueden resolver para identificar la posición y orientación del efector final de acuerdo a la información suministrada sobre las articulaciones. Si las variables articulares (ángulos y translaciones) son dadas, se puede calcular la posición del efector final resolviendo el problema cinemático directo, de otra manera si solamente se conoce la posición del efector final, se puede encontrar los valores de las variables articulares a través del problema cinemático inverso. La computación del modelo dinámico de un robot manipulador tiene un rol importante en la simulación de movimiento, el análisis de la estructura del manipulador y el diseño de algoritmos de control. Simular el movimiento del manipulador permite probar estrategias de control y técnicas de planeación de movimiento sin necesidad de poseer el sistema físico. Por ejemplo, Olsen y Petersen (Olsen and Petersen, 2001) presentaron un método para encontrar los parámetros del modelo de un robot con el fin de apoyar el diseño de controladores para robots basados en el modelo. También propusieron la computación de los parámetros del modelo de fricción usando métodos experimentales para dos eslabones del Mitsubishi PA-10 robot. Kostic y sus colegas (Kostic et al., 2004) mostraron la importancia de agregar un modelo de fricción preciso en control no lineal basado en modelo. Su trabajo muestra un procedimiento para mejorar el desempeño de un brazo robótico RRR y valida sus resultados a través de una tarea de escritura. Otra contribución al modelo del robot Mitsubishi PA-10 lo presenta Bompos (Bompos et al., 2007), donde los autores describen la identificación completa de los parámetros del modelo, la estimación de la rigidez de las articulaciones y un nuevo modelo no lineal de fricción para las articulaciones del manipulador. La verificación del modelo se hace a través de una tarea de seguimiento de trayectoria. De acuerdo a los resultados obtenidos en los trabajos mencionados anteriormente, es recomendable incluir un modelo de fricción en el modelo del sistema mecánico para lograr el diseño de un controlador adecuado. La acción más recomendable es identificar la fricción manifestada en el sistema y usar estos datos para crear el modelo matemático que pueda servir como referencia. Debido a que la no linealidad de la fricción puede afectar el desempeño del controlador, el uso de un modelo de fricción adecuado permite una mejor compensación. Existen muchos modelos de fricción empleados cuando se modelan mecanismos de control de posición. Estos modelos incluyen varios componentes como la fricción cinética, la fricción estática y la fricción viscosa. Armstrong y colegas publicaron una recopilación (Armstrong-Helouvry et al., 1994) donde se explica toda la teoría detrás del fenómeno de fricción y propone e integra un modelo de fricción basado en siete parámetros que incluyen la fricción estática, la fricción cinética, la fricción viscosa y la curva de fricción de Stribeck. A su vez, Canudas de Wit y colegas (Canudas de Wit et al., 1995) propusieron un modelo dinámico que considera las superficies de contacto como el contacto entre cerdas e ilustra el procedimiento de identificación de la fricción para validar el modelo usando datos experimentales (Canudas de Wit and Lischinsky, 1997). Hensen y colegas (Hensen et al., 2000) presentaron dos modelos de caja gris y los validaron usando datos experimentales obtenidos de un brazo en rotación. En algunos casos la influencia de la fricción no afecta significativamente el desempeño del sistema, por lo que una técnica de compensación podría no ser necesaria. En otros casos la estrategia de control puede ser lo suficientemente efectiva para compensar el error causado por las no linealidades debidas a la fricción en las articulaciones del manipulador. Por ejemplo, un control PID es capaz de lidiar con la fricción cuando todos sus parámetros son seleccionados convenientemente (Lewis et al., 2004). Sin embargo, sintonizar los parámetros de un PID no es una tarea sencilla y frecuentemente se requiere de la implementación de técnicas basadas en métodos iterativos que usan datos experimentales (Hamamoto et al., 2003; Hildebrand et al., 2005). CONTROL DE MANIPULADORESLas articulaciones de los manipuladores robóticos siguen diversas trayectorias para completar una tarea específica. La precisión en el movimiento de la estructura mecánica depende de las fuerzas aplicadas a las articulaciones del manipulador usando controladores. Existen varias técnicas de control lineal y no lineal usadas para el control articular de los manipuladores robóticos, considerando el manipulador como un sistema una-entrada/una-salida o single-input/single-output SISO, o como un sistema múltiples-entradas/múltiples-salidas o Multi-input/Multi-output MIMO. Cuando un robot manipulador es considerado como sistema SISO, cada eslabón se controla independientemente y los efectos de acoplamiento se consideran como perturbaciones. Si las perturbaciones son constantes se puede aplicar un compensador. Entre los compensadores más utilizados en robótica son el Proporcional Derivativo PD y Proporcional integral y Derivativo PID. Cuando la trayectoria articular cambia con el tiempo, el compensador puede ser apoyado agregando un lazo anticipativo a la salida del compensador. Si el modelo matemático del sistema es conocido, se puede usar un sistema dinámico basado en el modelo (observador) para compensar por las perturbaciones usando una estimación del estado completo del sistema. Cuando el manipulador es considerado como un Sistema MIMO el problema de control es no lineal. En la mayoría de los casos, el objetivo de la técnica de control es cancelar las no linealidades basándose en el modelo dinámico del manipulador. Las estrategias de control usadas para compensar las no linealidades en sistema MIMO son control PD con compensación de la gravedad, control dinámico inverso, control robusto y control adaptivo. El control dinámico inverso está basado en la cancelación exacta de las no linealidades usando un estado de realimentación no lineal. La implementación de control robusto depende de una estimación de las incertidumbres y la tolerancia de la estructura mecánica para establecer entradas de control. El control adaptivo usa una estimación en línea del modelo dinámico haciendo adaptaciones en línea que compensan por perturbaciones externas. El control PID es una estrategia de control ampliamente usada en la industria debido al hecho de que el componente integral del controlador puede reducir considerablemente el error del estado estacionario, manteniendo las ganancias pequeñas. Este tipo de controlador tiene comportamiento robusto bajo varias condiciones de operación y su diseño es simple debido a que está basado en un pequeño número de parámetros. Sin embargo pueden aparecer no linealidades cuando el término integral acumula un error significativo que rompe el lazo de realimentación. Esto puede ocurrir debido a las restricciones del actuador y se puede evitar limitando la salida del controlador o utilizando un ajuste de realimentación externa. Sintonizar un controlador PID no es una tarea sencilla, el diseñador debe confiar en métodos específicos para encontrar los valores adecuados de los parámetros. En la mayoría de los casos, la sintonización inicial se lleva a cabo a través de simulaciones computacionales considerando el modelo matemático del sistema. Una vez que el controlador es implementado se utiliza sintonización en línea para ajustar los parámetros a través de la ejecución de varios experimentos. Las reglas básicas para sintonización de PID son las reglas de Ziegler-Nichols. Estas reglas se aplican bajo distintas condiciones. Si la dinámica de la planta no se conoce con precisión, el método usa la respuesta transiente de la planta a un escalón unitario y los parámetros se escogen de acuerdo a la salida. En una segunda versión del método, la ganancia proporcional se cambia hasta que alcanza un valor crítico Ku, en este tiempo la salida exhibe oscilaciones sostenidas con período P, los parámetros se escogen considerando los valores de Ku y P. Otro método común para sintonizar el controlador usando la respuesta transiente de la planta a un escalón unitario es el método de auto-sintonización basado en realimentación por función relé. En este método se conecta un relé en el lazo de realimentación con la planta. Debido a que la amplitud de la oscilación y la salida del relé son proporcionales, la amplitud del relé se puede autoajustar para reducir las oscilaciones. Es posible sintonizar los parámetros de los controladores PID aún si la dinámica del sistema es completamente desconocida utilizando el método de sintonización iterativa de realimentación o Iterative Feedback Tunning IFT. Este método está basado en el comportamiento del controlador sometido a varios experimentos y permite un análisis más preciso del desempeño real del sistema cuando se ejecuta una tarea específica. El método usa los datos recolectados a partir de los experimentos y los somete a un criterio de minimización basado en el gradiente para encontrar los parámetros del controlador iterativamente. Aunque este método fue diseñado originalmente para sistemas lineales, se ha aplicado exitosamente en sistemas no lineales (Hamamoto et al., 2003, Sjörberg et al., 2003). Este tipo de sintonización limita al manipulador a la ejecución de tareas específicas y requiere de una serie de experimentos que en algunos manipuladores no es posible llevar a cabo, ya sea por su arquitectura o por su estructura cinemática. CONCLUSIONESLos manipuladores robóticos de brazo completo, por su cinemática similar a la del ser humano, pueden ser utilizados como plataforma para el desarrollo de diversas aplicaciones biomédicas. Entre éstas podemos mencionar el diseño e implementación de interfaces humano máquina, el diseño de prótesis de brazo y el diseño de controladores para prótesis robóticas de brazo. Para completar una tarea específica, como el alcanzar y tomar un objeto, el manipulador deberá seguir diversas trayectorias cuya precisión de ejecución dependerá del controlador encargado del movimiento de la estructura mecánica. La selección y diseño de algoritmos de control óptimos se debe hacer considerando las características físicas de la estructura mecánica y sus limitaciones, lo cual puede definirse a través del modelo cinemático y dinámico del manipulador. A su vez, el modelo matemático de un robot manipulador tiene un rol importante en la simulación de movimiento, la cual permitirá hacer ajustes fundamentales durante el proceso de diseño y el desarrollo de la aplicación deseada, considerando los objetivos de la implementación, las limitantes de la tarea a ejecutar y el comportamiento deseado del manipulador. REFERENCIASArmstrong, B. Khatib, O. Burdick, J. (1986), “The explicit dynamic model and inertial parameters of the PUMA 560 arm”, Proccedings of the 1986 IEEE International Conference on Robotics and Automation, 510–518. Armstrong-Helouvry, B. Dupont, P. Canudas de Wit, C. (1994), “A survey of models, analysis tools and compensation methods for the control of machines with friction”, Automatica, 30:1083–1138. Asada, H. Slotine, J-J.E. (1986), Robot Analysis and Control. John Wiley and Sons. Bompos, N.A. Artemiadis, P.K. Oikonomopoulos, A.S. Kyriakopoulos, K.J. (2007), “Modeling, full identification and control of the MITSUBISHI PA-10 robot arm”, IEEE/ASME International Conference on Advanced Intelligent Mechatronics, 1–6. Hamamoto, K. Fukuda, T. Sugie, T. (2003), “Iterative feedback tuning of controllers for a two-mass spring system with friction”, Control Engineering Practice, 11:10611068. Hensen, R. H. A. Angelis, G. Z. van de Molengraft, M. J. G. de Jager, A. G. Kok, J. J. (2000), “Grey-box modeling of friction: an experimental case-study”, European Journal of Control, 6. Izadbakhsh, A. (2009), “Closed-form dynamic model of the PUMA 560 robot arm”, Proccedings of the 4th International Conference on Autonomous Robots and Agents, 675–680. Kelly, R. Santibanez, V. Loria, A. (2005), Control of Robot Manipulators in Joint Space, Springer. Kennedy, C. W. Desai, J. P. (2004), “Model-based control of the MITSUBISHI PA-10 robot arm: application to robot-assisted surgery”, Proccedings of the 2004 IEEE International Conference on Robotics and Automation, 2523–2528. Khalil, W. Dombre, E. (2002), Modeling Identification and Control of Robots, Kogan Page Science. Kostic, D. de Jager, B. Steinbuch, M. Hensen, R. (2004), “Modeling and identification for high performance robot control: An RRR-robotic arm case study”, IEEE Transactions on Control System Technology. Lau, H. Y. K. Wai, L. C. C. (2002), “A Jacobian-based redundant control strategy for the 7-DOF WAM”, Seventh International Conference on Control, Automation, Robotics and Vision, 1060–1065. Lewis, F. L. Dawson, D. M. Abdallah, C. T. (2004), Robot Manipulator Control: Theory and Practice, Marcel Dekker. Lightcap, C. Banks, S. (2007), “Dynamic identification of a MITSUBISHI PA10-6CE robot using motion capture”, Proccedings of the 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems, 3860–3865. Neuman, C. P. Murray, J.J. (1987), “The complete dynamic model and customized algorithms of the PUMA robot”, IEEE Transactions on systems, man, and cybernetics, 17:635–644. Ogata, K. (2010), Modern Control Engineering, Pearson. Olsen, M. M. Petersen, H. G. (2001), “A new method for estimating parameters of a dynamic robot model”, IEEE Transactions on Robotics and Automation, 17. Olsson, H. Astrom, K.J. Canudas de Wit, C. Gafvert, M. Lischinsky, P. (1998), “Friction models and friction compensation”, European Journal of Control, 176–195. Orin, D. E. (1980), “Application of robotics to prosthetic control”, Annals of Biomedical Engineering, 8:305–316. Pineda, Z. Lecchini-Visintini, A., Quian Quiroga, R. (2012), “Iterative Feedback Tuning for the joint controllers of a 7-DOF Whole Arm Manipulator”, 51st IEEE Conference on Decision and Control, 544-549. Siciliano, B. Sciavicco, L. Villani, L. Oriolo, G. (2009), Robotics: Modelling, Planning and Control, Springer. Sousa, C. Cortesao, R. Queiros, P. (2006), “Compliant co-manipulation control for medical robotics”, Proceedings of the 2nd conference on Human System Interactions, 262–268. Yeon, J. S. Kim, E. J. Lee, S-H. Park, J. H. Hur, J-S. (2005), “Development of inverse dynamic controller for industrial robots with HyRoHILS system”, International Conference on Control, Automation and Systems, 1060–1065. |
Tlatemoani es una revista académica , editada y mantenida por el Grupo eumed●net de la Universidad de Málaga.
Para cualquier comunicación, envíe un mensaje a blancate2005@yahoo.es
Directora: Dra. Blanca Torres Espinosa;
revista.tlatemoani@uaslp.mx
ISSN: 1989-9300 |
|
|