Collision-free inverse kinematics of the redundant seven-link manipulator used in a cucumber picking robot

The paper presents results of research on an inverse kinematics algorithm that has been used in a functional model of a cucumber-harvesting robot consisting of a redundant P6R manipulator. Within a first generic approach, the inverse kinematics problem was reformulated as a non-linear programming problem and solved with a Genetic Algorithm (GA). Although solutions were easily obtained, the considerable calculation time needed to solve the problem prevented on-line implementation. To circumvent this problem, a second, less generic, approach was developed which consisted of a mixed numerical-analytic solution of the inverse kinematics problem exploiting the particular structure of the P6R manipulator. Using the latter approach, calculation time was considerably reduced. During the early stages of the cucumber-harvesting project, this inverse kinematics algorithm was used off-line to evaluate the ability of the robot to harvest cucumbers using 3D-information obtained from a cucumber crop in a real greenhouse. Thereafter, the algorithm was employed successfully in a functional model of the cucumber harvester to determine if cucumbers were hanging within the reachable workspace of the robot and to determine a collision-free harvest posture to be used for motion control of the manipulator during harvesting. The inverse kinematics algorithm is presented and demonstrated with some illustrative examples of cucumber harvesting, both off-line during the design phase as well as on-line during a field test

A novel closed-form solution for the inverse kinematics of redundant manipulators through workspace analysis

© 2017 Elsevier Ltd This work addresses the inverse kinematic problem for redundant serial manipulators. Its importance relies on its effect in the programming and control of redundant robots. Besides, no general closed-form techniques have been developed so far. In this paper, redundant manipulators are reduced to non-redundant ones by selecting a set of joints, denoted redundant joints, and parametrizing its joint variables. This selection is made through a workspace analysis which also provides an upper bound for the number of different closed-form solutions for a given pose. Once these joints have been identified several closed-form methods developed for non-redundant manipulators can be applied for obtaining the analytical solutions. Finally, particular instances for the parametrized joints variables are determined depending on the task to be executed. Different criteria and optimization functions can be defined for that purpose.Peer ReviewedPostprint (author's final draft

On-the-Fly Workspace Visualization for Redundant Manipulators

This thesis explores the possibilities of on-line workspace rendering for redundant robotic manipulators via parallelized computation on the graphics card. Several visualization schemes for different workspace types are devised, implemented and evaluated. Possible applications are visual support for the operation of manipulators, fast workspace analyses in time-critical scenarios and interactive workspace exploration for design and comparison of robots and tools

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

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

Configuration control of seven-degree-of-freedom arms

A seven degree of freedom robot arm with a six degree of freedom end effector is controlled by a processor employing a 6 by 7 Jacobian matrix for defining location and orientation of the end effector in terms of the rotation angles of the joints, a 1 (or more) by 7 Jacobian matrix for defining 1 (or more) user specified kinematic functions constraining location or movement of selected portions of the arm in terms of the joint angles, the processor combining the two Jacobian matrices to produce an augmented 7 (or more) by 7 Jacobian matrix, the processor effecting control by computing in accordance with forward kinematics from the augmented 7 by 7 Jacobian matrix and from the seven joint angles of the arm a set of seven desired joint angles for transmittal to the joint servo loops of the arm. One of the kinematic functions constraints the orientation of the elbow plane of the arm. Another one of the kinematic functions minimizes a sum of gravitational torques on the joints. Still another kinematic function constrains the location of the arm to perform collision avoidance. Generically, one kinematic function minimizes a sum of selected mechanical parameters of at least some of the joints associated with weighting coefficients which may be changed during arm movement. The mechanical parameters may be velocity errors or gravity torques associated with individual joints

Real-time failure-tolerant control of kinematically redundant manipulators

Includes bibliographical references (pages 1115-1116).This work considers real-time fault-tolerant control of kinematically redundant manipulators to single locked-joint failures. The fault-tolerance measure used is a worst-case quantity, given by the minimum, over all single joint failures, of the minimum singular value of the post-failure Jacobians. Given any end-effector trajectory, the goal is to continuously follow this trajectory with the manipulator in configurations that maximize the fault-tolerance measure. The computation required to track these optimal configurations with brute-force methods is prohibitive for real-time implementation. We address this issue by presenting algorithms that quickly compute estimates of the worst-case fault-tolerance measure and its gradient. Comparisons show that the performance of the best method is indistinguishable from that of brute-force implementations. An example demonstrating the real-time performance of the algorithm on a commercially available seven degree-of-freedom manipulator is presented

Automatic calibration of space based manipulators and mechanisms

Four tasks in manipulator kinematic calibration are summarized. Calibration of a seven degree of freedom manipulator was simulated. A calibration model is presented that can be applied on a closed-loop robot. It is an expansion of open-loop kinematic calibration algorithms subject to constraints. A closed-loop robot with a five-bar linkage transmission was tested. Results show that the algorithm converges within a few iterations. The concept of model differences is formalized. Differences are categorized as structural and numerical, with emphasis on the structural. The work demonstrates that geometric manipulators can be visualized as points in a vector space with the dimension of the space depending solely on the number and type of manipulator joint. Visualizing parameters in a kinematic model as the coordinates locating the manipulator in vector space enables a standard evaluation of the models. Key results include a derivation of the maximum number of parameters necessary for models, a formal discussion on the inclusion of extra parameters, and a method to predetermine a minimum model structure for a kinematic manipulator. A technique is presented that enables single point sensors to gather sufficient information to complete a calibration