A numerically stable algorithm for analytic inverse kinematics of 7-DoF S-R-S manipulators with joint limit avoidance

This paper presents a numerically stable algorithm for analytic inverse kinematics of 7-DoF S-R-S manipulators with joint limit avoidance. The arm angle is used to represent the self-motion manifold within a global arm configuration. The joint limits are analytically mapped to the arm angle space for joint limit avoidance. To profile the relation between the joint angle and arm angle, it is critical to characterize the singular arm angle for each joint. In the-state-of-the art methods, the existence of the singular arm angle is triggered by comparing a discriminant with zero given a threshold. We will show this leads to numerical issues since the threshold is inconsistent among different target poses, leading to incorrect range of the arm angle. These issues are overcome by associating indeterminate joint angles of tangent joints with angles of 0 or pi of cosine joints, rather than using an independent threshold for each joint. The closed-form algorithm in C++ code to perform numerically stable inverse kinematics of 7-DoF S-R-S manipulators with global arm configuration control and joint limit avoidance is also given.

Kinematic Control of Manipulator with Remote Center of Motion Constraints Synthesised by a Simplified Recurrent Neural Network

Redundancy manipulators need favorable redundancy resolution to obtain suitable control actions to guarantee accurate kinematic control. Among numerous kinematic control applications, some specific tasks such as minimally invasive manipulation/surgery require the distal link of a manipulator to translate along such fixed point. Such a point is known as remote center of motion (RCM) to constrain motion planning and kinematic control of manipulators. Recurrent neural network (RNN) which possesses parallel processing ability, is a powerful alternative and has achieved success in conventional redundancy resolution and kinematic control with physical constraints of joint limits. However, up to now, there still is few related works on the RNNs for redundancy resolution and kinematic control of manipulators with RCM constraints considered yet. In this paper, for the first time, an RNN-based approach with a simplified neural network architecture is proposed to solve the redundancy resolution issue with RCM constraints, with a new and general dynamic optimization formulation containing the RCM constraints investigated. Theoretical results analyze and convergence properties of the proposed simplified RNN for redundancy resolution of manipulators with RCM constraints. Simulation results further demonstrate the efficiency of the proposed method in end-effector path tracking control under RCM constraints based on a redundant manipulator.

Motion Planning of Nonholonomic Mobile Manipulators with Manipulability Maximization Considering Joints Physical Constraints and Self-Collision Avoidance

The motion of nonholonomic mobile manipulators (NMMs) is inherently constrained by joint limits, joint velocity limits, self-collisions and singularities. Most motion planning algorithms consider some of the aforementioned constraints, however, a unified framework to deal with all of them is lacking. This paper proposes a motion planning solution for the kinematic trajectory tracking of redundant NMMs that include all the constraints needed for practical implementation, which improves the manipulability of both the entire system and the manipulator to prevent singularities. Experiments using a 10-DOF NMM demonstrate the good performance of the proposed method for executing 6-DOF trajectories while satisfying all the constraints and simultaneously maximizing manipulability.

A modified firefly algorithm for the inverse kinematics solutions of robotic manipulators

The inverse kinematics of robotic manipulators consists of finding a joint configuration to reach a desired end-effector pose. Since inverse kinematics is a complex non-linear problem with redundant solutions, sophisticated optimization techniques are often required to solve this problem; a possible solution can be found in metaheuristic algorithms. In this work, a modified version of the firefly algorithm for multimodal optimization is proposed to solve the inverse kinematics. This modified version can provide multiple joint configurations leading to the same end-effector pose, improving the classic firefly algorithm performance. Moreover, the proposed approach avoids singularities because it does not require any Jacobian matrix inversion, which is the main problem of conventional approaches. The proposed approach can be implemented in robotic manipulators composed of revolute or prismatic joints of n degrees of freedom considering joint limits constrains. Simulations with different robotic manipulators show the accuracy and robustness of the proposed approach. Additionally, non-parametric statistical tests are included to show that the proposed method has a statistically significant improvement over other multimodal optimization algorithms. Finally, real-time experiments on five degrees of freedom robotic manipulator illustrate the applicability of this approach.

Optimization Based Dynamic Human Motion Prediction with Modular Exoskeleton Robots as Interactive Forces: The Case of Weight Lifting Motion

The optimization-based dynamics model is formulated for the weight lifting motion with human and exoskeleton model as interactive force term in this chapter. In the optimization algorithm, the human motion is defined as variables so that the motion which we want to generate (box lifting motion in this case) can be predicted. The objective function or cost function is defined as performance measure which can be switched by developer. In this paper we use the summation of each joint torque square which is considered as the dynamic effort for the motion. Constraints are defined as joint limits, torque limits, hand position, dynamic balance, exoskeleton assistive points, etc. Interaction force form exoskeleton robot can be derived as generalized coordinates and generalized force which are related to inertial reference frame and human body frame. The results can show how effective the exoskeleton robots are according to their assistive force.

Optimizing Mobility of Robotic Arms in Collision-free Motion Planning

A major task in motion planning is to find paths that have a high ability to react to external influences while ensuring a collision-free operation at any time. This flexibility is even more important in human-robot collaboration since unforeseen events can occur anytime. Such ability can be described as mobility, which is composed of two characteristics. First, the ability to manipulate, and second, the distance to joint limits. This mobility needs to be optimized while generating collision-free motions so that there is always the flexibility of the robot to evade dynamic obstacles in the future execution of generated paths. For this purpose, we present a Rapidly-exploring Random Tree (RRT), which applies additional costs and sampling methods to increase mobility. Additionally, we present two methods for the optimization of a generated path. Our first approach utilizes the built-in capabilities of the RRT*. The second method optimize the path with the stochastic trajectory optimization for motion planning (STOMP) approach with Gaussian Mixture Models. Moreover, we evaluate the algorithms in complex simulation and real environments and demonstrate an enhancement of mobility.

Inverse kinematics for cooperative mobile manipulators based on self-adaptive differential evolution

This article presents an approach to solve the inverse kinematics of cooperative mobile manipulators for coordinate manipulation tasks. A self-adaptive differential evolution algorithm is used to solve the inverse kinematics as a global constrained optimization problem. A kinematics model of the cooperative mobile manipulators system is proposed, considering a system with two omnidirectional platform manipulators with n DOF. An objective function is formulated based on the forward kinematics equations. Consequently, the proposed approach does not suffer from singularities because it does not require the inversion of any Jacobian matrix. The design of the objective function also contains penalty functions to handle the joint limits constraints. Simulation experiments are performed to test the proposed approach for solving coordinate path tracking tasks. The solutions of the inverse kinematics show precise and accurate results. The experimental setup considers two mobile manipulators based on the KUKA Youbot system to demonstrate the applicability of the proposed approach.

Planning of efficient trajectories in robotized assembly of aerostructures exploiting kinematic redundancy

Aerospace production volumes have increased over time and robotic solutions have been progressively introduced in the aeronautic assembly lines to achieve high-quality standards, high production rates, flexibility and cost reduction. Robotic workcells are sometimes characterized by robots mounted on slides to increase the robot workspace. The slide introduces an additional degree of freedom, making the system kinematically redundant, but this feature is rarely used to enhance performances. The paper proposes a new concept in trajectory planning, that exploits the redundancy to satisfy additional requirements. A dynamic programming technique is adopted, which computes optimized trajectories, minimizing or maximizing the performance indices of interest. The use case is defined on the LABOR (Lean robotized AssemBly and cOntrol of composite aeRostructures) project which adopts two cooperating six-axis robots mounted on linear axes to perform assembly operations on fuselage panels. Considering the needs of this workcell, unnecessary robot movements are minimized to increase safety, the mechanical stiffness is maximized to increase stability during the drilling operations, collisions are avoided, while joint limits and the available planning time are respected. Experiments are performed in a simulation environment, where the optimal trajectories are executed, highlighting the resulting performances and improvements with respect to non-optimized solutions.