Asistencia háptica basada en planificación de movimientos para la teleoperación cooperativa de sistemas multirobot

Abstract

This work proposes a framework for the teleoperation of anthropomorphic industrial robots using desktop haptic devices that provides an aid to the operator in the form of haptic guidance based on path planning techniques. The teleoperation framework incorporates a new model of correspondence mapping between the workspace of the haptic device used to command the remote node and that of the robot. The mapping takes into account the position and orientation of the active camera that provides the video fed back from the remote node. The main features of this system are: 1. The user can change the position of the active camera to increase the visibility or to change the scales related to the workspaces in order to set the precision. 2. The user feels slight guiding forces that attract and push him/her to the path towards the goal configuration, particularly when it contains configuration changes. 3. When the operator requests it or when he/she reaches the limits of the workspace of the haptic device, the assistance system calculates the new configuration for the haptic device, taking over the teleoperation and guiding the operator to that configuration where teleoperation can resume.

All kinesthetic aids are generated based on a Planner which includes a novel algorithm that is able to find feasible paths between both static and mobile obtacles or a mitxture of both. The main features of the proposed Planner are: 1. It is based on a Probabilistic RoadMap strategy based on a lazy evaluation of the possible collisions of the path. 2. It uses a reduced graph to find the solution path, which is a subset of a larger graph, thus ensuring both computational efficiency and coverage of the whole configuration space. 3. Each planned path is evaluated and iteratively improved by creating a new set of samples closer to the obstacles when any edge-validation fails. 4. Replanning is useful when moving obstacles are present or when the initial configuration changes and this process always brings as a result a new path very close to the one previously valid.

The Planner frees the user from paying attention to potential collisions between the environment and any part of the robot (not only the end-effector, as other approaches do). This can be applied especially in multi-robot environments, where the other robots present in the cell may interfere with the remote teleoperated movements. The planner deals with other robots as collections of moving obstacles.

The bilateral control scheme of the teleoperation system ensures its stability despite time delays. Additionally, the system influences on the remote node damping factor as a way of dealing with potential collisions, slowing the teleoperation when the system detects one.

The system has been validated with multiple users, both in simulated environments and with the real robot, and it has shown that with the use of its assistance the operator increases speed and security in performance, lightening the burden of teleoperation, especially when there are moving obstacles.

En el presente trabajo se propone un marco para la teleoperación de robots industriales antropomórficos que cuenta con elementos de ayuda al operador en forma de guiado háptico basado en técnicas de planificación de caminos (path planning) para facilitarle su labor. Incorpora un novedoso modelo de correspondencia entre el espacio de trabajo del dispositivo háptico con el que va a ser comandado y el del robot. Esta correspondencia tiene en cuenta la posición y orientación de la cámara activa que proporciona el video desde el sitio remoto. Las principales características de este sistema son: 1. El usuario puede cambiar de cámara activa para incrementar la visibilidad o cambiar las escalas que relacionan los espacios de trabajo para ajustar la precisión. 2. El usuario experimenta ligeras fuerzas de guiado que lo atraen hacia el camino planificado y también lo empujan a lo largo del mismo hacia la configuración objetivo, en particular cuando contiene cambios de configuración. 3. Cuando se alcanzan los limites del espacio de trabajo del dispositivo háptico o cuando el usuario lo solicita, se calcula la nueva configuración de este dispositivo, desde donde pueda retomar y efectuar la teleoperación y lo guía hasta ella. Las ayudas hápticas son generadas a partir de un camino que soluciona la tarea. Para lo cual se ha desarrollado un planificador que incorpora un novedoso algoritmo que es capaz de encontrar caminos realizables tanto entre obstáculos estáticos como entre móviles o la mezcla de unos y otros. Las principales características del planificador propuesto en el presente trabajo son: 1. Está basado en un planificador de mapa de carreteras probabilístico (Probabilistic Roadmap) con evaluación tardía de las colisiones del camino encontrado. 2. Se reduce la cantidad de muestras que componen el grafo donde se busca la solución a partir de uno más grande que cubre el espacio de configuraciones. 3. Cada camino planificado es evaluado y mejorado progresivamente de forma iterativa, creando un nuevo conjunto de muestras cerca de los obstáculos cuando la validación de alguna arista falla. 4. Es útil para replanificar cuando están presentes obstáculos móviles o cuando la configuración inicial cambia, dando siempre como resultado un camino muy cercano al anteriormente válido. Con esta ayuda el usuario se libera de prestar atención a las potenciales colisiones de cualquier parte del robot con el entorno y no solamente del efector final del robot (TCP) como se hace en otros enfoques. Esto es aplicado especialmente en entornos multirobot donde los otros robots presentes en la celda remota pueden interferir con los movimientos teleoperados y que en este trabajo son considerados como colecciones de obstáculos móviles. El esquema de control del sistema de teleoperación bilateral, garantiza la estabilidad a pesar de los retardos de las variables. Adicionalmente, se influye sobre su factor de amortiguamiento en el nodo remoto como una forma de hacer frente a potenciales colisiones, ralentizando la teleoperación cuando se advierte una potencial colisión. El sistema ha sido validado con varios usuarios, tanto en simulación como en experimentación con el robot real,mostrando que con esta asistencia se incrementa la velocidad y la seguridad en la ejecución de la tarea y se aligera la carga de la teleoperación, en especial cuando existen obstáculos móviles.