Method and apparatus for configuration control of redundant robots

A method and apparatus to control a robot or manipulator configuration over the entire motion based on augmentation of the manipulator forward kinematics is disclosed. A set of kinematic functions is defined in Cartesian or joint space to reflect the desirable configuration that will be achieved in addition to the specified end-effector motion. The user-defined kinematic functions and the end-effector Cartesian coordinates are combined to form a set of task-related configuration variables as generalized coordinates for the manipulator. A task-based adaptive scheme is then utilized to directly control the configuration variables so as to achieve tracking of some desired reference trajectories throughout the robot motion. This accomplishes the basic task of desired end-effector motion, while utilizing the redundancy to achieve any additional task through the desired time variation of the kinematic functions. The present invention can also be used for optimization of any kinematic objective function, or for satisfaction of a set of kinematic inequality constraints, as in an obstacle avoidance problem. In contrast to pseudoinverse-based methods, the configuration control scheme ensures cyclic motion of the manipulator, which is an essential requirement for repetitive operations. The control law is simple and computationally very fast, and does not require either the complex manipulator dynamic model or the complicated inverse kinematic transformation. The configuration control scheme can alternatively be implemented in joint space

Robust adaptive kinematic control of redundant robots

The paper presents a general method for the resolution of redundancy that combines the Jacobian pseudoinverse and augmentation approaches. A direct adaptive control scheme is developed to generate joint angle trajectories for achieving desired end-effector motion as well as additional user defined tasks. The scheme ensures arbitrarily small errors between the desired and the actual motion of the manipulator. Explicit bounds on the errors are established that are directly related to the mismatch between actual and estimated pseudoinverse Jacobian matrix, motion velocity and the controller gain. It is shown that the scheme is tolerant of the mismatch and consequently only infrequent pseudoinverse computations are needed during a typical robot motion. As a result, the scheme is computationally fast, and can be implemented for real-time control of redundant robots. A method is incorporated to cope with the robot singularities allowing the manipulator to get very close or even pass through a singularity while maintaining a good tracking performance and acceptable joint velocities. Computer simulations and experimental results are provided in support of the theoretical developments

Solving robotic kinematic problems : singularities and inverse kinematics

Kinematics is a branch of classical mechanics that describes the motion of points, bodies, and systems of bodies without considering the forces that cause such motion. For serial robot manipulators, kinematics consists of describing the open chain geometry as well as the position, velocity and/or acceleration of each one of its components. Rigid serial robot manipulators are designed as a sequence of rigid bodies, called links, connected by motor-actuated pairs, called joints, that provide relative motion between consecutive links. Two kinematic problems of special relevance for serial robots are: - Singularities: are the configurations where the robot loses at least one degree of freedom (DOF). This is equivalent to: (a) The robot cannot translate or rotate its end-effector in at least one direction. (b) Unbounded joint velocities are required to generate finite linear and angular velocities. Either if it is real-time teleoperation or off-line path planning, singularities must be addressed to make the robot exhibit a good performance for a given task. The objective is not only to identify the singularities and their associated singular directions but to design strategies to avoid or handle them. - Inverse kinematic problem: Given a particular position and orientation of the end-effector, also known as the end-effector pose, the inverse kinematics consists of finding the configurations that provide such desired pose. The importance of the inverse kinematics relies on its role in the programming and control of serial robots. Besides, since for each given pose the inverse kinematics has up to sixteen different solutions, the objective is to find a closed-form method for solving this problem, since closed-form methods allow to obtain all the solutions in a compact form. The main goal of the Ph.D. dissertation is to contribute to the solution of both problems. In particular, with respect to the singularity problem, a novel scheme for the identification of the singularities and their associated singular directions is introduced. Moreover, geometric algebra is used to simplify such identification and to provide a distance function in the configuration space of the robot that allows the definition of algorithms for avoiding them. With respect to the inverse kinematics, redundant robots are reduced to non-redundant ones by selecting a set of joints, denoted redundant joints, and by parameterizing their joint variables. This selection is made through a workspace analysis which also provides an upper bound for the number of different closed-form solutions. Once these joints have been identified, several closed-form methods developed for non-redundant manipulators can be applied to obtain the analytical expressions of all the solutions. One of these methods is a novel strategy developed using again the conformal model of the spatial geometric algebra. To sum up, the Ph.D dissertation provides a rigorous analysis of the two above-mentioned kinematic problems as well as novel strategies for solving them. To illustrate the different results introduced in the Ph.D. memory, examples are given at the end of each of its chapters.La cinemática es una rama de la mecánica clásica que describe el movimiento de puntos, cuerpos y sistemas de cuerpos sin considerar las fuerzas que causan dicho movimiento. Para un robot manipulador serie, la cinemática consiste en la descripción de su geometría, su posición, velocidad y/o aceleración. Los robots manipuladores serie están diseñados como una secuencia de elementos estructurales rígidos, llamados eslabones, conectados entres si por articulaciones actuadas, que permiten el movimiento relativo entre pares de eslabones consecutivos. Dos problemas cinemáticos de especial relevancia para robots serie son: - Singularidades: son aquellas configuraciones donde el robot pierde al menos un grado de libertad (GDL). Esto equivale a: (a) El robot no puede trasladar ni rotar su elemento terminal en al menos una dirección. (b) Se requieren velocidades articulares no acotadas para generar velocidades lineales y angulares finitas. Ya sea en un sistema teleoperado en tiempo real o planificando una trayectoria, las singularidades deben manejarse para que el robot muestre un rendimiento óptimo mientras realiza una tarea. El objetivo no es solo identificar las singularidades y sus direcciones singulares asociadas, sino diseñar estrategias para evitarlas o manejarlas. - Problema de la cinemática inversa: dada una posición y orientación del elemento terminal (también conocida como la pose del elemento terminal), la cinemática inversa consiste en obtener las configuraciones asociadas a dicha pose. La importancia de la cinemática inversa se basa en el papel que juega en la programación y el control de robots serie. Además, dado que para cada pose la cinemática inversa tiene hasta dieciséis soluciones diferentes, el objetivo es encontrar un método cerrado para resolver este problema, ya que los métodos cerrados permiten obtener todas las soluciones en una forma compacta. El objetivo principal de la tesis doctoral es contribuir a la solución de ambos problemas. En particular, con respecto al problema de las singularidades, se presenta un nuevo método para su identificación basado en el álgebra geométrica. Además, el álgebra geométrica permite definir una distancia en el espacio de configuraciones del robot que permite la definición de distintos algoritmos para evitar las configuraciones singulares. Con respecto a la cinemática inversa, los robots redundantes se reducen a robots no-redundantes mediante la selección de un conjunto de articulaciones, las articulaciones redundantes, para después parametrizar sus variables articulares. Esta selección se realiza a través de un análisis de espacio de trabajo que también proporciona un límite superior para el número de diferentes soluciones en forma cerrada. Una vez las articulaciones redundantes han sido identificadas, varios métodos en forma cerrada desarrollados para robots no-redundantes pueden aplicarse a fin de obtener las expresiones analíticas de todas las soluciones. Uno de dichos métodos es una nueva estrategia desarrollada usando el modelo conforme del álgebra geométrica tridimensional. En resumen, la tesis doctoral proporciona un análisis riguroso de los dos problemas cinemáticos mencionados anteriormente, así como nuevas estrategias para resolverlos. Para ilustrar los diferentes resultados presentados en la tesis, la memoria contiene varios ejemplos al final de cada uno de sus capítulos

Solving robotic kinematic problems : singularities and inverse kinematics

Aplicat embargament des de la data de defensa fins al 30/6/2019Kinematics is a branch of classical mechanics that describes the motion of points, bodies, and systems of bodies without considering the forces that cause such motion. For serial robot manipulators, kinematics consists of describing the open chain geometry as well as the position, velocity and/or acceleration of each one of its components. Rigid serial robot manipulators are designed as a sequence of rigid bodies, called links, connected by motor-actuated pairs, called joints, that provide relative motion between consecutive links. Two kinematic problems of special relevance for serial robots are: - Singularities: are the configurations where the robot loses at least one degree of freedom (DOF). This is equivalent to: (a) The robot cannot translate or rotate its end-effector in at least one direction. (b) Unbounded joint velocities are required to generate finite linear and angular velocities. Either if it is real-time teleoperation or off-line path planning, singularities must be addressed to make the robot exhibit a good performance for a given task. The objective is not only to identify the singularities and their associated singular directions but to design strategies to avoid or handle them. - Inverse kinematic problem: Given a particular position and orientation of the end-effector, also known as the end-effector pose, the inverse kinematics consists of finding the configurations that provide such desired pose. The importance of the inverse kinematics relies on its role in the programming and control of serial robots. Besides, since for each given pose the inverse kinematics has up to sixteen different solutions, the objective is to find a closed-form method for solving this problem, since closed-form methods allow to obtain all the solutions in a compact form. The main goal of the Ph.D. dissertation is to contribute to the solution of both problems. In particular, with respect to the singularity problem, a novel scheme for the identification of the singularities and their associated singular directions is introduced. Moreover, geometric algebra is used to simplify such identification and to provide a distance function in the configuration space of the robot that allows the definition of algorithms for avoiding them. With respect to the inverse kinematics, redundant robots are reduced to non-redundant ones by selecting a set of joints, denoted redundant joints, and by parameterizing their joint variables. This selection is made through a workspace analysis which also provides an upper bound for the number of different closed-form solutions. Once these joints have been identified, several closed-form methods developed for non-redundant manipulators can be applied to obtain the analytical expressions of all the solutions. One of these methods is a novel strategy developed using again the conformal model of the spatial geometric algebra. To sum up, the Ph.D dissertation provides a rigorous analysis of the two above-mentioned kinematic problems as well as novel strategies for solving them. To illustrate the different results introduced in the Ph.D. memory, examples are given at the end of each of its chapters.La cinemática es una rama de la mecánica clásica que describe el movimiento de puntos, cuerpos y sistemas de cuerpos sin considerar las fuerzas que causan dicho movimiento. Para un robot manipulador serie, la cinemática consiste en la descripción de su geometría, su posición, velocidad y/o aceleración. Los robots manipuladores serie están diseñados como una secuencia de elementos estructurales rígidos, llamados eslabones, conectados entres si por articulaciones actuadas, que permiten el movimiento relativo entre pares de eslabones consecutivos. Dos problemas cinemáticos de especial relevancia para robots serie son: - Singularidades: son aquellas configuraciones donde el robot pierde al menos un grado de libertad (GDL). Esto equivale a: (a) El robot no puede trasladar ni rotar su elemento terminal en al menos una dirección. (b) Se requieren velocidades articulares no acotadas para generar velocidades lineales y angulares finitas. Ya sea en un sistema teleoperado en tiempo real o planificando una trayectoria, las singularidades deben manejarse para que el robot muestre un rendimiento óptimo mientras realiza una tarea. El objetivo no es solo identificar las singularidades y sus direcciones singulares asociadas, sino diseñar estrategias para evitarlas o manejarlas. - Problema de la cinemática inversa: dada una posición y orientación del elemento terminal (también conocida como la pose del elemento terminal), la cinemática inversa consiste en obtener las configuraciones asociadas a dicha pose. La importancia de la cinemática inversa se basa en el papel que juega en la programación y el control de robots serie. Además, dado que para cada pose la cinemática inversa tiene hasta dieciséis soluciones diferentes, el objetivo es encontrar un método cerrado para resolver este problema, ya que los métodos cerrados permiten obtener todas las soluciones en una forma compacta. El objetivo principal de la tesis doctoral es contribuir a la solución de ambos problemas. En particular, con respecto al problema de las singularidades, se presenta un nuevo método para su identificación basado en el álgebra geométrica. Además, el álgebra geométrica permite definir una distancia en el espacio de configuraciones del robot que permite la definición de distintos algoritmos para evitar las configuraciones singulares. Con respecto a la cinemática inversa, los robots redundantes se reducen a robots no-redundantes mediante la selección de un conjunto de articulaciones, las articulaciones redundantes, para después parametrizar sus variables articulares. Esta selección se realiza a través de un análisis de espacio de trabajo que también proporciona un límite superior para el número de diferentes soluciones en forma cerrada. Una vez las articulaciones redundantes han sido identificadas, varios métodos en forma cerrada desarrollados para robots no-redundantes pueden aplicarse a fin de obtener las expresiones analíticas de todas las soluciones. Uno de dichos métodos es una nueva estrategia desarrollada usando el modelo conforme del álgebra geométrica tridimensional. En resumen, la tesis doctoral proporciona un análisis riguroso de los dos problemas cinemáticos mencionados anteriormente, así como nuevas estrategias para resolverlos. Para ilustrar los diferentes resultados presentados en la tesis, la memoria contiene varios ejemplos al final de cada uno de sus capítulos.Postprint (published version

The double universal joint wrist on a manipulator: Solution of inverse position kinematics and singularity analysis

This paper presents three methods to solve the inverse position kinematics position problem of the double universal joint attached to a manipulator: (1) an analytical solution for two specific cases; (2) an approximate closed form solution based on ignoring the wrist offset; and (3) an iterative method which repeats closed form position and orientation calculations until the solution is achieved. Several manipulators are used to demonstrate the solution methods: cartesian, cylindrical, spherical, and an anthropomorphic articulated arm, based on the Flight Telerobotic Servicer (FTS) arm. A singularity analysis is presented for the double universal joint wrist attached to the above manipulator arms. While the double universal joint wrist standing alone is singularity-free in orientation, the singularity analysis indicates the presence of coupled position/orientation singularities of the spherical and articulated manipulators with the wrist. The cartesian and cylindrical manipulators with the double universal joint wrist were found to be singularity-free. The methods of this paper can be implemented in a real-time controller for manipulators with the double universal joint wrist. Such mechanically dextrous systems could be used in telerobotic and industrial applications, but further work is required to avoid the singularities

Singularities of serial robots: identification and distance computation using geometric algebra

The singularities of serial robotic manipulators are those configurations in which the robot loses the ability to move in at least one direction. Hence, their identification is fundamental to enhance the performance of current control and motion planning strategies. While classical approaches entail the computation of the determinant of either a 6×n or n×n matrix for an n-degrees-of-freedom serial robot, this work addresses a novel singularity identification method based on modelling the twists defined by the joint axes of the robot as vectors of the six-dimensional and three-dimensional geometric algebras. In particular, it consists of identifying which configurations cause the exterior product of these twists to vanish. In addition, since rotors represent rotations in geometric algebra, once these singularities have been identified, a distance function is defined in the configuration space C , such that its restriction to the set of singular configurations S allows us to compute the distance of any configuration to a given singularity. This distance function is used to enhance how the singularities are handled in three different scenarios, namely, motion planning, motion control and bilateral teleoperation.Peer ReviewedPostprint (published version

Workspace and singularity determination of a 7-DoF wrist-partitioned serial manipulator towards graffiti painting

Els robots estan sent utilitzats, cada cop més, en la realització de tasques en la indústria. Molts d'ells també són dissenyats pensats per a realitzar les tasques de la llar. En general, els robots són dissenyats per a facilitar el dia a dia del éssers humans. Però quan es tracta d'obres artístiques, és menys comú trobar-se robots realitzant-les. Nosaltres pretenem sortir de la norma mitjançant l'ús d'un robot per a pintar un grafiti. La motivació per a aconseguir-ho convergeix en la formulació de dues preguntes: "Quin és el volum de treball d'un robot, quan l'orientació del seu efector final està fixada?" i "Donat un pla arbitrari, quina és la major àrea de treball lliure de singularitats en aquest?" Aquesta tesi proposa un mètode per a l'obtenció de les singularitats de posició en un pla qualsevol d'un manipulador serial amb un canell esfèric. El mètode s'ha obtingut mitjançant la combinació d'un mètode de determinació de singularitats de posició, el qual està basat en una tècnica per al decoplat de manipuladors que presenten un canell esfèric, i un algorisme branch-and-prune per a la resolució de sistemes d'equacions. S'ha obtingut el volum de treball d'un manipulador serial de 7 graus de llibertat a través d'un enfocament de cinemàtica directa. Es presenta una metodologia per a obtenir el volum de treball del manipulador serial quan el seu efector final té l'orientació constant i s'aplica per a obtenir aproximacions per al cas de certes orientacions. Es mostra com les singularitats poden ser analitades a través de separar-les en singularitats de posició i d'orientació. el mètode proposat formula i resol les equacions que determinen les singularitats de posició. Pel que fa a les singularitats d'orientació, es mostra que poden ser evitades sense perdre una quantitat significant de volum de treball, des del punt de vista de la posició.Los robots estén siendo utilizados, cada vez más, en la realización de tareas en la industria. Muchos de ellos también son diseñados pensados para realizar las tareas del hogar. En general, los robots son diseñados para facilitar el día a día de los seres humanos. Pero cuando se trata de obras artíticas, es menos común encontrarse a robots realizándolas. Nosotros pretendemos salirnos de lo común mediante el uso de un robot para pintar un grafiti. La motivación por lograrlo converge en la formulación de dos preguntas: "¿Cuál es el volumen de trabajo de un robot, cuando la orientación de su efector final está fijada?" y "Dado un plano arbitrario, ¿cuál es la mayor área de trabajo libre de singularidades en éste?" Esta tesis propone un método para la obtención de las singularidades de posición en un plano cualquiera de un manipulador serial con una muñeca esférica. El método ha sido obtenido mediante la combinación de un método de determinación de singularidades de posición, el cual está basado en una técnica para el decoplado de manipuladores que presentan una muñeca esférica, y un algoritmo branch-and-prune para la resolución de sistemas de ecuaciones. Se ha obtenido el volumen de trabajo de un manipulador serial de 7 grados de libertad a través de un enfoque de cinemática directa. Se presenta la metodología para obtener el volumen de trabajo del manipulador serial cuando su efector final tiene una orientación constante y se aplica para obtener aproximaciones para el caso de ciertas orientaciones. Se muestra cómo las singularidades pueden ser analizadas a través de separarlas en singularidades de posición y de orientación. El método propuesto formula y resuelve las ecuaciones que determinan las singularidades de posición. En cuanto a las singularidades de orientación, se muestra que pueden ser evitadas sin perder una cantidad significante de volumen de trabajo, desde el punto de vista de la posición.Robots are overtaking every day more tasks in the industry. A lot of them are even designed for performing household chores. In general, robots are designed to facilitate the day-to-day of human beings. But when it comes to artistic tasks, it is less usual to see robots performing them. We pretend to stay out of the crowd by using a robot to paint a graffiti. The motivation to achieve this task converges into the statement of two questions: "What is the workspace of a robot, when the orientation of its end-effector is fixed?" and "For a given plane, what is the largest singularity free surface on it?". This thesis proposes a method for the computation of the position singularities of a wrist-partitioned serial manipulator for a given plane. The method is obtained from the combination of a position singularity determination method, which is based on the decoupling technique of a wrist-partitioned manipulator, and a branch-and-prune algorithm for the resolution of systems of equations. The workspace of a 7-DoF serial manipulator is obtained by a forward kinematics approach. A methodology to obtain the constant orientation workspace of a serial manipulator is presented and applied to get approximations for some specific orientations. It is shown how singularities can be analyzed by decoupling them into position singularities and orientation singularities. The proposed method formulates and solves the equation that determines the position singularities. In the case of the orientation singularities, it is shown that they can be avoided without losing a significant amount of the workspace's volume, from the point of view of the position.Outgoin

JACO assistive robotic device : empowering people with disabilities through innovative algorithms

JACO is a commercially available robotic assistive device designed to help people with upper body disabilities gaining more autonomy in their daily life. The device consists of an arm and hand (gripper) mounted on a power wheelchair. This assistance is possible through basic functions such as tri-dimensional displacement of the gripper in space, finger opening and closing and orientation of the wrist. Although these basic functionalities allow the user to perform many tasks, advanced functionalities were required to further empower the users. This paper presents advanced functionalities that were implemented in JACO in order to increase the users’ safety and to enhance their autonomy by increasing the number of achievable tasks and diminishing the time and effort needed to achieve them

Inverse kinematics of a humanoid robot with non-spherical hip: a hybrid algorithm approach

This paper describes an approach to solve the inverse kinematics problem of humanoid robots whose construction shows a small but non negligible offset at the hip which prevents any purely analytical solution to be developed. Knowing that a purely numerical solution is not feasible due to variable efficiency problems, the proposed one first neglects the offset presence in order to obtain an approximate “solution” by means of an analytical algorithm based on screw theory, and then uses it as the initial condition of a numerical refining procedure based on the Levenberg‐Marquardt algorithm. In this way, few iterations are needed for any specified attitude, making it possible to implement the algorithm for real‐time applications. As a way to show the algorithm’s implementation, one case of study is considered throughout the paper, represented by the SILO2 humanoid robot