Next Article in Journal
Data Transmission Reduction in Wireless Sensor Network for Spatial Event Detection
Previous Article in Journal
Reliable Route Selection for Wireless Sensor Networks with Connection Failure Uncertainties
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Kinematics and Singularity Analysis of a 7-DOF Redundant Manipulator

1
School of Mechanical Engineering, Yanshan University, Qinhuangdao 066004, China
2
Parallel Robot and Mechatronic System Laboratory of Hebei Province, Yanshan University, Qinhuangdao 066004, China
*
Author to whom correspondence should be addressed.
Submission received: 15 September 2021 / Revised: 21 October 2021 / Accepted: 29 October 2021 / Published: 31 October 2021
(This article belongs to the Section Sensors and Robotics)

Abstract

:
A new method of kinematic analysis and singularity analysis is proposed for a 7-DOF redundant manipulator with three consecutive parallel axes. First, the redundancy angle is described according to the self-motion characteristics of the manipulator, the position and orientation of the end-effector are separated, and the inverse kinematics of this manipulator is analyzed by geometric methods with the redundancy angle as a constraint. Then, the Jacobian matrix is established to derive the conditions for the kinematic singularities of the robotic arm by using the primitive matrix method and the block matrix method. Then, the kinematic singularities conditions in the joint space are mapped to the Cartesian space, and the singular configuration is described using the end poses and redundancy angles of the robotic arm, and a singularity avoidance method based on the redundancy angles and end pose is proposed. Finally, the correctness and feasibility of the inverse kinematics algorithm and the singularity avoidance method are verified by simulation examples.

1. Introduction

With the rapid development of robotics and artificial intelligence technology, robots are increasingly used in many industrial applications, such as automobile manufacturing, mechanical processing, electrical and electronic industries, rubber and plastic industries, etc. Compared with the 6-DOF manipulator, a redundant manipulator with unique self-motion characteristics can accomplish complicated tasks easily, such as obstacle avoidance, singularity avoidance, and torque optimization [1]. The stiffness of the redundant manipulator decreases with the increase of the number of axes, so the 7-DOF manipulator, which is considered the simplest redundant manipulator, attracts the attention of scholars [2,3].
For redundant manipulators’ kinematic problems, a challenging problem is how to select an appropriate solution because the number of inverse kinematics solutions is infinite. Usually, the following methods are used: geometric method [4]; numerical method [5,6,7], such as pseudo-inverse of Jacobian matrix [8], augmented Jacobian matrix [9,10], gradient projection method [11], weighted least-norm solution [12], etc. The kinematic control of redundant manipulators can be achieved by position-based or velocity-based methods. Additionally, the latter is considered the standard approach to derive the inverse kinematics expression of the redundant manipulator [13]. However, compared with the position-based solution, the velocity-based solution exhibits several disadvantages, such as returning only one solution [14,15], requiring the pre-assignment of Cartesian trajectory, accumulation error, etc. [16] Since the number of inverse kinematics solutions of the redundant robot arm is infinite, the position-based closed-form solution is difficult to derive. Usually, the aided parameter, such as redundant angle, is introduced to derive the expression of inverse kinematics [17]. However, how to choose the appropriate joint angle needs to be researched further. A method about the comparison of the workspace proposed by Zaplana et al. is used to solve the problem about the selection of the redundant angle [18]. An elbow angle method with a more obvious geometric meaning is proposed by Kreutz-Delgado et al. [19], which can select the value of the redundant parameters according to the task. A position-based control method for the KUKA LBR (A commercial 7-DOF manipulator from KUKA Corporation) manipulator is proposed by Faria [16], and its configuration is an SRS (spherical joint, revolute joint, spherical joint) humanoid manipulator. Two auxiliary parameters are introduced to deal with the self-motion manifolds, the inverse kinematics is obtained by the geometric method, and the singularity avoidance is analyzed.
The singularity analysis and avoidance are very important for the path planning and movement control of redundant manipulators [20,21]. The Jacobian matrix for the redundant manipulator is a non-square matrix; the singularity condition cannot be obtained by simply finding the determinant of the matrix, so it is difficult to solve it. The Gram–Schmidt decomposition of the Jacobian matrix was used by Podhorodeski et al. [22] to solve the singular configurations of the redundant manipulator with a spherical wrist. Nokleby et al. [23] proposed a method based on screw reciprocity, which can be regarded as a general method for the singularity analysis of redundant manipulators. Kong et al. [24] proposed an approach of dependent-screw suppression to analyze the singularity of a 7-DOF redundant manipulator Canadarm2. Xu et al. [25,26] discussed the singularity condition of Canadarm2 by using the elementary matrix of Jacobian. To solve the singularity avoidance problem, the general methods are damped least variance (DLS) [27], singular value decomposition (SVD) [25], singular consistency method [28], and singular robustness algorithm [29]. However, most of these singularity avoidance algorithms are analyzed based on velocity and generally determine whether a singularity occurs during motion by computing the rank of the Jacobian matrix, while the position-based singular avoidance method in the case of deriving redundant robot inverse kinematics analytic solutions has not been discussed. That is, the position of the end-effector and the position of the joint angle are used to determine whether the manipulator is in a singular configuration.
The optimum kinematic design for a 7-DOF SRS configuration serial manipulator was proposed by Hollerbach [30], Due to its structural advantages in task performance and anthropomorphic characteristics, it has been extensively studied [31,32]. There are also many studies on the kinematics and singularity of a complex space manipulator with distance offset (the axes of the spherical joints do not intersect) [33,34]. Another superior kinematic design is a 7-DOF redundant manipulator with three consecutive parallel axes, which differs from the SRS configuration series manipulator in that the axis direction of joint 3 is different. There is little research on the kinematics and singularity of such a three consecutive parallel axes 7-DOF redundant manipulator.
In this paper, the kinematics and singularities of a typical 7-DOF manipulator with three consecutive parallel axes without distance offset are researched. The auxiliary parameters of its inverse kinematics are determined by self-motion analysis, and the analytical solution of its inverse kinematics is obtained. The singularity of this manipulator and the singular avoidance are studied.

2. Kinematics

2.1. Forward Kinematics

The robot that is researched is composed of seven revolute joints with three consecutive parallel axes. To realize kinematic control and describe the kinematic relationship between the pose of the robot’s end-effector and joint angle, the mechanical structure and joint coordinate system of this manipulator are shown in Figure 1.
The base coordinate frame is fixed to the ground, and each joint coordinate frame is defined based on D–H rules. To simplify the mathematical model, the tool coordinate system is not considered. The D–H parameters of the manipulator are presented in Table 1, in which the length of each link is d1 = |OS|, d2 = |SA|, d3 = |AE|, d4 = |EW|.
According to the D–H rules and parameters of this manipulator listed in Table 1, the coordinate transform matrix of adjacent joints can be obtained by using a homogeneous transformation matrix T i i 1 .
T i i 1 = [ c θ i s θ i 0 a i 1 s θ i c α i 1 c θ i c α i 1 s α i 1 d i s α i 1 s θ i s α i 1 c θ i s α i 1 c α i 1 d i c α i 1 0 0 0 1 ]
where c θ i = cos ( θ i ) , s θ i = sin ( θ i ) , c α i 1 = cos ( α i 1 ) ,   s α i 1 = sin ( α i 1 ) .
When the values of all joint angles are known, the homogeneous transformation matrix of the end-effector relative to the base can be obtained by multiplying seven homogeneous transformation matrices.
T 7 0 = T 1 0 T 2 1 T 3 2 T 4 3 T 5 4 T 6 5 T 7 6
According to Equation (2) the forward kinematic solution can be obtained, which indicates the position and orientation of the end-effector.

2.2. Self-Motion Analysis

According to the mechanical characteristics of the manipulator, the geometric simplification of the manipulator is carried out. Since the axes of the last three joints of the manipulator intersect at a point, when the axes are not coplanar, the rotation of the axes of the last three joints corresponds to a spherical pair centered on W, as shown in Figure 2.
When the position of the end-effector is determined, the location of W is known. Since the axes of the joints 2, 3, 4 are parallel to each other and the locations of point O and point S remain unchanged, it can be known that point O, S, A, E, and W are on the same plane P and the possible motion of the manipulator is the movement of the links SA, AE, and EW on the plane P. It can be considered as the self-motion of the 7-DOF manipulator. The movement can be seen as the planar four-bar motion with SW as the fixed link. The positions of points A and E are determined by only one parameter. The angle φ between SA and SW is considered as the parameter of the self-motion, as shown in Figure 3.
When the end-effector of the manipulator is at a different position, the length of SW is different. The variation range of redundant angle φ can be derived according to the kinematic principle of planar four-bar mechanism, which lays a foundation for solving the inverse kinematics of the redundant manipulator based on the redundant angle φ.

2.3. Inverse Kinematics

According to the configuration characteristics of this manipulator, the last three joints of the manipulator are equivalent to a spherical joint, which can reach any orientation. Therefore, for the inverse kinematics, the separation of position and orientation can be achieved. In this way, the first four joints of the manipulator determine the position of the end-effector; the last three joints determine the orientation of the end-effector.
Assuming the position and orientation of the manipulator are known as
T 7 0 = [ R 7 0 P 7 0 0 1 ] = [ n x o x a x p x n y o y a y p y n z o z a z p z 0 0 0 1 ]
The inverse kinematics can be solved by the following 5 steps:
  • θ1
As shown in Figure 4, since the axes of the joints 2, 3, 4 are parallel to each other, the position of the self-motion plane P is only determined by joint 1. Therefore, the expression of θ1 is
θ 1 = atan 2 ( n 0 × n 1 z 1 , n 0 n 1 ) + ( 1 G K 1 ) π 2
where GK1= ±1 corresponding to the two solutions of θ1, n0 and z1 is the axis direction of the joint 1 in the base coordinate system, n0 and n1 are the normal vectors of the initial principal plane P’ and the corresponding principal plane P of the current point W.
n 0 = [ 0 1 0 ] T n 1 = O S × S W = [ d 1 p y d 1 p x 0 ] T
where
O S = [ 0 0 d 1 ] T S W = O W O S = [ p x p y p z d 1 ] T
2.
θ2
As shown in Figure 5, θ2 can represent the angle of rotation from x1 to x2 around z2, and x2 is collinear with the link SA. If the redundancy angle φ is known, θ2 can be expressed as
θ 2 = G K 1 φ + φ S M
where φ is the redundant angle, φ S M can represent the angle of rotation from x1 to SW around z2.
According to θ1, φ S M and z2 can be obtained.
  φ S M = atan 2 ( x 1 × S W z 2 , x 1 S W ) z 2 = n 1
The unit vectors z2 and x1 represent the z-axis vector of the joint axis 2 and the x-axis vector of the joint axis 1, respectively.
3.
θ3
The position of point A can be solved when the angles θ1 and θ2 are known. At this time, AW, AE, and EW form a fixed triangle with a fixed edge length in Figure 6. In this way, the position of point E can be obtained.
  ψ = G K 2 arccos ( d 3 2 + | A W | 2 d 4 2 2 d 3 | A W | ) A E = d 3 Rot ( z 2 , ψ ) A W | A W |
where GK2= ±1 corresponds to the two possible positions of the point E, corresponding to point E above and point E’ below, respectively. |AW| represents the distance from point A to W.
θ3 is the angle of rotation from SA to AE around z3, so θ3 can be expressed as follows:
  θ 3 = atan 2 ( S A × A E z 3 , S A A E )
4.
θ4
According to the D–H method, θ4 is the angle of rotation from x3 to x4 around z4.
  θ 4 = atan 2 ( x 3 × x 4 z 4 , x 3 x 4 )
where z2 is parallel to z4. X3 can be obtained by coordinate transformation according to θ1, θ2,, and θ3. Because EW and z5 are collinear with each other, x4 can be expressed as
x 4 = z 4 × z 5 = z 3 × E W | E W |
5.
θ5,θ6,θ7
According to the above analysis, the values of the first four joints have been obtained, and the transformation matrix from the initial orientation to the target orientation can be described as
R 7 4 = R 4 0 1 R 7 0 = [ n x o x a x n y o y a y n z o z a z ]
where R 4 0 is the orientation matrix of joint coordinate system {4} in the base coordinate system, which is calculated by θ1, θ2, θ3, and θ4. R 7 0 is known and given by Equation (3).
According to the coordinate transformation of the D–H method, R 7 4 is the orientation matrix of joint coordinate system {7} in coordinate system {4}, which can also be described as
R 7 4 = R 5 4 R 6 5 R 7 6 = [ c 5 c 6 c 7 s 5 s 7 c 5 s 7 c 6 c 7 s 5 c 5 s 6 c 7 s 6 s 7 s 6 c 6 c 5 s 7 + c 6 c 7 s 5 c 5 c 7 s 5 c 6 s 7 s 5 s 6 ]
where s and c are the abbreviations of sine function and cosine function, respectively, and the subscript number i (i = 1, …, 7) is the corresponding joint angle θi. For example, c6 = cos(θ6).
When a y = 1 , that is θ 6 = 0 , ± π . The axes of joint 5 and joint 7 of the manipulator coincide; at this time, only the sum of values of the joint 5 and the joint 7 can be obtained, and the joint angles can be arbitrarily selected as long as the sum is unchanged.
θ 5 + θ 7 = atan 2 ( n z , n x )
When a y 1 , that is s 6 0 . Due to the existence of the cosine function, there are two solutions. Introducing variables GK3= ±1 reflect this position
θ 6 = G K 3 arccos ( a y ) θ 5 = atan 2 ( a z s 6 , a x s 6 ) θ 7 = atan 2 ( o y s 6 , n y s 6 )
In summary, eight discrete inverse solutions of the manipulator can be obtained with given position-orientation T and redundant angle φ, and the unique inverse solutions of the control variable GK1, GK2, and GK3 can be obtained.

3. Singularity Analysis

The Jacobian matrix reflects the mapping relationships between the generalized velocity (linear velocity and angular velocity) of the end-effector and the joint velocities. The singularity condition of the manipulator can be obtained by analyzing the conditions when the determinant of the Jacobian matrix is equal to zero. However, since the Jacobian matrix of the redundant manipulator is not a square matrix, it is not feasible to obtain singular conditions by means of the matrix determinant. The method based on the elementary transformation [26] of the Jacobian matrix is widely used. That is, the Jacobian matrix is simplified by the elementary transformation. The singular conditions are analyzed and concentrated in a low-dimensional submatrix by the form of the block matrix, and then the singularity conditions of the submatrix are analyzed to obtain the singularity conditions of the entire Jacobian matrix [23].

3.1. Jacobian Matrix

In this paper, the vector cross-product method [35] is used to establish the Jacobian matrix of the manipulator. The relationship between the terminal velocity and the joint velocity corresponding to a single joint is as follows:
[ ω v ] = J ( θ ) θ ˙
where ω and v are the angular velocity and linear velocity of the end effector, respectively. θ ˙ is the joint velocity vector and J(θ) is the Jacobian matrix. Since the seven joints of this manipulator are all revolute joints, the ith column of the Jacobian matrix can be expressed as:
J i = [ z i z i × p 7 5 i ]
where zi is the unit vector of the ith joint axis, p 7 5 i is the representation of the origin of the joint coordinate system {7} in the joint coordinate system {5} relative to the position vector in the coordinate system {i}.
Adopting the above method, the Jacobian matrix of the manipulator is established with joint 5 as the reference coordinate system as follows:
J 5 = [ c 5 s 234 s 5 s 5 s 5 0 0 s 6 s 5 s 234 c 5 c 5 c 5 0 1 0 c 234 0 0 0 1 0 c 6 J 41 J 42 J 43 d 4 c 5 0 0 0 J 51 J 52 J 53 d 4 s 5 0 0 0 0 J 62 d 3 c 4 0 0 0 0 ]
where the subscript of the symbol represents the sine or cosine of the corresponding joint variable sum, such as s 234 = sin ( θ 2 + θ 3 + θ 4 ) .
J 41 = d 4 s 234 s 5 + d 3 c 23 s 5 + d 2 c 2 s 5 J 51 = d 4 s 234 c 5 + d 3 c 23 c 5 + d 2 c 2 c 5 J 42 = d 4 c 5 d 3 s 4 c 5 d 2 s 34 c 5 J 52 = d 4 s 5 + d 3 s 4 s 5 + d 2 s 34 s 5 J 62 = d 3 c 4 + d 2 c 34 J 43 = d 4 c 5 d 3 s 4 c 5 J 53 = d 4 s 5 + d 3 s 4 s 5
Because of the wrist structure of the manipulator, the last three columns of the Jacobian matrix are in the simplest form. In this way, the Jacobian matrix can be separated into a low-dimensional matrix by elementary transformation. In the following section, the expression of the low-dimensional matrix is expressed, and the singularity conditions of the Jacobian matrix are obtained by analyzing the singularity conditions of the matrix.

3.2. Singularity Conditions

According to Equation (19), the lower right corner of the Jacobian matrix is simplified to a 3 × 3 zero matrix, which can be discussed by dividing the Jacobian matrix into blocks. The following discussion is based on the value of S6:
  • S6 = 0
When S6 = 0, the Jacobian matrix can be transformed into the following form
J 5 s 6 = 0 = [ λ 1 0 0 0 λ 2 0 1 0 λ 3 1 0 1 λ 4 0 0 0 λ 5 0 0 0 λ 6 0 0 0 ]
where λ1 to λ6 in Equation (20) are sub-matrices of the Jacobian matrix to make the structure of the Jacobian matrix look more concise.
To facilitate the singularity analysis, elementary transformation is performed on the matrix in Equation (20), and the matrix is written into the form of a block matrix.
J 5 s 6 = 0 = [ λ 3 1 0 1 λ 2 0 1 0 λ 1 0 0 0 λ 4 0 0 0 λ 5 0 0 0 λ 6 0 0 0 ] = [ S 11 5 S 12 5 S 21 5 O 4 × 3 ]
where O 4 × 3 is a 4 × 3 zero matrix, and the other sub-matrices are as follows:
S 11 5 = [ λ 3 λ 2 ] S 12 5 = [ 1 0 1 0 1 0 ] S 21 5 = [ λ 1 λ 4 λ 5 λ 6 ]
According to the characteristics of the matrix rank, S 12 5 is a row full rank matrix, i.e., rank ( S 12 5 ) = 2 . So, the rank of the block-triangle matrix can be computed according to the following equation [36]:
rank ( J 5 s 6 = 0 ) = rank ( [ S 11 5 S 12 5 S 21 5 O 4 × 3 ] ) = rank ( S 12 5 ) + rank ( S 21 5 )
If J 5 s 6 = 0 is singular, it should satisfy:
rank ( J 5 s 6 = 0 ) < 6
Namely,
rank ( S 21 5 ) < 4
We only need to analyze the singularity S 21 5 .
S 21 5 = [ c 5 s 234 s 5 s 5 s 5 A 21 A 22 A 23 d 4 c 5 A 31 A 32 A 33 d 4 s 5 0 A 42 d 3 c 4 0 ]
where
A 21 = s 5 ( d 4 s 234 + d 3 c 23 + d 2 c 2 ) A 22 = c 5 ( d 4 + d 3 s 4 + d 2 s 34 ) A 23 = c 5 ( d 4 + d 3 s 4 ) A 31 = c 5 ( d 4 s 234 + d 3 c 23 + d 2 c 2 ) A 32 = s 5 ( d 4 + d 3 s 4 + d 2 s 34 ) A 33 = s 5 ( d 4 + d 3 s 4 ) A 42 = d 3 c 4 + d 2 c 34
Since S 21 5 is a square matrix, the singularity conditions of the Jacobian matrix can be obtained by judging whether the determinant of the matrix is equal to zero.
det ( S 21 5 ) = d 2 d 3 s 3 s 5 ( d 2 c 2 + d 3 c 23 + d 4 s 234 )
Then, it can be obtained that, when det ( S 21 5 ) = 0 , the rank of the Jacobian matrix is less than 6; that is, it is in the singular position. For det ( S 21 5 ) = 0 , there are three cases: d 2 c 2 + d 3 c 23 + d 4 s 234 = 0 , s 3 = 0 , and s 5 = 0 .
2.
S6 ≠ 0
When S6 ≠ 0, the Jacobian matrix can be expressed in the form of block matrix
J 5 s 6 0 = [ λ 1 0 0 s 6 λ 2 0 1 0 λ 3 1 0 c 6 λ 4 0 0 0 λ 5 0 0 0 λ 6 0 0 0 ] = [ S 11 5 S 12 5 S 21 5 O 3 × 3 ]
where S 12 5 is a square matrix and its determinant value is det ( S 12 5 ) = s 6 . Because of S6 ≠ 0, to make Jacobian matrix singular, it needs to satisfy
rank ( S 21 5 ) < 3
The singularity of the Jacobian matrix can be judged by analyzing the singularity of S 21 5 . The expression of S 21 5 is as follows:
S 21 5 = [ A 11 A 12 A 13 d 4 c 5 A 21 A 22 A 23 d 4 s 5 0 A 32 d 3 c 4 0 ]
where
A 11 = ( d 4 s 234 + d 3 c 23 + d 2 c 2 ) s 5 A 12 = ( d 4 + d 3 s 4 + d 2 s 34 ) c 5 A 13 = ( d 4 + d 3 s 4 ) c 5 A 21 = ( d 4 s 234 + d 3 c 23 + d 2 c 2 ) c 5 A 22 = ( d 4 + d 3 s 4 + d 2 s 34 ) s 5 A 23 = ( d 4 + d 3 s 4 ) s 5 A 32 = d 3 c 4 + d 2 c 34
Since the matrix S 21 5 is a rectangular matrix, the determinant method cannot obtain the condition of matrix rank deficiency. Therefore, it is necessary to be discussed according to the structural characteristics of the matrix. By looking at the first column of matrix S 21 5 , we can see the following:
  • If A = d 2 c 2 + d 3 c 23 + d 4 s 234 = 0 , then A11 = A21 = 0, and S 21 5 becomes a square matrix.
S 21 A = 0 5 = [ ( d 4 + d 3 s 4 + d 2 s 34 ) c 5 ( d 4 + d 3 s 4 ) c 5 d 4 c 5 ( d 4 + d 3 s 4 + d 2 s 34 ) s 5 ( d 4 + d 3 s 4 ) s 5 d 4 s 5 d 3 c 4 + d 2 c 34 d 3 c 4 0 ]
Since det ( S 21 A = 0 5 ) = 0 , S6 ≠ 0 and d 2 c 2 + d 3 c 23 + d 4 s 234 = 0 is one of the conditions of matrix rank deficiency. Consider Equation (27), S6 = 0 and d 2 c 2 + d 3 c 23 + d 4 s 234 = 0 is also one of the conditions of matrix rank deficiency. Therefore, d 2 c 2 + d 3 c 23 + d 4 s 234 = 0 is one of the singular conditions of the matrix regardless of whether S6 is equal to 0 or not.
  • If A = d 2 c 2 + d 3 c 23 + d 4 s 234 0 , S 21 5 is transformed into an elementary transformation:
S 21 A 0 5 = [ 1 0 0 0 0 ( d 4 + d 3 s 4 + d 2 s 34 ) s 5 / A ( d 4 + d 3 s 4 ) s 5 / A d 4 s 5 / A 0 d 3 c 4 + d 2 c 34 d 3 c 4 0 ]
If S5 = 0, then the matrix can be written in the following form after the elementary transformation:
S 21 A 0 ,   s 5 = 0 5 = [ 1 0 0 0 0 ( d 4 + d 3 s 4 + d 2 s 34 ) c 5 / A ( d 4 + d 3 s 4 ) c 5 / A d 4 c 5 / A 0 d 3 c 4 + d 2 c 34 d 3 c 4 0 ]
It can be seen that the value of joint 5 does not affect the rank of the matrix, so the only condition in which the rank of the matrix S 21 5 is not full is
c 34 = 0   ,   c 4 = 0
In summary, there are four singularity conditions for the 7-DOF redundant manipulator, as shown in Table 2. If the joint angles of the manipulator satisfy any of them, the manipulator will be in a singular configuration.

4. Singularity Avoidance

It can be seen from the above analysis that the singularity conditions are described in the joint space. However, in practice, the end-effector of this manipulator is usually planned, and the singularity configuration is impossible to be predicted and avoided in motion planning because of the infinite number of the inverse kinematics solutions of the redundant manipulator. In the following section, the above-mentioned singular configuration is described based on position, and a singularity avoidance method is proposed for the avoidable singularities.

4.1. Type I Singularity

According to the expression analysis of condition 1 and condition 2, there are four possible configurations of manipulators regarding condition 1, which are shown in Table 3, and the configurations regarding condition 2 are shown in Table 4.
The first two of the four singularity conditions described above are all related to joint 6, so both condition 1 and condition 2 can be regarded as the first type of singularity. Since both condition 1 and condition 2 contain S6 = 0, such singular problems can be solved by avoiding the configuration corresponding to S6 = 0 through self-motion.
The following is the analysis of the characteristics of the manipulator when S6 = 0. When S6 = 0, the rotation axes of the joints 5 and 7 coincide with each other, and, since the axes of joints 2, 3, and 4 are parallel to each other, the axes of joints 5 and 7 must also be in the self-motion plane P formed by joints 2, 3, and 4, as shown in Figure 7.
Since the axis of the last joint 7 lies on the main plane P, according to the Equations (3) and (5), it can be expressed as
n 1 a = 0
where a = [ a x a y a z ] T , n1 is the normal vector to the plane P. Simplified Equation (35) can be obtained:
p x a y p y a x = 0
When the singularity occurs in Table 3, according to the geometric theorem forming the triangle, the distance SW between the shoulder point and wrist point of the manipulator and the corresponding redundancy angle meet the following equation:
φ = { ± φ 1   , | d 2 + d 3 d 4 | < | S W | < d 2 + d 3 + d 4 ± φ 2   , | | d 2 d 3 | d 4 | < | S W | < | d 2 d 3 | + d 4  
where the angle ± φ1 represents the corresponding redundancy angle when singular conditions of θ3 = 0, θ6 = 0, or π are satisfied, as shown in Figure 7a. In this case, angle φ1 can be expressed as the following equation:
φ 1 = arccos ( d 2 + d 3 ) 2 + | S W | 2 d 4 2 2 ( d 2 + d 3 ) | S W |
where the distance of SW can calculated from a given end-effector position, i.e., Equation (6). At this point, the axis vector of joint 5 (i.e., vector EW or EW) can be expressed as:
S E = R o t ( z 2 , φ 1 ) S W | S W | S E E W = S W S E S E = R o t ( z 2 , φ 1 ) S W | S W | S E E W = S W S E
where R o t ( z 2 , ± φ 1 ) represents the rotation matrix for the rotation of angle ± φ1 about the z2 axis. The angle ± φ2 represents the corresponding redundancy angle when singular condition of θ3 = π, θ6 = 0, or π are satisfied, as shown in Figure 7b. In this case, angle φ2 can be expressed as the following equation:
φ 2 = arccos ( d 2 d 3 ) 2 + | S W | 2 d 4 2 2 | d 2 d 3 | | S W |
So, the axis vector of joint 5 can be expressed as:
S E = R o t ( z 2 , φ 2 ) S W | S W | S E E W = S W S E S E = R o t ( z 2 , φ 2 ) S W | S W | S E E W = S W S E
When the axis of joint 7 is collinear with EW or E’W, the following equation is satisfied:
E W | E W | a = ± 1   or   E W | E W | a = ± 1  
Therefore, when the position and orientation of the end-effector are given, the relationship between EW vector and the axis vector a of joint 7 can be determined to know whether the manipulator is in the singular pose corresponding to singular condition 1.
In order to avoid singular configuration corresponding to singular condition 1, the redundant angle φ obtained according to Equation (38) and Equation (40) should be avoided during motion planning. However, singular condition 2 is only related to joint 5 and joint 6, and this singular type cannot be determined by the given end-effector position and orientation.

4.2. Type II Singularity

The last two of the four singularity conditions are related to joints 2, 3, and 4, so both conditions 3 and 4 can be regarded as the second kind of singularity. Since the first four joints determine the position of the end-effector, they can be regarded as the position singularity. From the perspective of workspace, position singularity can be divided into boundary singularity and internal singularity. Boundary singularity refers to the singularity caused by the position of the end-effector at the boundary of the workspace. Internal singularity refers to the position of the end-effector in the workspace when it is in the singular configuration. Whether it can be avoided needs to be discussed.
According to the geometric projection relationship of Figure 8, the projection of point W in the horizontal direction x is shown in Equation (43).
L x = d 2 c 2 + d 3 c 23 + d 4 c β
where β = θ 234 π / 2 . When this condition L x = 0 is satisfied, that is, singular condition 3, its geometric meaning is that the projection of point W in the horizontal direction x is zero. In other words, the end-effector of the manipulator is located on the axis of joint 1. At the moment, the position of the end-effector of the manipulator satisfies
  p x = p y = 0
From the analysis of the working space, the end-effector of the manipulator loses the movement perpendicular to the normal direction of the main plane, so the axis of joint 1 is also the boundary of the working space and cannot be avoided, as shown in Figure 9.
According to the expression analysis of condition 4, there are four possible joint combinations of joint 3 and joint 4, as shown in Table 5.
When θ3 = 0, θ4 = π/2, the manipulator is in the singularity position of the boundary of the workspace, which is an unavoidable singularity, and the other three are internal singularities. These four configurations have common motion characteristics. In these cases, points S and W are on a straight line; the length of SW is as follows:
| S W | = { d 2 + d 3 + d 4   , θ 3 = 0 ,   θ 4 = π / 2 d 2 + d 3 d 4   , θ 3 = 0 ,   θ 4 = π / 2 d 2 d 3 + d 4   , θ 3 = π ,   θ 4 = π / 2 d 2 d 3 d 4   , θ 3 = π ,   θ 4 = π / 2
At this time, the corresponding redundancy angle is φ = 0. Therefore, it can be concluded that, when the end-effector of the manipulator is in the avoidable singularity, the control variable φ is unequal to zero to avoid the current singularity configuration.

5. Simulation and Discussion

In this section, some simulation examples will be given to validate the previous analysis. Assume that the specific dimensions of the manipulator are as follows:
d 1 = 10 mm ,   d 2 = 20 mm ,   d 3 = 30 mm ,   d 4 = 20 mm

5.1. Case 1

Assuming that the initial position and orientation of the end-effector are
X e 0 = [ 30 mm ,   30 mm ,   30 mm ,   0.6 rad ,   0.4 rad ,   1.2 rad ]
The terminal position and orientation of the end-effector are
X ef = [ 40 mm ,   10 mm ,   10 mm ,   0 rad ,   0 rad ,   0 rad ]
When the manipulator is performing a task, intuitively, from an energy-saving point of view, it should try to move more joints near the end-effector of the robot arm and less joints near the base of the manipulator. Suppose we are now given the optimization requirement to keep joint 2 as motionless as possible during the motion and the motion of the remaining joints according to the principle of “the shortest trip”, that is, the amount of motion of each joint is minimized; the possible solution with the smallest joint angle difference from the previous time is selected to ensure a smooth transition of joint motion between the two times. The appropriate redundancy angle φ is selected to minimize the change of upper arm corresponding to adjacent path points. That is,
Δ θ 2 = | θ 2 ( i + 1 ) θ 2 ( i ) |
where θ 2 ( i ) and θ 2 ( i + 1 ) represent the angle of joint 2 between the current time and the next time. The symbol i represents the ith waypoint among many discrete points of a trajectory.
In Figure 10, the planned trajectory can be obtained by the interpolation between X e 0 and X ef , and the actual trajectory can be obtained by forward kinematic of the joint angle in Figure 11. The planned trajectory of the end-effector of the manipulator coincides with the actual trajectory, which proves the correctness of the algorithm of inverse kinematics. In Figure 11, the value of joint 2 does not change, which proves that this algorithm can make the manipulator move along the planned trajectory while keeping the upper arm as still as possible according to the optimization requirements.

5.2. Case 2

For manipulators, maneuverability [37] is usually used as a measure of the dexterity of the manipulator, which can be expressed by Equation (49)
ω = det ( J J T )
When ω = 0, it is in the singularity state. When ω > 0, it is in the non-singular state. To make the expression of singularity more obvious, Equation (49) is modified to
λ = 1 / ( det ( J J T ) + 1 )
When the location of the manipulator is in the non-singularity configuration, λ is close to 0, and, in the singularity configuration, λ is close to 1. So, λ can be used to judge whether the manipulator is at the singularity condition. Therefore, we can define λ as a singular index to judge singularity.

5.2.1. The Verification of Type I Singularity

Assuming that the position and orientation of the end-effector are
X e 1 = [ 30 mm ,   10 mm ,   10 mm ,   2.1803 rad ,   0.6194 rad ,   0.7326 rad ] H e 1 = [ 0.5256 0.2236 0.8250 30 0.4729 0.6708 0.2750 10 0.6149 0.7071 0.4937 10 0 0 0 1 ]
where X e 1 is the pose vector composed of three-dimensional position coordinates and RPY (roll-pitch-yaw) angle, and H e 1 is its corresponding homogeneous transformation matrix.
From Equation (51), it can be seen that the relationship between the position and the orientation of the manipulator satisfies Equation (36), and Equation (37) needs to be avoided by controlling the self-motion variables, and the value of the redundancy angle corresponding to the singularity can be obtained by the Equation (38).
φ = ±   0.1987   rad
Figure 12 shows the relationship between the singularity index of the manipulator and the selection of self-motion variables when the position and orientation of the end-effector are determined. Most of the values are infinitely close to zero, but there is a peak corresponding to the value λ between φ = 0 and φ = 0.5. At this time, according to the redundant angle corresponding to the singularity configuration obtained above, it can be proved that using the above singularity judgment method for type I , that is, judging whether singularity will occur according to the end pose relationship, and the value of redundant angle φ that should be avoided, can be obtained.

5.2.2. The Verification of Type II Singularity

The position singularity is only related to the position of the manipulator, so the given position of the end-effector is
X e 2 = [ 30 mm ,   0 mm ,   10 mm ,   0.2 rad ,   0.3 rad ,   0.5 rad ] H e 2 = [ 0.8384 0.4183 0.3494 30 0.4580 0.8882 0.0355 0 0.2955 0.1898 0.9363 10 0 0 0 1 ]
where X e 2 is the pose vector composed of three-dimensional position coordinates and RPY angle, and H e 2 is its corresponding homogeneous transformation matrix. It can be seen from Equation (53) that the distance between S and W of the manipulator satisfies the Equation (54) (i.e., | S W | = 30   mm = d 2 + d 3 d 4 ). It is necessary to avoid singularity by controlling the variable of self-motion. The value of redundancy angle corresponding to singularity can be obtained as shown below.
  φ = 0 ,   π   rad
Similarly, when the position and orientation of the end-effector are determined, the relationship between the singularity index of the manipulator and the self-motion variable is given. As can be seen from Figure 13, most of the singularity values are infinitely close to 0, but there is a peak corresponding to the value λ when the value of the redundant angle is 0 or π. At this time, according to the redundant angle corresponding to the singularity configuration obtained above, it is proved that the singularity judgment and avoidance method proposed above can avoid the type II singularity configuration.

5.3. Case 3

Through the previous analysis, it can be seen that this redundant manipulator can avoid singularities by self-motion. In addition, the description of singularity from the aspects of terminal posture and self-motion lays a foundation for trajectory planning. The following is a simulation and planning of the trajectory of the manipulator to verify the accuracy of the singularity avoidance.
Assuming the initial point of the trajectory of the manipulator is
X e 0 = [ 30 mm ,   20 mm ,   10 mm ,   0 ad ,   0 . 6 rad ,   0 . 4 rad ]
Two intermediate points on the trajectory are
X e 1 = [ 30 mm ,   10 mm ,   10 mm ,   2.1803 rad ,   0.6194 rad ,   0.7327 rad ] X e 2 = [ 30 mm ,   0 mm ,   10 mm ,   0.2 rad ,   0.3 rad ,   0.5 rad ]
The terminal point is
X ef = [ 30 mm , 10 mm ,   10 mm ,   0.6 rad ,   0.4 rad ,   1.2 rad ]
where X e 1 and X e 2 are the pose vectors of the end effector in case 2, which represent two types of singularity, respectively.
The end-effector of the manipulator moves according to the path planned by four nodes X e 0 , X e 1 , X e 2 , and X ef . To plan conveniently, a cubic spline curve interpolation algorithm is used, and the total time is 100s. According to the above kinematic analysis, the redundant angle φ needs to be determined to solve the inverse kinematics. According to Equation (49), the values of ω corresponding to different redundant angles φ are shown in Figure 14.
In Figure 14, these black circles express the value of redundant angle φ that satisfies the Equation (49) is maximum. The red line can be obtained by the curve fitting of the value that black circles represent. The color of Figure 14 expresses the value of ω with this redundant angle φ and increases from blue to yellow. Since the selection of the redundancy angle φ is based on the maneuverability index ω, the larger the maneuverability index ω, the better the flexibility of the manipulator, so the area where the red curve passes is mostly yellow. The maneuverability index ω is shown in Figure 15.
In Figure 15, the value of ω according to different redundant angle φ is far greater than 0, and the above values are 104 orders of magnitude, which can make the manipulator have the better configuration and flexibility when the position and orientation end-effector are satisfied.
The joint angular velocities of the manipulator during this motion are shown in Figure 16. As can be seen from the above figure, the angular velocity of each joint of the manipulator varies smoothly. Therefore, this method can be used for the control of the manipulator to make sure the manipulator stays away from the singularity.

6. Conclusions

The inverse kinematics and singularities of the 7-DOF redundant manipulator under study are analyzed, and the self-motion of the mechanism is characterized as a planar four-bar motion, described by the redundancy angle, and an inverse kinematics analysis algorithm of the 7-DOF redundant manipulator based on the self-motion is proposed. By analyzing the Jacobi matrix of the arm, a simplified Jacobi matrix is obtained using the coordinate system selection and primary transformation of the Jacobi matrix, and the singularity conditions of the arm are derived using the block matrix. A singular configuration avoidance algorithm based on self-motion is proposed through the selection of redundant angles to avoid singular patterns. The inverse kinematics and singularity analysis of the robotic arm are verified by simulation examples, laying the foundation for the motion planning of a 7-DOF manipulator.

Author Contributions

Conceptualization and methodology, Z.Y.; writing—original draft preparation, Y.G.; writing—review and editing, X.S.; visualization, X.C.; supervision, Y.G.; project administration, Z.C.; All authors have read and agreed to the published version of the manuscript.

Funding

This research was funded by National Natural Science Foundation of China, grant number 51775474.Natural Science Foundation of Hebei Province, grant number E2020203197, and Hebei Province Science and Technology Support Program, grant number 19221909D.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Kuhlemann, I.; Jauer, P.; Ernst, F.; Schweikard, A. Robots with Seven Degrees of Freedom: Is the Additional DoF Worth It? ICCAR2016; Institute of Electrical and Electronics Engineers Inc.: Hong Kong, China, 2016; pp. 80–84. [Google Scholar]
  2. Coleshill, E.; Oshinowo, L.; Rembala, R.; Bardia, B.; Daniel, R.; Shelley, S. Dextre: Improving maintenance operations on the International Space Station. Acta Astronaut. 2009, 64, 869–874. [Google Scholar] [CrossRef]
  3. Bischoff, R.; Kurth, J.; Schreiber, G.; Koeppe, R.; Hirzinger, G. The KUKA-DLR Lightweight Robot arm—A new reference platform for robotics research and manufacturing. In Proceedings of the ISR 2010 (41st International Symposium on Robotics) and ROBOTIK 2010 (6th German Conference on Robotics), Munich, Germany, 7–9 June 2010; pp. 741–748. [Google Scholar]
  4. Liu, W.; Chen, D.; Steil, J. Analytical inverse kinematics solver for anthropomorphic 7-DOF redundant manipulators with human-like configuration constraints. J. Intell. Robot. Syst. 2017, 86, 63–79. [Google Scholar] [CrossRef]
  5. Yahya, S.; Mohamed, H.A.F.; Moghavvemi, M.; Yang, S.S. A new geometrical inverse kinematics method for planar hyper redundant manipulators. In Proceedings of the 2009 Innovative Technologies in Intelligent Systems and Industrial Applications, Kuala Lumpur, Malaysia, 25–26 July 2009; pp. 20–22. [Google Scholar]
  6. Sheng, L.; Yiqing, W.; Qingwei, C.; Weili, H. A new geometrical method for the inverse kinematics of the hyper-redundant manipulators. In Proceedings of the 2006 IEEE International Conference on Robotics and Biomimetics, Kunming, China, 17–20 December 2006; pp. 1356–1359. [Google Scholar]
  7. Mohamed, H.A.F.; Yahya, S.; Moghavvemi, M.; Yang, S.S. A new inverse kinematics method for three dimensional redundant manipulators. In Proceedings of the 2009 ICCAS-SICE, Fukuoka, Japan, 18–21 August 2009; pp. 1557–1562. [Google Scholar]
  8. Whitney, D.E. Resolved motion rate control of manipulators and human prostheses. IEEE Trans. Man-Mach. Syst. 1969, 10, 47–53. [Google Scholar] [CrossRef]
  9. Baillieul, J. Kinematic programming alternatives for redundant manipulators, Proceedings. In Proceedings of the 1985 IEEE International Conference on Robotics and Automation, St. Louis, MO, USA, 25–28 March 1985; pp. 722–728. [Google Scholar]
  10. Baillieul, J. Avoiding obstacles and resolving kinematic redundancy, Proceedings. In Proceedings of the 1986 IEEE International Conference on Robotics and Automation, San Francisco, CA, USA, 7–10 April 1986; pp. 1698–1704. [Google Scholar]
  11. Liegeois, A. Automatic supervisory control of the configuration and behavior of multibody mechanisms. IEEE Trans. Syst. Man Cybern. 1977, 7, 868–871. [Google Scholar]
  12. Jun, W.; HongTao, W.; Rui, M.; Liang’an, Z. A study on avoiding joint limits for inverse kinematics of redundant manipulators using improved clamping weighted least-norm method. JMST 2018, 32, 1367–1378. [Google Scholar]
  13. Nakamura, Y.; Hanafusa, H. Inverse kinematic solutions with singularity robustness for robot manipulator control. J. Dyn. Syst. Meas. Control 1986, 108, 163–171. [Google Scholar] [CrossRef]
  14. An, H.H.; Clement, W.I.; Reed, B. Analytical inverse kinematic solution with self-motion constraint for the 7-DOF restore robot arm. In Proceedings of the 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics, Besacon, France, 8–11 July 2014; pp. 1325–1330. [Google Scholar]
  15. Tolani, D.; Goswami, A.; Badler, N.I. Real-time inverse kinematics techniques for anthropomorphic limbs. Graph. Models 2000, 62, 353–388. [Google Scholar] [CrossRef] [Green Version]
  16. Faria, C.; Ferreira, F.; Erlhagen, W.; Monteiro, S.; Bicho, E. Position-based kinematics for 7-DoF serial manipulators with global configuration control, joint limit and singularity avoidance. Mech. Mach. Theory 2018, 121, 317–334. [Google Scholar] [CrossRef] [Green Version]
  17. Lee, S.; Bejczy, A.K. Redundant arm kinematic control based on parameterization. In Proceedings of the 1991 IEEE International Conference on Robotics and Automation, Sacramento, CA, USA, 9–11 April 1991; pp. 458–465. [Google Scholar]
  18. Zaplana, I.; Basanez, L. A novel closed-form solution for the inverse kinematics of redundant manipulators through workspace analysis. Mech. Mach. Theory 2018, 121, 829–843. [Google Scholar] [CrossRef] [Green Version]
  19. Kreutz-Delgado, K.; Long, M.; Seraji, H. Kinematic analysis of 7-DOF manipulators. Int. J. Rob. Res. 1992, 11, 469–481. [Google Scholar] [CrossRef]
  20. Xia, D.; Wang, L.; Chai, T. Neural-network-friction compensation-based energy swing-up control of pendubot. IEEE Trans. Ind. Electron. 2014, 61, 1411–1423. [Google Scholar] [CrossRef]
  21. Xu, S.S.; Chen, C.; Wu, Z. Study of nonsingular fast terminal sliding-mode fault-tolerant control. IEEE Trans. Ind. Electron. 2015, 62, 3906–3913. [Google Scholar] [CrossRef]
  22. Podhorodeski, R.P.; Goldenberg, A.A.; Fenton, R.G. Resolving redundant manipulator joint rates and identifying special arm configurations using Jacobian null-space bases. IEEE Trans. Rob. Autom. 1991, 7, 607–618. [Google Scholar] [CrossRef]
  23. Nokleby, S.B.; Podhorodeski, R.P. Reciprocity-based resolution of velocity degeneracies (singularities) for redundant manipulators. Mech. Mach. Theory 2001, 36, 397–409. [Google Scholar] [CrossRef]
  24. Kong, X.W.; Gosselin, C.M. A dependent-screw suppression approach to the singularity analysis of a 7-DOF redundant manipulator: Canadarm2. Trans. Can. Soc. Mech. Eng. 2005, 29, 593–604. [Google Scholar] [CrossRef]
  25. Xu, W.; Zhang, J.; Liang, B.; Li, B. Singularity analysis and avoidance for robot manipulators with nonspherical wrists. IEEE Trans. Ind. Electron. 2016, 63, 277–290. [Google Scholar] [CrossRef]
  26. Xu, W.; Zhang, J.; Qian, H.; Chen, Y.; Xu, Y. Identifying the singularity conditions of Canadarm2 based on elementary Jacobian transformation. In Proceedings of the 2013 26th IEEE/RSJ International Conference on Intelligent Robots and Systems, Tokyo, Japan, 3–7 November 2013; pp. 795–800. [Google Scholar]
  27. Chiaverini, S.; Siciliano, B.; Egeland, O. Review of the damped least-squares inverse kinematics with experiments on an industrial robot manipulator. IEEE Trans. Control Syst. Technol. 1994, 2, 123–134. [Google Scholar] [CrossRef] [Green Version]
  28. Nenchev, D.N.; Tsumaki, Y.; Takahashi, M. Singularity-consistent kinematic redundancy resolution for the S-R-S manipulator. In Proceedings of the 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566), Sendai, Japan, 28 September–2 October 2004; pp. 3607–3612. [Google Scholar]
  29. Oetomo, D.; Ang, M.H., Jr. Singularity robust algorithm in serial manipulators. Robot. Comput. Integr. Manuf. 2009, 25, 122–134. [Google Scholar] [CrossRef]
  30. Hollerbach, J.M. Optimum Kinematic Design for a Seven Degree of Freedom Manipulator. In International Symposium of Robotics Research; Mit Press: Cambridge, MA, USA, 1985. [Google Scholar]
  31. Shimizu, M.; Yoon, W.; Kitagaki, K. A Practical Redundancy Resolution for 7 DOF Redundant Manipulators with Joint Limits. In Proceedings of the 2007 IEEE International Conference on Robotics and Automation, Rome, Italy, 21 May 2007; pp. 4510–4516. [Google Scholar]
  32. Busson, D.; Bearee, R.; Olabi, A. Task-oriented rigidity optimization for 7 DOF redundant manipulators. IFAC-PapersOnLine 2017, 1, 14588–14593. [Google Scholar] [CrossRef]
  33. Chen, G.; Zhang, L.; Jia, Q.; Sun, H. Singularity analysis of redundant space robot with the structure of Canadarm2. Math. Probl. Eng. 2014, 2014, 735030. [Google Scholar] [CrossRef]
  34. Xu, W.; She, Y.; Xu, Y. Analytical and semi-analytical inverse kinematics of SSRMS-type manipulators with single joint locked failure. Acta Astronaut. 2014, 1, 201–217. [Google Scholar] [CrossRef]
  35. Whitney, D.E. The mathematics of coordinated control of prosthetic arms and manipulators. J. Dyn. Sys. Meas. Control. 1972, 94, 303–309. [Google Scholar] [CrossRef]
  36. Matsaglia, G.; PHStyan, G. Equalities and inequalities for ranks of matrices. Linear Multilinear Algebra 1974, 3, 269–292. [Google Scholar] [CrossRef]
  37. Yoshikawa, T. Manipulability of robotic mechanisms. Int. J. Robot. Res. 1985, 2, 3–9. [Google Scholar] [CrossRef]
Figure 1. Structure of the redundant manipulator.
Figure 1. Structure of the redundant manipulator.
Sensors 21 07257 g001
Figure 2. Feature of the self-motion.
Figure 2. Feature of the self-motion.
Sensors 21 07257 g002
Figure 3. Planar four-bar mechanism.
Figure 3. Planar four-bar mechanism.
Sensors 21 07257 g003
Figure 4. Self-motion plane.
Figure 4. Self-motion plane.
Sensors 21 07257 g004
Figure 5. Geometric relationship of joint 2.
Figure 5. Geometric relationship of joint 2.
Sensors 21 07257 g005
Figure 6. Position of the elbow E.
Figure 6. Position of the elbow E.
Sensors 21 07257 g006
Figure 7. (a) Singular configuration corresponding to θ6 = 0 or π, θ3 = 0; (b) Singular configuration corresponding to θ6 = 0 or π, θ3 = π.
Figure 7. (a) Singular configuration corresponding to θ6 = 0 or π, θ3 = 0; (b) Singular configuration corresponding to θ6 = 0 or π, θ3 = π.
Sensors 21 07257 g007
Figure 8. Geometric illustration of singular condition 3.
Figure 8. Geometric illustration of singular condition 3.
Sensors 21 07257 g008
Figure 9. The configuration corresponding to condition 3.
Figure 9. The configuration corresponding to condition 3.
Sensors 21 07257 g009
Figure 10. The comparison of planned trajectory and actual trajectory.
Figure 10. The comparison of planned trajectory and actual trajectory.
Sensors 21 07257 g010
Figure 11. Variation of all joint angles.
Figure 11. Variation of all joint angles.
Sensors 21 07257 g011
Figure 12. Type I .
Figure 12. Type I .
Sensors 21 07257 g012
Figure 13. Type II .
Figure 13. Type II .
Sensors 21 07257 g013
Figure 14. The relationship of φ and maneuverability index ω corresponding to the trajectory.
Figure 14. The relationship of φ and maneuverability index ω corresponding to the trajectory.
Sensors 21 07257 g014
Figure 15. The variety of maneuverability index ω.
Figure 15. The variety of maneuverability index ω.
Sensors 21 07257 g015
Figure 16. Angular velocity of each joint.
Figure 16. Angular velocity of each joint.
Sensors 21 07257 g016
Table 1. D–H parameters of a 7-DOF manipulator.
Table 1. D–H parameters of a 7-DOF manipulator.
Jointθi a i 1 α i 1 ( rad ) d i
1θ100d1
2θ20π/20
3θ3d200
4θ4d300
5θ50π/2d4
6θ60π/20
7θ70π/20
Table 2. Joint singularity conditions.
Table 2. Joint singularity conditions.
Condition iJoint
1 s 6 = 0 ,   s 3 = 0
2 s 6 = 0 ,   s 5 = 0
3 d 2 c 2 + d 3 c 23 + d 4 s 234 = 0
4 c 34 = 0 ,   c 4 = 0
Table 3. Singularities corresponding to condition 1.
Table 3. Singularities corresponding to condition 1.
Singular condition θ 3 = 0 θ 6 = 0 θ 3 = 0 θ 6 = π θ 3 = π θ 6 = 0 θ 3 = π θ 6 = π
Configuration characteristics Sensors 21 07257 i001 Sensors 21 07257 i002 Sensors 21 07257 i003 Sensors 21 07257 i004
Table 4. Singularities corresponding to condition 2.
Table 4. Singularities corresponding to condition 2.
Singular condition θ 5 = 0 θ 6 = 0 θ 5 = 0 θ 6 = π θ 5 = π θ 6 = 0 θ 5 = π θ 6 = π
Configuration characteristics Sensors 21 07257 i005 Sensors 21 07257 i006 Sensors 21 07257 i007 Sensors 21 07257 i008
Table 5. Singularities corresponding to condition 4.
Table 5. Singularities corresponding to condition 4.
Singular condition θ 3 = 0 θ 4 = π / 2 θ 3 = 0 θ 4 = π / 2 θ 3 = π θ 4 = π / 2 θ 3 = π θ 4 = π / 2
Configuration characteristics Sensors 21 07257 i009 Sensors 21 07257 i010 Sensors 21 07257 i011 Sensors 21 07257 i012
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Shi, X.; Guo, Y.; Chen, X.; Chen, Z.; Yang, Z. Kinematics and Singularity Analysis of a 7-DOF Redundant Manipulator. Sensors 2021, 21, 7257. https://0-doi-org.brum.beds.ac.uk/10.3390/s21217257

AMA Style

Shi X, Guo Y, Chen X, Chen Z, Yang Z. Kinematics and Singularity Analysis of a 7-DOF Redundant Manipulator. Sensors. 2021; 21(21):7257. https://0-doi-org.brum.beds.ac.uk/10.3390/s21217257

Chicago/Turabian Style

Shi, Xiaohua, Yu Guo, Xuechan Chen, Ziming Chen, and Zhiwei Yang. 2021. "Kinematics and Singularity Analysis of a 7-DOF Redundant Manipulator" Sensors 21, no. 21: 7257. https://0-doi-org.brum.beds.ac.uk/10.3390/s21217257

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop