Singularity avoidance for manipulators with spherical wrists using the approximate damped reciprocal algorithm

Abstract

Due to the loss of freedom, the stability and tracking ability of the manipulator around the singularity become worse. This article aims at improving the accuracy of the manipulator and ensuring the stability of the system with the damped reciprocal method. Firstly, the singularities are separated into forearm and wrist singularities to obtain the singular factors of the manipulator respectively. Secondly, a new mathematical function of the approximate damped reciprocal of the singular factor is proposed. Thirdly, the singularities are avoided by modifying the Jacobian matrixes of the manipulator with the approximate damped reciprocal algorithm. Finally, the effectiveness and the stability of the system are proved by the simulations on a manipulator with the spherical wrist. The simulation results prove that this method can largely improve the accuracy of the end-effector and can ensure the stability of the system around the singular region.

Keywords

Singularity avoidance Jacobian matrix singular factor damped reciprocal spherical wrist

Introduction

The kinematic singularity is an inherent characteristic of a manipulator, in which bounded Cartesian speeds lead to infinite joint speeds, and bounded Cartesian accelerations lead to infinite end-effector forces. When a manipulator passes across a singular region in the work space, the manipulator may inevitably lead to a reduction in the stability and accuracy. Therefore, improving the tracking accuracy and the stability of the manipulator are important to the control of the manipulator during the singularity avoidance.

Many methods have been proposed to avoid the singularity: (a) methods based on the geometry,^1,2 which can intuitively reflect the configuration of singularities, but cannot obtain the mathematical expression of singularities; (b) methods based on task space control,^3

–7,8 in which singularities are avoided by motion planning, but it is difficult to find the proper parameters; (c) methods based on optimization,^9
–11 which take the singularity avoidance problem as an optimization problem, but are relatively time-consuming; (d) methods based on the Jacobian matrix,^12
–14 such as pseudoinverse method,¹⁵ Jacobian transpose,^16,17 and damped least-squares inverse of the Jacobian matrix.¹⁸ However, the pseudoinverse method is computationally time-consuming, and the Jacobian transpose and damped least-squares inverse are sensitive to the parameter selection as well as may cause large tracking errors.

A Jacobian transpose method based on the damped reciprocal¹⁹ was proposed, which had less computation complexity, but the piecewise damped reciprocal function had some discontinuity.²⁰ Then the Gaussian distribution damped reciprocal algorithm²¹ was introduced to improve the continuity of the singularity avoidance. After that the improved Gaussian distribution damped reciprocal algorithm was proposed to improve the tracking accuracy of the end-effector.²² However, the accuracy of those methods based on the damped reciprocal still need to be improved.

In this article, we take a manipulator with the spherical wrist as the research object. Firstly, we adopted the singularity separation method to reduce the computation complexity. Secondly, we proposed a new mathematical function of the approximate damped reciprocal. This function has the following advantages: closer to the common reciprocal, which will have a better accuracy during the singularity avoidance, and a lower maximum of the derivative of the function, which will be helpful to reduce the accelerations of the joints. Thirdly, the singularities are avoided by modifying the Jacobian matrixes of the manipulator with the approximate damped reciprocal algorithm. The contribution of this article is that we propose a mathematical function of the damped reciprocal to improve the tracking accuracy of manipulator and ensure the stability of the system.

The article is organized as follows: The second section describes the kinematics model of the manipulator. The singularities of the manipulator are divided into forearm singularities and wrist singularity in the third section. The fourth section proposes the approximate damped reciprocal algorithm, and analyzes the tracking errors, the velocities, and accelerations of the joints. The numerical simulation experiments are carried out to validate the proposed algorithm in the fifth section. Lately, the discussions are presented in the sixth section and conclusions are made in the last section.

Kinematics modeling

In this article, a manipulator with the spherical wrist is chosen as the research object. The axes of the last three joints of this manipulator intersect at a point.

The kinematics Denavit-Hartenberg (D-H) model of the manipulator is shown in Figure 1. The corresponding Denavit-Hartenberg(D-H) model parameters are presented in Table 1.

Figure 1.

The D-H module of the 6R manipulator.

Table 1.

The D-H parameters of the 6R manipulator.

Joint	$θ_{i}$	$α_{i - 1}$	$a_{i - 1}$	d_i
1	$θ_{1}$	0	0	d ₁
2	$θ_{2}$	$- \frac{π}{2}$	a ₁	0
3	$θ_{3}$	0	a ₂	0
4	$θ_{4}$	$- \frac{π}{2}$	a ₃	d ₄
5	$θ_{5}$	$\frac{π}{2}$	0	0
6	$θ_{6}$	$\frac{π}{2}$	0	0

In Figure 1, {T} denotes the tool center point (TCP) frame of the manipulator. As the tool directly contacts with the working object during the practical operation, the position and orientation of the TCP in the world frame are calculated as follows

_{T}^{0} T =_{6}^{0} T \cdot_{T}^{6} T

where $_{T}^{6} T$ denotes the transformation matrix of the {T} frame relative to the end-effector {E} frame, which is determined by the physical dimension and the installation of the tool, and $_{6}^{0} T$ denotes the transformation matrix of the {E} frame relative to the world frame. Since $_{T}^{6} T$ is a constant matrix, the position and orientation of the TCP would be calculated after the calculation of $_{6}^{0} T$ .

Singularity separation

We adopted the singularity separation algorithm of Xu.¹⁹ Firstly, we divide the six-degree-of-freedom (DOF) singularity avoidance problem into two 3-DOF singularity avoidance subproblems. Secondly, we calculate the singular factors of the two 3-DOF singularity avoidance subproblems correspondingly.

Without calculating the singular value decomposition (SVD), or estimating the minimum singularity value of the Jacobian matrix, this method has less computation burden and higher real-time performance.

Jacobian decomposition

The inverse Jacobian matrix of the manipulator is calculated to obtain the singular factors, and the computation complexity of calculating the inverse matrix of a six-dimensional (6D) matrix is $o {(6}^{6})$ .

In order to reduce the computation complexity, we decompose the 6D Jacobian matrix into four 3D matrixes, displayed in equation (2), which is based on that the orientation of the manipulator is only relative to the last three joints, and the computation complexity of calculating the inverse matrix of a 3D matrix is $o {(3}^{3})$ , which is less than that of a 6D matrix

[\begin{matrix} v \\ w \end{matrix}] = J \cdot \dot{q} = [\begin{matrix} J_{11} & 0 \\ J_{21} & J_{22} \end{matrix}] \cdot [\begin{matrix} {\dot{q}}_{f} \\ {\dot{q}}_{l} \end{matrix}]

where v and w are the linear and angular velocities of the end-effector in the world frame, respectively; ${\dot{q}}_{f}$ is the vector of the velocities of the first three joints; and ${\dot{q}}_{l}$ is the vector of the velocities of the last three joints.

According to equation (2), the velocities of joints can be calculated as follows

{\dot{q}}_{f} = J_{11}^{- 1} \cdot v

{\dot{q}}_{l} = J_{22}^{- 1} \cdot (w - J_{21} \cdot {\dot{q}}_{f})

which shows that, when the manipulator is in the forearm singular configuration, $J_{11}$ would be ill conditioned, and the velocities of the first three joints would not exist; when the manipulator is in the wrist singular configuration, $J_{22}$ would be ill conditioned, and the velocities of the last three joints would not exist.

Singular factors separation

Since the expressions of $J_{11}$ and $J_{22}$ in the world frame are complicated to separate the singular factors, we transform the Jacobian matrix into different joint frames to simplify the expressions of $J_{11}$ and $J_{22}$ .

Due to the forearm singularities occurring in the first three joints, we calculate the Jacobian matrix in the third joint frame to simplify $J_{11}$ as follows

^{0} J_{11} =_{3}^{0} R \cdot^{3} J_{11}

where $_{3}^{0} R$ denotes the rotation matrix of the third joint frame relative to the world frame, and $^{3} J_{11}$ denotes the Jacobian matrix of $J_{11}$ in the third joint frame. The formula of $^{3} J_{11}$ in equation (5) is shown as follows

^{3} J_{11} = [\begin{matrix} 0 & - d_{4} + s_{3} a_{2} & - d_{4} \\ 0 & a_{3} + c_{3} a_{2} & a_{3} \\ c_{23} a_{3} - s_{23} d_{4} + c_{2} a_{2} + a_{1} & 0 & 0 \end{matrix}]

where s_i is the representative of $sin (θ_{i})$ ; c_i is the representative of $cos (θ_{i})$ ; $s_{i j}$ is the representative of $sin (θ_{i} + θ_{j})$ ; and $c_{i j}$ is the representative of $cos (θ_{i} + θ_{j})$ .

The inverse matrix of $^{3} J_{11}$ is calculated as follows

^{3} J_{11}^{- 1} = [\begin{matrix} \frac{1}{k_{1}} & 0 & 0 \\ 0 & \frac{1}{k_{2}} & 0 \\ 0 & 0 & \frac{1}{k_{2}} \end{matrix}] \cdot [\begin{matrix} 0 & 0 & 1 \\ a_{3} & d_{4} & 0 \\ - (a_{3} + a_{2} c_{3}) & - d_{4} + a_{2} s_{3} & 0 \end{matrix}]

where both $k_{1} = c_{23} a_{3} - s_{23} d_{4} + c_{2} a_{2} + a_{1}$ and $k_{2} = a_{3} a_{2} s_{3} + d_{4} a_{2} c_{3}$ denote the forearm singular factors.

It is obvious that the wrist singularity occurs in the fifth joint, so we calculate the Jacobian matrix $J_{22}$ in the fifth joint frame as follows

^{5} J_{22} = [\begin{matrix} s_{5} & 0 & 0 \\ c_{5} & 0 & - 1 \\ 0 & 1 & 0 \end{matrix}]

Then the inverse matrix of $^{5} J_{22}$ is calculated as follows

^{5} J_{22}^{- 1} = [\begin{matrix} \frac{1}{k_{3}} & 0 & 0 \\ 0 & 1 & 0 \\ 0 & 0 & \frac{1}{k_{3}} \end{matrix}] \cdot [\begin{matrix} 1 & 0 & 0 \\ 0 & 0 & 1 \\ c_{5} & - s_{5} & 0 \end{matrix}]

where $k_{3} = s_{5}$ denotes the wrist singular factor.

Equations (7) and (9) show that, when $k_{1}, k_{2}, k_{3} = 0$ , the manipulator would be in the singular configuration, and the solutions of equations (3) and (4) would be infinite, so it is necessary to study the singularity avoidance of the manipulator.

Singularity avoidance algorithm

To solve the problem that the velocities of the joints will be infinitely great when the singular factors are small, a damped reciprocal method was proposed, which used a function to simulate the reciprocal function of the singular factor. The property of the damped reciprocal function can be expressed as follows

\{\begin{array}{l} \frac{k_{i}}{k_{i}^{2} + λ_{i}^{2}} \approx \frac{1}{k_{i}} & | | k_{i} | | ≫ λ_{i} \\ \frac{k_{i}}{k_{i}^{2} + λ_{i}^{2}} \approx \frac{k_{i}}{λ_{i}^{2}} & | | k_{i} | | ≪ λ_{i} \end{array}

where $λ_{i}$ is called the damped factor. When the absolute value of the singular factor k_i is much larger than the damped factor $λ_{i}$ , the value of the damped factor can be considered as zero. But when the absolute value of the singular factor k_i is less than the damped factor $λ_{i}$ , the denominator of the damped reciprocal can be considered as the damped factor squared, which would prevent the reciprocal value of the singular factor k_i from being infinite.

In order to achieve this goal, several functions of the damped factor were proposed, such as (a) the piecewise damped factor,¹⁹ as shown in equation (11), which may solve the problem of singularity avoidance, but piecewise damped factor function may be discontinuous²⁰ and the tracking accuracy of the end-effector was unsatisfactory; (b) the Gaussian distribution damped factor²¹ shown in equation (12), improved the continuity of algorithm, but the accuracy was worse than the piecewise method; and (c) the improved Gaussian distribution damped factor²² was shown in equation (13), which had the best accuracy among the three methods

λ_{i} = \{\begin{array}{l} λ_{0} (1 - \sqrt{\frac{| | k_{i} | |}{ε_{i}}}) & | | k_{i} | | ≪ ε_{i} \\ 0 & | | k_{i} | | > ε_{i} \end{array}

λ_{g} = λ_{0} e^{- {(\frac{k_{i}}{ε_{0}})}^{2}}

λ_{I g i} = λ_{0} ε_{0} e^{- {(\frac{k_{i}}{ε_{0}})}^{2}}

where the parameter $ε_{i}$ is a threshold value, $λ_{0} = 0. 3$ and $ε_{0} = 0.0 4$ . The curves of different damped reciprocals are displayed in Figure 2, where the curve closer to the common reciprocal $\frac{1}{k_{i}}$ , the method may have better performance in accuracy.

Figure 2.

The curves of different damped reciprocals.

Inspired by this deduction, we propose a function of the approximate damped reciprocal to simulate the reciprocal of the singular factor, which is shown in equation (14)

f (k_{i}) = \frac{λ_{0} e^{{(\frac{k_{i}}{ε_{0}})}^{2}} - λ_{0} e^{- {(\frac{k_{i}}{ε_{0}})}^{2}}}{k_{i} (λ_{0} e^{{(\frac{k_{i}}{ε_{0}})}^{2}} + e^{- {(\frac{k_{i}}{ε_{0}})}^{2}})}

where $λ_{0} = 0. 3$ and $ε_{0} = \frac{1}{90}$ are empirical values by a trial and error procedure. The curve of the approximate damped reciprocal is displayed in Figure 2, where the curve of our method is closer to the common reciprocal’s, so that it would be helpful to have a better accuracy of the manipulator.

Then we modify the Jacobian matrix of the manipulator by displacing the common reciprocal of the damped factor with the approximate damped reciprocal to avoid the singularity.

The velocity analysis

According to equations (3), (4), (7), and (9), the formulas of the joint velocities based on the approximate damped reciprocal algorithm are as follows

\{\begin{array}{l} {\dot{q}}_{1} = f (k_{1}) \cdot^{3} v_{z} \\ {\dot{q}}_{2} = f (k_{2}) \cdot (a_{3} \cdot^{3} v_{x} + d_{4} \cdot^{3} v_{y}) \\ {\dot{q}}_{3} = f (k_{2}) \cdot (- (a_{3} + a_{2} c_{3}) \cdot^{3} v_{x} + (- d_{4} + a_{2} s_{3}) \cdot^{3} v_{y}) \\ {\dot{q}}_{4} = f (k_{3}) \cdot^{5} Δ w_{x} \\ {\dot{q}}_{5} =^{5} Δ w_{z} \\ {\dot{q}}_{6} = f (k_{3}) \cdot c_{5} \cdot^{5} Δ w_{x} -^{5} Δ w_{y} \end{array}

where $^{5} Δ w =^{5} w -^{5} J_{21} \cdot {\dot{q}}_{f}$ .

According to equations (2), (6), (8), and (15), the formulas of the linear velocities and angular velocities based on the approximate damped reciprocal algorithm are as follows

\{\begin{array}{l} ^{3} {\hat{v}}_{x} = (- d_{4} + s_{3} a_{2}) {\dot{q}}_{2} - d_{4} {\dot{q}}_{3} = k_{2} f (k_{2}) \cdot^{3} v_{x} \\ ^{3} {\hat{v}}_{y} = (a_{3} + c_{3} a_{2}) {\dot{q}}_{2} + a_{3} {\dot{q}}_{3} = k_{2} f (k_{2}) \cdot^{3} v_{y} \\ ^{3} {\hat{v}}_{z} = (c_{23} a_{3} - s_{23} d_{4} + c_{2} a_{2} + a_{1}) {\dot{q}}_{1} = k_{1} f (k_{1}) \cdot^{3} v_{z} \\ ^{5} Δ {\hat{w}}_{x} = k_{3} \cdot {\dot{q}}_{4} = k_{3} f (k_{3}) \cdot^{5} Δ w_{x} \\ ^{5} Δ {\hat{w}}_{y} = c_{5} \cdot {\dot{q}}_{4} - {\dot{q}}_{6} =^{5} Δ w_{y} \\ ^{5} Δ {\hat{w}}_{z} = {\dot{q}}_{5} =^{5} Δ w_{z} \end{array}

Taken the space velocities of the path planning as references, the practical velocity errors of the end-effector are calculated as follows

\{\begin{array}{l} ^{3} {\hat{v}}_{x} -^{3} v_{x} = (k_{2} f (k_{2}) - 1) \cdot^{3} v_{x} \\ ^{3} {\hat{v}}_{y} -^{3} v_{y} = (k_{2} f (k_{2}) - 1) \cdot^{3} v_{y} \\ ^{3} {\hat{v}}_{z} -^{3} v_{z} = (k_{1} f (k_{1}) - 1) \cdot^{3} v_{z} \\ ^{5} Δ {\hat{w}}_{x} -^{5} Δ w_{x} = (k_{3} f (k_{3}) - 1) \cdot^{5} Δ w_{x} \\ ^{5} Δ {\hat{w}}_{y} -^{5} Δ w_{y} = 0 \\ ^{5} Δ {\hat{w}}_{z} -^{5} Δ w_{z} = 0 \end{array}

where the singular factor k₁ only affects the velocity along the Z-axis in the third joint frame; the singular factor k₂ only affects the velocities along the X-axis and Y-axis in the third joint frame; and the singular factor k₃ only affects the angular velocity around the X-axis in the fifth joint frame.

An indicator, called the error coefficient, is defined to measure the velocity error, which is displayed in equation (18). The curves of error coefficients of different methods are shown in Figure 3.

e = \frac{^{3} \hat{v}}{^{3} v} = ‖k_{i} f (k_{i}) - 1‖

Figure 3.

The error coefficient curves of different methods.

We can see from Figure 3 that the error coefficients are zero outside the singular region, while the maxima of the error coefficients are equal to one in the singular region. Moreover, our method has the least total error coefficients among the four methods.

The derivative analysis

The higher the joint acceleration, the greater the joint torque, the worse the stability of the manipulator, so it is necessary to analyze the joint accelerations of the manipulator. The relations between the joint accelerations ${\ddot{q}}_{i}$ and the derivatives of the approximate damped reciprocal $f^{'} (k_{i})$ are shown as follows

\{\begin{array}{l} {\ddot{q}}_{1} = f^{'} (k_{1}) \cdot^{3} v_{z} + f (k_{1}) \cdot^{3} {\dot{v}}_{z} \\ {\ddot{q}}_{2} = f^{'} (k_{2}) \cdot (a_{3} \cdot^{3} v_{x} + d_{4} \cdot^{3} v_{y}) \\ + f (k_{2}) \cdot (a_{3} \cdot^{3} {\dot{v}}_{x} + d_{4} \cdot^{3} {\dot{v}}_{y}) \\ {\ddot{q}}_{3} = f^{'} (k_{2}) \cdot (- (a_{3} + a_{2} c_{3}) \cdot^{3} v_{x} + (- d_{4} + a_{2} s_{3}) \cdot^{3} v_{y}) \\ + f (k_{2}) \cdot (- (a_{3} + a_{2} c_{3}) \cdot^{3} {\dot{v}}_{x} + (- d_{4} + a_{2} s_{3}) \cdot^{3} {\dot{v}}_{y}) \\ {\ddot{q}}_{4} = f^{'} (k_{3}) \cdot^{5} Δ w_{x} + f (k_{3}) \cdot^{5} Δ {\dot{w}}_{x} \\ {\ddot{q}}_{5} =^{5} Δ {\dot{w}}_{z} \\ {\ddot{q}}_{6} = f^{'} (k_{3}) \cdot c_{5} \cdot^{5} Δ w_{x} + f (k_{3}) \cdot c_{5} \cdot^{5} Δ {\dot{w}}_{x} -^{5} Δ {\dot{w}}_{y} \end{array}

which shows that the accelerations of joints are linear to the derivatives of the approximate damped reciprocals. The larger the derivatives of the approximate damped reciprocal, the accelerations of joints will be larger.

The curves of the derivatives of different damped reciprocals are shown in Figure 4, which shows that the proposed method has a higher derivative maximum than the piecewise damped reciprocal method and the Gaussian distribution damped reciprocal method, but has a lower derivative maximum than the improved Gaussian distribution damped reciprocal method, which means that the proposed method would produces less accelerations and moments of joints than the improved Gaussian distribution damped reciprocal method, when the linear and angular accelerations of both methods are equal.

Figure 4.

The derivative curves of different methods.

Simulation

In this section, the proposed singularity avoidance algorithm is applied to an industrial manipulator with the spherical wrist. Due to the limitations of the experimental environment, the simulation experiment is only carried out to prove the validity of the proposed algorithm. We have developed a simulation software based on C++ to simulate the motion of the manipulator. Our method can be validated on this software. The data analysis is done on the software of MATLAB (2019).

Numerical simulation introduction

Let ${q_{x}, q_{y}, q_{z}, q_{w}}$ , ${p_{x}, p_{y}, p_{z}}$ be the coordinates of the manipulator’s TCP in the world frame. ${q_{x}, q_{y}, q_{z}, q_{w}}$ represents the TCP attitude, measured with quaternion, which can be displaced with transformation matrixes, or Euler angles, and so on and ${p_{x}, p_{y}, p_{z}}$ represents the position of the TCP with unit of meter. The positions we take for experiments are listed as follows:

\begin{matrix} A = \{0, 0. 707107, 0, 0. 707107\}, \{1 .0 8, - 0. 1, 1.42\} \\ B = \{0, 0, 0, 1\}, \{0. 1, 0. 1, 2 .0 3\} \end{matrix}

We take the position of {0, −1.570796, 0.0, 0.0, 3.1415926, 0.0}, which denotes the angles of joints with unit of rad, as the original position to reach position A, and take the position of {0, −2.1423, −0.498749, 0.0, 2.641050, 0.0}, which denotes the angles of joints with unit of rad, as the original position to reach position B. Two linear paths are selected to do the simulation. The manipulator would enter the wrist singular region during completing the first path and would enter the forearm singular region during completing the second path.

The paths of manipulator in Cartesian space are generated by the path planning module, then the paths are transformed into the joints space through the trajectory interpolation module to control the motions of the joints. Our method would be applied on the trajectory interpolation module to avoid the singularities. Due to the singularity separation, our method has lower computational complexity. The period of trajectory interpolation is 4 ms, which would meet the real-time requirements of the system.

In fact, it is the tool that contacts with the working object directly, so it is necessary to consider the path accuracy of the TCP. As both the linear and angular velocity error can produce the position error of the TCP, we take the position of the TCP, calculated by equation (1), and the linear and angular velocity error of TCP, as indicators to compare with other methods. Finally, the stability of the system during the singularity avoidance is analyzed by verifying the velocity and acceleration of each joint.

Error simulation analysis

The linear paths of TCP of several methods are displayed in Figure 5, which shows that all four methods can finish the task of singularity avoidance, but the manipulator would deviate from the linear paths during passing across the singularities. Moreover the proposed method would approach the linear paths best among the four methods.

Figure 5.

The paths across the singularity region with different methods: (a) the wrist singularity and (b) the forearm singularity.

Taking v and w, the linear and angular velocities of TCP in the world frame of the path planning as references, we calculate the velocity errors of TCP as follows

e_{v} = | v - \hat{v} |

e_{w} = | w - \hat{w} |

where $\hat{v}, \hat{w}$ are the practical velocities of TCP in the world frame. The velocity errors of TCP in the world frame are shown in Figure 6, which shows that compared with the other three methods, the proposed method has the least angular velocity error around the singular region.

Figure 6.

The velocity errors of different methods: (a) the linear velocity error and (b) the angular velocity error.

Velocity and acceleration simulation analysis

High velocities and accelerations of joints would result in high force moments, which may have bad influence in system stability, so the velocity and acceleration analyses of different methods are important. The curves of the velocities and accelerations of joints are displayed in Figures 7 and 8. Since the wrist singularity is located on the first path, only the velocities and accelerations of the last three joints are shown in Figure 7; while the forearm singularity is located on the second path, only the velocities and accelerations of the first three joints are shown in Figure 8. Due to the small values of the accelerations of the second and the third joints, we approximate them to zero.

Figure 7.

The velocities and accelerations of the last three joints across the wrist singularity: (a) the velocities of the last three joints and (b) the accelerations of the last three joints.

Figure 8.

The velocities and accelerations of the first three joints across the forearm singularity: (a) the velocities of the first three joints and (b) the accelerations of the first three joints.

We can see from Figures 7 and 8 that the proposed method can control the velocities and accelerations of joints within the allowable range of the manipulator. Moreover, the proposed method has lower accelerations than the Gaussian distribution damped reciprocal method in Figure 7.

Discussion

The singularities of a 6R manipulator are avoided by the approximate damped reciprocal method in this article. All the accuracy, velocity, and acceleration simulation results prove that the proposed method can improve the path accuracy of the manipulator with limited velocities and accelerations of joints. A possible explanation of Figure 8 is that the accelerations of the joints are relative to the linear, angular accelerations of the path planning and the derivatives of the damped reciprocals (equation (19)). The path of our method is closer to the linear path in the singular region, which results in that our method would have higher linear and angular accelerations than other methods. However, due to the constraint of the derivative of the approximate damped reciprocal, the accelerations of the joints can be controlled in a limited range. As the singular factors are obtained by the singularity separation method based on the structure of the spherical wrist, which may limit the application of the proposed method, the method to obtain the singular factors from the Jacobian matrix of manipulators with nonspherical wrists will be presented in an upcoming paper. The singularity avoidance method would be applied on a 6-DOF manipulator with a spherical wrist, which can operate in 4500 km underwater environment.

Conclusion

In this article, the analysis and avoidance of the kinematics singularities of manipulators with spherical wrists are studied using the approximate damped reciprocal algorithm. Firstly, the 6-DOF singularity problem is separated into two 3-DOF singularity subproblems and the singular factors are calculated correspondingly. Secondly, a new mathematical function of the approximate damped reciprocal of the singular factor is proposed to improve the accuracy of the manipulator. Finally, the singularities are avoided by modifying the Jacobian matrixes of the manipulator with the approximate damped reciprocal algorithm. Without calculating the SVD or estimating the minimum singular value of the Jacobian matrix, the proposed algorithm may have better real-time performance. The simulation results prove that the proposed method may have better accuracy than the traditional damped reciprocal methods and can make the joint’s velocities and accelerations within the allowable range of the manipulator, which means that our method may have better accuracy and can ensure the stability of the manipulator around the singular region.

Footnotes

Declaration of conflicting interests

The author(s) declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.

Funding

The author(s) disclosed receipt of the following financial support for the research, authorship, and/or publication of this article: This work was supported by the Development of Intelligent Precise Operation Module (XDA22040303) and Anhui Natural Science Foundation of China (1808085QF214).

ORCID iD

Tiantian Yu

References

Gosselin

Schreiber

L-T

. Kinematically redundant spatial parallel mechanisms for singularity avoidance and large orientational workspace. IEEE Trans Robot 2016; 32: 286–300.

Ebrahimi

Carretero

Boudreau

. Kinematic analysis and path planning of a new kinematically redundant planar parallel manipulator. Robotica 2008; 26: 405–413.

Bhattacharya

Hatwal

Ghosh

. Comparison of an exact and an approximate method of singularity avoidance in platform type parallel manipulators. Mech Mach Theory 1998; 33: 965–974.

Cheng

Huang

. Virtual impedance control for safe human-robot interaction. J Intell Robot Syst 2016; 82: 3–19.

Dietrich

Albu-Schaffer

Hirzinger

On continuous null space projections for torque-based, hierarchical, multi-objective manipulation. In: 2012 IEEE international conference on robotics and automation, Saint Paul, MN, USA, 14–18 May 2012, pp. 2978–2985.

Galicki

. Real-time constrained trajectory generation of mobile manipulators. Robot Auton Syst 2016; 78: 49–62.

Huang

Yong

Chiba

, et al. Kinematic control with singularity avoidance for teaching-playback robot manipulator system. IEEE Trans Autom Sci Eng 2016; 13: 729–742.

Božek

Ivandić

Lozhkin

, et al. Solutions to the characteristic equation for industrial robot’s elliptic trajectories. Teh Vjesn 2016; 23(4): 1017–1023.

Gallant

Boudreau

. The synthesis of planar parallel manipulators with prismatic joints for an optimal, singularity-free workspace. J Robot Syst 2002; 19: 13–24.

10.

Doan

NCN

Lin

. Optimal robot placement with consideration of redundancy problem for wrist-partitioned 6R articulated robots. Robot Comput-Integr Manuf 2017; 48: 233–242.

11.

Bin

Feng

, et al. GA based adaptive singularity-robust path planning of space robot for on-orbit detection. Complexity 2018; 2018: 11 pages. DOI: 10.1155/2018/3702916.

12.

Colome

Torras

. Closed-loop inverse kinematics for redundant robots: comparative assessment and two enhancements. IEEE/ASME Trans Mechatron 2015; 20: 944–955.

13.

Dulęba

Opałka

. A comparison of Jacobian-based methods of inverse kinematics for serial robot manipulators. Int J Appl Math Comput Sci 2013; 23: 373–382.

14.

Liu

Zhou

Lai

, et al. An efficient inverse kinematic algorithm for a PUMA560-structured robot manipulator. Int J Adv Robot Syst 2013; 10: 236.

15.

Yuksel

. Intelligent visual servoing with extreme learning machine and fuzzy logic. Expert Syst Appl 2017; 72: 344–356.

16.

Zhang

Liang

, et al. Singularity analysis and avoidance for robot manipulators with nonspherical wrists. IEEE Trans Ind Electron 2016; 63: 277–290.

17.

Zhang

Qian

, et al. Identifying the singularity conditions of Canadarm2 based on elementary Jacobian transformation. In: 2013 IEEE/RSJ international conference on intelligent robots and systems, Tokyo, Japan, 3–7 November 2013, pp. 795–800.

18.

Chiaverini

Siciliano

Egeland

. Review of the damped least-squares inverse kinematics with experiments on an industrial robot manipulator. IEEE Trans Control Syst Technol 1994; 2: 123–134.

19.

W-F

. A novel approach to avoid singularities of PUMA-type manipulators. Acta Automat Sin 2009; 34: 670–675.

20.

Oetomo

Ang

Jr . Singularity robust algorithm in serial manipulators. Robot Comput-Integr Manuf 2009; 25: 122–134.

21.

Phuoc

Martinet

Lee

, et al. Damped least square based genetic algorithm with Gaussian distribution of damping factor for singularity-robust inverse kinematics. J Mech Sci Technol 2008; 22: 1330–1338.

22.

Cui

Feng

, et al. Singularity avoidance of 6R decoupled manipulator using improved Gaussian distribution damped reciprocal algorithm. Ind Robot 2017; 44: 324–332.