Motion Planning of Redundant Manipulator With Variable Joint Velocity Limit Based on Beetle Antennae Search Algorithm

Redundant manipulators play important roles in many industrial and service applications by assisting people fulfill heavy and repetitive jobs. However, redundant manipulators are coupled highly-nonlinear systems which exert difficulty of redundancy resolution computation. Conventional methods such as pseudo-inverse-based approaches obtain the resolved joint angles from joint velocity level, which may bring about more computational cost and may neglect joint velocity limits. In this work, a motion planning method based on beetle antennae search algorithm (BAS) is proposed for motion planning of redundant manipulators with the variable joint velocity limit. Such proposed work does not need to resolve the velocity kinematics equation as the conventional methods do, and the proposed method can directly deal with the forward kinematics equation to resolve the desired joint angles. The simulation and experiment on the five-link planar manipulator and the Kuka industrial manipulator system demonstrate the efficiency of the proposed method for motion planning of redundant manipulator, and reveal the reliable performance of the BAS algorithm as compared with genetic algorithm (GA), particle swarm optimization (PSO), firefly algorithm(FA) and quantum behaved particle swarm algorithm(QPSO) methods

Learning Probabilistic Generative Models For Fast Sampling-Based Planning

Due to their simplicity and efficiency in high dimensional space, sampling-based motion planners have been gaining interest for robotic manipulation in recent years. We present several new learning approaches using probabilistic generative models for fast sampling-based planning. First, we propose fast collision detection in high dimensional configuration spaces based on Gaussian Mixture Models (GMMs) for Rapidly-exploring Random Trees (RRT). In addition, we introduce a new probabilistically safe local steering primitive based on the probabilistic model. Our local steering procedure is based on a new notion of a convex probabilistically safety corridor that is constructed around a configuration using tangent hyperplanes of confidence ellipsoids of GMMs learned from prior collision history. For efficient sampling, we suggest a sampling method with a learned Q-function with linear function approximation based on feature representations such as Radial Basis Functions. This sampling method chooses the optimal node from which to extend the search tree via the softmax function of learned state values. We also discuss a novel constrained sampling-based motion planning method for grasp and transport tasks with redundant robotic manipulators, which allows the best grasp configuration and approach direction to be automatically determined. Since these approaches with the learned probabilistic models require large size data and time for training, it is essential that they are able to be adapted to environmental change in an online manner. The suggested online learning approach with the Dirichlet Process Mixture Model (DPMM) can adapt the complexity to the data and learn new Gaussian clusters with streaming data in newly explored areas without batch learning. We have applied these approaches in a number of robot arm planning scenarios and have shown their utility and effectiveness in simulation and on a physical 7-DoF robot manipulator

Automatic motion of manipulator using sampling based motion planning algorithms - application in service robotics

The thesis presents new approaches for autonomous motion execution of a robotic arm. The calculation of the motion is called motion planning and requires the computation of robot arm's path. The text covers the calculation of the path and several algorithms have been therefore implemented and tested in several real scenarios. The work focuses on sampling based planners, which means that the path is created by connecting explicitly random generated points in the free space. The algorithms can be divided into three categories: those that are working in configuration space(C-Space)(C- Space is the set of all possible joint angles of a robotic arm) , the mixed approaches using both Cartesian and C-Space and those that are using only the Cartesian space. Although Cartesian space seems more appropriate, due to dimensionality, this work illustrates that the C-Space planners can achieve comparable or better results. Initially an enhanced approach for efficient collision detection in C-Space, used by the planners, is presented. Afterwards the N dimensional cuboid region, notated as Rq, is defined. The Rq configures the C-Space so that the sampling is done close to a selected, called center, cell. The approach is enhanced by the decomposition of the Cartesian space into cells. A cell is selected appropriately if: (a) is closer to the target position and (b) lies inside the constraints. Inverse kinematics(IK) are applied to calculate a centre configuration used later by the Rq. The CellBiRRT is proposed and combines all the features. Continuously mixed approaches that do not require goal configuration or an analytic solution of IK are presented. Rq regions as well as Cells are also integrated in these approaches. A Cartesian sampling based planner using quaternions for linear interpolation is also proposed and tested. The common feature of the so far algorithms is the feasibility which is normally against the optimality. Therefore an additional part of this work deals with the optimality of the path. An enhanced approach of CellBiRRT, called CellBiRRT*, is developed and promises to compute shorter paths in a reasonable time. An on-line method using both CellBiRRT and CellBiRRT* is proposed where the path of the robot arm is improved and recalculated even if sudden changes in the environment are detected. Benchmarking with the state of the art algorithms show the good performance of the proposed approaches. The good performance makes the algorithms suitable for real time applications. In this work several applications are described: Manipulative skills, an approach for an semi-autonomous control of the robot arm and a motion planning library. The motion planning library provides the necessary interface for easy use and further development of the motion planning algorithms. It can be used as the part connecting the manipulative skill designing and the motion of a robotic arm

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

Pattern recognition based movement control and gripping forces control system on arm robot model using LabVIEW

Most arm robot has an inefficient operating time because it requires operator to input destination coordinates. Besides, main problem of arm robot is object’s vulnerability when it is manipulated by the robot. This research goals is to develop an arm robot control system which has ability to automatically detect object using image processing in order to reduce operating time. It is also able to control gripping force for eliminating damage to objects caused by robot gripper. This research is implemented in LabVIEW 2011 software to control arm robot model which can represent industrial scale robot. The software is designed with informative visualization to help user learn and understand robotic control concept deeply. The system can automatically detect object position based on pattern recognition method which has four steps: pre-processing process to initialize picture taken by camera, segmentation process for separating object from the background, classification process to determine characteristics of object, and position estimation process to estimate object position in the picture. The object’s position data are then calculated by using kinematic equation to control the robot’s motion. The results show that the system is able to detect object and move the robot automatically with accuracy rate in x-axis is 95.578 % and in y-axis is 92.878 %. The system also implements modified PI control method with FSR as input to control gripping force with maximum overshoot value `10 %. Arm robot model control system developed is successfully meet the expectation. The system control can be implemented to industrial scale arm robot with several modification because of kinematic similarity between model and industrial scale robot

Payload analysis and control of manipulators for human interactive environments

Esta tesis doctoral presenta los resultados de simulaciones numéricas y algunos análisis experimentales de tres aspectos principales: el modelamiento dinámico de manipuladores de múltiples grados de libertad (GdL) (n 2 GdL), el cálculo de la capacidad dinámica de carga asociada al manejo de dicha carga, y el análisis y diseño de controladores no lineales incluyendo el Control Adaptativo por Desfalsificación (CAD). Se desarrollaron análisis de dos (2) casos de estudio: el SCORBOT ER V PLUS fabricado por Intelitech Corp. de 5 grados de libertad y el manipulador redundante de 7 grados de libertad conocido como el Whole Arm Manipulator (WAM) fabricado por Barrett Technology Inc. y que cuenta con características de seguridad intrínseca, manipulación inversa y docilidad, y es aplicable en la interacción humano-robot (IHR). Inicialmente, se calculó y validó el modelado dinámico de los casos de estudio. Los modelos dinámicos inverso y directo del SCORBOT ER V PLUS fueron validados numéricamente. Luego, una validación experimental para el WAM presenta una comparación entre los datos numéricos y experimentales, identificando la necesidad de un mejor modelo de la fricción seca. Después, se propuso y evaluó una metodología para el cálculo de la capacidad dinámica de carga en el espacio de trabajo completo de manipuladores para diferentes tipos de controladores. Luego, para el análisis del Control Adaptativo por Desfalsificación con factor de olvido para manipuladores de múltiples grados de libertad, se realizó una comparación con un controlador adaptativo tradicional basado en el modelo y se aplicó al modelo del manipulador SCORBOR ER V PLUS. Finalmente, la técnica de Control por Desfalsificación fue exitosamente aplicada al modelo del WAM. En conclusión, este trabajo puede contribuir al uso de técnicas de control no lineal avanzado y manejo de carga para manipuladores redundantes con manipulación inversa, aplicables en ambientes de interacción con humanosAbstract : This doctoral thesis presents the results of numerical simulations and some experimental analysis of three main topics: the dynamical modeling of multiple degree of freedom (MDoF) manipulators (n 2 DoF), dynamic load carrying capacity computation (DLCC) for the payload handling issue and nonlinear control analysis and design including Unfalsified Adaptive Control (UAC). We performed analysis of two (2) cases of study: the 5 DoF SCORBOT ER V PLUS manufactured by Intelitech Corp. and the 7 DoF redundant Whole Arm Manipulator (WAM) manufactured by Barrett Technology Inc. with intrinsic safety, backdrivable and compliant characteristics and suitable for human-robot interaction (HRI). Initially, we computed and validated the dynamical model of the cases of study. The inverse and direct dynamical models of the SCORBOT ER V PLUS were numerically validated. Then, an experimental validation of inverse dynamical model of the WAM presents a comparison between numerical and experimental data, identifying the need for better friction models. After that, we proposed and evaluated a methodology for DLCC computation in the entire workspace of manipulators for different types of controllers. Then, for the analysis of the data-driven UAC with fading memory for multiple DoF manipulators, we performed a comparison with a traditional modelbased Adaptive Controller and applied to the SCORBOT ER V PLUS manipulator. Finally, the Unfalsified Control technique was successfully applied to the WAM model for a similar simulation setup. In conclusion, this work may contribute to the use of advanced nonlinear control and payload handling techniques for redundant backdrivable multiple DoF manipulators, suitable for human interactive environmentsDoctorad

Robô de entretenimento para apanhar bolas em voo

Mestrado em Engenharia de Automação IndustrialA Interação Humano-Robô (IHR) surge hoje como uma parte importante e desafiadora da robótica, requerendo tecnologia sofisticada e lidando com importantes aspectos de segurança. Em consonância com isso, a IHR pode ser usado para testar e avaliar tecnologias robóticas avançadas. A tarefa de apanhar uma bola em voo por um sistema robótico pode ser utilizada para avaliação sistemática de sistemas de visão e braços robóticos, quer individualmente quer de forma integrada. A realização deste jogo entre um humano e um robô é um exemplo de uma forma de interação segura que não envolva contato físico. O objetivo principal desta tese está centrado no estudo de um cenário para a realização da tarefa de apanhar um bola em voo usando tecnologia comercial. Na prossecução deste objectivo, são abordados três problemas principais: (1) o desenvolvimento de um sistema de visão para a detecção e seguimento da bola usando um sensor Kinect, (2) a aplicação de algoritmos capazes de fornecerem uma estimativa precisa da trajetória da bola em voo, e (3) o controlo do braço robótico que permita a intercepção da bola. O desenvolvimento da arquitectura software é suportado pelo Robot Operating System (ROS) baseado numa plataforma open-source de arquitetura distribuída. Foram realizados vários testes experimentais para validar as soluções propostas e avaliar o desempenho do sistema em diferentes situações. O teste de viabilidade do trabalho proposto foi realizado com base na simulação do sistema completo tilizando dados pré-gravados do sensor Kinect.Human-Robot Interaction (HRI) is now an important and challenging part of robotics as it requires high accuracy and sophisticated technology, along with safety as the first and fore-most aspect. In line with this, HRI can be used for testing and evaluating advanced robotic technologies. Ball catching by a robotic system is one such task that can be used for systematic evaluation of vision and robotic systems, either individually or in an integrated manner. Playing ball catching between a human and a robot is an example of such a form of safe interaction not involving physical contact. The main goal of this thesis is focused towards the study of a possible scenario for ball catching task by a robotic manipulator using off-the-shelf technologies. In the pursuit of that objective, three main problems are addressed: (1) to develop a vision system for ball detection and tracking using a Kinect sensor, (2) to provide trajectory estimation of the flying ball, and (3) to control the robotic arm for interception of the flying ball. The complete software development is supported by Robot Operating System (ROS) with open-source platform and distributed architecture. Several experimental tests are conducted to validate the proposed solutions and to evaluate the system’s performance in different situations. Simulation of integrated system for ball catching task is also implemented using pre-recorded data-sets from Kinect sensor for feasibility test of proposed work

Novel Reconfigurable Delta Robot Dual-Functioning as Adaptive Landing Gear and Manipulator

In this work a novel dual-functioning rotorcraft undercarriage is developed. The design is a reconfigurable delta robot which allows for transformation between Adaptive Landing Gear for vertical take-off and landing and 3DOF Aerial Manipulation mode. To reconfigure between operation modes without reaching singularities, a guideline to find a singularity-free geometry is presented. An adaptive landing control was developed and validated on a test-stand. For the 3DOF manipulation of the delta-structure, a third-order smooth trajectory was presented and integrated. The prototype, also depicted in the accompanying video, is then presented in free flight experiments demonstrating the advantages of the dual-functioning system

Robot Manipulators

Robot manipulators are developing more in the direction of industrial robots than of human workers. Recently, the applications of robot manipulators are spreading their focus, for example Da Vinci as a medical robot, ASIMO as a humanoid robot and so on. There are many research topics within the field of robot manipulators, e.g. motion planning, cooperation with a human, and fusion with external sensors like vision, haptic and force, etc. Moreover, these include both technical problems in the industry and theoretical problems in the academic fields. This book is a collection of papers presenting the latest research issues from around the world